运动学讲稿.ppt

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

1、关于运动学第一页，讲稿共四十六页哦 描述机器人操作机上每一活动杆件在空间相对于绝对坐标系或相对于机座坐标系的位置及姿态的方程，称为机器人操作机的运动学方程。机器人操作机末端操作器的位置和姿态问题，通常可分为两类基本问题。v一类是运动学正问题，已知机器人操作机中各运动副的运动参数和杆件的结构参数，求末端操作器相对于参考坐标系的位置和姿态。v另一类是运动学逆问题，根据已给定的满足工作要求时末端操作器相对于参考坐标系的位置和姿态以及杆件的结构参数，求各运动副的运动参数。第二页，讲稿共四十六页哦 4.1连杆参数和齐次变换矩阵1、连杆参数及连杆坐标系的建立坐标系连杆号的分配方法坐标系连杆号的分配方法：按

2、从机座到末端执行器的顺序，由低到高依次为各关节和各连杆编号。机座的编号为杆件0，与机座相连的连杆编号为杆件1，依次类推。机座与连杆1的关节编号为关节1，连杆1与连杆2的连接关节编号2，依次类推。各连杆的坐标系Z轴方向与关节轴线重合（对于移动关节，Z轴线沿此关节移动方向）。第三页，讲稿共四十六页哦1、连杆参数及连杆坐标系的建立van 关节n轴和n+1轴线公垂线的长度v 关节n轴线与n+1轴线的夹角 连杆n两端有关节n和n+1。描述该连杆可以通过两个几何参数:连杆长度和扭角。两条异面直线的公垂线段的长an即为连杆长度，这两条异面直线间的夹角n即为连杆扭角。nn+1第四页，讲稿共四十六页哦 1、连杆

3、参数及连杆坐标系的建立v 沿关节n轴线两个公垂线间的距离dn（两个连杆的相对位置）v 垂直于关节n轴线的平面内两个公垂线的夹角 确定杆件相对位置关系，由另外2个参数决定，一个是连杆的距离：，一个是杆件的转角：nn+1n-1第五页，讲稿共四十六页哦 这样,每个连杆可以由四个参数来描述,其中两个是连杆尺寸,两个表示连杆与相邻连杆的连接关系。当连杆n旋转时,n随之改变,为关节变量,其它三个参数不变;当连杆进行平移运动时,dn随之改变,为关节变量,其它三个参数不变。确定连杆的运动类型,同时根据关节变量即可设计关节运动副,从而进行整个机器人的结构设计。已知各个关节变量的值,便可从机座固定坐标系通过连杆坐

4、标系的传递,推导出手部坐标系的位姿形态。第六页，讲稿共四十六页哦 1、连杆参数及连杆坐标系的建立 坐标系的建立原则nn-1 连杆n坐标系的坐标原点位于n+1关节轴线上,是关节n+1的关节轴线与n和n+1关节轴线公垂线的交点。Z轴与n+1关节轴线重合。n+1 X轴与公垂线重合;从n指向n+1关节。Y轴按右手螺旋法则确定。第七页，讲稿共四十六页哦连杆的参数连杆的参数名称名称含义含义正负正负性能性能转角转角连杆连杆n n绕关节绕关节n n的的Z Zn-1n-1轴的转角轴的转角右手法则右手法则关节转动时为变量关节转动时为变量距离距离d dn n连杆连杆n n沿关节沿关节n n的的Z Zn-1n-1轴的

5、位移轴的位移沿沿Z Zn-1n-1正向为正向为+关节移动时为变量关节移动时为变量长度长度a an n沿沿X Xn n方向上连杆方向上连杆n n的长度的长度与与X Xn n正向一致正向一致尺寸参数，常量尺寸参数，常量扭角扭角连杆连杆n n两关节轴线之间的扭角两关节轴线之间的扭角右手法则右手法则尺寸参数，常量尺寸参数，常量连杆连杆n n 的坐标系的坐标系 原点原点O On n轴轴X Xn n轴轴Y Yn n轴轴Z Zn n位位于于关关节节n+1n+1轴轴线线与与连连杆杆n n两两关关节节轴轴线线的的公公垂垂线线的的交点处交点处沿沿连连杆杆n n两两关关节节轴轴线线的的公公垂垂线线，并并指向指向n+

