工业机器人第三章欧拉角DH参数

工业机器人第三章欧拉角DH参数第一页，共八十一页，编辑于2023年，星期日第二页，共八十一页，编辑于2023年，星期日

3.6RPY角和欧拉角

(一)RPY角

RPY角是描述船舶在海中航行时姿态的一种方法。将船的行驶方向取为Z轴，则绕Z轴的旋转(α角)称为滚动(Roll)；把绕Y轴的旋转(β角)称为俯仰(Pitch)；而把垂直方向取为X轴，将绕X轴的旋转(γ角)称为偏转(Yaw)，如右图1-9所示。操作臂手爪姿态的规定方法类似(如图1-10)，故习惯上称为RPY角方法。1-9滚动、俯仰、偏转1-10机器人手的滚动、俯仰、偏转第三页，共八十一页，编辑于2023年，星期日

这种描述活动坐标系方位的法则如下：活动系的初始方位与固定坐标系重合，首先将活动系绕固定坐标系的X轴旋转γ角，再绕固定坐标系的Y轴转β角，最后绕固定坐标系的Z轴转α角，如图1-11所示。因为三次旋转都是相对于固定坐标系的，所以得相应的旋转矩阵：1-11RPY角第四页，共八十一页，编辑于2023年，星期日其中：将矩阵相乘得：

它表示绕固定坐标系的三个轴依次旋转得到的旋转矩阵，因此称为绕固定轴X-Y-Z旋转的RPY角法。…..(11)第五页，共八十一页，编辑于2023年，星期日

现在来讨论逆问题：从给定的旋转矩阵求出等价的绕固定轴X-Y-Z的转角γ、β、α。令：

式中有3个未知数，共9个方程，其中6个方程不独立因此可以利用其中的3个方程解出未知数。…..(12)第六页，共八十一页，编辑于2023年，星期日由式(11)、(12)可以看出：如果cosβ≠0，则得到各个角的反正切表达式:

式中，Atan(y，x)是双变量反正切函数。式(13)中的根式一般有两个解，我们总是取-900≤β≤900中的一个解。……..(13)第七页，共八十一页，编辑于2023年，星期日(二)欧拉角1．绕运动系X-Y-Z转动的欧拉角这种坐标系运动的描述如下：运动坐标系的初始方位与参考系相同，首先使运动系绕Z轴转α角，然后绕运动系的Y轴转β角，最后绕运动系的X轴转γ角，如图1-12所示。这种描述法中的各次转动都是相对于运动坐标系的某轴进行的，而不是相对于固定的参考系。这样的三次转动角称为欧拉角。因此可以得出欧拉变换矩阵1-12绕Z-Y-X转动的欧拉角第八页，共八十一页，编辑于2023年，星期日欧拉变换矩阵：其中：将矩阵相乘得：第九页，共八十一页，编辑于2023年，星期日

这一结果与绕固定轴X-Y-Z旋转的结果完全相同。这是因为绕固定轴旋转的顺序与绕运动轴旋转的顺序相反，且旋转的角度也对应相等时，所得到的变换矩阵是相同的。因此，用Z-Y-X欧拉角与固定轴X-Y-Z转角描述运动坐标系是完全等价的。第十页，共八十一页，编辑于2023年，星期日2．绕Z-Y-Z转动的欧拉角这种坐标系运动的描述如下：最初，坐标系与参考坐标系重合。首先使运动系绕Z轴转动α角，然后绕运动系的Y轴转β角，最后绕运动系的Z轴转γ角，如图3-9所示。

绕Z-Y-Z转动的欧拉角第十一页，共八十一页，编辑于2023年，星期日

可以求得：第十二页，共八十一页，编辑于2023年，星期日同样，求Z-Y-Z欧拉角的逆解方法如下：如果sinβ≠0，则:令：第十三页，共八十一页，编辑于2023年，星期日第十四页，共八十一页，编辑于2023年，星期日(1)Zi坐标轴是沿着i+1关节的运动轴。(2)Xi轴是沿着Zi和Zi-1的公垂线，指向离开Zi-1轴的方向。(3)Yi轴的方向按构成XiYiZi右手直角坐标系来建立。(4)公垂线长度ai是Zi-1

和Zi两轴间的最小距离，一段称ai

为连杆长度。(5)两公垂线ai-1和ai之间的距离称为连杆距离di。(6)Xi-1轴与Xi之间的夹角为θi，以绕Zi-1轴右旋为正，一般称为连杆的夹角。(7)Zi-1轴与Zi之间的夹角为αi，以绕Xi轴右旋为正，αi称为扭转角。转动连杆参数3.7机器人连杆参数及其D—H坐标变换第十五页，共八十一页，编辑于2023年，星期日第十六页，共八十一页，编辑于2023年，星期日

若两杆以移动副连接，则连杆构件坐标系的建立及参数的规定如图2-2所示。图中各符号所表示的意义仍与图2-1相同。由于对于移动副来说，连杆长度ai

已经没有意义，故令其为零，形成的构件坐标系见图2-2。

移动连杆参数第十七页，共八十一页，编辑于2023年，星期日

由图2-1和图2-2可知，四个参数ai，di，θi，αi完全确定了连杆i-1和连杆i之间的相对关系，一般ai，αi为常量，由连杆i的形状确定。对于转动关节，di是常量，θi为变量；对于移动关节θi是常量，di是变量。根据上述模式，我们给所有连杆赋予坐标系，并且可以建立i-1和i坐标系之间的变换关系。应当说明的是，尽管Zi轴通过关节i+1的轴线，但坐标系XiYiZi是固定在连杆i上的，随连杆i运动而一起运动。第十八页，共八十一页，编辑于2023年，星期日1．旋转连杆坐标系及其D-H坐标变换

第十九页，共八十一页，编辑于2023年，星期日第二十页，共八十一页，编辑于2023年，星期日2．移动连杆坐标系及其连杆的D-H坐标变换

第二十一页，共八十一页，编辑于2023年，星期日第二十二页，共八十一页，编辑于2023年，星期日第二十三页，共八十一页，编辑于2023年，星期日

第三节建立机器人机构运动学方程的实例根据上节所述方法，首先建立机器人各杆件的构件坐标系，从而得出齐次变换矩阵Ti。一个T矩阵仅能描述连杆坐标系之间相对平移和旋转的一次齐次变换。T1描述第一个连杆相对于某个坐标系(如机身)的位姿，T2描述第二个连杆(构件)坐标系相对于第一个连杆(构件)坐标系的位姿。

第二十四页，共八十一页，编辑于2023年，星期日

若有一个六连杆机器人，机器人手的末端(即连杆坐标系6)相对于固定坐标系的变换可表示为第二十五页，共八十一页，编辑于2023年，星期日

一个六连杆机器人有六个自由度(每个连杆有一个自由度)。机器人最后一个构件(手部)有三个自由度用来确定其位置，三个自由度用来确定其方向。对如图2-3所示的一个机器人手部，我们可以把描述其位置和方向的坐标系原点定在两个手指的中点，用一个向量p描述这个原点。用三个向量n、o、a描述机器人的姿态。图2-3手抓坐标系第二十六页，共八十一页，编辑于2023年，星期日

当手部处于初始位置和姿态时，向量Z指向手接近物体的方向。其单位向量a称为接近向量。向量Y的单位向量o称为方位向量。最后一个单位向量称为正交向量n。上述向量构成右手矢量积，它们用向量的矢量积来表示：n=oxa

这样，变换T60可用下列矩阵表示:第二十七页，共八十一页，编辑于2023年，星期日

根据前面两式即可建立机器人的位姿方程。坐标变换图如图2-4所示。图2-4机器人手的坐标变换图第二十八页，共八十一页，编辑于2023年，星期日

下面给出两个机器人手运动方程的求解实例

[例1]

PUMA560六自由度机械手由转动坐标臂(RRR)和欧拉腕组成，其结构示意图参看图2-5。关节变量为θ1,θ2

,…,θ6，若己知PUMA560六自由度机械手θ1＝900,θ2＝00

,θ3＝900,θ4＝00

，θ5＝00

，θ6＝00

，a2＝431.8mm,d2＝149.09mm，d4＝433.07mm，d6＝56.25mm。求Ti(i＝l，2，3，4，5，6)及T60的表达式及当θi取给定值时末杆的位姿。第二十九页，共八十一页，编辑于2023年，星期日图2-5PUMA-560机械手坐标系第三十页，共八十一页，编辑于2023年，星期日

[解]

(1)设定机器人各杆的坐标系按D—H坐标系建立各杆的坐标系如图2-5所示。将o0z0设置在关节1的转轴上，o0和o1重合；o1z1o2z2分别沿关节2、3的转轴，o1z1

／／o2z2。z3与z2轴的交点为o3；o2和o3重合，d3＝0,o3x3y3z3并非置于臂的终端。o3z3是腕的第一个转轴。z4与z3的交点为o4

，设在臀的终端，是腕结构的中心，o4z4是腕的第二个转轴；z5与z4的交点为o5。o4和o5重合，o5z5是腕的第三个转轴。o6x6y6z6为终端坐标系，该坐标系考虑了工具长度d6。y6、x6、z6的单位向量分别记为n、o、a。第三十一页，共八十一页，编辑于2023年，星期日

(2)确定连杆的D-H参数和关节变量连杆变量αadcosαsinα1θ1-90°000-12θ20°a2d2103θ390°00014θ4-90°0d40-15θ590°00016θ60°0d610第三十二页，共八十一页，编辑于2023年，星期日

(3)求两杆间的位姿矩阵Ai

根据表2-1所示的D-H参数和公式(1)可求得Ai其中：第三十三页，共八十一页，编辑于2023年，星期日

(4)求末杆位姿矩阵令：可得第三十四页，共八十一页，编辑于2023年，星期日式中：第三十五页，共八十一页，编辑于2023年，星期日…..(5)第三十六页，共八十一页，编辑于2023年，星期日根据式(3)和式(4)可得：式中：……..(6)第三十七页，共八十一页，编辑于2023年，星期日

若令θ1＝900,θ2＝00

,θ3＝900,θ4＝00

θ5＝00

θ6＝00，并将有关常量代入T6矩阵，则有：第三十八页，共八十一页，编辑于2023年，星期日[例2]

斯坦福机器人的结构示意图如图2-6，它由球面坐标臂(RRP)和欧拉腕组成。求Ai(i=1，2，3，4，5，6)及T6的表达式。

[解]

(1)设定机器人各杆的坐标系按D—H坐标系建立各杆的坐标系如图2-6所示。图中z0轴沿关节1的轴，zi轴沿关节(i+1)的轴,令所有xi轴与机座坐标系x0轴平行，y轴按右手坐标系确定。原点o0和o1重合，o3、o4、o5、o6重合。第三十九页，共八十一页，编辑于2023年，星期日

(2)确定连杆的D-H参数和关节变量连杆的D-H参数见表2-2连杆变量αadcosαsinα1θ1-90°000-12θ290°0d2013θ30°0

d3

104θ4-90°000-15θ590°00016θ60°0010表2-2斯坦福机器人的D-H参数第四十页，共八十一页，编辑于2023年，星期日

(3)求两杆间的位姿矩阵Ai

根据表2-2所示的D-H参数和公式(1)可求得Ai其中：第四十一页，共八十一页，编辑于2023年，星期日

(4)求机器人的运动学方程其中：第四十二页，共八十一页，编辑于2023年，星期日

第四节机器人位移分析的逆问题前面介绍了如何建立机器人的运动学方程。对于具有n个自由度的操作臂而言，其运动学方程可以写成：

方程左边表示末端连杆相对于参考坐标系的位姿。根据机器人各个关节变量qi(i＝1，2，…，n)的值，便可计算出机器人末端的位姿方程，称为机械手的运动分析，或正向运动学；反之，为了使机器人所握工具相对参考系的位姿满足给定的要求，计算相应的关节变量，这一过程称为运动学逆解。第四十三页，共八十一页，编辑于2023年，星期日

从工程应用的角度而言，运动学逆解往往更重要，它是机器人运动规划和轨迹控制的基础。

正向运动学的解是唯一确定的，即各个关节变量给定之后，手臀末端的手爪或工具的位姿是唯一确定的；然而运动学逆解往往具有多重解，也可能不存在解。此外，对于运动学逆解而言，仅仅用某种方法求解是不够的，对于各种计算方法的计算效率、计算精度均有较多要求。下面以PUMA机器人为例来探讨机器人的运动学逆解。第四十四页，共八十一页，编辑于2023年，星期日

[例3]

求例1中PUMA560机械人的运动学逆解

[解]PUMA机械人的运动学方程(6)可以写成

在矩阵方程(7)中，左边的矩阵元素nx,…,pz是已知的，而右边的六个矩阵是未知的，它们依赖于关节变量θ1,…,θ6

。……..(7)第四十五页，共八十一页，编辑于2023年，星期日(1)求解θ1、θ3

用逆矩阵左乘矩阵方程(7):于是有:第四十六页，共八十一页，编辑于2023年，星期日

可由式(5)求出。令上式两边的(2,4)元素相等，可得：令:其中:……..(8)……..(9)把式(9)代入(8)，可得:第四十七页，共八十一页，编辑于2023年，星期日于是可以解出θ1：式中，正号和负号分别对应于θ1的两种可能解。第四十八页，共八十一页，编辑于2023年，星期日

我们再令矩阵两边的(1，4)元素、(3，4)元素分别相等，得以下方程：……..(10)由式(10)与式(8)的平方和，得：式中：……..(11)第四十九页，共八十一页，编辑于2023年，星期日

方程(11)中消除了θ1，式(11)和式(8)形式相同，因此可用三角代换求出θ3

第五十页，共八十一页，编辑于2023年，星期日(2)求解θ2、θ4

将左式左乘可得:

