机器人的空间描述与坐标变换.ppt

《机器人的空间描述与坐标变换.ppt》由会员分享，可在线阅读，更多相关《机器人的空间描述与坐标变换.ppt（24页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、1 第二章 机器人的空间描述和坐标变换2.1 位姿和坐标系描述2.2平移和旋转坐标系映射2.3平移和旋转齐次坐标变换2.4物体的变换和变换方程2.5通用旋转变换22.1位置方位表示与坐标系描述位置方位表示与坐标系描述 n1.位置描述位置描述 矢量矢量 Ap 表示箭头指向点的位置矢量，其表示箭头指向点的位置矢量，其中右上角标中右上角标“A”表示该点是用表示该点是用A坐标系描述坐标系描述的。的。（2-2）n2.方位描述方位描述 坐标系坐标系B与机械手末端工具固连，工具的姿态与机械手末端工具固连，工具的姿态可以由坐标系可以由坐标系B的方向来描述。而坐标系的方向来描述。而坐标系B的方的方向可以用沿三个

2、坐标轴的单位矢量来表示向可以用沿三个坐标轴的单位矢量来表示图2-2方位表示（2-1）旋旋转转矩矩阵阵 描述坐标系描述坐标系B的姿态，矢量的姿态，矢量 描述坐标系描述坐标系B的原点位的原点位置。置。33.位姿描述位姿描述 固连坐标系把刚体位姿描述问题转化为坐标系的描述问题。图固连坐标系把刚体位姿描述问题转化为坐标系的描述问题。图2-3中坐标系中坐标系B可以在固定坐标系可以在固定坐标系A中描述为中描述为（2-3）41.平移坐标变换平移坐标变换图图2-3平移变换平移变换 BP为坐标系为坐标系B描述的某一空间位描述的某一空间位置，我们也可以用置，我们也可以用AP（坐标系（坐标系A）描）描述同一空间位置

3、。因为两个坐标系具有述同一空间位置。因为两个坐标系具有相同的姿态，同一个点在不同坐标系下相同的姿态，同一个点在不同坐标系下的描述满足以下关系的描述满足以下关系 （2-4）2.2平移和旋转坐标系映射平移和旋转坐标系映射 旋旋转转坐坐标变换标变换的任的任务务是已知坐是已知坐标标系系B描述的描述的一个点的位置矢量一个点的位置矢量BP和和旋旋转转矩矩阵阵 ，求在坐，求在坐标标系系A下描述同一个点的位置矢量下描述同一个点的位置矢量AP。52.旋转坐标变换旋转坐标变换 （2-5）将（将（2-5）式写成矩）式写成矩阵阵形式得：形式得：（2-6）图2-4旋转变换 式（式（2-6）即为我们要求的旋转变换关系，该

4、变换是通过两个坐）即为我们要求的旋转变换关系，该变换是通过两个坐标系之间的旋转变换实现的。标系之间的旋转变换实现的。63.复合变换复合变换图图2-5复合变换复合变换 如果两个坐标系之间即存在平移如果两个坐标系之间即存在平移又存在旋转，如何计算同一个空间点又存在旋转，如何计算同一个空间点在两个坐标系下描述的变换关系？在两个坐标系下描述的变换关系？为了得到位置矢量为了得到位置矢量BP和和AP之之间的变换关系，我们建立一个中间的变换关系，我们建立一个中间坐标系间坐标系C。（2-7）（2-8）为了得到位置矢量为了得到位置矢量BP和和AP之间的变换关系，只需坐标系之间的变换关系，只需坐标系B 在坐标系下

5、在坐标系下A的描述。的描述。是是4 4矩矩阵阵，称，称为齐为齐次坐次坐标变换标变换矩矩阵阵。可以理解。可以理解为为坐坐标标系系B在固定坐在固定坐标标系系A中的描述。中的描述。72.3齐次坐标变换齐次坐标变换 坐标变换（坐标变换（2-8）可以写成以下形式）可以写成以下形式 （2-9）将位置矢量用将位置矢量用4 1矢量表示，增加矢量表示，增加1维的数值恒为维的数值恒为1，我们仍然用原，我们仍然用原来的符号表示来的符号表示4维位置矢量并采用以下符号表示坐标变换矩阵维位置矢量并采用以下符号表示坐标变换矩阵（2-10）（2-11）齐次坐标变换的主要作用是表达简洁，同时在表示多个坐标变换齐次坐标变换的主要

