是西门子的算法sqp序列二次规划算法的调试程序可以用来测试这个算法