工业机器人第三章欧拉角DH参数PPT课件

1、2021/7/2312021/7/2322021/7/2332021/7/234( , )( , )( ,)( , )RPYRot zRot yRot x 2021/7/2350000100000010000( , )00100000000100010001cscssccsRPYsssc coscsins00( , )00001c cc s ss cc s cs cs s sc cs s cRPYsc sc c 2021/7/23600( , )00001xxxyyyzzznoanoaRPYnoa 2021/7/23722cosxynn22tan2(,)tan2(,)tan2(,)zxyxxy

2、zAnnnAo nAaa2021/7/2382021/7/239( , )( , )( ,)( , )000010000001000000100000000100010001EulerRot zRot yRot xcscssccsscsc coscsins00( , )00001c cc s ss cc s cs ss cs s sc cs s cc sEulersc sc c 2021/7/23102021/7/23112021/7/2312( , )( , )( ,)( , )00000000010000001000001000010001000100EulerRot zRot yRot

3、zcscscsscscscc c cs sc c ss cc ss c cc ss c sc cs ss cs 00001sc 2021/7/231300( , )00001xxxyyyzzznoanoaEulernoa 22tan2,tan2(,)tan2(,)xyzzzyxAaaaAo nAaa2021/7/23142021/7/23152021/7/23162021/7/23172021/7/23182021/7/23192021/7/23202021/7/23212021/7/23222021/7/23232021/7/23242021/7/2325601 23456TTT TT TT

4、2021/7/23262021/7/2327600001xxxxyyyyzzzznoapnoapTnoap2021/7/2328601 234560001xxxxyyyyzzzznoapnoapTTT TT TTnoap2021/7/23292021/7/23302021/7/23312021/7/2332连连杆杆变变量量adcossin11 1-90000-122 20a2d21033 39000144 4-900d40-155 59000166 600d6102021/7/23331122223311222 233123244556445545640000000000,0100001010

5、000010001000100000000,010010000010001cscsa ccsscsca sscAAAdcscscscscAAAd666600000010000sscdcosiicsiniis2021/7/2334cos()ijijc sin()ijijs5 65 656 55 65 656 5645666000001c cc ssd ss cs scd cTA Asc4 5 64 64 5 64 64 564 54 5 64 64 5 64 64 56 4 5634565 65 656 540001c c cs sc c ss cc sd c ss c cc ss c sc s

6、s sd s sTA A As cs scd cd2021/7/2335111111116236311110001xxxxyyyyzzzznoapnoapTATnoap134 5 64 63 5 6134 5 64 63 5 614 5 64 6134 5 64 63 5 6134 5 64 63 5 614 5 64 613 4 53 513 4 53 514 513 4 563(),(),(),(),(xyzxyzxyzxnc c c cs ss s cns c c cs sc s cns c cc socc c cs cs s cosc c cs cc s sos c cs cac c

7、ss cas c sc cas spc c s ds 56413 4 56356414 56),(),yzc ddps c s dc c ddps s d2021/7/233622222222612345622220001xxxxyyyyzzzznoapnoapTA A A A Anoap2234 5 64 623 5 62234 5 64 623 5 624 5 64 62234 5 64 623 5 62234 5 64 623 5 624 5 64 6223 4 523 5223 4 523 524 52(),(),(),(),xyzxyzxyzxncc c cs ss s snsc c

8、 cs sc s sns c cc socc c cs cs s sosc c cs sc s sos c sc cac c ss cas c sc cas sp 23 4 562356422223 4 56235642 224 562(),(),yzc c s dsc dda cps c s dcc dda sps s dd2021/7/233761234560001xxxxyyyyzzzznoapnoapTA A A A A Anoap1234 5 64 623 5 614 5 64 61234 5 64 623 5 614 5 64 6234 5 64 623 5 61234 5 64

9、623 5 614 5 64 61234 5 64 6()(),()(),(),()(),()xyzxync cc c cs ss s cs s c cc sns cc c cs ss s cc s c cc snsc c cs sc s coccc c ss cs s sss c sc coscc c ss cs 23 5 614 5 64 6234 5 64 623 5 6123 4 523 51 4 5123 4 523 51 4 523 4 523 51623 4 523 52342216 4 521623 4 523 5(),(),(),(),()(),()zxyzxys scs c

