%% 求约当规范形
clear
clc
%% 给定一个线性时不变系统的状态方程为
disp('变换前系数矩阵:')
A=[2 -1 -1;0 -1 0;0 2 1]
B=[7 2 3]'
%% (1)定出系统的特征值和特征向量。
[V D]=eig(A);
for i=1:length(V) 
    V(:,i)=V(:,i)/max(V(:,i));
end
disp('解：特征向量:')
V
disp('特征值:')
D    
%% (2)构造变换矩阵并求逆
disp('变换矩阵:')
P=V
disp('逆矩阵:')
P_=inv(P)
%% (3)计算变换后系数矩阵
disp('变换后系数矩阵:')
A1=P_*A*P
B1=P_*B
%% 定出约当规范形状态方程,x_.=A1x_+B1u