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

Inverse Kinematic of Six-Axis Robots Based on R~*(3,0,1) Geometric Algebra

作　　者：杜鹃[1] 吴洪涛[1] 杨小龙[1] 陈柏[1] 程世利[2] DU Juan;WU Hongtao;YANG Xiaolong;CHEN Bai;CHENG Shili(College of Mechanical and Electrical Engineering,Nanjing University of Aeronautics and Astronautics,Nanjing 210016,Jiangsu,China;School of Automotive Engineering,Yancheng Institute of Technology,Yancheng 224051,Jiangsu,China)

机构地区：[1]南京航空航天大学机电学院,江苏南京210016 [2]盐城工学院汽车工程学院,江苏盐城224051

出　　处：《华南理工大学学报（自然科学版）》2018年第9期30-35,共6页Journal of South China University of Technology(Natural Science Edition)

基　　金：国家自然科学基金资助项目(51375230;51575256;51405417);江苏省自然科学基金资助项目(BK20140470)~~

摘　　要：R~*(3,0,1)几何代数模型结合了对偶四元数和共形几何的优势,即对偶四元数计算效率高,共形几何对点、面具有统一的坐标变换算子,能计算点、面之间的有向距离.本研究基于R~*(3,0,1)几何代数模型提出了6轴机器人位姿反解新算法,即在6轴机器人运动学反解过程中,根据关节到3种奇异形位参考面有向距离不同的属性,基于R~*(3,0,1)几何代数能确定唯一的运动学位姿反解,省去了传统反解中通过"最短行程"的准则来择优的步骤.该算法具有能检测关节与奇异面距离、算法简单、使反解问题的描述更为直观、能确定唯一解等优点,能很好地应用于实际的机器人运动控制中.将该算法在PUMA 560型机器人上进行了数值验证.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 the 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 on the basis of 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 being able to compute the sign distance to the singular planes,being simple,highly speedy to compute unique inverse kinematic solution effectively when applied to practical robot motion control.This algorithm is numerically verified on PUMA 560.

关 键 词：工业机器人 运动学反解 几何代数 有向距离 

分 类 号：TP242[自动化与计算机技术—检测技术与自动化装置]