Inverse Kinematics Analysis for Manipulator Robot with Wrist Offset Based On the Closed-Form Algorithm

摘要

This paper presents an algorithm to solve the inverse kinematics for a six degree of freedom (6 DOF) manipulator robot with wrist offset. This type of robot has a complex inverse kinematics, which needs a long time for such calculation. The proposed algorithm starts from find the wrist point by vectors computation then compute the first three joint angles and after that compute the wrist angles by analytic solution. This algorithm is tested for the TQ MA2000 manipulator robot as case study. The obtained results was compared with results of rotational vector algorithm where both algorithms have the same accuracy but the proposed algorithm saving round about 99.6% of the computation time required by the rotational vector algorithm, which leads to used this algorithm in real time robot control.