相似上三角矩阵变换

function [ B, P ] = my_same_tr( A )
    %求与A相似的上三角矩阵和变换矩阵P
    %B = P2^(-1)*P1^(-1)*A*P1*P2
    A = sym(A);
    n = size(A,2);
    for i = 1:n-1
        [V1,~] = eig(A(i:n,i:n));
        %V1 = V(:,1);
        V2 = null(V1');
        V = [V1,V2];
        B(1:i-1,:,i) = A(1:i-1,:);
        B(i:n,i:n,i) = inv(V)*A(i:n,i:n)*V;
        P(i:n,i:n,i) = V;
        A = B(:,:,i);
    end
    B = simplify(B);
    P = simplify(P);
end