其次章 机器人运动学

本文格式为Word版，下载可任意编辑——其次章机器人运动学

其次章机器人运动学

机器人，特别是其中最为常用的关节型机器人，由若干个关节所联系起来的一种开链，其一端固结在机座上，另一端安装有末端执行器。已知所有关节变量确定机器人末端执行器的位姿或者由末端手的位姿计算出每一个关节变量值是机器人运动学研究的主要内容。

本章主要介绍机器人运动学，首先介绍了1.1齐次坐标与齐次变换

在描述刚体（如零件、工具或机械手）间关系时，要用到点、向量、坐标系、平移、旋转以及变换等概念，这些概念可用齐次矩阵来表示。

1.1.1空间点的表示

在指定的直角坐标系?A?中，空间任一点P（图2-1）的位置可用3?1的列矢量P表

A示：

AP?px?pyApz（2.1）

A?其中px，py，pz为点P的三个坐标分量，P的上标A代表参考坐标系?A?，称P为位置矢量。

图2-1位置表示

1.1.2空间向量的表示

将一个n维空间的点用n?1维坐标表示，则该n?1维坐标即为n维坐标的齐次坐标，即：

AP?px?pyTpz1（2.2）

?在上式中参与一个比例因子w，点P表示为：

AP?ax?byczTw（2.3）

?其中，ax?pxw，by?pyw，cz?pzw。式2.2和2.3表示同一个点P。起始于原点，终止于P点的空间向量也可以采用齐次矩阵形式表示：

P?axby?czTw（2.4）

?若比例因子w变化，向量的大小也会发生变化，w大于1，向量所有的分量都变大，假使w小于1，向量所有的分量都变小，w等于1，各分量的大小保持不变。w等于0表示该向量的方向，称为方向向量。如图2-2中，i、j、k分别表示直角坐标系中X、Y、Z坐标轴的单位矢量，用齐次坐标表示为：

TTTX??1000?Y??0100?Z??0010?（2.5）

图2-2中所示的矢量u的方向表示为：

u??cos?cos?cos?T0?（2.6）

其中?、?、?分别为矢量u与坐标轴的夹角。1.1.3刚体位姿的表示

为了研究机器人的运动，往往不仅要表示空间某个点的位置，而且需要表示刚体的神态。指定一个坐标系与此刚体固接，再将此坐标系在空间表示出来，该坐标系称为动坐标系。如

Y?Z?为固接在刚体上的一个动坐标系，动坐标系的图2-3所示，O?为刚体上任一点，O?X?原点与固定坐标系原点之间做一个向量P来表示动坐标系的位置，即为式2.2。动坐标系的神态可由其坐标轴方向来表示，令n、o、a分别为X?、Y?、Z?坐标轴的单位向量，每个向量都由其所在固定坐标系中的三个分量表示：

?n?nx??o?ox?a?ax????nyoyaynzozaz?0?（2.7）0?0TTT动坐标系的位姿可以由三个表示方向的单位向量以及第四个位置向量来表示，式中前三个向量是w?0的方向向量，表示该坐标系的三个单位向量n、o和a的方向，而第四个

w?1的向量表示动坐标系的原点相对于固定坐标系的位置。与单位向量不同，向量P的长

度十分重要，因而比例因子为1。

F??noa?nx?np???y?nz??0oxoyoz0axayaz0px?py??（2.8）pz??1?由于动坐标系一直固接在该刚体上，只要动坐标系在空间表示出来，刚体相对于固定坐

标系的位姿也可以采用式2-8进行描述。空间中的刚体具有沿着X、Y和Z三轴的移动和绕三轴的旋转，因此需要6条独立的信息描述刚体的位姿。而式2-8中给出了12条信息，其中9条为神态信息，3条为位置信息。三个单位向量n、o和a两两正交，因而它的9个元素满足6个约束条件：

n?o?n?a?a?o?0（2.9）

n?o?a?1（2.10）

1.2齐次变换

变换为空间的一个运动，由旋转和平移组成。当空间的一个坐标系相对于固定的参考坐

标系运动时，这一运动可以用类似于表示坐标系的方式来表示。变换本身就是坐标系位姿的变换，分为以下几种形式：

1.2.1平移的齐次变换

一个坐标系（或刚体）在空间中以不变的神态运动，该变换为平移变换。坐标系的单位向量保持同一方向不变，所有改变只是坐标系原点相对于参考坐标系的变化，如图2-2所示。相对于固定参考系的新的坐标系的位置可以用原来坐标系的原点位置向量加上表示位移的向量求得。变换矩阵为：