10、 sc cosc c ss cc s sac c c ss cc s sas c c ss cc s sas c sc cpc d c c ss cs da cs d s sdps d c c ss c 2342216 4 52623 523 4 52342 2(),()zs da cc d s sdpd c cs c cc da s2021/7/23386010149.09001921.1210000001T2021/7/23392021/7/2340连杆连杆 变量变量adcossin11 1-90000-122 2900d20133 300d31044 4-90000-155 590001

11、66 6000102021/7/2341cosiicsiniis1122223311222 233123244556445545640000000000,0100001010000010001000100000000,010010000010001cscsa ccsscsca sscAAAdcscscscscAAAd666600000010000sscd2021/7/234261234560001xxxxyyyyzzzynoapnoapTA A A A A Anoap1234 5 64 623 5 614 5 64 61234 5 64 623 5 614 5 64 6234 5 64 623

12、 5 61234 5 64 623 5 614 5 64 61234 5 64 623 5()()()()()()()()xyzxync cc c cs ss s ss s c cc sns cc c cs ss s sc s c cc snsc c cs sc s soccc c ss cs s sss c sc coscc c ss cs s 614 5 64 6234 5 64 623 5 6123 4 523 51 4 5123 4 523 51 4 523 4 523 51 23121 231223()()()()zxyzxyzscs c sc cosc c ss cc s sac

13、c c ss cs s sas c c ss cc s sas c sc cpc s ds dps s dc dpc d 2021/7/2343120001xxxxyyyynzzzznoapnoapA AAnoap2021/7/23442021/7/23451234560000 xxxxyyyyzzzznoapnoapA A A A A Anoap2021/7/234611A11623456A TA A A A A1111610000001000010001xxxxyyyyzzzzcsnoapscnoapTnoap2021/7/234761T112xys pc pdcossinxypp22,t

14、an2(,)xyyxppApp2021/7/234821221222212sin()cos()1()tan2,1ddddA 222122tan2(,)tan2(,)yxxyAppAdppd2021/7/2349112234 2322xyc ps pa cd sa c2 234232 2xpa sd ca s3 34 34 3a cd sd sk2222222232422xyzpppaaddka2021/7/235022233434tan2(,)tan2( ,)Aa dAkadk2021/7/23511132A A1 231 23232 31 231 23232 363112000010001x

15、xxxyyyyzzzzc cs csa cnoapc ss sca snoapTscdnoap1111610000001000010001xxxxyyyyzzzzcsnoapscnoapTnoap4 5 64 64 5 64 64 564 54 5 64 64 5 64 64 56 4 5634565 65 656 540001c c cs sc c ss cc sd c ss c cc ss c sc ss sd s sTA A As cs scd cd2021/7/23521 231 2323233xyzc c ps c ps pa c a1 231 23232 34xyzc c ps c

16、 pc pa sd32 3112 342322112 341132 3232211()()()()()()()()zxyzxyzxyzxyaa cpc ps pa sdspc ps pa cdpc ps paa sspc ps p2021/7/2353232332 31142 32 341132 3tan2()()()()()()xxyzxyAaa cpc ps pda sa sdpc ps paa c22332021/7/23541 231 234 5114 5xyxya c ca s cc sa sa cs s 4111 231 2323tan2(,)xyxyzAa sa ca c ca

17、s ca s2021/7/2355111432A A A1111610000001000010001xxxxyyyyzzzzcsnoapscnoapTnoap11114321664A A A A TT1 23 41 41 23 41 423 42 3 42 43 41 23 41 41 23 41 423 42 3 4243 4641 231 23232 340001c c cs ss c cc ss ca c cd sa cc c ss cs c cc ss sa c sd ca sTc ss sca sod2021/7/23565 65 656 55 65 656 564566600000

