Torque Optimizing Control with Singularity-Robustness for Kinematically Redundant Robots

A new control method for kinematically redundant manipulators having the properties of torque-optimality and singularity-robustness is developed. A dynamic control equation, an equation of joint torques that should be satisfied to get the desired dynamic behavior of the end-effector, is formulated using the feedback linearization theory. The optimal control law is determined by locally optimizing an appropriate norm of joint torques using the weighted generalized inverses of the manipulator Jacobian-inertia product. In addition, the optimal control law is augmented with fictitious joint damping forces to stabilize the uncontrolled dynamics acting in the null-space of the Jacobian-inertia product. This paper also presents a new method for the robust handling of robot kinematic singularities in the context of joint torque optimization. Control of the end-effector motions in the neighborhood of a singular configuration is based on the use of the damped least-squares inverse of the Jacobian-inertia product. A damping factor as a function of the generalized dynamic manipulability measure is introduced to reduce the end-effector acceleration error caused by the damping. The proposed control method is applied to the numerical model of SNU-ERC 3-DOF planar direct-drive manipulator.