?1?0T???0??001000dx?0dy??（2.9）1dz??01?其中dx，dy和dz是纯平移向量d相对于参考坐标系x，y和z轴的三个向量，矩阵T的前三列等同于单位矩阵，表示没有旋转运动，最终一列表示平移运动。若坐标系平移前的位姿矩阵为：

Fold?nxoxaxPx??nyoyayP?y?（2.9）???nzozazPz???0001??则，坐标系平移后的位姿矩阵为：

Fnew?1?0???0??001000dx??nxoxaxPx?dx??nyoyayP?d?0dy?yy???Fold??（2.9）?nzozazPz?dz?1dz????01?0001??也可表示为：

Fnew?Trans(dx,dy,dz)?Fold（2.9）

对比式子2.9和2.9，坐标系平移变换前后的位姿矩阵维数一致，方向向量保持不变，

仅是位置向量发生变换，即为d和P相加的结果。

1.2.2旋转的齐次变换

空间某点P，坐标为(Px,Py,Pz)，当它绕x轴旋转角后至P?点，坐标为(Px?,Py?,Pz?)，

P点和P?点的坐标关系为：

?Px??Px??Py?Pycos??Pzsin?（2.9）?P?Psin??Pcos?yz?z写成矩阵形式为：

?Px???1????Py????0??Pz?????0也可表示为：

0co?ssin???Px??P??sin????y?（2.9）

co?s????Pz??0P??Rot(x,?)?P（2.9）

Rot(x,?)表示齐次坐标变换时绕x轴的旋转变换矩阵，第一列表示相对于x轴的位置，

其值为1，0，0，它表示沿着x轴的坐标没有改变。习惯上采用符号C?表示cos?，S?表示sin?，因此旋转矩阵表示为：

?10Rot(x,?)???0C???0S?将上式矩阵写成4?4的齐次变换矩阵为：

0??S???（2.9）C???

?10?0C?Rot(x,?)???0S???00同理，绕y轴和z轴的旋转矩阵分别为：

0?S?C?00?0??（2.9）0??1??C??0Rot(y,?)????S???01.2.3复合变换

0S?100C?000??C??S?0??Rot(z,?)???00???1??0?S?C?0000100?0??（2.9）0??1?复合变换是由固定参考坐标系或当前运动坐标系的一系列沿轴平移和绕轴旋转变换所

组成的。任何变换都可以分解为按一定顺序的一组平移和旋转变换，将两种变换组合在一个齐次变换中，称为复合变换。在计算变换矩阵时，要考虑算子左、右乘规则：假使相对于固定坐标系进行变换，则算子左乘；假使相对于动坐标系进行变换，则算子右乘。

动坐标系?n,o,a?相对于参考坐标系?x,y,z?依次进行下面三种变换：（1）绕x轴旋转?度；（2）接着沿x轴平移l1，沿z轴平移l3；（3）最终，绕y轴旋转?度。

点P固连在动坐标系上，动坐标系与固定坐标系重合，随着动坐标系?n,o,a?相对于固

定坐标系旋转或平移时，坐标系中的P点相对于固定坐标系也跟着改变，第一步变换后，P点相对于固定坐标系的坐标为：

P1,xyz?Rot(x,?)?P；（2.9）

其次步变换后，P点相对于固定坐标系的坐标为：

P2,xyz?Trans(l1,0,l3)?P(l1,0,l3)?Rot(x,?)?P；（2.9）1,xyz?Trans第三步变换后，P点相对于固定坐标系的坐标为：

P(l1,0,l3)?Rot(x,?)?P；（2.9）3,xyz?Rot(y,?)?P2,xyz?Rot(y,?)?Trans

每一步变换都是用变换矩阵左乘P点的坐标得到该点相对于固定坐标系的坐标，矩阵

的书写顺序和进行变换的顺序正好相反，变换的顺序很重要，假使颠倒了变换的顺序，结果将完全不同。

1.2.4相对于动坐标系的变换

上述介绍的变换是相对于固定坐标系进行的，所有的平移距离和旋转角度都是相对于参

考坐标系轴来测量的。在实际应用中，也有可能相对于动坐标系或当前坐标系的轴变换。点

P固连在动坐标系?n,o,a?上，依次进行下面三种变换：（1）绕a轴旋转?度；（2）接着

沿n轴平移l1，沿a轴平移l3；（3）最终，绕o轴旋转?度。

为了计算当前坐标系中点的坐标相对于参考坐标系的变化，这时需要右乘变换矩阵而不

是左乘。第一步变换后，P点相对于固定坐标系的坐标为：

P1,xyz?Rot(a,?)?P；其次步变换后，P点相对于固