robotaxx.pro~orig

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

  665   5.5928831e+03    1.0000000e+00    0.0000000e+00
  666   5.9495479e+03    1.0000000e+00    0.0000000e+00
  667   6.2362266e-02    1.3838494e+00    0.0000000e+00
  668   5.6242590e+00    1.0000000e+00    0.0000000e+00
  669   2.0562679e+01    1.0000000e+00    0.0000000e+00
  670   2.5410329e+01    1.0000000e+00    0.0000000e+00
  671   1.6301095e+03    1.0000000e+00    0.0000000e+00
  672   1.2735224e+03    1.0000000e+00    0.0000000e+00
  673   2.3700093e+00    1.0000000e+00    0.0000000e+00
  674   6.1599226e+00    1.0000000e+00    0.0000000e+00
  675   1.4690131e+00    1.0000000e+00    0.0000000e+00
  676   1.0197026e+02    1.0000000e+00    0.0000000e+00
  677   4.0599329e+03    1.0000000e+00    0.0000000e+00
  678   3.4895103e+03    1.0000000e+00    0.0000000e+00
  679   8.0967765e+00    1.0000000e+00    0.0000000e+00
  680   3.2764660e+00    1.0000000e+00    0.0000000e+00
  681   1.4576630e+02    1.0000000e+00    0.0000000e+00
  682   1.4156500e+02    1.0000000e+00    0.0000000e+00
  683   5.6527429e+03    1.0000000e+00    0.0000000e+00
  684   5.9617850e+03    1.0000000e+00    0.0000000e+00
  685   4.1361169e-02    1.3565684e+00    0.0000000e+00
  686   5.6382713e+00    1.0000000e+00    0.0000000e+00
  687   2.0605664e+01    1.0000000e+00    0.0000000e+00
  688   2.5198052e+01    1.0000000e+00    0.0000000e+00
  689   1.5927168e+03    1.0000000e+00    0.0000000e+00
  690   1.2931164e+03    1.0000000e+00    0.0000000e+00
  691   1.9336298e+00    1.0000000e+00    0.0000000e+00
  692   6.5858189e+00    1.0000000e+00    0.0000000e+00
  693   3.3509237e+00    1.0000000e+00    0.0000000e+00
  694   9.9707438e+01    1.0000000e+00    0.0000000e+00
  695   4.1227790e+03    1.0000000e+00    0.0000000e+00
  696   3.3803873e+03    1.0000000e+00    0.0000000e+00
  697   8.1049602e+00    1.0000000e+00    0.0000000e+00
  698   3.2543048e+00    1.0000000e+00    0.0000000e+00
  699   1.4512665e+02    1.0000000e+00    0.0000000e+00
  700   1.4114658e+02    1.0000000e+00    0.0000000e+00
  701   5.6418396e+03    1.0000000e+00    0.0000000e+00
  702   5.9014932e+03    1.0000000e+00    0.0000000e+00
  703   2.2500951e-02    1.3838494e+00    0.0000000e+00
  704   5.6404719e+00    1.0000000e+00    0.0000000e+00
  705   2.0779785e+01    1.0000000e+00    0.0000000e+00
  706   2.4622054e+01    1.0000000e+00    0.0000000e+00
  707   1.5431625e+03    1.0000000e+00    0.0000000e+00
  708   1.3005942e+03    1.0000000e+00    0.0000000e+00
  709   1.5175580e+00    1.0000000e+00    0.0000000e+00
  710   6.9769013e+00    1.0000000e+00    0.0000000e+00
  711   6.1975870e+00    1.0000000e+00    0.0000000e+00
  712   9.5956551e+01    1.0000000e+00    0.0000000e+00
  713   4.1503211e+03    1.0000000e+00    0.0000000e+00
  714   3.2434464e+03    1.0000000e+00    0.0000000e+00
  715   8.0974269e+00    1.0000000e+00    0.0000000e+00
  716   3.2285188e+00    1.0000000e+00    0.0000000e+00
  717   1.4354573e+02    1.0000000e+00    0.0000000e+00
  718   1.4021576e+02    1.0000000e+00    0.0000000e+00
  719   5.5824006e+03    1.0000000e+00    0.0000000e+00
  720   5.7926264e+03    1.0000000e+00    0.0000000e+00
  721   8.0188602e-03    1.4142136e+00    0.0000000e+00
  722   5.6330189e+00    1.0000000e+00    0.0000000e+00
  723   2.1138338e+01    1.0000000e+00    0.0000000e+00
  724   2.3737959e+01    1.0000000e+00    0.0000000e+00
  725   1.4878336e+03    1.0000000e+00    0.0000000e+00
  726   1.3012727e+03    1.0000000e+00    0.0000000e+00
  727   1.1344488e+00    1.0000000e+00    0.0000000e+00
  728   7.3271078e+00    1.0000000e+00    0.0000000e+00
  729   1.0094226e+01    1.0000000e+00    0.0000000e+00
  730   9.0877443e+01    1.0000000e+00    0.0000000e+00
  731   4.1527521e+03    1.0000000e+00    0.0000000e+00
  732   3.0989243e+03    1.0000000e+00    0.0000000e+00
  733   8.0785377e+00    1.0000000e+00    0.0000000e+00
  734   3.2035377e+00    1.0000000e+00    0.0000000e+00
  735   1.4136493e+02    1.0000000e+00    0.0000000e+00
  736   1.3911193e+02    1.0000000e+00    0.0000000e+00
  737   5.4973695e+03    1.0000000e+00    0.0000000e+00
  738   5.6590557e+03    1.0000000e+00    0.0000000e+00
  739  -4.4408921e-16    1.3838494e+00    3.3745442e-02
  740   5.6179709e+00    1.0000000e+00    0.0000000e+00
  741   2.1686991e+01    1.0000000e+00    0.0000000e+00
  742   2.2641044e+01    1.0000000e+00    0.0000000e+00
  743   1.4415659e+03    1.0000000e+00    0.0000000e+00
  744   1.2909801e+03    1.0000000e+00    0.0000000e+00
  745   7.9568530e-01    2.0757740e+00    0.0000000e+00
  746   7.6312711e+00    1.0000000e+00    0.0000000e+00
  747   1.5019400e+01    1.0000000e+00    0.0000000e+00
  748   8.4718678e+01    1.0000000e+00    0.0000000e+00
  749   4.1487347e+03    1.0000000e+00    0.0000000e+00
  750   2.9558851e+03    1.0000000e+00    0.0000000e+00
  751   8.0524250e+00    1.0000000e+00    0.0000000e+00
  752   3.1835169e+00    1.0000000e+00    0.0000000e+00
  753   1.3893853e+02    1.0000000e+00    0.0000000e+00
  754   1.3811168e+02    1.0000000e+00    0.0000000e+00
  755   5.3998383e+03    1.0000000e+00    0.0000000e+00
  756   5.5303460e+03    1.0000000e+00    0.0000000e+00
  757   4.4408921e-16    1.3565684e+00    5.4500020e-03
  758   5.5969102e+00    1.0000000e+00    0.0000000e+00
  759   2.2417106e+01    1.0000000e+00    0.0000000e+00
  760   2.1414261e+01    1.0000000e+00    0.0000000e+00
  761   1.3982220e+03    1.0000000e+00    0.0000000e+00
  762   1.2834874e+03    1.0000000e+00    0.0000000e+00
  763   5.1048316e-01    2.0348526e+00    0.0000000e+00
  764   7.8848821e+00    1.0000000e+00    0.0000000e+00
  765   2.0869149e+01    1.0000000e+00    0.0000000e+00
  766   7.7751427e+01    1.0000000e+00    0.0000000e+00
  767   4.1324904e+03    1.0000000e+00    0.0000000e+00
  768   2.8399542e+03    1.0000000e+00    0.0000000e+00
  769   8.0222379e+00    1.0000000e+00    0.0000000e+00
  770   3.1715824e+00    1.0000000e+00    0.0000000e+00
  771   1.3653846e+02    1.0000000e+00    0.0000000e+00
  772   1.3740759e+02    1.0000000e+00    0.0000000e+00
  773   5.3137006e+03    1.0000000e+00    0.0000000e+00
  774   5.4131373e+03    1.0000000e+00    0.0000000e+00
  775   9.4223457e-03    1.3838494e+00    0.0000000e+00
  776   5.5713191e+00    1.0000000e+00    0.0000000e+00
  777   2.3357693e+01    1.0000000e+00    0.0000000e+00
  778   2.0094901e+01    1.0000000e+00    0.0000000e+00
  779   1.3606780e+03    1.0000000e+00    0.0000000e+00
  780   1.2825191e+03    1.0000000e+00    0.0000000e+00
  781   2.8619509e-01    2.0757740e+00    0.0000000e+00
  782   8.0849170e+00    1.0000000e+00    0.0000000e+00
  783   2.7545309e+01    1.0000000e+00    0.0000000e+00
  784   7.0223028e+01    1.0000000e+00    0.0000000e+00
  785   4.1088424e+03    1.0000000e+00    0.0000000e+00
  786   2.7634700e+03    1.0000000e+00    0.0000000e+00
  787   7.9908967e+00    1.0000000e+00    0.0000000e+00
  788   3.1705862e+00    1.0000000e+00    0.0000000e+00
  789   1.3437548e+02    1.0000000e+00    0.0000000e+00
  790   1.3720323e+02    1.0000000e+00    0.0000000e+00
  791   5.2525253e+03    1.0000000e+00    0.0000000e+00
  792   5.3202631e+03    1.0000000e+00    0.0000000e+00
  793   2.9644155e-02    1.4142136e+00    0.0000000e+00
  794   5.5427067e+00    1.0000000e+00    0.0000000e+00
  795   2.4536415e+01    1.0000000e+00    0.0000000e+00
  796   1.8720481e+01    1.0000000e+00    0.0000000e+00
  797   1.3314998e+03    1.0000000e+00    0.0000000e+00
  798   1.2918868e+03    1.0000000e+00    0.0000000e+00
  799   1.2832099e-01    2.1213203e+00    0.0000000e+00
  800   8.2302052e+00    1.0000000e+00    0.0000000e+00
  801   3.4929722e+01    1.0000000e+00    0.0000000e+00
  802   6.2398295e+01    1.0000000e+00    0.0000000e+00
  803   4.0829793e+03    1.0000000e+00    0.0000000e+00
  804   2.7378259e+03    1.0000000e+00    0.0000000e+00
  805   7.9613446e+00    1.0000000e+00    0.0000000e+00
  806   3.1833571e+00    1.0000000e+00    0.0000000e+00
  807   1.3265756e+02    1.0000000e+00    0.0000000e+00
  808   1.3769804e+02    1.0000000e+00    0.0000000e+00
  809   5.2296076e+03    1.0000000e+00    0.0000000e+00
  810   5.2639388e+03    1.0000000e+00    0.0000000e+00
  811   6.0059911e-02    1.3838494e+00    0.0000000e+00
  812   5.5106520e+00    1.0000000e+00    0.0000000e+00
  813   2.5292297e+01    1.0000000e+00    0.0000000e+00
  814   1.7926443e+01    1.0000000e+00    0.0000000e+00
  815   1.4539261e+03    1.0000000e+00    0.0000000e+00
  816   1.1656048e+03    1.0000000e+00    0.0000000e+00
  817   3.7486878e-02    2.0757740e+00    0.0000000e+00
  818   8.3185809e+00    1.0000000e+00    0.0000000e+00
  819   4.1825490e+01    1.0000000e+00    0.0000000e+00
  820   5.5416674e+01    1.0000000e+00    0.0000000e+00
  821   4.2602472e+03    1.0000000e+00    0.0000000e+00
  822   2.5505331e+03    1.0000000e+00    0.0000000e+00
  823   7.9326351e+00    1.0000000e+00    0.0000000e+00
  824   3.2087886e+00    1.0000000e+00    0.0000000e+00
  825   1.3186669e+02    1.0000000e+00    0.0000000e+00
  826   1.3825043e+02    1.0000000e+00    0.0000000e+00
  827   5.1141226e+03    1.0000000e+00    0.0000000e+00
  828   5.3640011e+03    1.0000000e+00    0.0000000e+00
  829   9.2212655e-02    1.3565684e+00    0.0000000e+00
  830   5.4669353e+00    1.0000000e+00    0.0000000e+00
  831   2.4802954e+01    1.0000000e+00    0.0000000e+00
  832   1.8147199e+01    1.0000000e+00    0.0000000e+00
  833   1.5642940e+03    1.0000000e+00    0.0000000e+00
  834   1.0281609e+03    1.0000000e+00    0.0000000e+00
  835   6.4979451e-04    2.0348526e+00    0.0000000e+00
  836   8.3380722e+00    1.0000000e+00    0.0000000e+00
  837   4.6581409e+01    1.0000000e+00    0.0000000e+00
  838   5.0056434e+01    1.0000000e+00    0.0000000e+00
  839   4.3825616e+03    1.0000000e+00    0.0000000e+00
  840   2.3578213e+03    1.0000000e+00    0.0000000e+00
  841   7.8881945e+00    1.0000000e+00    0.0000000e+00
  842   3.2301015e+00    1.0000000e+00    0.0000000e+00
  843   1.3133507e+02    1.0000000e+00    0.0000000e+00
  844   1.3710339e+02    1.0000000e+00    0.0000000e+00
  845   4.9525855e+03    1.0000000e+00    0.0000000e+00
  846   5.4172342e+03    1.0000000e+00    0.0000000e+00
  847   1.1566279e-01    1.3838494e+00    0.0000000e+00
  848   5.4014072e+00    1.0000000e+00    0.0000000e+00
  849   2.2862312e+01    1.0000000e+00    0.0000000e+00
  850   1.9119916e+01    1.0000000e+00    0.0000000e+00
  851   1.6309102e+03    1.0000000e+00    0.0000000e+00
  852   8.6490551e+02    1.0000000e+00    0.0000000e+00
  853   0.0000000e+00    2.0757740e+00    2.4870530e-02
  854   8.2756050e+00    1.0000000e+00    0.0000000e+00
  855   4.8452906e+01    1.0000000e+00    0.0000000e+00
  856   4.6007107e+01    1.0000000e+00    0.0000000e+00
  857   4.3876309e+03    1.0000000e+00    0.0000000e+00
  858   2.1014898e+03    1.0000000e+00    0.0000000e+00
  859   7.8075592e+00    1.0000000e+00    0.0000000e+00
  860   3.2265807e+00    1.0000000e+00    0.0000000e+00
  861   1.2957276e+02    1.0000000e+00    0.0000000e+00
  862   1.3281617e+02    1.0000000e+00    0.0000000e+00
  863   4.6596960e+03    1.0000000e+00    0.0000000e+00
  864   5.3235667e+03    1.0000000e+00    0.0000000e+00
  865   1.1994436e-01    1.4142136e+00    0.0000000e+00
  866   5.3039444e+00    1.0000000e+00    0.0000000e+00
  867   1.9292287e+01    1.0000000e+00    0.0000000e+00
  868   2.0598473e+01    1.0000000e+00    0.0000000e+00
  869   1.6170753e+03    1.0000000e+00    0.0000000e+00
  870   6.7497374e+02    1.0000000e+00    0.0000000e+00
  871   1.6075805e-02    2.1213203e+00    0.0000000e+00
  872   8.1197573e+00    1.0000000e+00    0.0000000e+00
  873   4.6825181e+01    1.0000000e+00    0.0000000e+00
  874   4.2929031e+01    1.0000000e+00    0.0000000e+00
  875   4.2096615e+03    1.0000000e+00    0.0000000e+00
  876   1.7496659e+03    1.0000000e+00    0.0000000e+00
  877   7.6702887e+00    1.0000000e+00    0.0000000e+00
  878   3.1774887e+00    1.0000000e+00    0.0000000e+00
  879   1.2522464e+02    1.0000000e+00    0.0000000e+00
  880   1.2409261e+02    1.0000000e+00    0.0000000e+00
  881   4.1758540e+03    1.0000000e+00    0.0000000e+00
  882   4.9923420e+03    1.0000000e+00    0.0000000e+00
  883   9.8704174e-02    1.3838494e+00    0.0000000e+00
  884   5.1685892e+00    1.0000000e+00    0.0000000e+00
  885   1.5331039e+01    1.0000000e+00    0.0000000e+00
  886   2.1203407e+01    1.0000000e+00    0.0000000e+00
  887   1.2514398e+03    1.0000000e+00    0.0000000e+00
  888   7.2829761e+02    1.0000000e+00    0.0000000e+00
  889   3.4219644e-02    2.0757740e+00    0.0000000e+00
  890   7.8667204e+00    1.0000000e+00    0.0000000e+00
  891   4.3464130e+01    1.0000000e+00    0.0000000e+00
  892   3.8738374e+01    1.0000000e+00    0.0000000e+00
  893   3.4301597e+03    1.0000000e+00    0.0000000e+00
  894   1.7171575e+03    1.0000000e+00    0.0000000e+00
  895   7.4642435e+00    1.0000000e+00    0.0000000e+00
  896   3.0703432e+00    1.0000000e+00    0.0000000e+00
  897   1.1671484e+02    1.0000000e+00    0.0000000e+00
  898   1.1162545e+02    1.0000000e+00    0.0000000e+00
  899   3.7327798e+03    1.0000000e+00    0.0000000e+00
  900   4.1861697e+03    1.0000000e+00    0.0000000e+00
  901   6.2119280e-02    1.3565684e+00    0.0000000e+00