6、作用是表达简洁，同时在表示多个坐标变换的时候比较方便。的时候比较方便。1.齐次变换齐次变换82.齐次变换算子齐次变换算子 在机器人学中还经常用到下面的变换，如图在机器人学中还经常用到下面的变换，如图2-8，矢量，矢量AP1沿矢量沿矢量AQ平移至的平移至的AQ终点，得一矢量终点，得一矢量AP2。已知。已知AP1和和AQ求求AP2的过程称之为的过程称之为平移变换，与前面不同，这里只涉及单一坐标系。平移变换，与前面不同，这里只涉及单一坐标系。图图2-6平移算子平移算子 （2-12）可以采用齐次变换矩阵表示平移变换可以采用齐次变换矩阵表示平移变换（2-13）称称为为平移算子，其表达式平移算子，其表达式

7、为为 （2-14）其中其中I是是3 3单位矩阵。例如若单位矩阵。例如若AQ=ai+bj+ck，其中其中i、j和和k分别表示坐标系分别表示坐标系A三个坐标轴的三个坐标轴的单位矢量，则平移算子表示为单位矢量，则平移算子表示为 9同同样样，我，我们们可以研究矢量在同一坐可以研究矢量在同一坐标标系下的旋系下的旋转转变换变换，如，如图图2-9，AP1绕绕Z轴转轴转 角得到角得到AP2。则则图图2-7旋转算子旋转算子（2-20）Rot(z,)称为旋转算子，其表达式为称为旋转算子，其表达式为 （2-21）同理，可以得到绕同理，可以得到绕X轴和轴和Y轴的旋转算子轴的旋转算子 10 定义了平移算子和旋转算子以后

8、，可以将它们复合实现复杂的映射定义了平移算子和旋转算子以后，可以将它们复合实现复杂的映射关系。变换算子与前面介绍的坐标变换矩阵形式完全相同，因为所有描关系。变换算子与前面介绍的坐标变换矩阵形式完全相同，因为所有描述均在同一坐标系下，所以不需上下标描述（坐标系）。述均在同一坐标系下，所以不需上下标描述（坐标系）。（2-23）齐次坐标变换总结：表示坐表示坐标标系系B在坐在坐标标系系A下的描述，下的描述，的各列是坐的各列是坐标标系系B三个坐标轴方向的单位矢量，三个坐标轴方向的单位矢量，而表示坐标系而表示坐标系B原点位置。原点位置。2.它是不同坐它是不同坐标标系系间间的坐的坐标变换标变换。如。如3 3

9、.它是同一坐标系内的变换算子。它是同一坐标系内的变换算子。齐齐次坐次坐标变换标变换是复是复杂杂空空间变换间变换的基的基础础，必，必须认须认真理解和掌握。具体真理解和掌握。具体应应用的关用的关键键是理解它代表的是上面三种含是理解它代表的是上面三种含义义的哪一种，而不是的哪一种，而不是简单简单的套用的套用公式！公式！1.它是坐标系的描述。它是坐标系的描述。如如图图2-10表示的三个坐表示的三个坐标标系，已知坐系，已知坐标标系系A、B和和C之之间间的的变换变换矩矩阵阵 和和 位置矢量位置矢量CP，求在坐标系，求在坐标系A下表示同一个点的位置下表示同一个点的位置矢量矢量AP。113.复合变换复合变换

10、复合变换主要有两种应用形式，一种是建立了多个坐标系描述机器人复合变换主要有两种应用形式，一种是建立了多个坐标系描述机器人的位姿，任务是确定不同坐标系下对同一个量描述之间的关系；另一种是的位姿，任务是确定不同坐标系下对同一个量描述之间的关系；另一种是一个空间点在同一个坐标系内顺序经过多次平移或旋转变换，任务是确定一个空间点在同一个坐标系内顺序经过多次平移或旋转变换，任务是确定多次变换后点的位置。多次变换后点的位置。图图2-10 复合坐标变换复合坐标变换 （2-24）（2-25）根据坐标变换的定义得根据坐标变换的定义得（2-26）12(a)ZY顺序旋转顺序旋转(b)Y Z顺序旋转顺序旋转图图2-1

