rkfour.m

来自「运用MATLAB对控制系统进行仿真操作」· M 代码 · 共 13 行

function y=RKfour(h,A,B,C,U,N,n)
K=zeros(N,4);
X=zeros(N,1);
H=[0,1/2,1/2,1];
for i=1:n
    K(:,1)=h*(A*X+B*U);
    K(:,2)=h*(A*(X+H(2)*K(:,1))+B*U);
    K(:,3)=h*(A*(X+H(3)*K(:,2))+B*U);
    K(:,4)=h*(A*(X+H(4)*K(:,3))+B*U);    
    X=X+(1/6)*(K(:,1)+2*K(:,2)+2*K(:,3)+K(:,4));
    y(i)=C*X      %+D*U;
end