A Strong Real Time Algorithm For Inverse Kinematics Of 6r Robots

Huashan Liu,Shiqiang Zhu,Jianbo Wu
2009-01-01
Abstract:Different from the traditional method, we propose a novel algorithm based oil vector dot product and orthogonal matrix for inverse kinematics of 6R robots, which features in strong real time performance and no extraneous roots in the solving process. By using the character that the rotation sub-matrix is an orthogonal Zn matrix, the complex solution procedures of inverse matrix are avoided. Then the kinematics equations containing 6 unknown joint angle variables can be reconstructed to 10 pure algebraic equations by vector dot product. Particularly, aiming to improve the real time performance further, we optimized the linear combinations of the related equations for the 5th and 6th joint angle variables. Also, we utilize MAPLE in symbolic operations to increase the accuracy of solutions. Finally, experiments oil a 6R robot are implemented, which show that, the proposed algorithm can solve the equations in an average time of only 9.936 mu s, and makes a good performance in the practical strong real time motion control situation.
What problem does this paper attempt to address?