线性二次型最优控制的MATLAB实现 -