坐标系建立讲稿.ppt

《坐标系建立讲稿.ppt》由会员分享，可在线阅读，更多相关《坐标系建立讲稿.ppt（55页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、关于坐标系建立第一页，讲稿共五十五页哦 在在机机器器人人中中，通通常常有有两两类类关关节节：转转动动关关节节和和移移动动关关节节。不不同同于于人人类类的的关关节节，一一般般机机器器人人关关节节为为一一个个自自由由度度的的关关节节，其其目目的的是是为为了了简简化化力力学学、运运动动学学和和机机器器人人的的控控制制。转转动动关关节节提提供供了了一一个个转转动动自自由由度度，移移动动关关节节提提供供一一个个移移动动自自由由度度，各各关关节节间间是是以以固固定定杆杆件相连接的。件相连接的。旋旋转转关关节节有有两两种种基基本本形形式式：铰铰链和两杆的相对转动。链和两杆的相对转动。关关 节节第二页，讲稿共

2、五十五页哦杆杆 件件 机器人杆件是连接两个关节的固定物体（机械）机器人杆件是连接两个关节的固定物体（机械）。机器人杆件的主要目的是用来保持该关节与各相。机器人杆件的主要目的是用来保持该关节与各相关末端关节一个固定的关系。机器人末端杆件只有关末端关节一个固定的关系。机器人末端杆件只有一个关节，位于最接近末端（或机座）的位置。在一个关节，位于最接近末端（或机座）的位置。在最远离机座的末端，通常是附加一个手爪。为了更最远离机座的末端，通常是附加一个手爪。为了更容易、清楚地解释一个机器人的末端和其各关节点容易、清楚地解释一个机器人的末端和其各关节点的关系，课程中只以有限的杆件数作为研究讨论对的关系，课

3、程中只以有限的杆件数作为研究讨论对象。实际上，为了使得机器人更容易制造，类似的象。实际上，为了使得机器人更容易制造，类似的限制在机器人制造中也使用。限制在机器人制造中也使用。第三页，讲稿共五十五页哦下面给出了八种类型的常见杆件构形下面给出了八种类型的常见杆件构形：1)两两个个平平行行的的转转动动关关节节且且在在两两轴轴间间没没有有扭扭转转；连连杆杆参参数数ln连连 杆杆的的长长度度；如如果果连连杆杆的的中中心心线线被被认认作作x方方向向并并且且从从关关节节n-1到到关关节节 n沿沿xn-1方方 向向有有一一定定距距离离，整整个个杆杆件件可可以以绕绕关关节节n-1转转 动动 n角角，该该角角认认

4、为为是是两两连连杆杆夹夹角角并并且且这这个个角角就就是是一一般般转转动动关关节节的的变变量量；同同时时关关节节轴轴被被认认为为是是z方方向向并并且且绕绕zn-1转转动动；y轴轴由由右右手手定定则则确确定定。第四页，讲稿共五十五页哦坐标系及其相关参数确定：坐标系及其相关参数确定：一、坐标系确定一、坐标系确定 (1)Zn-1的确定的确定(转轴轴线转轴轴线)(2)Xn-1：垂直两连杆公垂线：垂直两连杆公垂线xn-1=zn-1 zn (3)Yn-1 ：根据右手定则确定：根据右手定则确定 二、参数确定二、参数确定(1)连杆长度连杆长度ln：zn-1 zn沿沿xn-1的距离；的距离；(2)两关节轴扭角两关

5、节轴扭角 n：zn-1 zn绕绕xn的转角；的转角；(3)dn：两连杆间偏置：两连杆间偏置：xn-1 xn沿沿zn-1距离，距离，0；(4)n：两连杆间角度，：两连杆间角度，Xn-1 Xn绕绕zn-1的转角，的转角，变量。变量。第五页，讲稿共五十五页哦 2)两个转动关节在空间形成两轴间两个转动关节在空间形成两轴间90的扭转；连杆参数的扭转；连杆参数ln连杆的长度；连杆的长度；如果连杆的中心线被认作如果连杆的中心线被认作x方向并且从方向并且从关节关节n-1到关节到关节n沿沿xn-1方向有一定距方向有一定距离，整个杆件可以绕关节离，整个杆件可以绕关节n-1转动转动 n角，该角认为是两连杆夹角，这个

