用MATLAB编写,可以用来求控制系统的能控性矩阵