General closed-form inverse kinematics for arbitrary three-joint subproblems based on the product of exponential model

Abstract

The inverse kinematics problems of robots are usually decomposed into several Paden–Kahan subproblems based on the product of exponential model. However, the simple combination of subproblems cannot solve all the inverse kinematics problems, and there is no common approach to solve arbitrary three-joint subproblems in an arbitrary postural relationship. The novel algebraic geometric (NAG) methods that obtain the general closed-form inverse kinematics for all types of three-joint subproblems are presented in this paper. The geometric and algebraic constraints are used as the conditions precedent to solve the inverse kinematics of three-joint subproblems. The NAG methods can be applied in the inverse kinematics of three-joint subproblems in an arbitrary postural relationship. The inverse kinematics simulations of all three-joint subproblems are implemented, and simulation results indicating that the inverse solutions are consistent with the given joint angles validate the general closed-form inverse kinematics. Huaque III minimally invasive surgical robot is used as the experimental platform for the simulation, and a master–slave tracking experiment is conducted to verify the NAG methods. The simulation result shows the inverse solutions and six sets given joint angles are consistent. Additionally, the mean and maximum of the master–slave tracking experiment for the closed-form solution are 0.1486 and 0.4777 mm, respectively, while the mean and maximum of the master–slave tracking experiment for the compensation method are 0.3188 and 0.6394 mm, respectively. The experiments results demonstrate that the closed-form solution is superior to the compensation method. The results verify the proposed general closed-form inverse kinematics based on the NAG methods.

Keywords

inverse kinematics / Paden–Kahan subproblems / three-joint subproblems / product of exponential / closed-form solution

参考文献

[1] Husty M L , Pfurner M , Schröcker H P . A new and efficient algorithm for the inverse kinematics of a general serial 6R manipulator. Mechanism and Machine Theory, 2007, 42( 1): 66– 81

[2] Murray R M Li Z X Sastry S S. A Mathematical Introduction to Robotic Manipulation. Boca Raton: CRC Press, 1994

[3] Niu G J , Pan B , Ai Y , Fu Y L . Intuitive control algorithm of a novel minimally invasive surgical robot. Computer Assisted Surgery, 2016, 21( sup1): 92– 101

[4] Stoica A , Pisla D , Andras S , Gherman B , Gyurka B Z , Plitea N . Kinematic, workspace and singularity analysis of a new parallel robot used in minimally invasive surgery. Frontiers of Mechanical Engineering, 2013, 8( 1): 70– 79

[5] Tang A L. Research on the teleoperation motion control strategy for a master-slave minimally invasive surgical robot. Dissertation for the Doctoral Degree. Shanghai: Shanghai Jiao Tong University, 2014 (in Chinese)

[6] Zhang F , Teng S , Wang Y F , Guo Z J , Wang J J , Xu R L . Design of bionic goat quadruped robot mechanism and walking gait planning. International Journal of Agricultural and Biological Engineering, 2020, 13( 5): 32– 39

[7] Lakhal O , Melingui A , Merzouki R . Hybrid approach for modeling and solving of kinematics of a compact bionic handling assistant manipulator. IEEE/ASME Transactions on Mechatronics, 2016, 21( 3): 1326– 1335

[8] Yang H , Fang H R , Fang Y F , Li X Y . Dimensional synthesis of a novel 5-DOF reconfigurable hybrid perfusion manipulator for large-scale spherical honeycomb perfusion. Frontiers of Mechanical Engineering, 2021, 16( 1): 46– 60

[9] Zhang W X , Lu S N , Ding X L . Recent development on innovation design of reconfigurable mechanisms in China. Frontiers of Mechanical Engineering, 2019, 14( 1): 15– 20

[10] Kim J , Jie W , Kim H , Lee M C . Modified configuration control with potential field for inverse kinematics solution of redundant manipulator. IEEE/ASME Transactions on Mechatronics, 2021, 26( 4): 1782– 1790

[11] Patil A , Kulkarni M , Aswale A . Analysis of the inverse kinematics for 5 DOF robot arm using D–H parameters. In: Proceedings of 2017 IEEE International Conference on Real-time Computing and Robotics (RCAR). Okinawa: IEEE, 2017, 688– 693

[12] Xu J , Song K C , He Y , Dong Z P , Yan Y H . Inverse kinematics for 6-DOF serial manipulators with offset or reduced wrists via a hierarchical iterative algorithm. IEEE Access: Practical Innovations, Open Solutions, 2018, 6 : 52899– 52910

[13] Soleimani Amiri M , Ramli R . Intelligent trajectory tracking behavior of a multi-joint robotic arm via genetic–swarm optimization for the inverse kinematic solution. Sensors, 2021, 21( 9): 3171

[14] Zhou H B , Zhou S , Yu J , Zhang Z D , Liu Z Z . Trajectory optimization of pickup manipulator in obstacle environment based on improved artificial potential field method. Applied sciences, 2020, 10( 3): 935

[15] Tian X M , Xu Y . Low delay control algorithm of robot arm for minimally invasive medical surgery. IEEE Access: Practical Innovations, Open Solutions, 2020, 8 : 93548– 93560

[16] Xu Z H , Li S , Zhou X F , Yan W , Cheng T B , Huang D . Dynamic neural networks based kinematic control for redundant manipulators with model uncertainties. Neurocomputing, 2019, 329 : 255– 266

[17] Gallardo-Alvarado J , Aguilar-Nájera C R , Casique-Rosas L , Rico-Martínez J M , Islam M N . Kinematics and dynamics of 2(3-RPS) manipulators by means of screw theory and the principle of virtual work. Mechanism and Machine Theory, 2008, 43( 10): 1281– 1294

