資源描述：
《matlab四桿機(jī)構(gòu)源程序》由會員上傳分享，免費(fèi)在線閱讀，更多相關(guān)內(nèi)容在行業(yè)資料-天天文庫。
1、1.角位移M函數(shù)：functiony=jweiyi(x)%Inputparameters%x(1)=theta-1%x(2)=theta-2guessvalue%x(3)=theta-3guessvalue%x(4)=r1%x(5)=r2%x(6)=r3%x(7)=r4%Outputparameters%y(1)=theta-2%y(2)=theta-3theta2=x(2);theta3=x(3);%epsilon=1.0E-6;%f=[x(4)*cos(x(1))+x(5)*cos(thet
2、a2)-x(7)-x(6)*cos(theta3);x(4)*sin(x(1))+x(5)*sin(theta2)-x(6)*sin(theta3)];%whilenorm(f)>epsilonJ=[-x(5)*sin(theta2)x(6)*sin(theta3);x(5)*cos(theta2)-x(6)*cos(theta3)];dth=inv(J)*(-1.0*f);theta2=theta2+dth(1);theta3=theta3+dth(2);f=[x(4)*cos(x(1))+x
3、(5)*cos(theta2)-x(7)-x(6)*cos(theta3);x(4)*sin(x(1))+x(5)*sin(theta2)-x(6)*sin(theta3)];norm(f);end;y(1)=theta2;y(2)=theta3;2.r1旋轉(zhuǎn)360°時(shí)，θ2，θ3的M文件程序：r(1)=50;r(2)=150;r(3)=300;r(4)=400;dr=pi/180;th(1)=0;th(2)=58.4119*dr;th(3)=154.7912*dr;y=jweiyi([th(1
4、),th(2),th(3),r(1),r(2),r(3),r(4)])dth=1*dr;fori=1:360y=jweiyi([th(1),th(2),th(3),r(1),r(2),r(3),r(4)]);th23(i,:)=[th(1)/dr,th(2)/dr,th(3)/dr];th(1)=th(1)+dth;th(2)=y(1);th(3)=y(2);endfigure(1)plot(th23(:,1),th23(:,2),th23(:,1),th23(:,3),th23(:,1),th
5、23(:,1))axis([0,360,0,360])gridontitle('角位移線圖')xlabel('曲柄轉(zhuǎn)角th(1)')ylabel('從動件轉(zhuǎn)角th(2),th(3)')text(300,50,'角th(2)')text(300,150,'角th(3)')text(200,200,'角th(1)')3.角速度的M函數(shù)：functiony=rrrvel(x)%Inputparameters%%x(1)=theta-1%x(2)=theta-2%x(3)=theta-3%x(4)=dt
6、heta-1%x(5)=r1%x(6)=r2%x(7)=r3%%Outputparameters%%y(1)=dtheta-2%y(2)=dtheta-3%A=[-x(6)*sin(x(2))x(7)*sin(x(3));x(6)*cos(x(2))-x(7)*cos(x(3))];B=[x(5)*sin(x(1));-x(5)*cos(x(1))]*x(4);y=inv(A)*B;4.r1旋轉(zhuǎn)360°時(shí)ω2，ω3的M文件程序：th(1)=0;dr=pi/180;dth(1)=36;dth(2)
7、=58.4119*dr;dth(3)=154.7912*dr;dth1=1*dr;r(1)=50;r(2)=150;r(3)=300;r(4)=400;forj=1:360x=rrrvel([th(1),dth(2),dth(3),dth(1),r(1),r(2),r(3)]);y=jweiyi([th(1),dth(2),dth(3),r(1),r(2),r(3),r(4)]);dth(2)=y(1);dth(3)=y(2);th(1)=th(1)+dth1;dth23(j,:)=[th(1)
8、/dr,x(1)/dr,x(2)/dr];endfigure(2)plot(dth23(:,1),dth23(:,2),dth23(:,1),dth23(:,3))axis([0,360,-800,2000])gridontitle('角速度線圖')xlabel('曲柄旋轉(zhuǎn)角度')ylabel('從動件角速度dth(2),dth(3)(rad/s)')text(250,200,'連桿2角速度')text(50,100,'搖桿3角速度')5.r1旋轉(zhuǎn)360°時(shí)，α2，α3程序M文件：r(1)=50
