Курсовая работа: Численные методы интегрирования и оптимизации сложных систем

clc

T=4;

A=[0 1 0 0; 0 0 1 0; 0 0 0 1; -595.23809523*Ki -43.6507936507-595.23809523*Kp -56.34920634920635-595.23809523*Kd -5.59523809523809];

B=[0; 595.23809*Kd; 595.23809*Kp-3330.498866*Kd; 595.23809*Ki-33540.615-354308.277*(Kd)^2-3330.498*Kp-18634.934*Kd];

k=0;

t=0;

while (t < (T-h))

if (t <= 3*h)

K1=A*(A_X(k+1,:))';

K2=A*(A_X(k+1,:))'+1/3*K1;

K3=A*(A_X(k+1,:))'+1/6*K1+1/6*K2;

K4=A*(A_X(k+1,:))'+1/8*K1+3/8*K2;

K5=A*(A_X(k+1,:))'+1/2*K1-3/2*K3+2*K4;

A_X(k+2,:)=(A_X(k+1,:))+h/6*(K1'+4*K4'+K5');

else

h1=h;

t=t+h1;

H=(eye(length(A_X(1,:)))-(9*h1/24)*A);

G=(eye(length(A_X(1,:)))+19*h1/24*A)*(A_X(k+1,:))'+h1/24*A*(-5*(A_X(k,:))'+(A_X(k-1,:))')

+h1/24*B*(9*1+19*1-5*1);

A_X(k+2,:)=(inv(H)*G)';

end

Otr(k+1)=t;

k=k+1;

end

grid on

fibon.m

function h=fibon(a,b,h)

F(1)=1; F(2)=1;n=100;