11、1旋转顺序对旋转顺序对变换结果影响变换结果影响例例2-3已知点已知点u=7i+3j+2k，先，先对对它它进进行行绕绕Z轴轴旋旋转转90o的的变换变换得点得点v，再，再对对点点v进进行行绕绕Y轴轴旋旋转转90o的的变换变换得得点点w，求，求v和和w。如果只关心最后的变换结果，可以按下式计算如果只关心最后的变换结果，可以按下式计算计算结果与前面的相同，称计算结果与前面的相同，称R=Rot(y,90o)Rot(z,90o)为复合旋转算子。为复合旋转算子。13注：固定坐标系变换，矩阵乘的顺序注：固定坐标系变换，矩阵乘的顺序“自右向左自右向左”如果改变旋转顺序，先对它进行绕如果改变旋转顺序，先对它进行绕

12、y轴旋转轴旋转90o，再绕，再绕z轴旋转轴旋转90o，结，结果如图果如图2-11b所示。比较图所示。比较图2-11a和图和图2-11b可以发现最后的结果并不相同，可以发现最后的结果并不相同，即旋转顺序影响变换结果。即旋转顺序影响变换结果。从数学角度解释就是矩阵乘法不满足交换率，从数学角度解释就是矩阵乘法不满足交换率，Rot(y,90o)Rot(z,90o)Rot(z,90o)Rot(y,90o)。和和 ，求求 和和给给定定 计计算算142.4物体的变换和变换方程物体的变换和变换方程已知坐已知坐标标系系B相相对对坐坐标标系系A的描述的描述求求坐坐标标系系A相相对对坐坐标标系系B的描述的描述一种直

13、接的方法是矩一种直接的方法是矩阵阵求逆，另一种方法是根据求逆，另一种方法是根据变换变换矩矩阵阵的特点直的特点直接得出逆接得出逆变换变换。后一种方法更。后一种方法更简单简单方便。方便。即齐次变换的求逆问题。即齐次变换的求逆问题。等价等价为为：已知：已知 是坐是坐标标系系B的原点在的原点在坐坐标标系系B中的描述，中的描述，显显然然为为零矢量。零矢量。由由（2-28）式得）式得15根据前面的讨论，旋转矩阵关系为根据前面的讨论，旋转矩阵关系为 （2-27）将坐标变换用于坐标系将坐标变换用于坐标系B的原点得的原点得（2-28）（2-29）逆变换可以直接用正变换的旋转矩阵和平移矩阵表示逆变换可以直接用正变

14、换的旋转矩阵和平移矩阵表示（2-30）16A沿沿xA平移平移3个单位，再绕新的个单位，再绕新的zA 轴转轴转180o得得 B因此因此B沿沿zB平移平移2个单位，然后绕个单位，然后绕yB轴转轴转90o再绕新再绕新xB轴转轴转150o得得 C图图2-12楔形块角点坐标系楔形块角点坐标系例例2-4，如如图图2-12给给出的楔形出的楔形块块角点坐角点坐标标系，求系，求齐齐次坐次坐标变换标变换因此因此A沿沿xA和和zA平移平移3和和2，然后绕，然后绕yA轴转轴转90，再绕新，再绕新xA轴转轴转-30得得C也可以按以下方法计算也可以按以下方法计算17 事实上，对于像本例题这种简单的情况，可以直接利用齐次坐

15、标变换事实上，对于像本例题这种简单的情况，可以直接利用齐次坐标变换的定义得到变换矩阵。即直接写出坐标系的定义得到变换矩阵。即直接写出坐标系C坐标轴矢量在坐标系坐标轴矢量在坐标系A下表下表示得旋转矩阵，平移矢量为坐标系示得旋转矩阵，平移矢量为坐标系C的原点在坐标系的原点在坐标系A下的矢量表示。下的矢量表示。18变换方程变换方程 图图2-13表示了多个坐标系的关系图，可以用两种不表示了多个坐标系的关系图，可以用两种不同的方式得到世界坐标系同的方式得到世界坐标系U下坐标系下坐标系D的描述。的描述。（2-31）（2-32）由（由（2-31）和（）和（2-32）可以得到变换方程）可以得到变换方程图图2-

