七.Matlab编程及绘图
clear all;clc;
%初始条件
theta1=linspace(-25.72,334.28,100);%单位度
theta1=theta1*pi/180;%转换为弧度制
W1=80*pi/30;%角速度单位rad/s
H=0.6;%行程单位m
L1=0.1605;%O2A的长度单位m
L3=0.6914;%O3B的长度单位m
L4=0.2074;%BF的长度单位m
L6=0.370;%O2O3的长度单位m
L6u=0.6572;%O3D的长度单位m
Z=pi/180;%角度与弧度之间的转换
dT=(theta1(3)-theta1(2))/W1;%时间间隔
for j=1:100
t(j)=dT*(j-1);%时间因素
end
%求解S3、Theta3、Theta4和SE四个变量
S3=((L6)^2+(L1)^2-2*L6*L1*cos(theta1+pi/2)).^0.5;%求出O3A的值for i=1:100%求解角度theta3、Theta4和SE的长度
theta3(i)=acos(L1*cos(theta1(i))/S3(i));
theta4(i)=asin((L6u-L3*sin(theta3(i)))/L4);
SE(i)=L3*cos(theta3(i))+L4*cos(theta4(i));
end%求解完成
%求解完成
%求解VS3、W3、W4和VE四个变量
for i=1:100
J= inv([cos(theta3(i)),-S3(i)*sin(theta3(i)),0,0;
sin(theta3(i)),S3(i)*cos(theta3(i)),0,0;
0,-L3*sin(theta3(i)),-L4*sin(theta4(i)),-1;
0,L3*cos(theta3(i)),L4*cos(theta4(i)),0]);
K=J*W1*[-L1*sin(theta1(i));L1*cos(theta1(i));0;0];
VS3(i)=K(1);
W3(i)=K(2);
W4(i)=K(3);
VE(i)=K(4);
end%求解完成
%求解aS3、a3、a4、aE四个变量
for i=1:100
J= inv([cos(theta3(i)),-S3(i)*sin(theta3(i)),0,0;
sin(theta3(i)),S3(i)*cos(theta3(i)),0,0;
0,-L3*sin(theta3(i)),-L4*sin(theta4(i)),-1;
0,L3*cos(theta3(i)),L4*cos(theta4(i)),0]);
本文发布于:2024-02-02 20:22:33,感谢您对本站的认可!
本文链接:https://www.4u4v.net/it/170687655246221.html
版权声明:本站内容均来自互联网,仅供演示用,请勿用于商业和其他非法用途。如果侵犯了您的权益请与我们联系,我们将在24小时内删除。
留言与评论(共有 0 条评论) |