Abstract：Methods using the Jacobian matrix are quite effective for manipulator inverse kinematic solution except in regions near singular points. Many approaches have been developed to handle the singularity problem. In this paper, an algorithm using damped pseudoinverse with variable damped weight is introduced for inverse kinematic solution. An upper bound of condition number of the Jacobian matrix is established, according to the value of this upper bound, a method to adaptively adjust the damped weight is proposed. The introduced algorithm is stable in regions near singular points and can achieve accurate solution.
1 Nakamura Y,Hanafusa H.Inverse Kinematic Solutions with Singularity Robust ness for Robot Manipulator Control.ASME Journal of Dynamic Systems,Measurement,and Control,1986,108:163～171 2 Wampler C W.Manipulator Inverse Kinematic Solutions Based on Vector Formulations and Damped Least-squares Method.IEEE Trans,Systems,Man,and Cybernetics,1986,SMC-16(1):93～101 3 Angeles J,Rojas A A.Manipulator In verse Kinematicsvia Condition Minimization and Condituation.Int J Robotics and Automation,1987,2(2):61～69 4 Mayorga R V,Wong A K C,Milano.A Fast Procedure for Manipulat or Inverse Kinematics Evaluation and Pseudoinverse Robust ness.IEEE Trans Systems,Man and Cybernetics,1992,SMC-22(4):790～798 5 Chan S K,Lawrence P D.General Inverse Kinematics with the Error Damped Pseudoin verse.Proc IEEE Int Conf Robotics and Automation,1988:834～839