MATLAB求解线性二次型最优控制问题