A complete generalized solution to the inverse kinematics of robots

The kinematic transformation between task space and joint configuration coordinates is nonlinear and configuration dependent. A solution to the inverse kinematics is a vector of joint configuration coordinates that corresponds to a set of task space coordinates. For a class of robots closed form solutions always exist, but constraints on joint displacements cannot be systematically incorporated in the process of obtaining a solution. An iterative solution is presented that is suitable for any class of robots having rotary or prismatic joints, with any arbitrary number of degrees of freedom, including both standard and kinematically redundant robots. The solution can be obtained subject to specified constraints and based on certain performance criteria. The solution is based on a new rapidly convergent constrained nonlinear optimization algorithm which uses a modified Newton-Raphson technique for solving a system nonlinear equations. The algorithm is illustrated using as an example a kinematically redundant robot.