controllable.m

System will automatically delete the directory of debug and release, so please do not put files on t

function [A,B,C,D]=controllable(num,den)
if length(num)>length(den)
    deg=length(num)-1;
else
    deg=length(den)-1;
end

A=zeros(deg,deg);
for i=1:deg-1
    A(i,i+1)=1;
end
for i=1:deg
    A(deg,i)=-den(deg+2-i);
end

B=zeros(deg,1);
B(deg,1)=1;

C=zeros(1,deg);
for i=1:deg
    C(1,i)=num(deg+2-i)-den(deg+2-i)*num(1);
end
D=num(1);