6、角就角，该角认为是两连杆夹角，这个角就是一般转动关节的变量；同时关节轴被是一般转动关节的变量；同时关节轴被认为是认为是z方向并且方向并且绕绕zn-1转动；转动；y轴由右手定则确定。轴由右手定则确定。第六页，讲稿共五十五页哦坐标系及其相关参数确定：坐标系及其相关参数确定：一、坐标系确定一、坐标系确定 (1)Zn-1的确定的确定(转轴轴线转轴轴线)(2)Xn-1：xn-1=zn-1 zn (3)Yn-1 ：根据右手定则确定：根据右手定则确定 二、参数确定二、参数确定(1)连杆长度连杆长度ln：zn-1 zn沿沿xn-1的距离；的距离；(2)两关节轴扭角两关节轴扭角 n：zn-1 zn绕绕xn的转角

7、，的转角，90；(3)dn：两连杆间偏置：两连杆间偏置：xn-1 xn沿沿zn-1距离，距离，0；(4)n：两连杆间角度，：两连杆间角度，Xn-1 Xn绕绕Zn-1的转角，的转角，变量。变量。第七页，讲稿共五十五页哦 3)两两个个转转动动关关节节相相互互交交叉叉垂垂直直轴轴；两两个个关关节节转转动动轴轴相相交交，连连杆杆参参数数 ln=0；关关节节轴轴被被认认为为是是z方方向向；x方方向向由由两两个个z轴轴确确定定，y方方向向由由右右手手定定则则确确定定；dn为为偏偏移移值值。第八页，讲稿共五十五页哦坐标系及其相关参数确定：坐标系及其相关参数确定：一、坐标系确定一、坐标系确定 (1)Zn-1的

8、确定的确定(转轴轴线、柱轴方向线转轴轴线、柱轴方向线)(2)Xn-1：xn-1=zn-1 zn (3)Yn-1 ：根据右手定则确定：根据右手定则确定 二、参数确定二、参数确定(1)连杆长度连杆长度ln：zn-1 zn沿沿xn-1的距离，两轴相交为的距离，两轴相交为0；(2)两关节轴扭角两关节轴扭角 n：zn-1 zn绕绕xn的转角，的转角，-90 ；(3)dn：两连杆间偏置：两连杆间偏置：xn-1 xn沿沿zn-1距离，距离，dn；(4)n：连杆绕：连杆绕zn-1的转角，变量。的转角，变量。第九页，讲稿共五十五页哦 4)两两个个转转动动关关节节相相互互垂垂直直并并且且重重合合；连连杆杆参参数数

9、ln=0；关关节节轴轴被被认认为为是是z方方向向；x方方向向由由两两个个z轴轴确确定定，y方方向向由由右右手手定定则则；dn为为偏偏移移值值。原原点点由由n-1坐坐标标系系决决定定 第十页，讲稿共五十五页哦坐标系及其相关参数确定：坐标系及其相关参数确定：一、坐标系确定一、坐标系确定 (1)Zn-1的确定的确定(转轴轴线、柱轴方向线转轴轴线、柱轴方向线)(2)Xn-1、：xn-1=zn-1 zn (3)Yn-1 ：根据右手定则确定：根据右手定则确定 二、参数确定二、参数确定(1)连杆长度连杆长度ln：zn-1 zn沿沿xn-1的距离，两轴相交的距离，两轴相交0；(2)两关节轴扭角两关节轴扭角 n

