robotcxx.pro~orig

sqp程序包。用sqp算法实现非线性约束的优化求解

  191   5.7493379e+02    1.0000000e+00    0.0000000e+00
  192   1.6686150e+02    1.0000000e+00    0.0000000e+00
  193   6.1332255e+00    1.0000000e+00    0.0000000e+00
  194   5.2001200e+00    1.0000000e+00    0.0000000e+00
  195   1.5220643e+02    1.0000000e+00    0.0000000e+00
  196   1.3211162e+02    1.0000000e+00    0.0000000e+00
  197   6.9191338e+02    1.0000000e+00    0.0000000e+00
  198   4.4931013e+02    1.0000000e+00    0.0000000e+00
  199   2.1487414e+00    1.0000000e+00    0.0000000e+00
  200   3.4145443e+00    1.0000000e+00    0.0000000e+00
  201   9.4774711e+00    1.0000000e+00    0.0000000e+00
  202   3.3568657e+01    1.0000000e+00    0.0000000e+00
  203   7.4090687e-01    1.1041384e+03    0.0000000e+00
  204   2.5947082e+02    1.0000000e+00    0.0000000e+00
  205   5.1592166e+00    1.0000000e+00    0.0000000e+00
  206   3.1857119e+00    1.0000000e+00    0.0000000e+00
  207   6.6938513e+01    1.0000000e+00    0.0000000e+00
  208   2.9915277e+01    1.0000000e+00    0.0000000e+00
  209   5.1712548e+02    1.0000000e+00    0.0000000e+00
  210   1.5942500e+02    1.0000000e+00    0.0000000e+00
  211   6.1118003e+00    1.0000000e+00    0.0000000e+00
  212   5.0147711e+00    1.0000000e+00    0.0000000e+00
  213   1.4495867e+02    1.0000000e+00    0.0000000e+00
  214   1.2407964e+02    1.0000000e+00    0.0000000e+00
  215   6.3253975e+02    1.0000000e+00    0.0000000e+00
  216   4.0830716e+02    1.0000000e+00    0.0000000e+00
  217   2.0005089e+00    1.0000000e+00    0.0000000e+00
  218   3.4635714e+00    1.0000000e+00    0.0000000e+00
  219   8.0006736e+00    1.0000000e+00    0.0000000e+00
  220   3.2783459e+01    1.0000000e+00    0.0000000e+00
  221   2.8421709e-14    1.2708082e+03    1.0432631e-04
  222   2.3782386e+02    1.0000000e+00    0.0000000e+00
  223   5.2351730e+00    1.0000000e+00    0.0000000e+00
  224   2.9609474e+00    1.0000000e+00    0.0000000e+00
  225   6.4696021e+01    1.0000000e+00    0.0000000e+00
  226   2.7068277e+01    1.0000000e+00    0.0000000e+00
  227   4.6011446e+02    1.0000000e+00    0.0000000e+00
  228   1.5822757e+02    1.0000000e+00    0.0000000e+00
  229   6.0980741e+00    1.0000000e+00    0.0000000e+00
  230   4.8300866e+00    1.0000000e+00    0.0000000e+00
  231   1.3818962e+02    1.0000000e+00    0.0000000e+00
  232   1.1671121e+02    1.0000000e+00    0.0000000e+00
  233   5.7870472e+02    1.0000000e+00    0.0000000e+00
  234   3.7259071e+02    1.0000000e+00    0.0000000e+00
  235   1.8512664e+00    1.0000000e+00    0.0000000e+00
  236   3.5182022e+00    1.0000000e+00    0.0000000e+00
  237   6.7161938e+00    1.0000000e+00    0.0000000e+00
  238   3.1985851e+01    1.0000000e+00    0.0000000e+00
  239   3.8023071e-01    8.7805809e+02    0.0000000e+00
  240   2.1755456e+02    1.0000000e+00    0.0000000e+00
  241   5.3170694e+00    1.0000000e+00    0.0000000e+00
  242   2.7371335e+00    1.0000000e+00    0.0000000e+00
  243   6.2384961e+01    1.0000000e+00    0.0000000e+00
  244   2.4694640e+01    1.0000000e+00    0.0000000e+00
  245   4.0323845e+02    1.0000000e+00    0.0000000e+00
  246   1.6339200e+02    1.0000000e+00    0.0000000e+00
  247   6.0918074e+00    1.0000000e+00    0.0000000e+00
  248   4.6471297e+00    1.0000000e+00    0.0000000e+00
  249   1.3189408e+02    1.0000000e+00    0.0000000e+00
  250   1.0999371e+02    1.0000000e+00    0.0000000e+00
  251   5.2997845e+02    1.0000000e+00    0.0000000e+00
  252   3.4176070e+02    1.0000000e+00    0.0000000e+00
  253   1.7019444e+00    1.0000000e+00    0.0000000e+00
  254   3.5779171e+00    1.0000000e+00    0.0000000e+00
  255   5.6184599e+00    1.0000000e+00    0.0000000e+00
  256   3.1178132e+01    1.0000000e+00    0.0000000e+00
  257   1.7862607e+00    1.0134374e+03    0.0000000e+00
  258   1.9856067e+02    1.0000000e+00    0.0000000e+00
  259   5.4028525e+00    1.0000000e+00    0.0000000e+00
  260   2.5169397e+00    1.0000000e+00    0.0000000e+00
  261   5.9977216e+01    1.0000000e+00    0.0000000e+00
  262   2.2815116e+01    1.0000000e+00    0.0000000e+00
  263   3.4599079e+02    1.0000000e+00    0.0000000e+00
  264   1.7491123e+02    1.0000000e+00    0.0000000e+00
  265   6.0927830e+00    1.0000000e+00    0.0000000e+00
  266   4.4669400e+00    1.0000000e+00    0.0000000e+00
  267   1.2606521e+02    1.0000000e+00    0.0000000e+00
  268   1.0391349e+02    1.0000000e+00    0.0000000e+00
  269   4.8596277e+02    1.0000000e+00    0.0000000e+00
  270   3.1542495e+02    1.0000000e+00    0.0000000e+00
  271   1.5534472e+00    1.0000000e+00    0.0000000e+00
  272   3.6422228e+00    1.0000000e+00    0.0000000e+00
  273   4.7021199e+00    1.0000000e+00    0.0000000e+00
  274   3.0362141e+01    1.0000000e+00    0.0000000e+00
  275   4.1208742e+00    1.3725296e+03    0.0000000e+00
  276   1.8075398e+02    1.0000000e+00    0.0000000e+00
  277   5.4901654e+00    1.0000000e+00    0.0000000e+00
  278   2.3033396e+00    1.0000000e+00    0.0000000e+00
  279   5.7441693e+01    1.0000000e+00    0.0000000e+00
  280   2.1452895e+01    1.0000000e+00    0.0000000e+00
  281   2.8805390e+02    1.0000000e+00    0.0000000e+00
  282   1.9262073e+02    1.0000000e+00    0.0000000e+00
  283   6.1008061e+00    1.0000000e+00    0.0000000e+00
  284   4.2905339e+00    1.0000000e+00    0.0000000e+00
  285   1.2069516e+02    1.0000000e+00    0.0000000e+00
  286   9.8456473e+01    1.0000000e+00    0.0000000e+00
  287   4.4629073e+02    1.0000000e+00    0.0000000e+00
  288   2.9320870e+02    1.0000000e+00    0.0000000e+00
  289   1.4066525e+00    1.0000000e+00    0.0000000e+00
  290   3.7106525e+00    1.0000000e+00    0.0000000e+00
  291   3.9621058e+00    1.0000000e+00    0.0000000e+00
  292   2.9539369e+01    1.0000000e+00    0.0000000e+00
  293   7.2830601e+00    1.6813765e+03    0.0000000e+00
  294   1.6406397e+02    1.0000000e+00    0.0000000e+00
  295   5.5763176e+00    1.0000000e+00    0.0000000e+00
  296   2.0996400e+00    1.0000000e+00    0.0000000e+00
  297   5.4746000e+01    1.0000000e+00    0.0000000e+00
  298   2.0632318e+01    1.0000000e+00    0.0000000e+00
  299   2.2934131e+02    1.0000000e+00    0.0000000e+00
  300   2.1616096e+02    1.0000000e+00    0.0000000e+00
  301   6.1157050e+00    1.0000000e+00    0.0000000e+00
  302   4.1189050e+00    1.0000000e+00    0.0000000e+00
  303   1.1577559e+02    1.0000000e+00    0.0000000e+00
  304   9.3608628e+01    1.0000000e+00    0.0000000e+00
  305   4.1063245e+02    1.0000000e+00    0.0000000e+00
  306   2.7475566e+02    1.0000000e+00    0.0000000e+00
  307   1.2627648e+00    1.0000000e+00    0.0000000e+00
  308   3.7831186e+00    1.0000000e+00    0.0000000e+00
  309   3.4522933e+00    1.0000000e+00    0.0000000e+00
  310   2.8665940e+01    1.0000000e+00    0.0000000e+00
  311   2.2639698e+00    1.0537308e+03    0.0000000e+00
  312   1.5745485e+02    1.0000000e+00    0.0000000e+00
  313   5.6588004e+00    1.0000000e+00    0.0000000e+00
  314   1.9100247e+00    1.0000000e+00    0.0000000e+00
  315   5.1796035e+01    1.0000000e+00    0.0000000e+00
  316   2.0469989e+01    1.0000000e+00    0.0000000e+00
  317   1.8385763e+02    1.0000000e+00    0.0000000e+00
  318   2.3141131e+02    1.0000000e+00    0.0000000e+00
  319   6.1380367e+00    1.0000000e+00    0.0000000e+00
  320   3.9537301e+00    1.0000000e+00    0.0000000e+00
  321   1.1129539e+02    1.0000000e+00    0.0000000e+00
  322   8.9443564e+01    1.0000000e+00    0.0000000e+00
  323   3.8668703e+02    1.0000000e+00    0.0000000e+00
  324   2.5218827e+02    1.0000000e+00    0.0000000e+00
  325   1.1243742e+00    1.0000000e+00    0.0000000e+00
  326   3.8609719e+00    1.0000000e+00    0.0000000e+00
  327   3.2648443e+00    1.0000000e+00    0.0000000e+00
  328   2.7711199e+01    1.0000000e+00    0.0000000e+00
  329  -1.2789769e-13    1.0948484e+03    7.7455566e-05
  330   1.5036494e+02    1.0000000e+00    0.0000000e+00
  331   5.7368827e+00    1.0000000e+00    0.0000000e+00
  332   1.7411364e+00    1.0000000e+00    0.0000000e+00
  333   4.8543117e+01    1.0000000e+00    0.0000000e+00
  334   2.1152980e+01    1.0000000e+00    0.0000000e+00
  335   1.3692945e+02    1.0000000e+00    0.0000000e+00
  336   2.5401941e+02    1.0000000e+00    0.0000000e+00
  337   6.1712050e+00    1.0000000e+00    0.0000000e+00
  338   3.7994871e+00    1.0000000e+00    0.0000000e+00
  339   1.0739355e+02    1.0000000e+00    0.0000000e+00
  340   8.6206714e+01    1.0000000e+00    0.0000000e+00
  341   3.6588803e+02    1.0000000e+00    0.0000000e+00
  342   2.3557175e+02    1.0000000e+00    0.0000000e+00
  343   9.9439735e-01    1.0000000e+00    0.0000000e+00
  344   3.9459425e+00    1.0000000e+00    0.0000000e+00
  345   3.4506520e+00    1.0000000e+00    0.0000000e+00
  346   2.6694015e+01    1.0000000e+00    0.0000000e+00
  347  -1.2789769e-13    1.5438096e+03    1.0770080e-04
  348   1.4369914e+02    1.0000000e+00    0.0000000e+00
  349   5.8100533e+00    1.0000000e+00    0.0000000e+00
  350   1.6004565e+00    1.0000000e+00    0.0000000e+00
  351   4.5023866e+01    1.0000000e+00    0.0000000e+00
  352   2.2801634e+01    1.0000000e+00    0.0000000e+00
  353   9.1540963e+01    1.0000000e+00    0.0000000e+00
  354   2.8207681e+02    1.0000000e+00    0.0000000e+00
  355   6.2193428e+00    1.0000000e+00    0.0000000e+00
  356   3.6613370e+00    1.0000000e+00    0.0000000e+00
  357   1.0427421e+02    1.0000000e+00    0.0000000e+00
  358   8.4129960e+01    1.0000000e+00    0.0000000e+00
  359   3.4966791e+02    1.0000000e+00    0.0000000e+00
  360   2.2512866e+02    1.0000000e+00    0.0000000e+00
  361   8.7572462e-01    1.0000000e+00    0.0000000e+00
  362   4.0397871e+00    1.0000000e+00    0.0000000e+00
  363   4.0602300e+00    1.0000000e+00    0.0000000e+00
  364   2.5632233e+01    1.0000000e+00    0.0000000e+00
  365   1.2946762e+00    2.0645045e+03    0.0000000e+00
  366   1.3882971e+02    1.0000000e+00    0.0000000e+00
  367   5.8775516e+00    1.0000000e+00    0.0000000e+00
  368   1.4957160e+00    1.0000000e+00    0.0000000e+00
  369   4.1282103e+01    1.0000000e+00    0.0000000e+00
  370   2.5525938e+01    1.0000000e+00    0.0000000e+00
  371   5.1711945e+01    2.4985765e+03    0.0000000e+00
  372   3.1261147e+02    1.0000000e+00    0.0000000e+00
  373   6.2866055e+00    1.0000000e+00    0.0000000e+00
  374   3.5444180e+00    1.0000000e+00    0.0000000e+00
  375   1.0213681e+02    1.0000000e+00    0.0000000e+00
  376   8.3441078e+01    1.0000000e+00    0.0000000e+00
  377   3.3984729e+02    1.0000000e+00    0.0000000e+00
  378   2.2065026e+02    1.0000000e+00    0.0000000e+00
  379   7.7112428e-01    1.0000000e+00    0.0000000e+00
  380   4.1441929e+00    1.0000000e+00    0.0000000e+00
  381   5.1259687e+00    1.0000000e+00    0.0000000e+00
  382   2.4562968e+01    1.0000000e+00    0.0000000e+00
  383   5.8904656e+00    1.2646493e+03    0.0000000e+00
  384   1.3420619e+02    1.0000000e+00    0.0000000e+00
  385   5.9383145e+00    1.0000000e+00    0.0000000e+00
  386   1.4346613e+00    1.0000000e+00    0.0000000e+00
  387   3.7399874e+01    1.0000000e+00    0.0000000e+00
  388   2.9400234e+01    1.0000000e+00    0.0000000e+00
  389   1.7659824e+01    1.0000000e+00    0.0000000e+00
  390   3.4659149e+02    1.0000000e+00    0.0000000e+00
  391   6.3769802e+00    1.0000000e+00    0.0000000e+00
  392   3.4536541e+00    1.0000000e+00    0.0000000e+00
  393   1.0120063e+02    1.0000000e+00    0.0000000e+00
  394   8.4355229e+01    1.0000000e+00    0.0000000e+00
  395   3.3579680e+02    1.0000000e+00    0.0000000e+00
  396   2.2458984e+02    1.0000000e+00    0.0000000e+00
  397   6.8295546e-01    1.0000000e+00    0.0000000e+00
  398   4.2604906e+00    1.0000000e+00    0.0000000e+00
  399   6.6762681e+00    1.0000000e+00    0.0000000e+00
  400   2.3525294e+01    1.0000000e+00    0.0000000e+00
  401   8.4622544e+00    1.0804326e+03    0.0000000e+00
  402   1.3568921e+02    1.0000000e+00    0.0000000e+00
  403   5.9906678e+00    1.0000000e+00    0.0000000e+00
  404   1.4245013e+00    1.0000000e+00    0.0000000e+00
  405   3.3472568e+01    1.0000000e+00    0.0000000e+00
  406   3.4480948e+01    1.0000000e+00    0.0000000e+00
  407  -2.8421709e-14    9.9906310e+02    2.0262657e-04
  408   3.7479380e+02    1.0000000e+00    0.0000000e+00
  409   6.4937113e+00    1.0000000e+00    0.0000000e+00
  410   3.3931808e+00    1.0000000e+00    0.0000000e+00
  411   1.0168113e+02    1.0000000e+00    0.0000000e+00
  412   8.7078638e+01    1.0000000e+00    0.0000000e+00
  413   3.4343461e+02    1.0000000e+00    0.0000000e+00
  414   2.3317125e+02    1.0000000e+00    0.0000000e+00
  415   6.1345518e-01    1.0000000e+00    0.0000000e+00
  416   4.3899418e+00    1.0000000e+00    0.0000000e+00
  417   8.7650745e+00    1.0000000e+00    0.0000000e+00
  418   2.2548661e+01    1.0000000e+00    0.0000000e+00
  419   7.1829939e+00    1.6277956e+03    0.0000000e+00
  420   1.4592393e+02    1.0000000e+00    0.0000000e+00
  421   6.0329099e+00    1.0000000e+00    0.0000000e+00
  422   1.4721855e+00    1.0000000e+00    0.0000000e+00
  423   2.9604724e+01    1.0000000e+00    0.0000000e+00
  424   4.0851182e+01    1.0000000e+00    0.0000000e+00
  425   5.2164939e+00    1.4666111e+03    0.0000000e+00
  426   3.9286152e+02    1.0000000e+00    0.0000000e+00
  427   6.6398745e+00    1.0000000e+00    0.0000000e+00