收稿日期: 2022-02-21
网络出版日期: 2022-07-15
基金资助
广东省重点领域研发计划项目(2021B0101220003)
Inverse Kinematics Solution of 5-DOF Manipulator via Joint Angle Parameterization and Feasible Direction of Approach Vector
Received date: 2022-02-21
Online published: 2022-07-15
Supported by
the Research and Development Project in Key Areas of Guangdong Province(2021B0101220003)
五自由度的机械臂无法达到任意位姿,采用传统的位姿描述方式进行逆运动学求解时,极易产生无解的情况。文中以一种适用于清洁、喷涂、焊接等作业的、由4个旋转关节和1个移动关节构成的五自由度机械臂为例,建立运动学模型并进行逆运动学分析,在此基础上,提出一种关节角参数化结合接近矢量可行方向的逆运动学求解方法。该方法基于自由度约束的末端位姿描述,先通过关节角参数化将末端执行器的运动空间由三维降为二维,再采用几何法分析末端执行器在不同目标位置(远端、中间端、近端)时的接近矢量的可行方向,从而避免参数盲目取值,确保运动学逆解的存在,然后根据运动连续性和各关节的运动范围从中筛选出最优解。路径规划仿真结果表明,实际路径与规划路径非常吻合,关节运动平稳,证明了所提方法的可行性和准确性。文中研究的五自由度机械臂具有一定的代表性,逆运动学求解方法计算复杂度低,求解过程较为简便,求解思路可为欠自由度机械臂的逆运动学求解提供借鉴。
万珍平, 罗钊, 陆龙生, 等 . 关节角参数化结合接近矢量可行方向的五自由度机械臂逆运动学求解[J]. 华南理工大学学报(自然科学版), 2023 , 51(1) : 16 -21 . DOI: 10.12141/j.issn.1000-565X.220066
The manipulator with five degrees of freedom (5-DOF) cannot reach any pose, so it is easy to get no solution when the traditional pose description method is used to solve the inverse kinematics. In this paper, a 5-DOF manipulator consisting of four rotary joints and one prismatic joint, which is suitable for cleaning, spraying, welding and other operations, is taken as an example to establish a kinematic model and its inverse kinematic analysis is carried out. Then, an inverse kinematics solution method based on joint angle parameterization combined with the feasible direction of approach vector is proposed based on the end pose description of degree of freedom constraints. In this method, firstly, the motion space of the end executor is reduced from three dimensions to two dimensions through joint angle parameterization. Then, the feasible direction of the approach vector of the end executor at different target positions (distal, middle and proximal) is analyzed by geometric method, so as to avoid blind parameter setting and ensure the existence of inverse kinematics solutions. Thereafter, the optimal solution is selected according to the motion continuity and motion range of each joint. The simulation analysis results of path planning show that the actual path is very consistent with the planned path and the joint motion is stable, which proves the feasibility and accuracy of the proposed solution method. The 5-DOF manipulator studied in this paper is representative to some extent and the proposed solution method possesses the advantage of low computational complexity and simple solving process. Therefore, the solution idea can provide reference for the inverse kinematics solution of the manipulator with less degrees of freedom.
| 1 | SINGLA A .Kinematic modeling of robotic manipulators[J].Proceedings of the National Academy of Sciences,India Section A:Physical Sciences,2017,87(3):303-319. |
| 2 | B=UI TAM, LINH T A O, NGUYEN T,et al .DE-based algorithm for solving the inverse kinematics on a robotic arm manipulators[J].Journal of Physics:Conference Series,2021,1922(1):012008/1-9. |
| 3 | NGUYEN T T, TAO N L, NGUYEN V T,et al .Apply PSO algorithm with searching space improvements on a 5 degrees of freedom robot[C]∥Proceedings of the 2020 3rd International Conference on Intelligent Robotic and Control Engineering (IRCE)?.[S.l.]:IEEE,2020:75-80. |
| 4 | 裴九芳,许德章,王海 .基于旋量理论的三指机器人灵巧手逆运动学分析[J].中国机械工程,2017,28(24):2975-2980. |
| 4 | PEI Jiufang, XU Dezhang, WANG Hai .Inverse kinematics analyses of 3-finger robot dexterous hand based on screw theory[J].China Mechanical Engineering,2017,28(24):2975-2980. |
| 5 | 谢习华,范诗萌,周烜亦,等 .基于改进差分进化算法的机械臂运动学逆解[J].机器人,2019,41(1):50-57. |
| 5 | XIE Xihua, FAN Shimeng, ZHOU Xuanyi,et al .Inverse kinematics of manipulator based on the improved differential evolution algorithm[J].Robot,2019,41(1):50-57. |
| 6 | 林阳,赵欢,丁汉 .基于多种群遗传算法的一般机器人逆运动学求解[J].机械工程学报,2017,53(3):1-8. |
| 6 | LIN Yang, ZHAO Huan, DING Han .Solution of inverse kinematics for general robot manipulators based on multiple population genetic algorithm[J].Journal of Mechanical Engineering,2017,53(3):1-8. |
| 7 | ZHANG Y, LI Y, XIAO X .A novel kinematics analysis for a 5-DOF manipulator based on KUKA youBot[C]∥Proceedings of the 2015 IEEE International Conference on Robotics and Biomimetics (ROBIO).[S.l.]:IEEE,2015:1477-1482. |
| 8 | SHANMUGASUNDAR G, SIVARAMAKRISHNAN R, MEGANATHAN S,et al .Structural optimization of an five degrees of freedom (T-3R-T) robot manipulator using finite element analysis[J].Materials Today:Proceedings,2019,16:1325-1332. |
| 9 | XU D, ACOSTA C C A, GAN J Q,et al .An analysis of the inverse kinematics for a 5-DOF manipulator[J].International Journal of Automation and Computing,2005,2(2):114-124. |
| 10 | WANG H .Kinematics and control for a personal robot with five degrees-of-freedom arms[C]∥Proceedings of the 2007 IEEE International Conference on Networking,Sensing and Control.[S.l.]:IEEE,2007:507-512. |
| 11 | RAMíREZ-TORRES J G, TOSCANO-PULIDO G, RAMíREZ-SALDíVAR A,et al .A complete closed-form solution to the inverse kinematics problem for the P2Arm manipulator robot[C]∥Proceedings of the 2010 IEEE Electronics, Robotics and Automotive Mechanics Conference.[S.l.]:IEEE,2010:372-377. |
| 12 | ZHOU Y B, XI F F .Exact kinematic analysis of the general 5R robot[J].Mechanism and Machine Theory,1998,33(1/2):175-184. |
| 13 | CHEN I M, GAO Y .Closed-form inverse kinematics solver for reconfigurable robots[C]∥Proceedings of the 2001 ICRA, IEEE International Conference on Robotics and Automation (Cat.?No.?01CH37164).[S.l.]:IEEE,2001:2395-2400. |
| 14 | SHIMIZU M .Analytical inverse kinematics for 5-DOF humanoid manipulator under arbitrarily specified unconstrained orientation of end-effector[J].Robotica,2015,33(4):747-767. |
| 15 | 朱晓龙,顿向明 .一种五自由度机械臂逆运动学求解的几何法[J].机械与电子,2014(5):76-80. |
| 15 | ZHU Xiao-long, Xiang-ming DUN .A geometical method for inverse kinematics of 5-DOF manipulator[J].Machinery & Electronics,2014(5):76-80. |
| 16 | 李万莉,李宁 .一种五自由度机械臂的运动学分析与逆运动学求解[J].机电一体化,2017,23(11):3-7. |
| 16 | LI Wanli, LI Ning .Kinematics analysis and inverse kinematics solution of a 5-DOF manipulator[J].Mechatronics,2017,23(11):3-7. |
| 17 | 陈鹏,刘璐,余飞,等 .一种仿人机械臂的运动学逆解的几何求解方法[J].机器人,2012,34(2):211-216. |
| 17 | CHEN Peng, LIU Lu, YU Fei,et al .A geometrical method for inverse kinematics of a kind of humanoid manipulator[J].Robot,2012,34(2):211-216. |
/
| 〈 |
|
〉 |