基于拉格朗日函数Hesse阵的SQP方法求解约束优化问题的核心代码