10、：zn-1 zn绕绕xn的转角，的转角，90 ；(3)dn：两连杆间距离：两连杆间距离：xn-1 xn沿沿zn-1移动距离，移动距离，0；(4)n：连杆绕：连杆绕zn-1的转角，变量。的转角，变量。第十一页，讲稿共五十五页哦 5)两两个个移移动动柱柱关关节节相相互互垂垂直直并并相相交交；连连杆杆参参数数ln=0；关关节节轴轴线线方方向向是是z向向；x向向由由z轴轴确确定定，y方方向向由由右右手手定定则则确确定定；dn 与与dn+1为柱关节变量。为柱关节变量。第十二页，讲稿共五十五页哦坐标系及其相关参数确定：坐标系及其相关参数确定：一、坐标系确定一、坐标系确定 (1)Zn-1的确定的确定(转轴轴

11、线、柱轴方向线转轴轴线、柱轴方向线)(2)Xn-1、：xn-1=zn-1 zn (3)Yn-1 ：根据右手定则确定：根据右手定则确定 二、参数确定二、参数确定(1)连杆长度连杆长度ln：zn-1 zn沿沿xn-1的距离，两轴相交的距离，两轴相交0；(2)两关节轴扭角两关节轴扭角 n：zn-1 zn绕绕xn的转角，的转角，-90 ；(3)dn：移动关节移动变量；：移动关节移动变量；(4)n：移动关节转角为：移动关节转角为0。第十三页，讲稿共五十五页哦 6)一一个个转转动动关关节节和和一一个个移移动动柱柱关关节节相相互互垂垂直直并并相相交交；连连杆杆参参数数ln=0；转转动动关关节节轴轴线线方方向

12、向和和移移动动关关节节移移动动方方向向是是z向向；x方方向向由由z轴轴确确定定，y方方向向由由右右手手定定则则确确定定；n为为转转动动关关节节变变量量、dn+1为为移动关节变量。移动关节变量。第十四页，讲稿共五十五页哦坐标系及其相关参数确定：坐标系及其相关参数确定：一、坐标系确定一、坐标系确定 (1)Zn-1的确定的确定(转轴轴线、柱轴方向线转轴轴线、柱轴方向线)(2)Xn-1、：xn-1=zn-1 zn (3)Yn-1 ：根据右手定则确定：根据右手定则确定 二、参数确定二、参数确定(1)连杆长度连杆长度ln：zn-1 zn沿沿xn-1的距离，两轴相交的距离，两轴相交0；(2)两关节轴扭角两关

13、节轴扭角 n：zn-1 zn绕绕xn的转角，的转角，-90 ；(3)dn+1：移动关节移动变量，：移动关节移动变量，dn=偏置量；偏置量；(4)n：转动关节变量。：转动关节变量。第十五页，讲稿共五十五页哦 7)一一个个移移动动柱柱关关节节和和一一个个转转动动关关节节相相互互平平行行；连连杆杆参参数数ln=偏偏置置量量；关关节节轴轴线线方方向向是是z向向；x方方向向由由z轴轴确确定定，y方方 向向由由右右手手定定则则；转转动动和和移移动动关关节节变变量量为为 n和和dn+1。第十六页，讲稿共五十五页哦坐标系及其相关参数确定：坐标系及其相关参数确定：一、坐标系确定一、坐标系确定 (1)Zn-1的确

14、定的确定(转轴轴线、柱轴方向线转轴轴线、柱轴方向线)(2)Xn-1、：xn-1=zn-1 zn (3)Yn-1 ：根据右手定则确定：根据右手定则确定 二、参数确定二、参数确定(1)连杆长度连杆长度ln：zn-1 zn沿沿xn-1的距离；的距离；(2)两关节轴扭角两关节轴扭角 n：zn-1 zn绕绕xn的转角，的转角，0 ；(3)dn+1：移动关节移动变量；：移动关节移动变量；(4)n：转动关节变量。：转动关节变量。第十七页，讲稿共五十五页哦 8)一一个个移移动动柱柱关关节节和和一一个个转转动动关关节节相相互互垂垂直直；连连杆杆参参数数ln=0；关关节节轴轴线线方方向向是是z向向；x向向由由z轴

