A Screw Solution of Industrial Robot's Inverse Kinematics Problem
-
摘要: 运用旋量方法建立工业机器人运动学模型,提出一类子问题以求解通用的逆解算法。利用仿真软件DELMIA的机器人模型库,给出一种"特殊位形法"来求解机器人连杆参数。将机器人前三个关节运动定义为一类新的子问题,即已知点绕两个平行轴线和一个与前两个轴垂直的轴线旋转至定点的问题。结合经典的Paden-Kahan子问题,推导出机器人8组逆解的解析算式。以IRB1400弧焊机器人为例,验证算法正确性。仿真结果显示算法误差在10-12数量级,耗时不到0.12 ms,能够满足机器人控制系统高精度和实时性要求。
-
关键词:
- 工业机器人 /
- 逆解 /
- 旋量理论 /
- Paden-Kahan子问题
Abstract: The kinematics model of an industrial robot is established with the screw theory, and a sub-problem category is proposed for its general inverse kinematics solution. The link parameters of the robot is calculated with the special configuration method and the robot model library of simulation software DELMIA(digital enterprise lean manufacturing interaction application). The motion of the first three joints is defined as a new type of sub-problem, which can be described as a known point rotating around two parallel axes and an axe perpendicular to the first two axes at a given point. Combined with the classical Paden-Kahan sub-problem, eight groups of analytic expressions for inverse solution are derived. Taking the IRB1400 arc welding robot as an example, we verify the algorithm. The simulation results show that the algorithm has an error of 10-12 orders of magnitude and needs less than 0.12 ms, which satisfies the high requirements for the accuracy and real-time of the robot's control system.-
Key words:
- industrial robot /
- inverse solution /
- Paden-Kahan sub-problem /
- screw theory
-
[1] 熊有伦,尹周平,熊蔡华.机器人操作[M].武汉:湖北科学技术出版社,2002 Xiong Y L, Yin Z P, Xiong C H. Robot manipulation[M]. Wuhan: Hubei Science & Technology Press, 2002 (in Chinese) [2] 理查德·摩雷,李泽湘,夏恩卡·萨思特里.机器人操作的数学导论[M].徐卫良,钱瑞明译.北京:机械工业出版社,1998 Murray R M, Li Z X, Sastry S S. A mathematical introduction to robotic manipulation[M]. Xu W L, Qian R M, trans.Beijing: China Machine Press, 1998 (in Chinese) [3] Rocha C R, Tonetto C P, Dias A. A comparison between the Denavit-Hartenberg and the screw-based methods used in kinematic modeling of robot manipulators[J]. Robotics and Computer-Integrated Manufacturing, 2011,27(4):723-728 [4] Selig J M. Geometrical foundations of robotics[M]. Singapore: World Scientific Publishing Co., Inc., 2000 [5] Sariyildiz E, Cakiray E, Temeltas H. A comparative study of three inverse kinematic methods of serial industrial robot manipulators in the screw theory framework[J]. International Journal of Advanced Robotic Systems, 2011,8(5):9-24 [6] Campa R, Camarillo K, Arias L. Kinematic modeling and control of robot manipulators via unit quaternions: Application to a spherical wrist[C]//Proceedings of the 45th IEEE Conference on Decision and Control. San Diego, CA: IEEE, 2006:6474-6479 [7] Brockett R W. Robotic manipulators and the product of exponentials formula[M]//Fuhrmann P A, ed. Mathematical Theory of Networks and Systems. Berlin Heidelberg: Springer, 1984:120-129 [8] 李悦,周利坤.基于旋量理论的RRRP机器人正运动学分析研究[J].机械科学与技术,2014,33(2):194-198 Li Y, Zhou L K. The kinematics analysis of a RRRP robot based on the screw theory[J]. Mechanical Science and Technology for Aerospace Engineering, 2014,33(2):194-198 (in Chinese) [9] 李悦,周利坤.基于旋量理论的RRRP机器人逆运动学分析研究[J].机械科学与技术,2014,33(6):820-824 Li Y, Zhou L K. The research of RRRP robot inverse kinematics based on the screw theory[J]. Mechanical Science and Technology for Aerospace Engineering, 2014,33(6):820-824 (in Chinese) [10] 赵杰,刘玉斌,蔡鹤皋.一种运动旋量逆解子问题的求解及其应用[J].机器人,2005,27(2):163-167 Zhao J, Liu Y B, Cai H G. Solution for one type of inverse kinematics sub-problem in screw theory and its application[J]. Robot, 2005,27(2):163-167 (in Chinese) [11] 孔民秀,孙立宁,杜志江,等.一类运动支链逆解问题的旋量指数积求解方法[J].哈尔滨工业大学学报,2008,40(3):372-375 Kong M X, Sun L N, Du Z J, et al. Solution to inverse kinematics of a type of kinematic chain using screw theory and exponential product method[J]. Journal of Harbin Institute of Technology, 2008,40(3):372-375 (in Chinese) [12] Sariyildiz E, Temeltas H. Solution of inverse kinematic problem for serial robot using quaterninons[C]//Proceedings of the International Conference on Mechatronics and Automation. Changchun: IEEE, 2009:26-31 [13] 杨明明,陈伟海,于守谦,等.基于Paden-Kahan子问题的冗余度机器人逆运动学求解[J].机器人,2004,26(3):250-255 Yang M M, Chen W H, Yu S Q, et al. Kinematic solutions for redundant robot based on Paden-Kahan sub-problems[J]. Robot, 2004,26(3):250-255 (in Chinese) [14] 钱东海,王新峰,赵伟,等.基于旋量理论和Paden-Kahan子问题的6自由度机器人逆解算法[J].机械工程学报,2009,45(9):72-76 Qian D H, Wang X F, Zhao W, et al. Algorithm for the inverse kinematics calculation of 6-DOF robots based on screw theory and Paden-Kahan sub-problems[J]. Journal of Mechanical Engineering, 2009,45(9):72-76 (in Chinese) [15] 吕世增,张大卫,刘海年.基于吴方法的6R机器人逆运动学旋量方程求解[J].机械工程学报,2010,46(7):35-41 Lü S Z, Zhang D W, Liu H N. Solution of screw equation for inverse kinematics of 6R robot based on Wu's Method[J]. Journal of Mechanical Engineering, 2010,46(7):35-41 (in Chinese)
点击查看大图
计量
- 文章访问数: 156
- HTML全文浏览量: 34
- PDF下载量: 13
- 被引次数: 0