最优化方法中的罚函数法求解方程的根,自己编写的MATLAB程序