适合有最优化理论基础的朋友,程序自己编写,仅供借鉴,已封装成函数