[发明专利]一种六自由度串联机械臂的位置逆解控制方法

说明书

技术领域

本发明涉及一种六自由度串联机械臂的位置逆解控制方法。

背景技术

六自由度机械臂控制系统，包括依次连接的上位机、下位机、电机驱动器、电机和六自由度机械臂。在整个系统中六自由度机械臂的位置逆解问题至关重要。位置逆解问题是机械手机构学乃至机械学中的最基础也是最重要的研究问题之一，它直接关系到机械手运动分析、离线编程、轨迹规划和实时等工作。机械臂的位置逆算法，就是机械手臂的手部在固定的直角坐标空间中某一点和某一姿态，求解机械臂六个自由度相应的关节角(或称关节坐标)，因此逆算法是机器人控制的基本组成部分。

传统的机械手的结构一般比较特殊，如轴线相交或平行，轴线长度为零等等，这样它的姿态和位置之间就没有耦合，其逆解很容易用分离变量的办法实现。然而对于一类结构尺寸比较一般的复杂机械手，由于姿态和位置高度耦合，一般无法进行变量分离，这时必须借助于数值算法，可分为三类：(1)数值-解析法、牛顿-拉弗森法等，这些算法可满足实时性要求，较难得到全部逆解，且必须给出适当的初值。(2)优化算法、区间迭代法、遗传算法等，这类算法收敛范围大，可求出全部逆解，但一般实时性差。(3)位置和姿态分别迭代法，这类算法能较迅速地求得全部解，但当机械手位置和姿态高度耦合时，迭代过程会发散。

发明内容

为了克服已有位置逆解控制方法的实时性较差、准确性不高的不足，本发明提供一种实时性良好、准确性高的六自由度串联机械臂的位置逆解控制方法。

本发明解决其技术问题所采用的技术方案是：

一种六自由度串联机械臂的位置逆解控制方法，其特征在于：利用对偶四元数能表示三维物体旋转和平移的性质，六自由度机械臂的各个转动关节经过转换由对偶四元数表示出来，在三维空间中，绕单位矢量u＝(u_x，u_y，u_z)旋转θ角的旋转可以用单位四元数表示为：

cos(θ/2)+sin(θ/2)(u_xi+u_yj+u_zk)

即

q＝[cos(θ/2)，sin(θ/2)<u_x，u_y，u_z>]    (1)

单位四元数如式(2)所示能够描述出刚体的旋转，三维空间内的一个位移可以由旋转加平移合成，以单位四元数q表示旋转，p＝(p_x，p_y，p_z)表示平移矢量，则用对偶四元数表示为：

Q(q，p)＝([cos(θ/2)，sin(θ/2)<u_x，u_y，u_z>]，<p_x，p_y，p_z>)    (2)

则对偶四元数求逆表示为：

Q^-1＝(q^-1，-q^-1*p*q)    (14)

其中

-q^-1*p*q＝-p+[-2s(v×(-p))+2v×(v×(-p))]    (15)

机械臂的转动关节与对偶四元数的转换关系定义成：

[R_w，T_w]＝([w，<a，b，c>，<p_x，p_y，p_z>])    (16)

其中(R_w，T_w)代表机械臂各个转动关节相对于底座的转动方向和在三维空间里的位移向量；

设Q_i，1≤i≤6为各个机械臂转动关节相对于机械臂底座空间上的转换公式，利用这个转换公式把各个转动关节联系在一起如：

Q₁(q₁，p₁)，Q₂(q₁，p₂)…Q₆(q₆，p₆)    (17)

且设

S_i＝Q_iQ_i+1…Q₆    (18)