状态空间转化成传递函数（附matlab代码）

老师布置的作业，要求如下：
根据定理2和莱弗勒算法，使用matlab编写从状态空间转化成传递函数的程序，输入为（A B C D）,输出为传递函数或其系数矩阵。代码如下：

clc
clear
A=input('请输入矩阵A:');
B=input('请输入矩阵B:');
C=input('请输入矩阵C:');
D=input('请输入矩阵D:');
[m,n]=size(A);  
[x,y]=size(B);
a=zeros(1,m);  
 R=eye(m);
 K=eye(m);
 P=R*A;
 a(1)=-trace(P)/1; 
for i=2:m
    R=R*A+a(i-1)*K;
    P=R*A;
    a(i)=-trace(P)/i;
end   %求取出n个特征多项式
cab=zeros(m-1,y);
cab(1,:)=C*A*B;
for i=2:m-1
    T=A^i;
    cab(i,:)=C*T*B;
end 
b=zeros(m,y);
b(1,:)=C*B; 
for i=2:m
    pk=0;
    for j=1:i-2
        pk=a(j)*cab(i-1-j,:)+pk;
    end
    b(i,:)=cab(i-1,:)+pk+a(i-1)*C*B;
end
a
b