15、轴确确定定，y方方向向由由右右手手定定则则；dn为为偏偏移移值值。第十八页，讲稿共五十五页哦坐标系及其相关参数确定：坐标系及其相关参数确定：一、坐标系确定一、坐标系确定 (1)Zn-1的确定的确定(转轴轴线、柱轴方向线转轴轴线、柱轴方向线)(2)Xn-1、：xn-1=zn-1 zn (3)Yn-1 ：根据右手定则确定：根据右手定则确定 二、参数确定二、参数确定(1)连杆长度连杆长度ln：zn-1 zn沿沿xn-1的距离，两轴相交的距离，两轴相交0；(2)两关节轴扭角两关节轴扭角 n：zn-1 zn绕绕xn的转角，的转角，90 ；(3)dn：移动关节移动变量；：移动关节移动变量；(4)n+1：转

16、动关节变量。：转动关节变量。第十九页，讲稿共五十五页哦2.8 D-H表示法表示法学习目标：学习目标：1 理解理解D-H法原理法原理 2 学会用学会用D-H法对机器人建模法对机器人建模学习重点：学习重点：1 给关节指定参考坐标系给关节指定参考坐标系 2 制定制定D-H参数表参数表 3 利用参数表计算转移矩阵利用参数表计算转移矩阵第二十页，讲稿共五十五页哦一一 背景简介：背景简介：1955年年，Denavit和和Hartenberg提提出出了了这这一一方方法法，后后成成为为表表示示机机器器人人以以及及对对机机器器人人建建模模的的标标准准方方法法，应应用广泛。用广泛。二二 总体思想总体思想 首先给每

17、个关节指定坐标系，然后确定从一个关节到首先给每个关节指定坐标系，然后确定从一个关节到下一个关节进行变化的步骤，这体现在两个相邻参考坐标下一个关节进行变化的步骤，这体现在两个相邻参考坐标系之间的变化，将所有变化结合起来，就确定了末端关节系之间的变化，将所有变化结合起来，就确定了末端关节与基座之间的总变化，从而建立运动学方程，进一步对其与基座之间的总变化，从而建立运动学方程，进一步对其求解。求解。第二十一页，讲稿共五十五页哦1.坐坐标标系系的的确确定定规规则则一一 关关节节，连连杆杆命命名名规规则则：第第一一个个关关节节指指定定为为关关节节n,第第二二个个关关节节为为n+1,其其余余关关节节以以此

18、此类类推推。连连杆杆命命名名规规则则与与关关节节相同。相同。坐标系的确定坐标系的确定第二十二页，讲稿共五十五页哦坐标系的确定规则坐标系的确定规则2.Z轴确定规则轴确定规则如果关节是旋转的，如果关节是旋转的，Z轴位于按右手规则旋转的方轴位于按右手规则旋转的方向，转角向，转角 为关节变量。如果关节是滑动的，为关节变量。如果关节是滑动的，Z轴轴为沿直线运动的方向，连杆长度为沿直线运动的方向，连杆长度d为关节变量。关为关节变量。关节节n处处Z轴下标为轴下标为n-1。3.X轴确定规则轴确定规则情况情况1 两关节两关节Z轴既不平行也不相交轴既不平行也不相交取两取两Z轴公垂线方向作为轴公垂线方向作为X轴方向

19、，命名规则同轴方向，命名规则同Z轴轴第二十三页，讲稿共五十五页哦X轴确定规则轴确定规则情况情况2：两关节：两关节Z轴平行轴平行此时，两此时，两Z轴之间有无数条公垂线，可挑选与前一关节轴之间有无数条公垂线，可挑选与前一关节的公垂线共线的一条公垂线的公垂线共线的一条公垂线情况情况3：两关节：两关节Z轴相交轴相交取两条取两条Z轴的叉积方向作为轴的叉积方向作为X轴。轴。第二十四页，讲稿共五十五页哦Y轴及变量确定规则轴及变量确定规则4.Y轴确定原则轴确定原则取取X轴，轴，Z轴差积方向作为轴差积方向作为Y轴方向。（右手）轴方向。（右手）5.变量选择原则变量选择原则用用 角表示绕角表示绕Z轴的旋转角，轴的旋

