用牛顿 拉格朗日法求解约束优化问题

用牛顿-拉格朗日法求解约束优化问题,% min f(x) s.t. h_i(x)=0, i=1,..., l. %输入: x0是初始点, mu0是乘子向量的初始值 %输出: x, mu 分别是近似最优点及相应的乘子, % val是最优值, mh是约束函数的模, k是迭代次数. maxk=200; %最大迭代次数