




版權(quán)說(shuō)明:本文檔由用戶(hù)提供并上傳,收益歸屬內(nèi)容提供方,若內(nèi)容存在侵權(quán),請(qǐng)進(jìn)行舉報(bào)或認(rèn)領(lǐng)
文檔簡(jiǎn)介
1、引Stanford Arm Forword Kinematics 的基本結(jié)論:一計(jì)算的Jacobian結(jié)果二各級(jí)矩陣三矢量叉積法J=J1 J2 J3 J4 J5 J6四驗(yàn)證直接微分法和矢量叉積法的結(jié)果一致:1.J1與直接求導(dǎo)比較:.2.J2matlab的計(jì)算驗(yàn)證過(guò)程:>> syms c6 s6 c5 s5 c4 s4>> T65=c6 -1*s6 0 0;0 0 -1 0;s6 c6 0 0;0 0 0 1>> T54=c5 -1*s5 0 0;0 0 1 0;-1*s5 -1*c5 0 0;0 0 0 1>> T43=c4 -1*s4 0 0;
2、s4 c4 0 0 ;0 0 1 0;0 0 0 1>> T63=T43*T54*T65T63 = c4*c5*c6-s4*s6, -c4*c5*s6-s4*c6, c4*s5, 0 s4*c5*c6+c4*s6, -s4*c5*s6+c4*c6, s4*s5, 0 -s5*c6, s5*s6, c5, 0 0, 0, 0, 1>> syms d3>> T32=1 0 0 0; 0 0 -1 -1*d3;0 1 0 0;0 0 0 1>> T62=T32*T63T62 = c4*c5*c6-s4*s6, -c4*c5*s6-s4*c6, c4*s
3、5, 0 s5*c6, -s5*s6, -c5, -d3 s4*c5*c6+c4*s6, -s4*c5*s6+c4*c6, s4*s5, 0 0, 0, 0, 1>> syms c1 c2 s1 s2>> R20=c1*c2 -1*c1*s2 -1*s1;s1*c2 -1*s1*s2 c1;-1*s2 -1*c2 0>> p622=0;-1*d3;0p622 = 0 -d3 0>> p620=R20*p622p620 = c1*s2*d3 s1*s2*d3c2*d3>> z2=0 0 c1;0 0 s1;-1*c1 -1*s1 0z2
4、 = 0, 0, c1 0, 0, s1 -c1, -s1, 0>> v2=z2*p620v2 = c1*c2*d3 s1*c2*d3 -c12*s2*d3-s12*s2*d3與直接求導(dǎo)比較:.在matlab中用B=jacobian(f,v)方法直接求導(dǎo)獲取雅可比矩陣>> clear>> syms theta1 d3 d2 theta2>> F=cos(theta1)*d3*sin(theta2)-sin(theta1)*d2;sin(theta1)*d3*sin(theta2)+cos(theta1)*d2;d3*cos(theta2)F =
5、cos(theta1)*d3*sin(theta2)-sin(theta1)*d2 sin(theta1)*d3*sin(theta2)+cos(theta1)*d2 d3*cos(theta2) >> syms theta4 theta5 theta6>> v=theta1;theta2;d3;theta4;theta5;theta6v = theta1 theta2 d3 theta4 theta5 theta6>> jacob=jacobian(F,v) 直接求偏導(dǎo):>> syms theta1 d3 d2 theta2 theta4 th
6、eta5 theta6>>F1=cos(theta1)*d3*sin(theta2)-sin(theta1)*d2>> dif(F1,theta1)補(bǔ)充對(duì)教材雅可比矩陣逆矩陣的求解:>> syms l1 theta1 l2 theta2>>J=-l1*sin(theta1)-l2*sin(theta1+theta2)-l2*sin(theta1+theta2);l1*cos(theta1)+l2*cos(theta1+theta2) l2*cos(theta1+theta2)J = -l1*sin(theta1)-l2*sin(theta1+th
7、eta2), -l2*sin(theta1+theta2) l1*cos(theta1)+l2*cos(theta1+theta2), l2*cos(theta1+theta2)>> inv(J) ans = -cos(theta1+theta2)/l1/(cos(theta1+theta2)*sin(theta1)-sin(theta1+theta2)*cos(theta1), -sin(theta1+theta2)/l1/(cos(theta1+theta2)*sin(theta1)-sin(theta1+theta2)*cos(theta1) (l1*cos(theta1)+l2*cos(theta1+theta2)/l2/l1/(cos(theta1+theta2)*sin(theta1)-sin(theta1+theta2)*cos(theta1), (l1*sin(theta1)+l2*sin(theta1+theta2)/l2/l1/(cos(theta1+theta2)*sin(theta1)-sin(theta1+theta2)*cos(theta1) >> J11=simple(-co
溫馨提示
- 1. 本站所有資源如無(wú)特殊說(shuō)明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請(qǐng)下載最新的WinRAR軟件解壓。
- 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請(qǐng)聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶(hù)所有。
- 3. 本站RAR壓縮包中若帶圖紙,網(wǎng)頁(yè)內(nèi)容里面會(huì)有圖紙預(yù)覽,若沒(méi)有圖紙預(yù)覽就沒(méi)有圖紙。
- 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
- 5. 人人文庫(kù)網(wǎng)僅提供信息存儲(chǔ)空間,僅對(duì)用戶(hù)上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理,對(duì)用戶(hù)上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對(duì)任何下載內(nèi)容負(fù)責(zé)。
- 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請(qǐng)與我們聯(lián)系,我們立即糾正。
- 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶(hù)因使用這些下載資源對(duì)自己和他人造成任何形式的傷害或損失。
最新文檔
- 2025年小學(xué)教導(dǎo)處春季課外拓展計(jì)劃
- 教師培訓(xùn)管理體系構(gòu)建與實(shí)施
- 活動(dòng)義齒日常護(hù)理指南
- 九年級(jí)英語(yǔ)課內(nèi)外結(jié)合計(jì)劃
- 防止患者摔傷護(hù)理
- 扁桃體術(shù)后護(hù)理要點(diǎn)
- 2024-2025學(xué)年人教版三年級(jí)數(shù)學(xué)家長(zhǎng)指導(dǎo)計(jì)劃
- 小學(xué)三年級(jí)數(shù)學(xué)競(jìng)賽備戰(zhàn)計(jì)劃
- 2019-2025年資料員之資料員基礎(chǔ)知識(shí)通關(guān)提分題庫(kù)(考點(diǎn)梳理)
- 2024-2025學(xué)年山東省聊城市運(yùn)河教育聯(lián)盟學(xué)校八年級(jí)上學(xué)期第二次學(xué)情調(diào)研地理試卷
- 村集體經(jīng)濟(jì)組織會(huì)計(jì)課件
- 大學(xué)歷史大學(xué)理念和大學(xué)精神培訓(xùn)教材課件
- 初中物理《電學(xué)》中考專(zhuān)項(xiàng)復(fù)習(xí)典型考試題100題匯總(附答案)
- 班組工程量結(jié)算書(shū)
- 最新易制毒化學(xué)品管理制度大全
- 機(jī)載直流用電設(shè)備電源特性要求及試驗(yàn)方法
- 養(yǎng)老院老人入(出)院流程圖
- 健康照護(hù)教材課件匯總完整版ppt全套課件最全教學(xué)教程整本書(shū)電子教案全書(shū)教案課件合集
- 最新-臨時(shí)救助申請(qǐng)審核審批表模板
- 《有效溝通》PPT課件-(2)
- 青春紅綠燈教學(xué)設(shè)計(jì)中小學(xué)心理健康心理游戲腳本
評(píng)論
0/150
提交評(píng)論