20、转角，d表示在表示在Z轴上两条相轴上两条相邻的公垂线之间的距离，邻的公垂线之间的距离，a表示每一条公垂线的长表示每一条公垂线的长度度(关节偏移关节偏移)，角，角 表示两个相邻表示两个相邻Z轴之间的角度也轴之间的角度也叫关节扭转。通常情况下，只有叫关节扭转。通常情况下，只有 和和d是关节变量。是关节变量。第二十五页，讲稿共五十五页哦 到达下一坐标系的标准运动到达下一坐标系的标准运动我们可以通过以下几个运动，将一个参考坐标系变换我们可以通过以下几个运动，将一个参考坐标系变换到下一个参考坐标系。到下一个参考坐标系。1 绕绕Zn轴旋转轴旋转 ，它使得它使得Xn+1和和Xn互互相平行相平行第二十六页，讲

21、稿共五十五页哦 到达下一坐标系的标准运动到达下一坐标系的标准运动2 沿沿Zn轴平移轴平移dn+1距离，距离，使得使得Xn和和Xn+1共线共线3 沿沿Xn轴平移轴平移an+1的距离，使的距离，使Xn和和Xn+1的原点重合。的原点重合。第二十七页，讲稿共五十五页哦 到达下一坐标系的标准运动到达下一坐标系的标准运动4 将将Zn轴绕轴绕Xn+1轴旋转轴旋转 ，使得，使得Zn轴与轴与Zn+1轴对轴对准。准。这样就实现了从一个坐标系变换下一个坐标系这样就实现了从一个坐标系变换下一个坐标系第二十八页，讲稿共五十五页哦列出变换矩阵列出变换矩阵 由于所有的运动都是相对于当前坐标系而言的。因此，由于所有的运动都是

22、相对于当前坐标系而言的。因此，总的变换矩阵总的变换矩阵A等于各变换矩阵右乘。等于各变换矩阵右乘。从而得到的结果如下：从而得到的结果如下：以此类推，总的变换矩阵为：以此类推，总的变换矩阵为：第二十九页，讲稿共五十五页哦D-H参数表参数表通过原理图确定各参数，制定通过原理图确定各参数，制定D-H参数表如下：参数表如下：#da1 23456将各参数带入矩阵方程即可得到运动学方程，进一步求将各参数带入矩阵方程即可得到运动学方程，进一步求解。解。第三十页，讲稿共五十五页哦例2.11 如图，已知一两杆机构，两杆长分别为l1、l2，转角变量为 、，1)确定零位置；2)建立连杆坐标系3)确定参数；4)确定工作

23、空间第三十一页，讲稿共五十五页哦例2.12 如图，已知一两杆机构，一杆偏置为d1、二杆长为l2，转角变量为，：1)建立连杆坐标系；2)确定参数；3)确定工作空间第三十二页，讲稿共五十五页哦例2.13 如图，已知一两杆机构，一杆偏置为d1、二杆偏置为d2，变量为，d2：1)建立连杆坐标系；2)确定参数；3)确定工作空间第三十三页，讲稿共五十五页哦例2.14 如图，已知一两杆机构：1)建立连杆坐标系；2)确定参数；3)确定工作空间第三十四页，讲稿共五十五页哦例2.15 如图，已知一两杆机构：1)建立连杆坐标系；2)确定参数；3)确定工作空间第三十五页，讲稿共五十五页哦例例 题题 2.19对下图所示

