一种基座姿态可控空间机器人的通用避奇异算法

A general singularity avoidance algorithm is proposed to solve the kinematic singularity problem of pedestal-controllable space manipulator in Cartesian path planning. First, we establish Jacobian matrix of the space manipulator by the method of virtual mechanical arm, and determine singular area by judging the relationship between the determinant of Jacobian matrix and angular velocity in real time. Then, Newton-Raphson iterative method is used to solve inverse kinematics of manipulator. Finally, we design a segmental path planning algorithm of "differential term extraction + refitting" for singularity avoidance, until the joint angle breaks away from the singular area. Simulation results show that the proposed algorithm can accomplish the singular avoidance task effectively. The proposed algorithm can be adapted to various degrees of freedom and configurations of mechanical arm. Moreover, it is convenient for users to adjust the relationship between calculation time and tracking accuracy, and has good universality.