matlab工具箱GPOPS和INTLAB,高斯伪谱法用于最优控制问题中非线性规划求解