6、1n+1关节关节根根据据轴轴X Xn n、Z Zn n按按右右手法则确定手法则确定与关节与关节n+1n+1轴线重合轴线重合连杆参数及坐标系连杆参数及坐标系 第八页，讲稿共四十六页哦2 2、连杆坐标系之间的变换矩阵nn-1(1)令n-1系绕Zn-1轴旋转n角,使Xn-1与Xn平行,算子为Rot(z,n)。(2)沿Zn-1轴平移dn,使Xn-1与Xn重合,算子为Trans(0,0,dn)。n+1(3)沿Xn轴平移an,使两个坐标系原点重合,算子为Trans(an,0,0)。(4)绕Xn轴旋转an角,使得n-1系与n系重合,算子为Rot(x,)。第九页，讲稿共四十六页哦 D-H变换矩阵变换矩阵 该变

7、换过程用一个总的变换矩阵An来表示连杆n的齐次变换矩阵为:第十页，讲稿共四十六页哦v4.2工业机器人运动学方程v1、机器人运动学方程我们将为机器人的每一个连杆建立一个坐标系，并用齐次变换来描述这些坐标系间的相对关系，也叫相对位姿。通常把描述一个连杆坐标系与下一个连杆坐标系间相对关系的齐次变换矩阵叫Ai变换矩阵,简称Ai矩阵。如A1矩阵表示第一个连杆坐标系相对固定坐标系的位姿;A2矩阵表示第二个连杆坐标系相对第一个连杆坐标系的位姿;Ai表示第i个连杆相对于第i-1个连杆的位姿变换矩阵。那么,第二个连杆坐标系在固定坐标系中的位姿可用A1和A2的乘积来表示,即:第十一页，讲稿共四十六页哦v如此类推，

8、对于六连杆机器人，有下列T6矩阵v v该等式称为机器人运动学方程。方程右边为从固定参考系到手部坐标系的各连杆坐标系之间变换矩阵的连乘；方程左边 表示这些矩阵的乘积，即机器人手部坐标系相对于固定参考系的位姿。式中，前三列表示手部的姿态，第四列表示手部的位置。第十二页，讲稿共四十六页哦 连杆参数中变量,其余参数d、a、均为常量。考虑到关节轴线平行，列出SCARA机器人连杆的参数如表所示。2、平面关节型机器人的运动学方程例1：如图所示为具有一个肩关节、一个肘关节和一个腕关节的SCARA机器人。此类机器人的机械结构特点是三个关节轴线是相互平行的。固定坐标系0和连杆1、连杆2、连杆3的坐标系1、2、3分

9、别如图(a)所示,坐落在关节1、关节2、关节3和手部中心。坐标系3也就是手部1坐标系。SCARA机器人的坐标系第十三页，讲稿共四十六页哦v该平面关节型机器人的运动学方程为v式中，A1表示连杆1的坐标系l相对于固定坐标系0的齐次变换矩阵；A2表示连杆2的坐标系2相对于连杆1的坐标系1的齐次变换矩阵；A3表示连杆3的坐标系即手部坐标系3相对于连杆2的坐标系2的齐次变换矩阵。参考图2-18(b)，于是有：第十四页，讲稿共四十六页哦第十五页，讲稿共四十六页哦式中：c123cos(1+2+3)；s123=sin(1+2+3)；c12=cos(1+2)；s12=sin(1+2)；c1cos1 s1=sin

