program5_2.asv

此为matlab的代码。包括数值o45算法及o23算法

%MATLAB Program5_2
A=[2 1 0 0;0 2 0 0;0 0 -1 0;0 0 0 -1];
B=[0;1;1;1];
Qc=ctrb
(A,B)
rank_Qc=rank(Qc)
L=length(A);
%判断系统的能控性
if rank_Qc==L
    str='系统是状态完全能控的'
P_A=poly(A);
a4=P_A(5);  a3=P_A(4);a2=P_A(3);a1=P_A(2);
P_x=poly([-2;-2;-2;-1])
a_x4=P_x(5); a_x3=P_x(4);a_x2=P_A(3);a_x1=P_A(2);
Tc=Qc*[a3 a2 a1 1;a2 a1 1 0;a1 1 0 0; 1 0 0 0]
F=[a_x4-a4 a_x3-a3 a_x2-a2 a_x1-a1]*inv(Tc)
else 
    str='系统是状态不完全能控的'
end