16、13坐标变换序列坐标变换序列 可以利用可以利用变换变换方程方程（2-33）求解其中任意一个未知求解其中任意一个未知变换变换。例如，假。例如，假设设除除 以外其余以外其余变换变换均均为为已知，已知，则该则该未知未知变换变换可以用下式可以用下式计计算算在坐标系的图形表示方法中，从一个坐标系原点指向另一个坐标系原点在坐标系的图形表示方法中，从一个坐标系原点指向另一个坐标系原点的箭头表示坐标系的描述关系。的箭头表示坐标系的描述关系。（2-35）（2-36）19例例2-5假假设设已知已知图图机械臂末端工具坐机械臂末端工具坐标标系系T相相对对基座基座坐坐标标系系B的描述，的描述，还还已知工作台坐已知工作台

17、坐标标系系S相相对对基座基座坐坐标标系系B的描述，并且已知螺栓坐的描述，并且已知螺栓坐标标系系G相相对对工作工作台坐台坐标标系系S的描述。的描述。计计算螺栓相算螺栓相对对机械臂工具坐机械臂工具坐标标系系的位姿。的位姿。解：添加从工具坐标系解：添加从工具坐标系T原点到螺栓坐标系原点到螺栓坐标系G原点原点的箭头，可以得到如下变换方程的箭头，可以得到如下变换方程 （2-37）螺栓相对机械臂工具坐标系的位姿描述为螺栓相对机械臂工具坐标系的位姿描述为 （2-38）201.绕任意轴旋转变换绕任意轴旋转变换下面讨论绕任意轴下面讨论绕任意轴 f 旋转矩阵，轴在坐标系旋转矩阵，轴在坐标系A下表示为下表示为以以

18、f 为为 Z 轴建立与轴建立与A固连的坐标系固连的坐标系C用用n、o和和f表示坐标系表示坐标系C三个坐标三个坐标轴的单位矢量，在坐标系轴的单位矢量，在坐标系A下表示为下表示为图图2-18绕任意轴旋转变换绕任意轴旋转变换 因为固连的坐标系因为固连的坐标系C与与A固连，所以绕固连，所以绕 f旋转旋转等价于绕等价于绕ZC旋转。为此我们先将旋转。为此我们先将Ap在坐标系在坐标系C下下表示，再绕表示，再绕ZC旋转旋转 角，最后再把旋转得到的矢量角，最后再把旋转得到的矢量用坐标系用坐标系A表示。表示。Ap1=Rot(f,)Ap2.52.5通用旋转变换通用旋转变换21再将再将Cp1在坐在坐标标系系A下表示下

19、表示因此因此其中一个矢量其中一个矢量上式中的上式中的n和和o各分量是未知的，需要用各分量是未知的，需要用 f 的各分量表示的各分量表示 22根据坐标系的右手规则知根据坐标系的右手规则知n o=f，叉积可以按下式计算，叉积可以按下式计算再根据旋转矩阵的正交性可以得再根据旋转矩阵的正交性可以得 将上式对角线相加得将上式对角线相加得 r11+r22+r33=1+2c c=(r11+r22+r33-1)/2 232.等效转轴与转角等效转轴与转角 前面讨论了给定转轴和转角可以得到旋转矩阵，那么是否任意给定的旋转矩前面讨论了给定转轴和转角可以得到旋转矩阵，那么是否任意给定的旋转矩阵都可以确定等效的转轴阵都

20、可以确定等效的转轴f和转角和转角 哪？也就是两个坐标原点重合的坐标系可以通哪？也就是两个坐标原点重合的坐标系可以通过绕固定轴转一定的角度来实现从一个坐标系转换到另一个坐标系。过绕固定轴转一定的角度来实现从一个坐标系转换到另一个坐标系。将关于对角线对称的两个元素分别相减得将关于对角线对称的两个元素分别相减得r32-r23=2fxs,r13-r31=2fys,r21-r12=2fzs 将上式平方求和得：将上式平方求和得：4s2=(r32-r23)2+(r13-r31)2+(r21-r12)2 假设限定绕矢量假设限定绕矢量 f 正向旋转，且正向旋转，且0 180o，则，则可得可得 的值的值 =atan(s/c)24可得矢量可得矢量 f 分量的值分量的值 在应用中需要注意的是，当转角在应用中需要注意的是，当转角 的值接近的值接近0o或或180o时，方向矢量时，方向矢量 f 各分量的值计算出现问题，属于奇异情况。各分量的值计算出现问题，属于奇异情况。