Augmented Feasibility Maps: A Simultaneous Approach to Redundancy Resolution and Path Planning Conference Paper 2024 Congress communication