机器人运动学ppt课件.ppt

创新设计作业:设计一种类人教学机器人。要求机器人具有类似人的四肢，单片机控制。给出总体的设计方案、机械结构和传动方案、选择合适的传感器、控制方案。,1,第2章机器人运动学(KinematicsofRobots),引言机器人位置与姿态的描述机器人运动学正问题机器人运动学逆问题机器人的雅可比矩阵,2,2.1引言（TheIntroduction）,机器人运动学正问题：定义逆问题：定义机器人动力学,3,基本概念（TheBasicConcepts）,自由度：物体能够对坐标系进行独立运动的数目称为自由度(DOF,degreeoffreedom)。刚体具有6个自由度三个旋转自由度R1,R2,R3三个平移自由度T1,T2,T3,4,机动度：DegreeofMobility关节：Joint连杆：Link自由度由机动度构成,机动度不一定是自由度.,5个机动度，2个自由度,5,2.2机器人位置与姿态的描述(TheDescriptionofPositionandPosture),6,位置与姿态的表示,位置描述：位置矢量(positionvector)直角坐标系A,位置矢量Ap矩阵表示矢量和表示矢量的模，单位矢量,7,一、机器人坐标系变换(CoordinateTransformation)Ouvw：Puvw=（Pu,Pv,Pw）TOxyz：Pxyz=（Px,Py,Pz）T当Ouvw坐标系绕一轴线转动后，均可通过一个3x3旋转矩阵R将原坐标Puvw变换到Oxyz系中的坐标Pxyz，即：Pxyz=RPuvw,8,由矢量分量的定义有：Puvw=puiu+pvjv+pwkwpu、pv、pw分别表示P沿Ou、Ov、Ow轴的分量Px=ixP=ixiupu+ixjvpv+ixkwpwPy=iyP=iyiupu+iyjvpv+iykwpwPz=izP=iziupu+izjvpv+izkwpw将上式写成矩阵形式：Px=ixiuixjvixkwPuPy=iyiuiyjviykwPvPz=iziuizjvizkwPwPxyz=RPuvw同样，也有Puvw=QPxyz，QR1RT,9,如果Ouvw坐标系统绕Ox轴转动角，变换矩阵Rx,称为绕Ox轴转动角的旋转矩阵，此时ix=iu，ixiuixjvixkw100Rx,=iyiuiyjviykw=0cos-siniziuizjvizkw0sincos向量点乘：ab=|a|b|cos(a),10,类似地，绕Oy轴转动角和绕Oz轴转角的33旋转矩阵分别为，cos0sinRy,=010-sin0coscos-sin0Rz,=sincos0001矩阵Rx,、Ry,和Rz,称为基本旋转矩阵。任何旋转变换可以由有限个基本旋转变换合成得到。,11,依次左乘（如果uvw对xyz旋转）依次右乘（如果uvw绕自己的坐标轴旋转）R=Rz,Ry,Rx,12,例题：求表示绕Oy轴转角，然后绕Ow轴转角，再绕Ou轴转角的合成旋转矩阵。,13,例题：坐标系B的初始位姿与参考坐标系A相同，坐标系B相对于A的zA轴旋转30，再沿A的xA轴移动12，沿A的yA轴移动6。求旋转矩阵。解：,14,二、齐次坐标和变换矩阵齐次坐标是用n+l维坐标来描述n维空间中的位置，其第n+1个分量（元素）称为比例因子。P=(Px,Py,Pz,)T在机器人学的应用中，一般将比例因子取为1。机器人系统运动分析中，齐次变换矩阵写成以下形式：T=R33P31=旋转矩阵33位置矢量31O13I11O131,15,若三维空间的位置矢量P表示成齐次坐标，即P=pxpypz1T,1000cos0sin0Tx，=0cos-sin0Ty，=01000sincos0-sin0cos000010001cos-sin00100dxTz，=sincos00Ttran=010dy0010001dz00010001Pxyz=TPuvw,16,课前提问：,（1）什么是机器人运动学的正问题和逆问题？（2）机器人的坐标变换矩阵的一般形式是什么？（3）连续的变换矩阵，什么情况下依次左乘、什么情况下依次右乘？（4）什么是齐次坐标和齐次变换？,17,2.3机器人运动学正问题(TheForwardKinematicProblem),DenavitHartenberg(D-H)表示法,18,1.坐标系的建立：n关节机器人需建立n+1个坐标系，其中参考(机座)坐标系为O0 x0y0z0,，机械手末端的坐标系为Onxnynzn,19,串联杆型机械手是由一系列通过连杆与其活动关节连接在一起所组成。如图所示，任何一个连杆都可以用两个量来描述：一个是公共垂线距离an，另一个是与an垂直的平面上两个轴的夹角n，习惯上称an为连杆长度，n称为连杆的扭转角。,20,如图所示，在每个关节轴上有两个连杆与之相连，即关节轴有两个公垂线与之垂直，每一个连杆一个。两个相连的连杆的相对位置用dn和n确定，dn是沿着n关节轴两个垂线的距离，n是在垂直这个关节轴的平面上两个被测垂线之间的夹角，dn和n分别称作连杆之间的距离及夹角。,21,为了描述连杆之间的关系，我们对每个连杆赋一个坐标系。转动关节：关节变量为n。连杆n的坐标原点设在关节n和关节n+1轴之间的公共垂线与关节n+1轴的交点上。在关节轴相交的情况下（无公垂线），这个原点就在两个关节轴的相交点上（an0）。如果两个关节轴平行（有无数条公垂线），则原点的选择要使下一个连杆的关节距离为0（dn0），连杆n的z轴与n+1关节轴在一条直线上。x轴与任何存在的公共垂线成一条直线，并且沿着这条垂线从n关节指向n+1关节。在相交关节的情况下，x轴的方向平行或者逆平行zn-1zn的向量叉积，应该注意，这个条件对于沿着关节n和n+1之间垂线的x轴同样满足。当xn-1和xn平行，且有相同的指向时，则对于第n个转动关节n0。,表连杆参数,22,确定和建立每个坐标系的原则：(1)zi轴沿着第i关节的运动轴;(2)xi轴垂直于zi-1轴和zi轴并指向离开zi-1轴的方向;(3)yi轴按右手坐标系的要求建立。按照这些规则，第0号坐标在机座上的位置和方向可任选，只要z0轴沿着第1关节运动轴。第n坐标系可放在手的任何部位，只要xn轴与zn-1轴垂直。,23,z0,z2,z3,z4,x3,x2,x0,x4,0,2,1,z5,x5,z6,x6,6,4,3,5,z1,x1,24,2、几何参数的定义描述串联机器人相邻坐标系之间的关节关系可归纳为如下4个参数：i:绕zi-1轴(右手规则)由xi-1轴指向xi轴的关节角;di:从第i-1坐标系的原点到zi-1轴和xi轴的交点沿zi-1轴的距离;ai:从zi-1和xi的交点到第i坐标系原点沿xi轴的偏置距离;i:绕xi轴(右手规则)由zi-1轴转向zi轴的偏角。,25,3、建立i坐标系和i-1坐标系的齐次变换矩阵：,26,第i坐标系相对于机座齐坐标系的次变换矩阵是各齐次变换矩阵i-1Ai的连乘积：,4、得出机器人手爪到机座的变换矩阵,27,0Tn=0A11A2.n-1Ann为手的法向矢量，o为手的滑动矢量，a为手的接近矢量，p为手的位置矢量,28,例题1：建立二秆机构的末端的变换矩阵,同理：,29,最后得到的变换矩阵为：,30,z0,z2,z3,z4,x3,x2,x0,x4,0,2,1,z5,x5,z6,x6,6,4,3,5,D-H参数表：,z1,x1,例题2:PUMA机器人的坐标变换矩阵,31,z0,z2,z3,z4,x3,x2,x0,x4,0,2,1,z5,x5,z6,x6,6,4,3,5,D-H参数表：,z1,x1,32,33,例题3:斯坦福机械手,一、建立坐标系二、D-H参数表三、i-1Ai坐标变换矩阵,0,1,2,3,4,5,6,Z0,X0,Z1,X1,Z2,X2,Z3,X3,Z4,X4,Z5,X5,Z6,X6,34,表斯坦福机械手连杆参数Linkiiaidicosisini110000-122-900d20130900d310440000-155-90000166900d610,35,斯坦福机械手的A变换如下：C10-S10S10C100A1=0-1000001C20S20S20-C201A2=010d20001100001002A3=001d30001,36,C40-S40S40C403A4=0-1000001C50S50S50-C504A5=01000001C6-S600S6C6005A6=00100001,37,斯坦福机械手A变换的积如下所示，这些是从连杆6开始，然后逐步回到基坐标。C6-S600S6C6005T6=0010（3.44）0001C5C6-C5S6S50S5C6-S5S6-C504T6=S6C600（3.45）0001C4C5C6-S4S6-C4C5S6-S4C6C4S50S4C5C6+C4S6-S4C5S6+C4C6S4S503T6=-S5C6S5S6C50（3.46）0001,38,C4C5C6-S4S6-C4C5S6-S4C6C4S50S4C5C6+C4S6-S4C5S6+C4C6S4S502T6=-S5C6S5S6C5d3（3.47）0001C2(C4C5C6-S4S6)-S2S5C6-C2(C4C5S6+S4C6)+S2S5S6S2(C4C5C6-S4S6)+C2S5C6-S2(C4C5S6+S4C6)-C2S5S61T6=S4C5C6+C4C6-S4C5S6+C4C600C2C4S5+S2C5S2d3S2C4S5-C2C5-C2d3S4S5d2（3.48）01,39,nxoxaxpxnyoyaypy0T6=nzozazpz0001其中nx=C1C2(C4C5C6-S4S6)-S2S5C6-S1(S4C5S6+C4S6)ny=S1C2(C4C5C6-S4S6)-S2S5C6+C1(S4C5S6+C4S6)nz=-S2(C4C5C6-S4S6)-C2S5C6ox=C1-C2(C4C5S6+S4C6)+S2S5C6-S1(-S4C5S6+C4S6)oy=S1-C2(C4C5C6+S4C6)+S2S5S6+C1(-S4C5S6+C4S6)oz=S2(C4C5C6+S4C6)+C2S5S6ax=C1(C2C4S5+S2C5)S1S4C5ay=S1(C2C4S5+S2C5)+C1S4S5az=S2C4S5+C2C5px=C1S2d3S1d2py=S1S2d3+C1d2pz=C2d3,40,0Tn=0A11A2.n-1An,41,课前提问：,（1）PUMA机器人的坐标变换矩阵D-H参数？（2）矩阵的逆矩阵如何求解？,42,定义：若|A|0,则方阵A可逆，且,A*称为A的伴随阵，由行列式|A|的方阵各个元素的代数余子式所Aij构成。,另一种求法：,行列式变换,43,2.4机器人运动学逆问题(TheInverseKinematicProblem),44,Z：机器人基座相对于基础坐标系0Tn：手部端点相对于机器人基座Z：末端执行器相对于手部端点物体用变换B：物体参考坐标系相对于基础坐标系G：末端执行器对物体的抓持位置相对于物体参考坐标系,Z0TnE=BG这个方程可以用有向变换图来表示。图的每一段弧表示一个变换。从它的定义的坐标系向外指向。用Z-1左乘和用E-1右乘方程，得到0Tn=Z-1BGE-1,机器人坐标变换关系：,45,从有向变换图上我们可以直接得到上述结果，从0Tn弧线的尾部开始，沿着图形顺时针依次列出各个变换，直到0Tn弧的箭头为止。在逆变换时，我们从0T6弧的箭头开始，按逆时针方向依次列出各个变换，直到T6弧的起始点为止，则可得到0Tn的逆0Tn-1=EG-1B-1Z作为进一步的例子，假设一个物体B的位置不知道，但机械手移动，使得末端抓手正好定位在物体上面。然后用G-1右乘式（2.61）求出B。或者在有向变换图中从B的尾部沿着逆时针方向到达弧B的箭头，直接得到同样结果。B=Z0TnEG-1同样，我们可以用有向变换图求出变换的连接组。例如Z0Tn=BGE-1,46,47,48,49,50,同时可确定d3为用依次左乘方程式可得以下4个方程式,51,计算得式中,52,由式中第3行第3列为0可得即解得,53,由式第1行3列和第2行3列可得解得由第4个方程式可得,54,类似的有,第1行2列和2行2列对应元素相等得,可得,55,2.5机器人的雅可比矩阵(JacobianMatrix),意义：手端在基础坐标中的速度与各关节速度间的关系，以及手部与外界接触力与对应各关节力间的关系。一、雅可比矩阵的定义：n自由度机器人，其关节变量向量可写为Q(q1,q2,qn)T，手部在基础坐标中的位置和姿态为P,则：P(xeyezeexeyez)T(p1p2p3p4p5p6)T,56,P的各个元素都是n个关节变量的函数：,57,二、雅可比矩阵的求法P的前3个元素表示手的线速度，后3个元素表示手的角速度。可以将P写成分块形式：,58,1、JLi的求法a、第i个关节为移动关节：,设某时刻仅此关节运动，其余关节静止不动:ve=JLiqi设bi-1为zi-1轴上的单位矢量：,.,59,b、第i个关节为转动关节时，,60,2、JAi的求法a、b、,总结:,61,3.确定bi-1和ri-1,e用b表示zi-1轴上的单位向量把它转换在基础坐标系中,即为如图所示,用O,Oi-1,On分别表示基础坐标系,i-1号坐标系及手部