MATLAB機(jī)器人仿真程序_第1頁
MATLAB機(jī)器人仿真程序_第2頁
MATLAB機(jī)器人仿真程序_第3頁
MATLAB機(jī)器人仿真程序_第4頁
MATLAB機(jī)器人仿真程序_第5頁
免費(fèi)預(yù)覽已結(jié)束，剩余1頁可下載查看

下載本文檔

版權(quán)說明：本文檔由用戶提供并上傳，收益歸屬內(nèi)容提供方，若內(nèi)容存在侵權(quán)，請(qǐng)進(jìn)行舉報(bào)或認(rèn)領(lǐng)

文檔簡介

1、附錄MATLAB 機(jī)器人工具箱仿真程序：1)運(yùn)動(dòng)學(xué)仿真模型程序( Rob1.m)L1=link(pi/2 150 0 0)L2=link(0 570 0 0)L3=link(pi/2 130 0 0)L4=link(-pi/2 0 0 640)L5=link(pi/2 0 0 0)L6=link(0 0 0 95)r=robot(L1 L2 L3 L4 L5 L6) = MOTOMAN-UP 6 % 模型的名稱 drivebot(r)2)正運(yùn)動(dòng)學(xué)仿真程序( Rob2.m)L1=link(pi/2 150 0 0)L2=link(0 570 0 0)L3=link(pi/2 130

2、0 0)L4=link(-pi/2 0 0 640)L5=link(pi/2 0 0 0)L6=link(0 0 0 95)r=robot(L1 L2 L3 L4 L5 L6)= MOTOMAN-UP 6t=0:0.01:10;% 產(chǎn)生時(shí)間向量qA=0 0 0 0 0 0 ; % 機(jī)械手初始關(guān)節(jié)角度機(jī)械手終止關(guān)節(jié)角度);% 給仿真圖像命名qAB=-pi/2 -pi/3 0 pi/6 pi/3 pi/2 ;%figure(Name,up6機(jī)器人正運(yùn)動(dòng)學(xué)仿真演示q=jtraj(qA,qAB,t);%生成關(guān)節(jié)運(yùn)動(dòng)軌跡T=fkine(r,q);% 正向運(yùn)動(dòng)學(xué)仿真函數(shù)figure(Name,

3、up6 機(jī)器人末端位移圖 ) subplot(3,1,1); plot(t, squeeze(T(1,4,:); xlabel(Time (s); ylabel(X (m); subplot(3,1,2);plot(t, squeeze(T(2,4,:);xlabel(Time (s);ylabel(Y (m);subplot(3,1,3);plot(t, squeeze(T(3,4,:);xlabel(Time (s);ylabel(Z (m);x=squeeze(T(1,4,:);y=squeeze(T(2,4,:);z=squeeze(T(3,4,:);figure(Name,up6 機(jī)

4、器人末端軌跡圖 );plot3(x,y,z);3)機(jī)器人各關(guān)節(jié)轉(zhuǎn)動(dòng)角度仿真程序：( Rob3.m)L1=link(pi/2 150 0 0 )L2=link(0 570 0 0)L3=link(pi/2 130 0 0)L4=link(-pi/2 0 0 640)L5=link(pi/2 0 0 0 )L6=link(0 0 0 95)r=robot(L1 L2 L3 L4 L5 L6)=motoman-up6t=0:0.01:10;qA=0 0 0 0 0 0 ;qAB= pi/6 pi/6 pi/6 pi/6 pi/6 pi/6;q=jtraj(qA,qAB,t);Plot(r

5、,q);subplot(6,1,1);plot(t,q(:,1);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 1);xlabel(時(shí)間/s);ylabel(角度/rad);subplot(6,1,2);plot(t,q(:,2);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 2);xlabel(時(shí)間/s);ylabel(角度/rad);subplot(6,1,3);plot(t,q(:,3);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 3);xlabel(時(shí)間/s);ylabel(角度/rad);subplot(6,1,4);plot(t,q(:,4);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 4);xlabel(時(shí)間/s);ylabel(角度/rad );subplot

6、(6,1,5);plot(t,q(:,5);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 5);xlabel(時(shí)間/s);ylabel(角度/rad);subplot(6,1,6);plot(t,q(:,6);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 6);xlabel(時(shí)間/s);ylabel(角度/rad);4)機(jī)器人各關(guān)節(jié)轉(zhuǎn)動(dòng)角速度仿真程序： ( Rob4.m ) t=0:0.01:10;qA=0 0 0 0 0 0 ;% 機(jī)械手初始關(guān)節(jié)量qAB= 1.5709 -0.8902 -0.0481 -0.5178 1.0645 -1.0201; q,qd,qdd=jtraj(qA,qAB,t);Plot(r,q);subplot(

7、6,1,1);plot(t,qd(:,1);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 1);xlabel( 時(shí)間 /s);ylabel(rad/s);subplot(6,1,2);plot(t,qd(:,2);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 2);xlabel( 時(shí)間 /s);ylabel(rad/s);subplot(6,1,3);plot(t,qd(:,3);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 3);xlabel( 時(shí)間 /s);ylabel(rad/s);subplot(6,1,4);plot(t,qd(:,4);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 4);xlabel( 時(shí)間 /s);ylabel(rad/s );subplot(6,1

8、,5);plot(t,qd(:,5);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 5);xlabel( 時(shí)間 /s);ylabel(rad/s);subplot(6,1,6);plot(t,qd(:,6);title( 轉(zhuǎn)動(dòng)關(guān)節(jié) 6);xlabel( 時(shí)間 /s);ylabel(rad/s);5)機(jī)器人各關(guān)節(jié)轉(zhuǎn)動(dòng)角加速度仿真程序：( Rob5.m)t=0:0.01:10;% 產(chǎn)生時(shí)間向量qA=0 0 0 0 0 0qAB =1.5709 -0.8902 -0.0481 -0.5178 1.0645 -1.0201; q,qd,qdd=jtraj(qA,qAB,t);figure(name,up6 機(jī)器人機(jī)械手各關(guān)

9、節(jié)加速度曲線);subplot(6,1,1);plot(t,qdd(:,1);title( 關(guān)節(jié) 1);xlabel( 時(shí)間 (s);ylabel(力口速度(rad/sA2);subplot(6,1,2);plot(t,qdd(:,2);title( 關(guān)節(jié) 2);xlabel( 時(shí)間 (s);ylabel( 加速度 (rad/sA2);subplot(6,1,3);plot(t,qdd(:,3);title( 關(guān)節(jié) 3);xlabel( 時(shí)間(s);ylabel(力口速度(rad/sA2) subplot(6,1,4);plot(t,qdd(:,4);title( 關(guān)節(jié) 4);xlabel( 時(shí)間(s);ylabel(力口速度(rad/sA2) subplot(6,1,5

溫馨提示

  • 1. 本站所有資源如無特殊說明，都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請(qǐng)下載最新的WinRAR軟件解壓。
  • 2. 本站的文檔不包含任何第三方提供的附件圖紙等，如果需要附件，請(qǐng)聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
  • 3. 本站RAR壓縮包中若帶圖紙，網(wǎng)頁內(nèi)容里面會(huì)有圖紙預(yù)覽，若沒有圖紙預(yù)覽就沒有圖紙。
  • 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
  • 5. 人人文庫網(wǎng)僅提供信息存儲(chǔ)空間，僅對(duì)用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理，對(duì)用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯，并不能對(duì)任何下載內(nèi)容負(fù)責(zé)。
  • 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容，請(qǐng)與我們聯(lián)系，我們立即糾正。
  • 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶因使用這些下載資源對(duì)自己和他人造成任何形式的傷害或損失。

最新文檔

評(píng)論

0/150

提交評(píng)論