[18] Hayati S A . Robot arm geometric link parameter estimation. In: Proceedings of the 22nd IEEE Conference on Decision & Control. San Antonio: IEEE, 1983, 1477– 1483

[19] Zhao R B Shi Z P Guan Y Shao Z Z Zhang Q Y Wang G H. Inverse kinematic solution of 6R robot manipulators based on screw theory and the Paden–Kahan subproblem. International Journal of Advanced Robotic Systems, 2018, 15(6): 1729881418818297

[20] Paden B E. Kinematics and control of robot manipulators. Dissertation for the Doctoral Degree. Berkeley: University of California, 1985

[21] Chen I M , Gao Y . Closed-form inverse kinematics solver for reconfigurable robots. In: Proceedings of 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164). Seoul: IEEE, 2001, 3 : 2395– 2400

[22] Zhao J , Wang W D , Gao Y S , Cai H G . Generation of closed-form inverse kinematics for reconfigurable robots. Frontiers of Mechanical Engineering in China, 2008, 3( 1): 91– 96

[23] Tan Y S Cheng P L Xiao A P. Solution for a new sub-problem in screw theory and its’ application in the inverse kinematics of a manipulator. Applied Mechanics and Materials, 2010, 34–35: 271– 275

[24] Leoro J , Hsiao T S , Betancourt C . A new geometric subproblem to extend solvability of inverse kinematics based on screw theory for 6R robot manipulators. International Journal of Control, Automation, and Systems, 2021, 19( 1): 562– 573

[25] Chen Q C , Zhu S Q , Zhang X Q . Improved inverse kinematics algorithm using screw theory for a six-DOF robot manipulator. International Journal of Advanced Robotic Systems, 2015, 12( 10): 140

[26] Li W W , Zhou G B , Zhou X F , Chen Z L , Wu L , Zeng S F . Kinematics analysis of generalized SRU manipulator based on screw theory. In: Proceedings of 2018 the 3rd International Conference on Robotics and Automation Engineering (ICRAE). Guangzhou: IEEE, 2018, 160– 165

[27] Wang H X Lu X Zhang Z Y Li Y X Sheng C Y Gao L. A novel second subproblem for two arbitrary axes of robots. International Journal of Advanced Robotic Systems, 2018, 15(2): 1729881418769194

[28] Wang H X , Lu X , Sheng C Y , Zhang Z G , Cui W , Li Y X . General frame for arbitrary 3R subproblems based on the POE model. Robotics and Autonomous Systems, 2018, 105 : 138– 145

[29] Wang Y C , Ding X L , Tang Z X , Hu C W , Xu K . A novel analytical inverse kinematics method for SSRMS-type space manipulators based on the POE formula and the Paden-Kahan subproblem. International Journal of Aerospace Engineering, 2021, 6690696

[30] Song T , Pan B , Niu G J , Fu Y L . Preoperative planning algorithm for robot-assisted minimally invasive cholecystectomy combined with appendectomy. IEEE Access: Practical Innovations, Open Solutions, 2020, 8 : 177100– 177111

[31] Yu L T Wang W J Wang Z Y Gu Q Wang L. Acquisition method of inverse kinematics analytical solutions for a class of robots dissatisfying the Pieper criterion. Robot, 2016, 38(4): 486– 494 (in Chinese)

Nomenclature

Abbreviations
D–H	Denavit–Harbenterg
DOF	Degree-of-freedom
NAG	Novel algebraic geometric
POE	Product of exponential
R, T	revolute joint and translational joint, respectively
RCM	Remote center of motion
Variables
c, d, p, p1, p2, p3, and q	Position vectors of points c, d, p, p1, p2, p3, and q, respectively
{\mathit{g}}_{\text{st}}(\mathbf{0}), {\mathit{g}}_{\text{st}}(\mathit{\theta })	Initial transformation matrix and transformation matrix at different joint angles of the tool frame, respectively
lc2	Distance between points c and p2
lij (i, j = 1, 2, 3)	Distance between points pi and pj
m	Difference between the vectors p3 and p
{\stackrel{\mathbf{~}}{\mathit{p}}}_5	Homogeneous coordinate of point p5
\stackrel{\mathbf{~}}{\mathit{q}}, \stackrel{\mathbf{~}}{\mathit{p}}	Homogeneous coordinate of points q and p, respectively
\mathit{r}	Position vector of the reference point r of the revolute joint axis
r5	Position vector of point p5
\mathit{v}	Unit directional vector of the translational joint axis
{\theta }_i	Generalized angle of the ith joint
δ	Distance between two vectors s and t, δ = ||s − t||
\text{ω}	Unit directional vector of the revolute joint axis
\widehat{\text{ω}}	Skew-symmetric matrices of \text{ω}
\mathit{\xi }	Joint twist
{\mathit{\xi }}_i \left(i=1,2,3\right)	Twist coordinate of the ith joint axis
{\hat{\mathit{\xi }}}_i \left(i=1,2,3\right)	Instantaneous joint twist of the ith joint axis

Acknowledgements

This study was supported by the Foundation for Innovative Research Groups of the National Natural Science Foundation of China (Grant No. 51521003), the National Natural Science Foundation of China (Grant No. 61803341), and the Self-planned Task of State Key Laboratory of Robotics and System (Harbin Institute of Technology) (Grant No. SKLRS202009B). No conflicts of interest exist in this paper.

版权

2022 Higher Education Press