乘子法核心代码,fun、dfun为目标函数和梯度;hf、dhf为等式约束函数及其Jacobi矩阵的转置;gf、dgf为不等式约束函数及其Jacobi矩阵的转置;x0为初始点