自控系统数字仿真实验代码

2.1

function dy = f21( t1,y )

dy=t1+y;

end

h=0.01;

yo1=1 ;

y41=1;

T0=0 ;

Tf=1;

t=0;

yo=1 ;

y4=1;

for i=1:Tf/h ;

k1= t(i)+ y41 ;

k2= t(i)+h/2+ y41+h/2*k1;

k3= t(i)+h/2+ y41+h/2*k2;

k4= t(i)+h+ y41+h*k3;

yo1=yo1+h*(t(i)+yo1);

y41= y41+h/6*(k1+2*k2+2*k3+k4);

y4=[y4,y41];

yo=[yo,yo1] ;

t=[t,t(i)+h];

end

yt=2*exp(t)-t-1;

[t1,y]=ode45('f21',[0 1],1);

plot(t,yo,'g',t,y4,'r',t,yt,'k',t1,y, 'b') ;

legend('yo','y4','yt', 'yode')

2.2.

f22.m

function y4=f22(A,B,C,D,r,T,h)

y4=0 ;

R=r ;

x=[0 ;0 ;0 ] ;

N=T/h ;

for i=1 :N

k1=A*x+B*R;

k2=A*(x+h*k1/2)+B*R ;

k3=A*(x+h*k2/2)+B*R ;

k4=A*(x+h*k3)+B*R ;

x=x+h*(k1+2*k2+2*k3+k4)/6 ;

y4(i)=C*x+D*R ;

end