Quasi-Orthogonal Foliations of the Configuration Space: A Redundancy Resolution Approach at Position Level

High versatility and flexibility of robotic systems require kinematic structures with many degrees of freedom. This usually renders the system kinematically redundant, i.e., the main manipulation or interaction task does not fully determine its maneuvers. Additional constraints or objectives are required to solve the under-determined control and planning problems. The state-of-the-art approaches arrange tasks in a hierarchy and decouple lower from higher priority tasks on velocity or torque level. Velocities and torques are elements of vector spaces. Thus the approaches are inherently based on linear algebra tools. In this paper, we develop an approach to redundancy resolution and decoupling on position level. That requires moving from vector spaces and linear algebra to manifolds and differential geometry. We propose to determine, another set of coordinate functions in addition to the task forward kinematics. The Jacobian of those functions shall resemble the conditions known from the linear algebra-based velocity- and torque-level decoupling to the best extent possible. The approach provides a better insight into the topological properties of robot kinematics and control problems, allowing a more global geometric view. Quasi-decoupled coordinates can help to avoid or diminish some practical and theoretical difficulties related to the classical projection approaches at the cost of higher offline computational efforts. A condition for the existence of these coordinates is derived. If the condition is not satisfied, we still find approximate solutions by numerical optimization. Finally, we show simulation results for both, trajectory tracking and classical impedance control and validate the approach experimentally on a 7DoF robot.