10、1。(cos可用c表示，sin可用s表示)T3是A1、A2、A3连乘的结果，表示手部坐标系3(即手部)的位置和姿态。第十六页，讲稿共四十六页哦于是，可写出手部位置()列阵为第十七页，讲稿共四十六页哦v表示手部姿态的方向v矢量n、o、a分别为第十八页，讲稿共四十六页哦当转角变量1、2、3给定时，可以算出具体数值。如图所示，设1=30。,2=60。,3 30。，则可根据平面关节型机器人运动学方程式求解出运动学正解，即手部的位姿矩阵表达式为第十九页，讲稿共四十六页哦例2：如图所示的三自由度平面关节机器人，设杆件l，2的长度为l1，l2。试决定各杆件的A矩阵，并求末端执行器(杆件3)对绝对坐标系的变换

11、。三自由度平面关节机器人第二十页，讲稿共四十六页哦 因为每个关节轴线都处于同一平面，所以，又因为各杆件都处于同一平面，故各杆件坐标系原点都在同一平面上，所以 矩阵的参数表：第二十一页，讲稿共四十六页哦各杆件坐标系(右手坐标系)均设置在上关节处，各Z轴均垂直于图纸平面，取离开纸平面为正向，各x轴均为各杆件的延长线。第二十二页，讲稿共四十六页哦 例3：下图所示为斯坦福机器人及赋给各连杆的坐标系。斯坦福机器人的手臂有两个转动关节(关节1和关节2)，且两个转动关节的轴线相交于一点，一个移动关节(关节3)，共三个自由度：杆1绕固定坐标系的Z0轴旋转；杆2绕杆1坐标系的Z1轴旋转；杆3绕杆2坐标系的Z2轴

12、平移d3。手腕有三个转动关节，与转动关节的轴线相交于一点，共三个自由度；杆4绕杆3坐标系的Z3轴旋转；杆5绕杆4坐标系的Z4轴旋转；杆6绕杆5坐标系的Z5轴旋转;X6Y6Z6为手部坐标系，原点位于手部两手爪的中心，离手腕中心的距离为H，当夹持工件时，需确定它与被夹持工件上固联坐标系的相对位置关系和相对姿态关系。第二十三页，讲稿共四十六页哦第二十四页，讲稿共四十六页哦斯坦福机器人各连杆的参数第二十五页，讲稿共四十六页哦 矩阵1与0系是旋转关节连接，如图(a)所示。坐标系1相对于固定坐标系的Z0轴的旋转为变量，然后绕自身坐标系X1轴作的旋转变换，一90。所以第二十六页，讲稿共四十六页哦 2系与1系

13、是旋转关节连接，连杆距离为d2如图(b)所示。坐标系2相对于坐标系1的Z1轴的旋转为变量 ，然后绕自身坐标系Z2轴正向作d2距离的平移变换及绕X2轴作的旋转坐标变换，90。所以第二十七页，讲稿共四十六页哦 3系与2系是移动关节连接如图2-19(c)所示。坐标系3相对于坐标系2的Z2轴的平移为变量d3。所以第二十八页，讲稿共四十六页哦图2-21是斯坦福机器人手腕三个关节的示意图，它们都是转动关节，关节变量为4 5及6并且三个关节的中心重合。第二十九页，讲稿共四十六页哦 如图(a)所示，系4对系3的旋转变量为4,然后绕自身坐标轴X4作 4的旋转变换,=-90。所以第三十页，讲稿共四十六页哦 如图(

14、b)所示，系5对系4的旋转变量为5,然后绕自身坐标轴X5作 5的旋转变换,，=90。所以第三十一页，讲稿共四十六页哦 如图(c)所示，系6相对于系5的旋转变量为6，并移动距离H，所以第三十二页，讲稿共四十六页哦这样，所有的矩阵已建立。如果要知道非相邻杆件间的关系，只要用相应的矩阵连乘即可。如：第三十三页，讲稿共四十六页哦第三十四页，讲稿共四十六页哦 斯坦福机器人连杆参数如表2-3所示。现已知关节变量为：1=90，2=90，d3=300mm，A=90，5=90,6=90。并且，机器人结构参数d2=100mm，H=50mm。第三十五页，讲稿共四十六页哦 假如=0，则n、o、a三个方向矢量不变，而位

