工业机器人的运动学PPT课件.ppt

.,1,工业机器人,湖北工业大学机械工程学院主讲：张铮,2,.,第2章工业机器人的运动学,2.1齐次坐标及对象物的描述2.2齐次变换及运算2.3工业机器人连杆参数及其齐次变换矩2.4工业机器人运动学方程,3,.,2.1齐次坐标及对象物的描述,一、点的位置描述在选定的直角坐标系A中,空间任一点P的位置可用31的位置矢量p表示,其左上标代表选定的参考坐标系,pxp=pypz,式中:px、py、pz是点P在坐标系A中的三个位置坐标分量,如图,4,.,二、齐次坐标,如用四个数组成的(41)列阵,PxP=PyPz1,表示三维空间直角坐标系A中点P,则列阵PxPyPz1称为三维空间点P的齐次坐标。,必须注意,齐次坐标的表示不是惟一的。我们将其各元素同乘一非零因子w后,仍然代表同一点P,即PxaP=Py=bPzc1w式中:a=wpx;b=wpy;c=wpz。,5,.,三、坐标轴方向的描述,如图所示,i、j、k分别是直角坐标系中X、Y、Z坐标轴的单位向量。若用齐次坐标来描述X、Y、Z轴的方向,则X=1000TY=0100TZ=0010T从上可知,我们规定:(41)列阵abc0T中第四个元素为零,且a2+b2+c2=1,则表示某轴(某矢量)的方向;(41)列阵abcwT中第四个元素不为零,则表示空间某点的位置。图中矢量v的方向用(41)列阵可表达为v=abc0Ta=cos,b=cos,c=cos图中矢量v所坐落的点O为坐标原点,可用(41)列,6,.,例2-1用齐次坐标写出图2-3中矢量u、v、w的方向列阵。,解矢量u:cos=0,cos=0.7071067,cos=0.7071067u=00.70710670.70710670T矢量v:cos=0.7071067,cos=0,cos=0.7071067v=0.707106700.70710670T矢量w:cos=0.5,cos=0.5,cos=0.7071067w=0.50.50.70710670T,7,.,四、动坐标系位姿的描述动坐标系位姿的描述就是对动坐标系原点位置的描述以及对动坐标系各坐标轴方向的描述。1.刚体位置和姿态的描述,设有一刚体Q,如图2-4所示,O为刚体上任一点,OXYZ为与刚体固连的一个坐标系,称为动坐标系刚体Q在固定坐标系OXYZ中的位置可用齐次坐标形式的一个(41)列阵表示为：,x0p=y0z01,8,.,刚体的姿态可由动坐标系的坐标轴方向来表示。令n、o、a分别为X、Y、Z坐标轴的单位方向矢量,每个单位方向矢量在固定坐标系上的分量为动坐标系各坐标轴的方向余弦,用齐次坐标形式的(41)列阵分别表示为,n=nxnynz0T,o=oxoyoz0T,a=axayaz0T,因此,图2-4中刚体的位姿可用下面(44)矩阵来描述:,nxoxaxx0T=noap=nyoyayy0nzozazz00001,很明显,对刚体Q位姿的描述就是对固连于刚体Q的坐标系OXYZ位姿的描述。,9,.,例2-2图2-5表示固连于刚体的坐标系B位于OB点，xb=10,yb=5,zb=0。ZB轴与画面垂直,坐标系B相对固定坐标系A有一个30的偏转,试写出表示刚体位姿的坐标系B的(44)矩阵表达式。,解XB的方向列阵:n=cos30cos60cos900T=0.8660.5000.0000TYB的方向列阵:o=cos120cos30cos900T=-0.5000.8660.0000T,ZB的方向列阵:a=0.0000.0001.0000T坐标系B的位置列阵:p=10.05.00.01T所以,坐标系B的(44)矩阵表达式为,0.866-0.5000.00010.0TT=0.5000.8660.0005.00.0000.0001.0000.00001,10,.,2.手部位置和姿态的表示机器人手部的位置和姿态也可以用固连于手部的坐标系B的位姿来表示,如图所示。,手部的位姿可用(44)矩阵表示为：,nxoxaxpxnoap=nyoyaypynzozazpz0001,11,.,例2-3图表示手部抓握物体Q,物体为边长2个单位的正立方体,写出表达该手部位姿的矩阵式。,解因为物体Q形心与手部坐标系OXYZ的坐标原点O相重合,所以手部位置的(41)列阵为,p=1111T,手部坐标系X轴的方向可用单位矢量n来表示:=90,=180,=90n:nx=cos=0ny=cos=-1nz=cos=0,同理,手部坐标系Y轴与Z轴的方向可分别用单位矢量o和a来表示，根据式(2-8)可知,手部位姿可用矩阵表达为0-101T=noap=-100100-110001,12,.,2.2齐次变换及运算刚体的运动是由转动和平移组成的。为了能用同一矩阵表示转动和平移,有必要引入(44)的齐次坐标变换矩阵。,一、平移的齐次变换首先,我们介绍点在空间直角坐标系中的平移。如图所示,空间某一点A,坐标为(x,y,z),当它平移至A点后,坐标为(x,y,z),x=x+xy=y+yz=z+z,或写成:x100xxy=010yyz001zz100011也可以简写为A=Trans(x,y,z)A式中:Trans(x,y,z)表示齐次坐标变换的平移算子。,13,.,例2-4有下面两种情况(如图所示）动坐标系A相对于固定坐标系的X0、Y0、Z0轴作(-1,2,2)平移后到A;动坐标系A相对于自身坐标系(即动系)的X、Y、Z轴分别作(-1,2,2)平移后到A。已知写出AA矩阵表达式。,0-101A=-100100-110001,解动坐标系A的两个平移坐标变换算子均为,100-1Trans(x,y,z)=010200120001,A坐标系是动系A沿固定坐标系作平移变换得来的,因此算子左乘,A的矩阵表达式为,A=Trans(-1,2,2)A0-100=-100300-130001,A坐标系是动系A沿自身坐标系作平移变换得来的,因此算子右乘,A的矩阵表达式为,A=ATrans(-1,2,2),0-10-1=-100200-1-10001,14,.,二、旋转的齐次变换首先我们介绍点在空间直角坐标系中的旋转,如图2-10所示,空间某一点A,坐标为(x,y,z),当它绕Z轴旋转角后至A点,坐标为(x,y,z)。,A点和A点的坐标关系为:,x=cosx-sinyy=sinx+cosyz=z,或用矩阵表示为xcos-sin0 xy=sincos0yz001z,xcos-sin00 xy=sincos00yz0010z100011,A点和A点的齐次坐标分别为xyz1T和xyz1T,因此A点的旋转齐次变换过程为,a=Rot(z,)a,Rot(z,)表示齐次坐标变换时绕Z轴的旋转算子,算子左乘表示相对于固定坐标系进行变换,15,.,下图所示为点A绕任意过原点的单位矢量k旋转角的情况,kx,ky,kz分别为k矢量在固定参考系坐标轴X、Y、Z上的三个分量,且kx2+ky2+kz2=1。,可以证得,绕任意过原点的单位矢量k转角的旋转齐次变换公式为,kxkxvers+ckykxvers-kzskzkxvers+kys0Rot(k,)=kxkyvers+kzskykyvers+ckzkyvers-kxs0kxkzvers-kyskykzvers+kxskzkzvers+c00001,式中:vers=1-cos;值的正负号由右手螺旋法则决定。上式称为一般旋转齐次变换通式,它概括了绕X、Y、Z轴进行旋转齐次变换的各种特殊情况。,16,.,三、平移加旋转的齐次变换平移变换和旋转变换可以组合在一个齐次变换中,点W若还要作4i-3j+7k的平移,则如图2-14所示,只要左乘上平移变换算子,即可得到最后E点的列阵表达式,e=Trans(4,-3,7)Rot(y,90)Rot(z,90)u,100400107=010-310003001701002000100011001476=100-33=40107210000111,0014100-301070001,其中,为平移加旋转的一般齐次变换矩阵。,17,.,2.3工业机器人连杆参数及其齐次变换矩阵,如图1所示,连杆两端有关节n和n+1。该连杆尺寸可以用两个量来描述:一个是两个关节轴线沿公垂线的距离an,称为连杆长度;另一个是垂于an的平面内两个轴线的夹角n,称为连杆扭角。这两个参数为连杆的尺寸参数。,一、连杆参数及连杆坐标系的建立,再考虑连杆n与相邻连杆n-1的关系,若它们通过关节相连,如图2所示,其相对位置可用两个参数dn和n来确定,其中dn是沿关节n轴线两个公垂线的公距离,n是垂直于关节n轴线的平面内两个公垂线的夹角。这是表达相邻杆件关系的两个参数。,图1,图2,18,.,二、连杆坐标系之间的变换矩阵,建立了各连杆坐标系后,n-1系与n系间的变换关系可以用坐标系的平移、旋转来实现从n-1系到n系的变换,可先令n-1系绕Zn-1轴旋转n角,再沿Zn-1轴平移dn,然后沿Xn轴平移an,最后绕Xn轴旋转n角,使得n-1系与n系重合。于是连杆n的齐次变换矩阵为：,An=Rot(z,n)Trans(0,0,dn)Trans(an,0,0)Rot(x,n)cn-sn00100an1000=sncn0001000cn-sn00010001dn0sncn0000100010001cn-sncnsnsnancn=sncncn-cnsnansn0sncndn0001,19,.,2.4工业机器人运动学方程,一机器人运动学方程,通常把描述坐标系与下一个连杆间的相对关系的齐次变换矩阵叫做A变换矩阵或A矩阵。如果A1矩阵表示第一个连杆坐标系相对于固定的坐标系的位置，A2矩阵表示第二个连杆坐标系相对第一连杆坐标系的位置，那么第二个连杆坐标系在固定坐标系中的位置可用A1和A2的乘积来表示：T2=A1A2。,若A3矩阵表示第三个连杆坐标系相对于第二个连杆坐标系的位置，则有：T3=A1A2A3。如此类推，对于六连杆机器人，有下列T6矩阵：T6=A1A2A3A4A5A6。,计算结果T6是一个(44)矩阵,即nxoxaxpxT6=nyoyaypynzozazpz0001,式中:前三列表示手部的姿态;第四列表示手部的位置。,20,.,二、正向运动学及实例,1.平面关节型机器人的运动学方程,下图1所示为具有一个肩关节、一个肘关节和一个腕关节的SCARA机器人。机器人连杆的参数如表1所示，机器人坐标系图2所示。,图1,图2,表1,21,.,该平面关节型机器人的运动学方程为T3=A1A2A3式中:A1表示连杆1的坐标系1相对于固定坐标系0的齐次变换矩阵;A2表示连杆2的坐标系2相对于连杆1的坐标系1的齐次变换矩阵;A3表示连杆3的坐标系即手部坐标系3相对于连杆2的坐标系2的齐次变换矩阵。参考图2,于是有A1=Rot(z0,1)Trans(l1,0,0)A2=Rot(z1,2)Trans(l2,0,0)c1-s10l1c1c2-s20l2c2=s1c10l1s1=s2c20l2s20010001000010001A3=Rot(z2,3)Trans(l3,0,0)c3-s30l3c3=s3c30l3s300100001,c123-s1230l3c123+l2c12+l1c1T3=s123c1230l3s123+l2s12+l1s100100001,22,.,T3是A1、A2、A3连乘的结果,表示手部坐标系3(即手部)的位置和姿态。,nxoxaxpxT3=nyoyaypynzozazpz0001,于是,可写出手部位置(41)列阵为,pxl3c123+l2c12+l1c1P=py=l3s123+l3s12+l1s1pz011,表示手部姿态的方向矢量n、o、a分别为,nxc123n=ny=s123nz000,ox-s123o=oy=c123oz000,ax0a=ay=0az100,当转角变量1、2、3给定时,可以算出具体数值。,23,.,2.斯坦福机器人的运动学方程,表2-3斯坦福机器人杆件参数,矩阵Ai。1系与0系是旋转关节连接,如上图(a)所示。坐标系1相对于固定坐标系0的Z0轴的旋转为变量1,然后绕自身坐标系X1轴作1的旋转变换,1=-90。所以,c10-s10A1=Rot(z0,1)Rot(x1,1)=s10c100-1000001,同理得A2,A3,A4,A5,A6。,斯坦福机器人手臂坐标系,24,.,这样,所有杆