Constrained closed loop inverse kinematics

This paper introduces a kinematically constrained closed loop inverse kinematics algorithm for motion control of robots or other articulated rigid body systems. The proposed strategy utilizes gradients of collision and joint limit potential functions to arrive at an appropriate weighting matrix to penalize and dampen motion approaching constraint surfaces. The method is particularly suitable for self collision avoidance of highly articulated systems which may have multiple collision points among several segment pairs. In that respect, the proposed method has a distinct advantage over existing gradient projection based methods which rely on numerically unstable null-space projections when there are multiple intermittent constraints. We also show how this approach can be augmented with a previously reported method based on redirection of constraints along virtual surface manifolds. The hybrid strategy is effective, robust, and does not require parameter tuning. The efficacy of the proposed algorithm is demonstrated for a self collision avoidance problem where the reference motion is obtained from human observations. We show simulation and experimental results on the humanoid robot ASIMO.

Authors

• Behzad Dariush
• Youding Zhu
• Arjun Arumbakkam
• Kikuo Fujimura

Keywords

• Kinematics
• Collision avoidance
• Humanoid robots
• Robustness
• Service robots
• Robotics and automation
• Motion control
• Motion planning
• Human robot interaction
• USA Councils
• Inverse Kinematics
• Simulation Results
• Weight Matrix
• Numerical Instability
• Humanoid Robot
• Segment Pairs
• Joint Limits
• Collision Point
• Reference Motion
• Root Mean Square Error
• Degrees Of Freedom
• Magnitude Of Change
• Minimum Distance
• Diagonal Matrix
• Upper Body
• Hybrid Approach
• Positive Definite Matrix
• Definite Matrix
• Position Vector
• Tracking Error
• Least Squares Solution
• Weight Method
• Obstacle Avoidance
• Task Space
• Human Motion
• Joint Space
• Robot Motion
• Critical Distance
• Jacobian Matrix
• Weighting Factor