24、简单机器人，根据对下图所示简单机器人，根据D-H法，建立必要坐标系及法，建立必要坐标系及参数表。参数表。第三十六页，讲稿共五十五页哦第一步：根据第一步：根据D-H法建立坐标系的规则建立坐标系法建立坐标系的规则建立坐标系 第三十七页，讲稿共五十五页哦第二步：将做好的坐标系简化为我们熟悉的线图形式第二步：将做好的坐标系简化为我们熟悉的线图形式第三十八页，讲稿共五十五页哦第三步：根据建立好的坐标系，确定各参数，并写入第三步：根据建立好的坐标系，确定各参数，并写入D-H参数表参数表#da1009020030040-90500906000第三十九页，讲稿共五十五页哦第四步：将参数代入第四步：将参数代入A

25、矩阵，可得到矩阵，可得到第四十页，讲稿共五十五页哦第第5步步 求出总变化矩阵求出总变化矩阵第四十一页，讲稿共五十五页哦思考题思考题第四十二页，讲稿共五十五页哦2.9 机器人的逆运动学解机器人的逆运动学解让我们通过下面这道例题来了解一下机器人逆运动学求解的让我们通过下面这道例题来了解一下机器人逆运动学求解的一般步骤。例一般步骤。例2.19最后方程为最后方程为求逆运动学方程的解求逆运动学方程的解第四十三页，讲稿共五十五页哦 根据第根据第3行第行第4列元素对应相等可得到列元素对应相等可得到依次用依次用 左乘上面两个矩阵，得到：左乘上面两个矩阵，得到：第四十四页，讲稿共五十五页哦根据根据1，4元素和元

26、素和2，4元素，可得到：元素，可得到：将上面两个方程两边平方相加，并利用和差化将上面两个方程两边平方相加，并利用和差化积公式得到积公式得到第四十五页，讲稿共五十五页哦已知已知于是可得到：于是可得到：依次类推，分别在方程依次类推，分别在方程2.19两边左乘两边左乘A1A4的逆，的逆，可得到可得到第四十六页，讲稿共五十五页哦机器人的逆运动学解第四十七页，讲稿共五十五页哦这样，这样，就可以计算出来了，接下来再一次利用式就可以计算出来了，接下来再一次利用式由于由于C12=C1C2-S1S2以及以及S12=S1C2+C1S2，最后得到：，最后得到：机器人的逆运动学解第四十八页，讲稿共五十五页哦最后用最后

27、用A5的逆左乘式的逆左乘式2.67，再利用，再利用2,1元素和元素和2,2元素，得元素，得到：到：机器人的逆运动学解第四十九页，讲稿共五十五页哦2.10 机器人的运动学编程机器人的运动学编程在实际应用中，对运动学的求解是相当繁琐和耗时的，因在实际应用中，对运动学的求解是相当繁琐和耗时的，因此需要用计算机编程来实现。并且应尽量避免使用矩阵求此需要用计算机编程来实现。并且应尽量避免使用矩阵求逆或高斯消去法等相对繁琐的算法。正确的算法是：逆或高斯消去法等相对繁琐的算法。正确的算法是：第五十页，讲稿共五十五页哦第五十一页，讲稿共五十五页哦对机器人相关概念的补充对机器人相关概念的补充一一 退化退化当机器

28、人失去一个自由度，并因此不按所期望的状态当机器人失去一个自由度，并因此不按所期望的状态运动时即称为退化。运动时即称为退化。退化发生条件：退化发生条件：1 机器人达到物理极限，不能进一步运动机器人达到物理极限，不能进一步运动2两个相似关节共线两个相似关节共线第五十二页，讲稿共五十五页哦退化状态下的机器人退化状态下的机器人第五十三页，讲稿共五十五页哦不灵巧区域：能对机器人定位不定姿的区域称为不灵巧不灵巧区域：能对机器人定位不定姿的区域称为不灵巧区域。区域。D-H法的局限性：无法表示关于法的局限性：无法表示关于y轴的运动。轴的运动。第五十四页，讲稿共五十五页哦感感谢谢大大家家观观看看第五十五页，讲稿共五十五页哦