约束优化方法与MATLAB实现