robotaxx.pro~orig

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

  191   3.2205502e+02    1.0000000e+00    0.0000000e+00
  192   3.9347578e+02    1.0000000e+00    0.0000000e+00
  193   4.0162964e+00    1.0000000e+00    0.0000000e+00
  194   3.0831909e+00    1.0000000e+00    0.0000000e+00
  195   3.9722653e+01    1.0000000e+00    0.0000000e+00
  196   3.0166695e+01    1.0000000e+00    0.0000000e+00
  197   5.3326455e+02    1.0000000e+00    0.0000000e+00
  198   5.6755206e+02    1.0000000e+00    0.0000000e+00
  199   1.1865102e+00    1.0000000e+00    0.0000000e+00
  200   2.4523132e+00    1.0000000e+00    0.0000000e+00
  201   2.4818166e-02    1.4054378e+01    0.0000000e+00
  202   1.2020629e+01    1.0000000e+00    0.0000000e+00
  203   1.7528188e+02    1.0000000e+00    0.0000000e+00
  204   1.3623023e+02    1.0000000e+00    0.0000000e+00
  205   3.7158699e+00    1.0000000e+00    0.0000000e+00
  206   1.7423652e+00    1.0000000e+00    0.0000000e+00
  207   2.2726748e+01    1.0000000e+00    0.0000000e+00
  208   4.3755096e+00    1.0000000e+00    0.0000000e+00
  209   3.6631725e+02    1.0000000e+00    0.0000000e+00
  210   4.4361424e+02    1.0000000e+00    0.0000000e+00
  211   4.1873380e+00    1.0000000e+00    0.0000000e+00
  212   3.0903088e+00    1.0000000e+00    0.0000000e+00
  213   4.2840209e+01    1.0000000e+00    0.0000000e+00
  214   3.2443839e+01    1.0000000e+00    0.0000000e+00
  215   6.0610185e+02    1.0000000e+00    0.0000000e+00
  216   6.3994661e+02    1.0000000e+00    0.0000000e+00
  217   1.1262354e+00    1.0000000e+00    0.0000000e+00
  218   2.5892979e+00    1.0000000e+00    0.0000000e+00
  219  -8.8817842e-16    1.3687914e+01    4.8282793e-03
  220   1.2823410e+01    1.0000000e+00    0.0000000e+00
  221   1.9172616e+02    1.0000000e+00    0.0000000e+00
  222   1.5403475e+02    1.0000000e+00    0.0000000e+00
  223   3.9237628e+00    1.0000000e+00    0.0000000e+00
  224   1.6495372e+00    1.0000000e+00    0.0000000e+00
  225   2.4088466e+01    1.0000000e+00    0.0000000e+00
  226   4.7642052e+00    1.0000000e+00    0.0000000e+00
  227   4.0703606e+02    1.0000000e+00    0.0000000e+00
  228   4.9194229e+02    1.0000000e+00    0.0000000e+00
  229   4.3495271e+00    1.0000000e+00    0.0000000e+00
  230   3.0815396e+00    1.0000000e+00    0.0000000e+00
  231   4.5629966e+01    1.0000000e+00    0.0000000e+00
  232   3.4516344e+01    1.0000000e+00    0.0000000e+00
  233   6.7518887e+02    1.0000000e+00    0.0000000e+00
  234   7.0785476e+02    1.0000000e+00    0.0000000e+00
  235   1.0580015e+00    1.0000000e+00    0.0000000e+00
  236   2.7249373e+00    1.0000000e+00    0.0000000e+00
  237   1.7763568e-15    1.5623811e+01    3.1431110e-03
  238   1.3534056e+01    1.0000000e+00    0.0000000e+00
  239   2.1073970e+02    1.0000000e+00    0.0000000e+00
  240   1.6754314e+02    1.0000000e+00    0.0000000e+00
  241   4.1271721e+00    1.0000000e+00    0.0000000e+00
  242   1.5472362e+00    1.0000000e+00    0.0000000e+00
  243   2.5199069e+01    1.0000000e+00    0.0000000e+00
  244   5.2525569e+00    1.0000000e+00    0.0000000e+00
  245   4.3828860e+02    1.0000000e+00    0.0000000e+00
  246   5.4524679e+02    1.0000000e+00    0.0000000e+00
  247   4.5052777e+00    1.0000000e+00    0.0000000e+00
  248   3.0606000e+00    1.0000000e+00    0.0000000e+00
  249   4.8158682e+01    1.0000000e+00    0.0000000e+00
  250   3.6429167e+01    1.0000000e+00    0.0000000e+00
  251   7.3784717e+02    1.0000000e+00    0.0000000e+00
  252   7.7528419e+02    1.0000000e+00    0.0000000e+00
  253   9.8292787e-01    1.0000000e+00    0.0000000e+00
  254   2.8589005e+00    1.0000000e+00    0.0000000e+00
  255   2.2891133e-03    1.9292741e+01    0.0000000e+00
  256   1.4173717e+01    1.0000000e+00    0.0000000e+00
  257   2.2844063e+02    1.0000000e+00    0.0000000e+00
  258   1.8021722e+02    1.0000000e+00    0.0000000e+00
  259   4.3243277e+00    1.0000000e+00    0.0000000e+00
  260   1.4384149e+00    1.0000000e+00    0.0000000e+00
  261   2.6063319e+01    1.0000000e+00    0.0000000e+00
  262   5.8326951e+00    1.0000000e+00    0.0000000e+00
  263   4.6487415e+02    1.0000000e+00    0.0000000e+00
  264   5.9763628e+02    1.0000000e+00    0.0000000e+00
  265   4.6547499e+00    1.0000000e+00    0.0000000e+00
  266   3.0289069e+00    1.0000000e+00    0.0000000e+00
  267   5.0440971e+01    1.0000000e+00    0.0000000e+00
  268   3.8159067e+01    1.0000000e+00    0.0000000e+00
  269   7.9641890e+02    1.0000000e+00    0.0000000e+00
  270   8.3821253e+02    1.0000000e+00    0.0000000e+00
  271   9.0182296e-01    1.0000000e+00    0.0000000e+00
  272   2.9905986e+00    1.0000000e+00    0.0000000e+00
  273   4.5259837e-03    2.0668403e+01    0.0000000e+00
  274   1.4738941e+01    1.0000000e+00    0.0000000e+00
  275   2.4451429e+02    1.0000000e+00    0.0000000e+00
  276   1.9176982e+02    1.0000000e+00    0.0000000e+00
  277   4.5127291e+00    1.0000000e+00    0.0000000e+00
  278   1.3259032e+00    1.0000000e+00    0.0000000e+00
  279   2.6642625e+01    1.0000000e+00    0.0000000e+00
  280   6.5301749e+00    1.0000000e+00    0.0000000e+00
  281   4.8572248e+02    1.0000000e+00    0.0000000e+00
  282   6.4861620e+02    1.0000000e+00    0.0000000e+00
  283   4.7975577e+00    1.0000000e+00    0.0000000e+00
  284   2.9872854e+00    1.0000000e+00    0.0000000e+00
  285   5.2458247e+01    1.0000000e+00    0.0000000e+00
  286   3.9688421e+01    1.0000000e+00    0.0000000e+00
  287   8.4971227e+02    1.0000000e+00    0.0000000e+00
  288   8.9542415e+02    1.0000000e+00    0.0000000e+00
  289   8.1546892e-01    1.0000000e+00    0.0000000e+00
  290   3.1194689e+00    1.0000000e+00    0.0000000e+00
  291   4.6916842e-03    1.9281875e+01    0.0000000e+00
  292   1.5227193e+01    1.0000000e+00    0.0000000e+00
  293   2.5868742e+02    1.0000000e+00    0.0000000e+00
  294   2.0195022e+02    1.0000000e+00    0.0000000e+00
  295   4.6895422e+00    1.0000000e+00    0.0000000e+00
  296   1.2128646e+00    1.0000000e+00    0.0000000e+00
  297   2.6897935e+01    1.0000000e+00    0.0000000e+00
  298   7.3738046e+00    1.0000000e+00    0.0000000e+00
  299   4.9994919e+02    1.0000000e+00    0.0000000e+00
  300   6.9770868e+02    1.0000000e+00    0.0000000e+00
  301   4.9333378e+00    1.0000000e+00    0.0000000e+00
  302   2.9365378e+00    1.0000000e+00    0.0000000e+00
  303   5.4196056e+01    1.0000000e+00    0.0000000e+00
  304   4.1003222e+01    1.0000000e+00    0.0000000e+00
  305   8.9668917e+02    1.0000000e+00    0.0000000e+00
  306   9.4586141e+02    1.0000000e+00    0.0000000e+00
  307   7.2463390e-01    1.0000000e+00    0.0000000e+00
  308   3.2449877e+00    1.0000000e+00    0.0000000e+00
  309   3.0712008e-03    2.2140695e+01    0.0000000e+00
  310   1.5635149e+01    1.0000000e+00    0.0000000e+00
  311   2.7047568e+02    1.0000000e+00    0.0000000e+00
  312   2.1082400e+02    1.0000000e+00    0.0000000e+00
  313   4.8516040e+00    1.0000000e+00    0.0000000e+00
  314   1.1028283e+00    1.0000000e+00    0.0000000e+00
  315   2.6788940e+01    1.0000000e+00    0.0000000e+00
  316   8.3970557e+00    1.0000000e+00    0.0000000e+00
  317   5.0733678e+02    1.0000000e+00    0.0000000e+00
  318   7.4404239e+02    1.0000000e+00    0.0000000e+00
  319   5.0617748e+00    1.0000000e+00    0.0000000e+00
  320   2.8774683e+00    1.0000000e+00    0.0000000e+00
  321   5.5643338e+01    1.0000000e+00    0.0000000e+00
  322   4.2095538e+01    1.0000000e+00    0.0000000e+00
  323   9.3675030e+02    1.0000000e+00    0.0000000e+00
  324   9.8844842e+02    1.0000000e+00    0.0000000e+00
  325   6.3010932e-01    1.0000000e+00    0.0000000e+00
  326   3.3667070e+00    1.0000000e+00    0.0000000e+00
  327   1.3204466e-03    2.6769432e+01    0.0000000e+00
  328   1.5960506e+01    1.0000000e+00    0.0000000e+00
  329   2.8002524e+02    1.0000000e+00    0.0000000e+00
  330   2.1798811e+02    1.0000000e+00    0.0000000e+00
  331   4.9954853e+00    1.0000000e+00    0.0000000e+00
  332   9.9973910e-01    1.0000000e+00    0.0000000e+00
  333   2.6279325e+01    1.0000000e+00    0.0000000e+00
  334   9.6347837e+00    1.0000000e+00    0.0000000e+00
  335   5.0722255e+02    1.0000000e+00    0.0000000e+00
  336   7.8761216e+02    1.0000000e+00    0.0000000e+00
  337   5.1826753e+00    1.0000000e+00    0.0000000e+00
  338   2.8109573e+00    1.0000000e+00    0.0000000e+00
  339   5.6796353e+01    1.0000000e+00    0.0000000e+00
  340   4.2965059e+01    1.0000000e+00    0.0000000e+00
  341   9.6914395e+02    1.0000000e+00    0.0000000e+00
  342   1.0229095e+03    1.0000000e+00    0.0000000e+00
  343   5.3267266e-01    1.0000000e+00    0.0000000e+00
  344   3.4842178e+00    1.0000000e+00    0.0000000e+00
  345   0.0000000e+00    2.7617837e+01    1.3705011e-03
  346   1.6203543e+01    1.0000000e+00    0.0000000e+00
  347   2.8727755e+02    1.0000000e+00    0.0000000e+00
  348   2.2336853e+02    1.0000000e+00    0.0000000e+00
  349   5.1174663e+00    1.0000000e+00    0.0000000e+00
  350   9.0786947e-01    1.0000000e+00    0.0000000e+00
  351   2.5341240e+01    1.0000000e+00    0.0000000e+00
  352   1.1116732e+01    1.0000000e+00    0.0000000e+00
  353   4.9970867e+02    1.0000000e+00    0.0000000e+00
  354   8.2797114e+02    1.0000000e+00    0.0000000e+00
  355   5.2958934e+00    1.0000000e+00    0.0000000e+00
  356   2.7378876e+00    1.0000000e+00    0.0000000e+00
  357   5.7657607e+01    1.0000000e+00    0.0000000e+00
  358   4.3614536e+01    1.0000000e+00    0.0000000e+00
  359   9.9359825e+02    1.0000000e+00    0.0000000e+00
  360   1.0489861e+03    1.0000000e+00    0.0000000e+00
  361   4.3307501e-01    1.0000000e+00    0.0000000e+00
  362   3.5971375e+00    1.0000000e+00    0.0000000e+00
  363   1.7763568e-15    2.5047754e+01    1.7610851e-03
  364   1.6365295e+01    1.0000000e+00    0.0000000e+00
  365   2.9222995e+02    1.0000000e+00    0.0000000e+00
  366   2.2694029e+02    1.0000000e+00    0.0000000e+00
  367   5.2135772e+00    1.0000000e+00    0.0000000e+00
  368   8.3174158e-01    1.0000000e+00    0.0000000e+00
  369   2.3955100e+01    1.0000000e+00    0.0000000e+00
  370   1.2866815e+01    1.0000000e+00    0.0000000e+00
  371   4.8525244e+02    1.0000000e+00    0.0000000e+00
  372   8.6459017e+02    1.0000000e+00    0.0000000e+00
  373   5.4013063e+00    1.0000000e+00    0.0000000e+00
  374   2.6591188e+00    1.0000000e+00    0.0000000e+00
  375   5.8233176e+01    1.0000000e+00    0.0000000e+00
  376   4.4049920e+01    1.0000000e+00    0.0000000e+00
  377   1.0100483e+03    1.0000000e+00    0.0000000e+00
  378   1.0666326e+03    1.0000000e+00    0.0000000e+00
  379   3.3307338e-01    1.0000000e+00    0.0000000e+00
  380   3.7061420e+00    1.0000000e+00    0.0000000e+00
  381   2.1976534e-01    2.8761916e+01    0.0000000e+00
  382   1.6255448e+01    1.0000000e+00    0.0000000e+00
  383   2.6480221e+02    1.0000000e+00    0.0000000e+00
  384   2.6019271e+02    1.0000000e+00    0.0000000e+00
  385   5.2812381e+00    1.0000000e+00    0.0000000e+00
  386   7.7758495e-01    1.0000000e+00    0.0000000e+00
  387   2.1863646e+01    1.0000000e+00    0.0000000e+00
  388   1.5205583e+01    1.0000000e+00    0.0000000e+00
  389   5.1009281e+02    1.0000000e+00    0.0000000e+00
  390   8.5489397e+02    1.0000000e+00    0.0000000e+00
  391   5.5008784e+00    1.0000000e+00    0.0000000e+00
  392   2.5775523e+00    1.0000000e+00    0.0000000e+00
  393   5.8433837e+01    1.0000000e+00    0.0000000e+00
  394   4.4536245e+01    1.0000000e+00    0.0000000e+00
  395   1.0479924e+03    1.0000000e+00    0.0000000e+00
  396   1.0519873e+03    1.0000000e+00    0.0000000e+00
  397   2.3852758e-01    1.0000000e+00    0.0000000e+00
  398   3.8160627e+00    1.0000000e+00    0.0000000e+00
  399   9.6328548e-01    1.0000000e+00    0.0000000e+00
  400   1.5700779e+01    1.0000000e+00    0.0000000e+00
  401   2.4027381e+02    1.0000000e+00    0.0000000e+00
  402   2.9478922e+02    1.0000000e+00    0.0000000e+00
  403   5.3240260e+00    1.0000000e+00    0.0000000e+00
  404   7.5785948e-01    1.0000000e+00    0.0000000e+00
  405   1.8919383e+01    1.0000000e+00    0.0000000e+00
  406   1.8574762e+01    1.0000000e+00    0.0000000e+00
  407   5.4257910e+02    1.0000000e+00    0.0000000e+00
  408   8.4858476e+02    1.0000000e+00    0.0000000e+00
  409   5.6048555e+00    1.0000000e+00    0.0000000e+00
  410   2.5043251e+00    1.0000000e+00    0.0000000e+00
  411   5.8461450e+01    1.0000000e+00    0.0000000e+00
  412   4.5688955e+01    1.0000000e+00    0.0000000e+00
  413   1.0937494e+03    1.0000000e+00    0.0000000e+00
  414   1.0465027e+03    1.0000000e+00    0.0000000e+00
  415   1.5630330e-01    1.3838494e+00    0.0000000e+00
  416   3.9327899e+00    1.0000000e+00    0.0000000e+00
  417   2.3615143e+00    1.0000000e+00    0.0000000e+00
  418   1.4731593e+01    1.0000000e+00    0.0000000e+00
  419   2.2011288e+02    1.0000000e+00    0.0000000e+00
  420   3.3810671e+02    1.0000000e+00    0.0000000e+00
  421   5.3471821e+00    1.0000000e+00    0.0000000e+00
  422   7.8645764e-01    1.0000000e+00    0.0000000e+00
  423   1.5301477e+01    1.0000000e+00    0.0000000e+00
  424   2.3158016e+01    1.0000000e+00    0.0000000e+00
  425   6.0151307e+02    1.0000000e+00    0.0000000e+00
  426   8.4985788e+02    1.0000000e+00    0.0000000e+00
  427   5.7255707e+00    1.0000000e+00    0.0000000e+00