18、1c cc ssd ss cs scd cTA Asc1 2341 41 2341 422345()()()xya c c cs sas c cc sas cs 1 231 23235()()()xyzac cas sacc555tan2( ,)As c2021/7/23571111154321665A A A A A TT61 23 41 41 23 41 423 4()()()xyzsn c c ss cns c sc cn s s 61 23 41 451 23 51 23 41 451 23 423 4 523 5()()()xyzcncc cs s cc s sns c cc s c

19、s s cn s c cc s666tan2(,)As c2021/7/23582021/7/23592021/7/236011121314212223243132333441424344aaaaaaaaTaaaaaaaa13111214232122243132333443414244aaaaxxxxaaaaxxxxdTdxaaaaxxxxaaaaxxxx2021/7/2361(,)( ,)TdTTrans dx dy dz Rot k dT(,)Trans dx dy dz( ,)Rot k d(,)( ,)dTTrans dx dy dz Rot k dI T(,)( ,)Trans ds

20、 dy dz Rot k dI 2021/7/2362(,)( ,)Trans ds dy dz Rot k dI 100010(,)0010001dxdyTrans dx dy dzdz1010( ,)100001zyzxyxk dk dk dk dRot k dk dk d2021/7/23631001010000101001000011000100001000100010000000zyzxyxzyzxyxdxk dk ddyk dk ddzk dk dk dk ddxk dk ddyk dk ddz 0000000zydxzxdyyxdz 12021/7/236400110100501

21、000001A00.5dijk 00.10ijk2021/7/2365000.1100000.1000.50000 0000000zydxzxdyyxdz 00.5dijk 00.10ijk00.10 xyz100.5dxdydz2021/7/2366000.1100110000010050.1000.501000000000100.1010000000.10.50000dAA 2021/7/2367TdTTT 1TTT dTT TdTTT2021/7/2368 这个变换方程如同前面变这个变换方程如同前面变换方程一样，可以用一个变换换方程一样，可以用一个变换图来表示，如右图所示。由图图来表示，

22、如右图所示。由图也可以直接得到上式。也可以直接得到上式。 方程方程2 2很重要，因为它把相很重要，因为它把相对于不同的坐标系之间的微分对于不同的坐标系之间的微分变化联系起来了。我们首先展变化联系起来了。我们首先展开方程右端的矩阵乘积，展开开方程右端的矩阵乘积，展开过程中进行了简化，可得出微过程中进行了简化，可得出微分变化向量分变化向量d d和和的元素之间的的元素之间的直接关系。变换直接关系。变换T T称为微分坐标称为微分坐标变换。变换。1TTT 22021/7/2369如果把微分坐标变化如果把微分坐标变化T T的元素用向量的元素用向量n n、o o、a a和和P P描述为描述为0001xxxx

23、yyyyzzzznoapnoapTnoap()()()()()()()()()()()()0000 xxxxyyyyzzzznoapdnoapdTnoapd2021/7/23701()()()()()()()()()()()()0000nnnonanpdonoooaopdTTanaoaaapd式中，式中，d d和和就是微分旋转和微分平移。将上式左乘就是微分旋转和微分平移。将上式左乘 可得可得1T2021/7/23710()()()()0()()()()0()0000Tn oanpnd nn oo ap od oano apad a ()()()ab cbacbca ()0aac2021/7/2

24、372n oaanoo an0()0()0()0000Taopnd nanp od oonpad a 0000000TTTTTTTTTTzydxzxdyyxdx 由于由于n、o、a正交，所以正交，所以34由式由式1定义为：定义为：T2021/7/2373 令式令式3 3和式和式4 4相等，我们就利用相对基础坐标系来描述的相等，我们就利用相对基础坐标系来描述的微分旋转和平移的向量微分旋转和平移的向量( (和和d)d)，得到相对于坐标系，得到相对于坐标系T T来描述的来描述的微分旋转和平移的向量，即微分旋转和平移的向量，即()()()TTTdxpnd ndyp od odzpad aTTTxnyoza652021/7/2374() ()()()() ()()()().TxyzxyzxyzxyzxxyyzzxxyyzzdxijkPn iPnjPn kd id jd kn in jn kPnPnPnn dn dn d()()(),()()(),.T