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.

[1]  A. Liegeois,et al.  Automatic supervisory control of the configuration and behavior of multi-body mechanisms , 1977 .

[2]  Keith L. Doty,et al.  A Theory of Generalized Inverses Applied to Robotics , 1993, Int. J. Robotics Res..

[3]  John M. Hollerbach,et al.  Local versus global torque optimization of redundant manipulators , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[4]  Tsuneo Yoshikawa,et al.  Dynamic manipulability of robot manipulators , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[5]  Thomas B. Sheridan,et al.  Robust compliant motion for manipulators, part I: The fundamental concepts of compliant motion , 1986, IEEE J. Robotics Autom..

[6]  A. Nedungadi,et al.  A Local Solution with Global Characteristics for the Joint Torque Optimization of a Redundant Manipulator , 1989 .

[7]  Rajiv V. Dubey,et al.  A weighted least-norm solution based scheme for avoiding joint limits for redundant joint manipulators , 1993, IEEE Trans. Robotics Autom..

[8]  John Baillieul,et al.  Kinematic programming alternatives for redundant manipulators , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[9]  Neville Hogan,et al.  Stable execution of contact tasks using impedance control , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[10]  Hee-Jun Kang,et al.  Joint torque optimization of redundant manipulators via the null space damping method , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[11]  L. Sciavicco,et al.  A dynamic solution to the inverse kinematic problem for redundant manipulators , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[12]  Kazem Kazerounian,et al.  An alternative method for minimization of the driving forces in redundant manipulators , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[13]  Charles A. Klein,et al.  Dynamic simulation of a kinematically redundant manipulator system , 1987, J. Field Robotics.

[14]  Charles W. Wampler,et al.  Manipulator Inverse Kinematic Solutions Based on Vector Formulations and Damped Least-Squares Methods , 1986, IEEE Transactions on Systems, Man, and Cybernetics.

[15]  Toshio Tsuji,et al.  Non-contact impedance control for redundant manipulators using visual information , 1997, Proceedings of International Conference on Robotics and Automation.

[16]  Tsuneo Yoshikawa,et al.  Manipulability of Robotic Mechanisms , 1985 .

[17]  A. A. Maciejewski,et al.  Obstacle Avoidance , 2005 .

[18]  Larry Leifer,et al.  Applications of Damped Least-Squares Methods to Resolved-Rate and Resolved-Acceleration Control of Manipulators , 1988 .

[19]  Miomir Vukobratovic,et al.  A dynamic approach to nominal trajectory synthesis for redundant manipulators , 1984, IEEE Transactions on Systems, Man, and Cybernetics.

[20]  Mark W. Spong,et al.  Robust linear compensator design for nonlinear robotic control , 1985, IEEE J. Robotics Autom..

[21]  S. Shankar Sastry,et al.  Dynamic control of redundant manipulators , 1989, J. Field Robotics.

[22]  Anthony A. Maciejewski,et al.  Numerical filtering for the operation of robotic manipulators through kinematically singular configurations , 1988, J. Field Robotics.

[23]  Robert L. Williams.  Local performance optimization for a class of redundant eight-degree-of-freedom manipulators , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[24]  Mark W. Spong,et al.  Robot dynamics and control , 1989 .

[25]  Feng Gao,et al.  Criteria based analysis and design of three degree of freedom planar robotic manipulators , 1997, Proceedings of International Conference on Robotics and Automation.

[26]  Ian D. Walker,et al.  Impact configurations and measures for kinematically redundant and multiple armed robot systems , 1994, IEEE Trans. Robotics Autom..

[27]  J. Y. S. Luh,et al.  Resolved-acceleration control of mechanical manipulators , 1980 .

[28]  Clément Gosselin,et al.  A Global Performance Index for the Kinematic Optimization of Robotic Manipulators , 1991 .

[29]  Oussama Khatib,et al.  A unified approach for motion and force control of robot manipulators: The operational space formulation , 1987, IEEE J. Robotics Autom..

[30]  Homayoun Seraji,et al.  Real-time collision avoidance for redundant manipulators , 1995, IEEE Trans. Robotics Autom..

[31]  Shugen Ma,et al.  Improving local torque optimization techniques for redundant robotic mechanisms , 1991, J. Field Robotics.

[32]  T. Yoshikawa,et al.  Task-Priority Based Redundancy Control of Robot Manipulators , 1987 .

[33]  Charles A. Klein,et al.  Review of pseudoinverse control for use with kinematically redundant manipulators , 1983, IEEE Transactions on Systems, Man, and Cybernetics.

[34]  John M. Hollerbach,et al.  Redundancy resolution of manipulators through torque optimization , 1987, IEEE J. Robotics Autom..

[35]  Tsuneo Yoshikawa,et al.  Manipulability and redundancy control of robotic mechanisms , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[36]  Zhaoyu Wang,et al.  Global versus Local Optimization in Redundancy Resolution of Robotic Manipulators , 1988, Int. J. Robotics Res..

[37]  Adi Ben-Israel,et al.  Generalized inverses: theory and applications , 1974 .

[38]  Nenad Kircanski,et al.  An experimental study of resolved acceleration control in singularities: damped least-squares approach , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[39]  Yoshihiko Nakamura,et al.  Inverse kinematic solutions with singularity robustness for robot manipulator control , 1986 .