• CN:11-2187/TH
  • ISSN:0577-6686

›› 2010, Vol. 46 ›› Issue (17): 35-41.

• 论文 • 上一篇    下一篇

基于吴方法的6R机器人逆运动学旋量方程求解

吕世增;张大卫;刘海年   

  1. 天津大学机械工程学院;东北大学机械工程及自动化学院
  • 发布日期:2010-09-05

Solution of Screw Equation for Inverse Kinematics of 6R Robot Based on Wu’s Method

LÜ Shizeng;ZHANG Dawei;LIU Hainian   

  1. School of Mechanical Engineering, Tianjin University School of Mechanical Engineering and Automation, Northeastern University
  • Published:2010-09-05

摘要: 基于旋量理论建立6R机器人的运动学模型,与传统的D-H参数法相比,旋量法从整体上描述刚体的运动,避免了用局部坐标系描述时所造成的奇异性。但用旋量法求解运动学逆问题时,受到子问题算法的限制。将吴方法引入逆运动学问题的求解,通过其特征列的思想与旋量法相结合,并利用数字化推理平台(Mathematics mechanization platform, MMP)和Maple软件进行符号化运算实现了运动学逆解算法,最后用计算实例证明了算法的可靠性。基于吴方法求解机器人逆运动学的旋量方程,继承了旋量法的优点并减小了对子问题算法的依赖性,更加便于计算机的机械化运算。该方法具有较高的效率和精度,可以推广到其他构型(如并联机构)机器人运动学问题的求解。

关键词: 6R机器人, 螺旋理论, 逆运动学, 吴方法

Abstract: The kinematics model of the 6R serial robot is set up by using screw method, which is under the overall description of rigid body movement, and compared with the traditional D-H method, singularity is avoided when describing in local coordinate. However, solving the inverse kinematics is restricted by the sub-problems algorithm when using screw method. Wu’s method is introduced to the process of inverse kinematics, and the algorithm of inverse kinematics is realized by combining the idea of characteristic set with screw method, through the symbolic calculation using mathematics mechanization platform (MMP) and Maple software. Finally, the reliability of the algorithm is illustrated by the calculation of examples. Based on Wu’s method, solving the inverse kinematics equation not only inherits the advantage of screw method but also becomes more independent to sub-problems algorithm, which makes the mechanical calculation much easier. The method can be extended to solving the kinematics problems of robot with other configurations (such as parallel mechanism).

Key words: 6R robot, Inverse kinematics, Screw theory, Wu’s method

中图分类号: