The kinematic roadmap: a motion planning based global approach for inverse kinematics of redundant robots

Abstract

This paper proposes a novel and global approach to solving the point-to-point inverse kinematics problem for highly redundant manipulators. Given an initial configuration of the robot, the problem is to find a reachable configuration that corresponds to a desired position and orientation of the end-effector. Central to our approach is the novel notion of kinematic roadmap for a manipulator. The kinematic roadmap captures the connectivity of the connected component of the free configuration space of the manipulator in a finite graph like structure. The point-to-point inverse kinematics problem is then solved using this roadmap. We provide completeness results for our algorithm. Our implementation of SEARCH is an efficient closed form solution, albeit local, to inverse kinematics that exploits the serial kinematic structure of serial manipulator arms. Initial experiments with a 7-DOF manipulator have been extremely successful.