Efficient and Singularity-Aware Inverse Kinematics for 6-DOF and 7-DOF Revolute Manipulators

Inverse kinematics (IK) for 6-DOF and 7-DOF revolute robot manipulators may be decomposed into canonical subproblems which find the angles on circles where they intersect with other geometric objects. We present new algebraic solutions and geometric interpretations for six subproblems. We demonstrate significant performance improvements over existing IK methods. 7-DOF manipulators have one redundant DOF to parameterize, so we introduce the general SEW angle, which generalizes the conventional SEW angle but with an arbitrary reference direction function. One special choice, the stereographic SEW angle, has a singularity when the wrist is on a half-line instead of a full line.