15、置矢量的分量Px、Py、Pz分别为代入本例给出的已知参数值和变量值，求得数值解：第三十六页，讲稿共四十六页哦v3、反向运动学及实例v上面我们说明了正向求解问题，即给出关节变量和d求出手部位姿各矢量n、o、a和p，这种求解方法只需将关节变量代入运动学方程中即可得出。但在机器人控制中，问题往往相反即在已知手部要到达的目标位姿的情况下如何求出关节变量，以驱动各关节的马达，使手部的位姿得到满足，这就是反向运动学问题，也称求运动学逆解。v现以斯坦福机器人为例来介绍反向求解的一种方法。为了书写简便，假设=0，即坐标系6与坐标系5原点相重合。已知斯坦福机器人的运动学方程为第三十七页，讲稿共四十六页哦设坐标系

16、6与坐标系5原点重合，其运动学方程为：现在给出矩阵及各杆参数 ，求关节变量 ，其中 。其中 为坐标系1，相对于固定坐标系O的Z0 轴旋转 ，然后绕自身坐标系X1轴作 的旋转变换，所以 斯坦福机器人及连杆坐标系第三十八页，讲稿共四十六页哦 斯坦福（STANFORD）机器人的连杆坐标系第三十九页，讲稿共四十六页哦只要列出 ，在上式两边分别左乘运动学方程，即可得展开方程两边矩阵，对应项相等，即可得 ，同理可顺次求得 上述求解的过程称为分离变量法，即将一个未知数由矩阵方程的右边移到左边，使其与其它未知数分开，解出这个未知数，再把下一个未知数移到坐标，重复进行，直到解出所有的未知数。第四十页，讲稿共四十

17、六页哦v还应注意到机器人运动学逆解问题的求解存在如下三个问题：v (1)解可能不存在。机器人具有一定的工作域，假如给定手部位置在工作域之外，则解不存在。如图所示二自由度平面关节机械手，假如给定手部位置矢量(x,y)位于外半径为 与内半径为 的圆环之外,则无法求出逆解1 及2，即该逆解不存在。工作域外逆解不存在第四十一页，讲稿共四十六页哦v (2)解的多重性。机器人的逆运动学问题可能出现多解。如图(a)表示一个二自由度平面关节机械手出现两个逆解的情况。对于给定的在机器人工作域内的手部位置A(x,y)可以得到两个逆解：及 。从图(a)可知手部是不能以任意方向到达目标点A的。增加一个手腕关节自由度，

18、如图(b)所示三自由度平面关节机械手即可实现手部以任意方向到达目标点A。逆解的多重性第四十二页，讲稿共四十六页哦v 在多解情况下,一定有一个最接近解，即最接近起始点的解。图(a)表示3R机械手的手部从起始点A运动到目标点B，完成实线所表示的解为最接近解，是一个“最短行程”的优化解。但是，如图(b)所示，在有障碍存在的情况下，上述的最接近解会引起碰撞，只能采用另一解，如图(b)中实线所示。尽管大臂、小臂将经过“遥远”的行程，为了避免碰撞也只能用这个解，这就是解的多重性带来可供选择的好处。避免碰撞的一个可能实现的解第四十三页，讲稿共四十六页哦 关于解的多重性的另一实例如图所表示PUMA560机器人实现同一目标位置和姿态有四种形位，即四种解。另外，腕部的“翻转”又可能得出两种解，其排列组合共可能有8种解。PUMA560机器人的四个逆解第四十四页，讲稿共四十六页哦 (3)求解方法的多样性。机器人逆运动学求解有多种方法，一般分为两类：封闭解和数值解。不同学者对同一机器人的运动学逆解也提出不同的解法。应该从计算方法的计算效率、计算精度等要求出发，选择较好的解法。第四十五页，讲稿共四十六页哦感谢大家观看第四十六页，讲稿共四十六页哦