华南理工大学学报(自然科学版) ›› 2018, Vol. 46 ›› Issue (9): 30-35.doi: 10.3969/j.issn.1000-565X.2018.09.005

• 机械工程 • 上一篇    下一篇

基于R* (3,0,1)几何代数的六轴机器人位姿反解

杜鹃1,吴洪涛1,杨小龙2,陈柏2,程世利3   

  1. 1. 南京航空航天大学
    2. 南京航空航天大学机电学院
    3. 盐城工学院汽车工程学院
  • 收稿日期:2017-11-30 修回日期:2018-05-04 出版日期:2018-09-25 发布日期:2018-08-01
  • 通信作者: 吴洪涛( 1963-) ,男,教授,博士生导师,主要从事机器人动力学、并联机构等研究 E-mail: mehtwu@126.com
  • 作者简介:杜鹃( 1990-) ,女,博士生,主要从事机器人机构学、几何代数研究.
  • 基金资助:
    国家自然科学基金资助项目( 51375230,51575256,51405417) ;
    江苏省自然科学基金资助项目( BK20140470)

Inverse Kinematic of Six-axis robots based on R* (3,0,1) Geometric Algebra

DU Juan 1 WU Hongtao 1 YANG Xiaolong 1 CHEN Bai 1 CHENG Shili 2   

  1. 1. College of Mechanical and Electrical Engineering,Nanjing University of Aeronautics and Astronautics,Nanjing 210016,
    Jiangsu,China;
    2. School of Automotive Engineering,Yancheng Institute of Technology,Yancheng 224051,Jiangsu,China
  • Received:2017-11-30 Revised:2018-05-04 Online:2018-09-25 Published:2018-08-01
  • Contact: 吴洪涛( 1963-) ,男,教授,博士生导师,主要从事机器人动力学、并联机构等研究 E-mail: mehtwu@126.com
  • About author:杜鹃( 1990-) ,女,博士生,主要从事机器人机构学、几何代数研究.
  • Supported by:
    The National Natural Science Foundation of China( 51375230,51575256,51405417) and the Natural Science Foundation of Jiangsu Province( BK20140470)

摘要: R^* (3,0,1)几何代数模型结合了对偶四元数和共形几何的优势,即对偶四元数计算效率高,共形几何对点、面具有统一的坐标变换算子,能计算点、面之间的有向距离。本文基于R^* (3,0,1)几何代数模型提出了六轴机器人位姿反解新算法,即在6轴机器人运动学反解过程中,根据机器人关节到3种奇异形位参考面有向距离不同的属性,基于R^* (3,0,1)几何代数能确定唯一的运动学位姿反解,省去了传统反解中通过“最短行程”的准则来择优的步骤,提供了一种机器人运动学反解的新算法。该算法具有能检测关节与奇异面距离、算法简单、使反解问题的描述更为直观、能确定唯一解等优点,能很好地应用于实际的机器人运动控制中,并在PUMA 560型机器人上进行了数值验证.

关键词:

工业机器人, 运动学反解, 几何代数, 有向距离

Abstract: The Geometric algebra model R^* (3,0,1) combines the benefits of dual quaternions and conformal geometric algebra, i.e., dual quaternions can compute faster while comformal geometric algebra have same translation algorithm for points and planes as well as have algorithm to compute sign distance between points and planes. A new inverse kinematic of industrial robots algorithm is proposed based on R^* (3,0,1) model, i.e., the unique solution of inverse kinematic of industrial robots is determined by the sign distances between joints and three singular planes, and the sign distances can be computed by R^* (3,0,1) model. This new algorithm can find unique solution without comparing a preferred one which is widely applied in general inverse kinematic solution. This new algorithm has advantages, such as be able to compute the sign distance to the singular planes, simple, high speed to compute unique inverse kinematic solution, effectively when applied to practical robot motion control. This algorithm is numerical verified on PUMA 560.

Key words:

industrial robots, inverse kinematics, geometric algebra, signed distance

中图分类号: