在1955年,Denavit和Hartenberg在“ASME Journal of Applied Mechanics”发表了一篇论文,后来利用这篇论文来对机器人进行表示和建模,并导出了它们的运动方程,这已成为表示机器人和对机器人运动进行建模的标准方法,所以必须学习这部分内容。Denavit-Hartenberg(D-H)模型表示了对机器人连杆和关节进行建模的一种非常简单的方法,可用于任何机器人构型,而不管机器人的结构顺序和复杂程度如何。它也可用于表示已经讨论过的在任何坐标中的变换,例如直角坐标、圆柱坐标、球坐标、欧拉角坐标及RPY坐标等。另外,它也可以用于表示全旋转的链式机器人、SCARA机器人或任何可能的关节和连杆组合。尽管采用前面的方法对机器人直接建模会更快、更直接,但D-H表示法有其附加的好处,使用它已经开发了许多技术,例如,雅克比矩阵的计算和力分析等。
假设机器人由一系列关节和连杆组成。这些关节可能是滑动(线性)的或旋转(转动)的,它们可以按任意的顺序放置并处于任意的平面。连杆也可以是任意的长度(包括零),它可能被弯曲或扭曲,也可能位于任意平面上。所以任何一组关节和连杆都可以构成一个我们想要建模和表示的机器人。
为此,需要给每个关节指定一个参考坐标系,然后,确定从一个关节到下一个关节(一个坐标系到下一个坐标系)来进行变换的步骤。如果将从基座到第一个关节,再从第一个关节到第二个关节直至到最后一个关节的所有变换结合起来,就得到了机器人的总变换矩阵。在下一节,将根据D-H表示法确定一个一般步骤来为每个关节指定参考坐标系,然后确定如何实现任意两个相邻坐标系之间的变换,最后写出机器人的总变换矩阵。
图2.25 通用关节—连杆组合的D-H表示
假设一个机器人由任意多的连杆和关节以任意形式构成。图2.25表示了三个顺序的关节和两个连杆。虽然这些关节和连杆并不一定与任何实际机器人的关节或连杆相似,但是他们非常常见,且能很容易地表示实际机器人的任何关节。这些关节可能是旋转的、滑动的、或两者都有。尽管在实际情况下,机器人的关节通常只有一个自由度,但图2.25中的关节可以表示一个或两个自由度。
图2.25(a)表示了三个关节,每个关节都是可以转动或平移的。第一个关节指定为关节n,第二个关节为关节n+1,第三个关节为关节n+2。在这些关节的前后可能还有其他关节。连杆也是如此表示,连杆n位于关节n-1与n+1机器人资料之间,连杆n+1位于关节n+1与n+2之间。
为了用D-H表示法对机器人建模,所要做的第一件事是为每个关节指定一个本地的参考坐标系。因此,对于每个关节,都必须指定一个z轴和x轴,通常并不需要指定y轴,因为y轴总是垂直于x轴和z轴的。此外,D-H表示法根本就不用y轴。以下是给每个关节指定本地参考坐标系的步骤:
● 所有关节,无一例外的用z轴表示。如果关节是旋转的,z轴位于按右手规则旋转的方向。如果关节是滑动的,z轴为沿直线运动的方向。在每一种情况下,关节n处的z轴(以及该关节的本地参考坐标系)的下标为n-1。例如,表示关节n+1的z轴是。这些简单规则可使我们很快地定义出所有关节的z轴。对于旋转关节,绕z轴的旋转(角)是关节变量。对于滑动关节,沿z轴的连杆长度d是关节变量。
● 如图2.25(a)所示,通常关节不一定平行或相交。因此,通常z轴是斜线,但总有一条距离最短的公垂线,它正交于任意两条斜线。通常在公垂线方向上定义本地参考坐标系的x轴。所以如果表示与之间的公垂线,则的方向将沿。同样,在与之间的公垂线为,的方向将沿。注意相邻关节之间的公垂线不一定相交或共线,因此,两个相邻坐标系原点的位置也可能不在同一个位置。根据上面介绍的知识并考虑下面例外的特殊情况,可以为所有的关节定义坐标系。
● 如果两个关节的z轴平行,那么它们之间就有无数条公垂线。这时可挑选与前一关节的公垂线共线的一条公垂线,这样做就可以简化模型。
● 如果两个相邻关节的z轴是相交的,那么它们之间就没有公垂线(或者说公垂线距离为零)。这时可将垂直于两条轴线构成的平面的直线定义为x轴。也就是说,其公垂线是垂直于包含了两条z轴的平面的直线,它也相当于选取两条z轴的叉积方向作为x轴。这也会使模型得以简化。
在图2.25(a)中,角表示绕z轴的旋转角,d表示在z轴上两条相邻的公垂线之间的距离,a表示每一条公垂线的长度(也叫关节偏移量),角表示两个相邻的z轴之间的角度 (也叫关节扭转)。通常,只有和d是关节变量。
下一步来完成几个必要的运动,即将一个参考坐标系变换到下一个参考坐标系。假设现在位于本地坐标系,那么通过以下四步标准运动即可到达下一个本地坐标系。
(1)绕轴旋转(如图2.25(a)与(b)所示),它使得和互相平行,因为和都是垂直于轴的,因此绕轴旋转使它们平行(并且共面)。
(2)沿轴平移距离,使得和共线(如图2.25(c)所示)。因为和已经平行并且垂直于,沿着移动则可使它们互相重叠在一起。
(3)沿轴平移的距离,使得和的原点重合(如图2.25(d)和(e)所示)。这是两个参考坐标系的原点处在同一位置。
(4)将轴绕轴旋转,使得轴与轴对准(如图2.25(f)所示)。这时坐标系n和n+1完全相同(如图2.25(g)所示)。至此,我们成功的从一个坐标系变换到了下一个坐标系。
在n+1和n+2坐标系间严格地按照同样的四个运动顺序可以将一个坐标变换到下一个坐标系。如有必要,可以重复以上步骤,就可以实现一系列相邻坐标系之间的变换。从参考坐标系开始,我们可以将其转换到机器人的基座,然后到第一个关节,第二个关节……,直至末端执行器。这里比较好的一点是,在任何两个坐标系之间的变换均可采用与前面相同的运动步骤。
通过右乘表示四个运动的四个矩阵就可以得到变换矩阵A,矩阵A表示了四个依次的运动。由于所有的变换都是相对于当前坐标系的(即他们都是相对于当前的本地坐标系来测量与执行),因此所有的矩阵都是右乘。从而得到结果如下:
(2.51)
(2.52)
比如,一般机器人的关节2与关节3之间的变换可以简化为:
(2.53)
在机器人的基座上,可以从第一个关节开始变换到第二个关节,然后到第三个……,再到机器人的手,最终到末端执行器。若把每个变换定义为,则可以得到许多表示变换的矩阵。在机器人的基座与手之间的总变换则为:
发布评论