angle.asv

来自「水平直线挖掘的源程序」· ASV 代码 · 共 55 行

ASV
55 行
字号
L0=0;L(1)=0;L(2)=3.72;L(3)=1.62;L(4)=1.05;x0=5.5;xf=3;z0=0;zf=0;m=0;%挖掘机参数
af=atan((z0-zf)./(x0-xf));%判断所给直线的角度
%while 23*pi/180<=beita<=149.5*pi/180 | -51*pi/180<afa<75*pi/180
t=0:0.1:25;
x=x0-0.1*t.*cos(af);%速度为0.1m/s
z=z0-0.1*t.*sin(af);
y=0;
sita1=atan(y./x);
sita4=0;
gama=atan(z./x);
afa=acos((x.^2+z.^2+L(2)^2-(L(3)+L(4))^2)./(2*sqrt(x.^2+z.^2)*L(2)))+gama;%动臂转角  
beita=acos(((L(2)^2+(L(3)+L(4))^2)-x.^2-z.^2)./(2*L(2)*(L(3)+L(4))));%斗杆与动臂夹角
%end
%for i=1:1:length(beita)
for i=1:1:length(beita)
if  23*pi/180<beita(i)&180<beita(i)<149.5*pi/180 & -51*pi/180<afa(i)&afa(i)<75*pi/180
    m=m+1;
end
end
for i1=1:1:m
    afa0(i1)=afa(i1);
    beita0(i1)=beita(i1);
end
n=0.1:0.1:m/10;
subplot(2,2,1)
theta11=afa0./pi*180+beita0./pi*180;
plot(n,theta11)
title('挖掘机回转角度与斗杆转动角度之和')
xlabel('时间(秒)')
ylabel('角度(度)')
grid
subplot(2,2,2)
theta22=afa0./pi*180;
plot(n,theta22)
title('挖掘机动臂转动角度曲线')
 xlabel('时间(秒)')
 ylabel('角度(度)')
 grid
 subplot(2,2,3)
 theta33=beita0./pi*180;
 plot(n,theta33)
 title('挖掘机斗杆转动角度曲线')
 xlabel('时间(秒)')
 ylabel('角度(度)')
 grid
 %end
 subplot(2,2,4)
 theta44=sita1./pi*180;
 plot(theta22,theta33)
 title('挖掘机铲斗转动角度曲线')
 xlabel('时间(秒)')
 ylabel('角度(度)')
 grid
%铲斗与斗杆的相对转角为零!
%该程序已经验证过beita和afa的正确性,2005.3.14

⌨️ 快捷键说明

复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?