式中，T63由式给出。令上式两边矩阵的(1，4)和(2，4)元素分别相等，得到：……..(12)第五十一页，共八十一页，编辑于2023年，星期日由式(13)和式(14)求得：……..(14)……..(13)第五十二页，共八十一页，编辑于2023年，星期日由于c23和s23表达式的分母相等且为正，故有：……..(15)

根据θ3、θ1解的四种可能组合，由式(15)可以算出θ23的四个值，于是得到θ2的四个可能解：第五十三页，共八十一页，编辑于2023年，星期日

因为矩阵方程(12)左边为已知，令等式两边的(1，3)元素和(3，3)元素分别相等，便可得：只要s5≠0，我们可以求得θ4：第五十四页，共八十一页，编辑于2023年，星期日(3)求解θ5θ4解出后，将左式继续左乘可得:

式(16)的左边，因θ1θ2θ3θ4中均已解出，从而有下式：……..(16)…..(17)第五十五页，共八十一页，编辑于2023年，星期日

使式(17)两边的(1,3)元素和(3,3)元素相等，得出：又因为：

因而可得：第五十六页，共八十一页，编辑于2023年，星期日(4)求解θ6

继续用以上方法求解θ6

使方程两边的（3，1）元素和（1，1）相等，得到方程从而得到θ6第五十七页，共八十一页，编辑于2023年，星期日

注意：PUMA-560机器人的运动学逆解可能存在4个解。这是因为在求解θ1θ3时出现正负号，故可能得到4个解。下图给出了这4种解的对应形态。第五十八页，共八十一页，编辑于2023年，星期日

第五节机器人的微分运动和微分变换

在机器人的操作与控制中，由于种种原因机器人末端操作器的位姿与目的物之间会产生位姿误差。为了补偿这一位姿误差，要求末端操作器产生一微小运动。此外，机器人操作时，有时会碰到两个不同坐标系之间的微位移关系问题，例如用摄像机时，摄像机安装在某杆上，摄像机摄到的微位移是用固结于摄像机的坐标系来描述的。要求补偿的末端操作器的微位移是用基础坐标系来描述的，末端操作器的微位移又是通过关节空间的各关节的微运动来实现的，这就存在不同坐标系之间微位移的关系问题。第五十九页，共八十一页，编辑于2023年，星期日

一、变换的微分假设有一个变换，它的元素是某个变量的函数，对于这个变换的微分就是该变换矩阵各元素对该变量的偏导数所组成的变换阵乘以该变量的微分。给定变换T为它的元素是某个变量x的函数，则变换T的微分为:第六十页，共八十一页，编辑于2023年，星期日

二、微移动——微平动和微转动

所谓微运动指的是无限小的运动，即无限小移动和无限小转动。它既可以用给定的当前坐标系矩阵T来描述，也可以用基础坐标系来描述。已知坐标系矩阵T，微分运动后变为T+dT。应用相对于基础坐标系的左乘法则，T+dT可表示为：

式中，是用基础坐标系描述的微移动dx，dy，dz的移动变换。是用基础坐标系描述的绕k轴微旋转dθ的旋转运动变换。由上式得:I为4X4的单位矩阵第六十一页，共八十一页，编辑于2023年，星期日

代表一个微分平移和微分旋转的变换。微分移动的齐次变换矩阵为：微分旋转的齐次变换矩阵为：第六十二页，共八十一页，编辑于2023年，星期日

绕k轴旋转dθ等价于分别绕三个轴X，Y，Z轴旋转δx,δy,δz。令kxdθ=δx，kydθ=δy,

kzdθ=δz并代入上式可得：—1第六十三页，共八十一页，编辑于2023年，星期日

[例]

假设有一个坐标系A为：

相对于基础坐标系的微分平移为，微分旋转为，试求与d和δ相应的A的微分变换。第六十四页，共八十一页，编辑于2023年，星期日

[解]

首先构造微分平移和旋转变换第六十五页，共八十一页，编辑于2023年，星期日第六十六页，共八十一页，编辑于2023年，星期日三、两直角坐标系间的微分移动的关系——微分变换

前面讨论了用基准坐标系和当前T坐标系描述的微分运动，分别为和，不同坐标系的微分运动和的关系为：所以有：第六十七页，共八十一页，编辑于2023年，星期日

这个变换方程如同前面变换方程一样，可以用一个变换图来表示，如右图所示。由图也可以直接得到上式。方程2很重要，因为它把相对于不同的坐标系之间的微分变化联系起来了。我们首先展开方程右端的矩阵乘积，展开过程中进行了简化，可得出微分变化向量d和δ的元素之间的直接关系。变换T称为微分坐标变换。—2第六十八页，