m_chap2_ex4.m

simulink 动态仿真实例m文件

global p,
t0=0;x0=zeros(6,1);h=0.02;
m=(1*1000)*[1 0 0;1 1 0;1 1 1];
k1=980000*[1 -1 0;0 1 -1;0 0 1];
c=1407*[1 -1 0;0 1 -1;0 0 1];
a4=1*1000*[1;1;1];aa4=inv(m)*a4;

j=1;
t=0:h:7.96;n=length(t);


for i=1:n;
   p=(0.12*9.8/0.98)*ppp(t0);
   l1=m_chap2_ex4_sub(t0,x0);
   p=(0.12*9.8/0.98)*ppp(t0+h/2);
   l2=m_chap2_ex4_sub(t0+h/2,x0+(h/2)*l1);
   l3=m_chap2_ex4_sub(t0+h/2,x0+(h/2)*l2);
   p=(0.12*9.8/0.98)*ppp(t0+h);
   l4=m_chap2_ex4_sub(t0+h,x0+h*l3);
   
   
   t1=t0+h;
   x1=x0+(h/6)*(l1+2*l2+2*l3+l4);
   
   acca=-inv(m)*c*x0(4:6)-inv(m)*k1*x0(1:3)-aa4*(0.12*9.8/0.98)*ppp(t0);

   u1(j)=x1(1);u2(j)=x1(2);u3(j)=x1(3);
   v1(j)=acca(1)+(0.12*9.8/0.98)*ppp(t0);v2(j)=acca(2)+v1(j);v3(j)=acca(3)+v2(j);
   
   t0=t1;x0=x1;
   j=j+1;
end

maxx=[max(abs(u1));max(abs(u2));max(abs(u3))],
maxa=[max(abs(v1));max(abs(v2));max(abs(v3))],