robotcxx.pro~orig

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

  428   3.3669194e+00    1.0000000e+00    0.0000000e+00
  429   1.0382831e+02    1.0000000e+00    0.0000000e+00
  430   9.1882537e+01    1.0000000e+00    0.0000000e+00
  431   3.6633493e+02    1.0000000e+00    0.0000000e+00
  432   2.4609278e+02    1.0000000e+00    0.0000000e+00
  433   5.6483413e-01    1.0000000e+00    0.0000000e+00
  434   4.5338341e+00    1.0000000e+00    0.0000000e+00
  435   1.1460444e+01    1.0000000e+00    0.0000000e+00
  436   2.1676334e+01    1.0000000e+00    0.0000000e+00
  437  -4.2632564e-14    2.6149232e+03    7.3860762e-05
  438   1.6824952e+02    1.0000000e+00    0.0000000e+00
  439   6.0636345e+00    1.0000000e+00    0.0000000e+00
  440   1.5843678e+00    1.0000000e+00    0.0000000e+00
  441   2.5951552e+01    1.0000000e+00    0.0000000e+00
  442   4.8606198e+01    1.0000000e+00    0.0000000e+00
  443   4.0987095e+01    2.7511477e+03    0.0000000e+00
  444   3.9646165e+02    1.0000000e+00    0.0000000e+00
  445   6.8185683e+00    1.0000000e+00    0.0000000e+00
  446   3.3787683e+00    1.0000000e+00    0.0000000e+00
  447   1.0797932e+02    1.0000000e+00    0.0000000e+00
  448   9.9125545e+01    1.0000000e+00    0.0000000e+00
  449   4.0940716e+02    1.0000000e+00    0.0000000e+00
  450   2.6359091e+02    1.0000000e+00    0.0000000e+00
  451   5.3855317e-01    1.0000000e+00    0.0000000e+00
  452   4.6927585e+00    1.0000000e+00    0.0000000e+00
  453   1.4657209e+01    1.0000000e+00    0.0000000e+00
  454   2.1133623e+01    1.0000000e+00    0.0000000e+00
  455   2.3159999e+01    1.8642553e+03    0.0000000e+00
  456   1.6814355e+02    1.0000000e+00    0.0000000e+00
  457   6.0808459e+00    1.0000000e+00    0.0000000e+00
  458   1.7661216e+00    1.0000000e+00    0.0000000e+00
  459   2.2891757e+01    1.0000000e+00    0.0000000e+00
  460   5.7637614e+01    1.0000000e+00    0.0000000e+00
  461   7.0705872e+01    2.2809331e+03    0.0000000e+00
  462   4.2668335e+02    1.0000000e+00    0.0000000e+00
  463   7.0314673e+00    1.0000000e+00    0.0000000e+00
  464   3.4311560e+00    1.0000000e+00    0.0000000e+00
  465   1.1465280e+02    1.0000000e+00    0.0000000e+00
  466   1.0903990e+02    1.0000000e+00    0.0000000e+00
  467   4.4543329e+02    1.0000000e+00    0.0000000e+00
  468   3.1978089e+02    1.0000000e+00    0.0000000e+00
  469   5.3315309e-01    1.0000000e+00    0.0000000e+00
  470   4.8644382e+00    1.0000000e+00    0.0000000e+00
  471   1.8187575e+01    1.0000000e+00    0.0000000e+00
  472   2.1125771e+01    1.0000000e+00    0.0000000e+00
  473   4.6624145e+01    1.0000000e+00    0.0000000e+00
  474   1.7707795e+02    1.0000000e+00    0.0000000e+00
  475   6.0789158e+00    1.0000000e+00    0.0000000e+00
  476   2.0174712e+00    1.0000000e+00    0.0000000e+00
  477   2.0717486e+01    1.0000000e+00    0.0000000e+00
  478   6.7737542e+01    1.0000000e+00    0.0000000e+00
  479   1.3106544e+02    1.8981479e+03    0.0000000e+00
  480   4.5056000e+02    1.0000000e+00    0.0000000e+00
  481   7.2744816e+00    1.0000000e+00    0.0000000e+00
  482   3.5207011e+00    1.0000000e+00    0.0000000e+00
  483   1.2412742e+02    1.0000000e+00    0.0000000e+00
  484   1.2158099e+02    1.0000000e+00    0.0000000e+00
  485   5.0393417e+02    1.0000000e+00    0.0000000e+00
  486   3.9087421e+02    1.0000000e+00    0.0000000e+00
  487   5.4642489e-01    1.0000000e+00    0.0000000e+00
  488   5.0458997e+00    1.0000000e+00    0.0000000e+00
  489   2.2042622e+01    1.0000000e+00    0.0000000e+00
  490   2.1681100e+01    1.0000000e+00    0.0000000e+00
  491   7.4264978e+01    2.0281455e+03    0.0000000e+00
  492   1.9280921e+02    1.0000000e+00    0.0000000e+00
  493   6.0520531e+00    1.0000000e+00    0.0000000e+00
  494   2.3364338e+00    1.0000000e+00    0.0000000e+00
  495   1.9521182e+01    1.0000000e+00    0.0000000e+00
  496   7.8857193e+01    1.0000000e+00    0.0000000e+00
  497   2.2281386e+02    1.7089189e+03    0.0000000e+00
  498   4.7157903e+02    1.0000000e+00    0.0000000e+00
  499   7.5420971e+00    1.0000000e+00    0.0000000e+00
  500   3.6425522e+00    1.0000000e+00    0.0000000e+00
  501   1.3647997e+02    1.0000000e+00    0.0000000e+00
  502   1.3679329e+02    1.0000000e+00    0.0000000e+00
  503   5.8551754e+02    1.0000000e+00    0.0000000e+00
  504   4.8277921e+02    1.0000000e+00    0.0000000e+00
  505   5.7613318e-01    1.0000000e+00    0.0000000e+00
  506   5.2341957e+00    1.0000000e+00    0.0000000e+00
  507   2.6213334e+01    1.0000000e+00    0.0000000e+00
  508   2.2825727e+01    1.0000000e+00    0.0000000e+00
  509   1.0991495e+02    3.6459892e+03    0.0000000e+00
  510   2.1343560e+02    3.1868755e+03    0.0000000e+00
  511   5.9955901e+00    1.0000000e+00    0.0000000e+00
  512   2.7199032e+00    1.0000000e+00    0.0000000e+00
  513   1.9414422e+01    1.0000000e+00    0.0000000e+00
  514   9.0923466e+01    1.0000000e+00    0.0000000e+00
  515   3.4812218e+02    2.9663389e+03    0.0000000e+00
  516   4.9258927e+02    1.0000000e+00    0.0000000e+00
  517   7.8288226e+00    1.0000000e+00    0.0000000e+00
  518   3.7918351e+00    1.0000000e+00    0.0000000e+00
  519   1.5177910e+02    1.0000000e+00    0.0000000e+00
  520   1.5471503e+02    1.0000000e+00    0.0000000e+00
  521   6.9156006e+02    1.0000000e+00    0.0000000e+00
  522   6.0184217e+02    1.0000000e+00    0.0000000e+00
  523   6.1948012e-01    1.0000000e+00    0.0000000e+00
  524   5.4258690e+00    1.0000000e+00    0.0000000e+00
  525   3.0517238e+01    1.0000000e+00    0.0000000e+00
  526   2.4716467e+01    1.0000000e+00    0.0000000e+00
  527   1.9718207e+02    1.0000000e+00    0.0000000e+00
  528   1.9707273e+02    2.3663490e+03    0.0000000e+00
  529   5.9053549e+00    1.0000000e+00    0.0000000e+00
  530   3.1626689e+00    1.0000000e+00    0.0000000e+00
  531   2.0578947e+01    1.0000000e+00    0.0000000e+00
  532   1.0369689e+02    1.0000000e+00    0.0000000e+00
  533   4.7937172e+02    2.7818890e+03    0.0000000e+00
  534   5.4569077e+02    1.0000000e+00    0.0000000e+00
  535   8.1281177e+00    1.0000000e+00    0.0000000e+00
  536   3.9625806e+00    1.0000000e+00    0.0000000e+00
  537   1.7009166e+02    1.0000000e+00    0.0000000e+00
  538   1.7511900e+02    1.0000000e+00    0.0000000e+00
  539   7.8846222e+02    1.0000000e+00    0.0000000e+00
  540   7.8855698e+02    1.0000000e+00    0.0000000e+00
  541   6.7149711e-01    1.0000000e+00    0.0000000e+00
  542   5.6153448e+00    1.0000000e+00    0.0000000e+00
  543   3.4679728e+01    1.0000000e+00    0.0000000e+00
  544   2.7441156e+01    1.0000000e+00    0.0000000e+00
  545   3.0976262e+02    1.0000000e+00    0.0000000e+00
  546   1.6978610e+02    1.6162870e+03    0.0000000e+00
  547   5.7753938e+00    1.0000000e+00    0.0000000e+00
  548   3.6548690e+00    1.0000000e+00    0.0000000e+00
  549   2.2990917e+01    1.0000000e+00    0.0000000e+00
  550   1.1678107e+02    1.0000000e+00    0.0000000e+00
  551   6.3543659e+02    1.0000000e+00    0.0000000e+00
  552   6.1139008e+02    1.0000000e+00    0.0000000e+00
  553   8.4291759e+00    1.0000000e+00    0.0000000e+00
  554   4.1445079e+00    1.0000000e+00    0.0000000e+00
  555   1.9099105e+02    1.0000000e+00    0.0000000e+00
  556   1.9726447e+02    1.0000000e+00    0.0000000e+00
  557   8.9844094e+02    1.0000000e+00    0.0000000e+00
  558   1.0197539e+03    1.0000000e+00    0.0000000e+00
  559   7.2665309e-01    1.0000000e+00    0.0000000e+00
  560   5.7965381e+00    1.0000000e+00    0.0000000e+00
  561   3.8514867e+01    1.0000000e+00    0.0000000e+00
  562   3.0878879e+01    1.0000000e+00    0.0000000e+00
  563   4.4805040e+02    1.0000000e+00    0.0000000e+00
  564   1.2867700e+02    1.0000000e+00    0.0000000e+00
  565   5.6004657e+00    1.0000000e+00    0.0000000e+00
  566   4.1843211e+00    1.0000000e+00    0.0000000e+00
  567   2.6383533e+01    1.0000000e+00    0.0000000e+00
  568   1.2975240e+02    1.0000000e+00    0.0000000e+00
  569   8.1505242e+02    1.0000000e+00    0.0000000e+00
  570   6.8443883e+02    1.0000000e+00    0.0000000e+00
  571   8.7201414e+00    1.0000000e+00    0.0000000e+00
  572   4.3262410e+00    1.0000000e+00    0.0000000e+00
  573   2.1354653e+02    1.0000000e+00    0.0000000e+00
  574   2.2016438e+02    1.0000000e+00    0.0000000e+00
  575   1.0150597e+03    1.0000000e+00    0.0000000e+00
  576   1.2918499e+03    1.0000000e+00    0.0000000e+00
  577   7.7939062e-01    1.0000000e+00    0.0000000e+00
  578   5.9633906e+00    1.0000000e+00    0.0000000e+00
  579   4.1786375e+01    1.0000000e+00    0.0000000e+00
  580   3.4853929e+01    1.0000000e+00    0.0000000e+00
  581   6.0805239e+02    1.0000000e+00    0.0000000e+00
  582   7.2506009e+01    4.0591825e+03    0.0000000e+00
  583   5.3768606e+00    1.0000000e+00    0.0000000e+00
  584   4.7373113e+00    1.0000000e+00    0.0000000e+00
  585   3.0370798e+01    1.0000000e+00    0.0000000e+00
  586   1.4206989e+02    1.0000000e+00    0.0000000e+00
  587   1.0140985e+03    1.0000000e+00    0.0000000e+00
  588   7.5535332e+02    1.0000000e+00    0.0000000e+00
  589   8.9891812e+00    1.0000000e+00    0.0000000e+00
  590   4.4963812e+00    1.0000000e+00    0.0000000e+00
  591   2.3649689e+02    1.0000000e+00    0.0000000e+00
  592   2.4250501e+02    1.0000000e+00    0.0000000e+00
  593   1.1290467e+03    1.0000000e+00    0.0000000e+00
  594   1.5931869e+03    1.0000000e+00    0.0000000e+00
  595   8.2475652e-01    1.0000000e+00    0.0000000e+00
  596   6.1105009e+00    1.0000000e+00    0.0000000e+00
  597   4.4431053e+01    1.0000000e+00    0.0000000e+00
  598   3.8961595e+01    1.0000000e+00    0.0000000e+00
  599   7.2323030e+02    1.0000000e+00    0.0000000e+00
  600   6.0168636e+01    2.7428047e+03    0.0000000e+00
  601   5.1032874e+00    1.0000000e+00    0.0000000e+00
  602   5.2995987e+00    1.0000000e+00    0.0000000e+00
  603   3.4486884e+01    1.0000000e+00    0.0000000e+00
  604   1.5314657e+02    1.0000000e+00    0.0000000e+00
  605   1.2354569e+03    1.0000000e+00    0.0000000e+00
  606   8.0138035e+02    1.0000000e+00    0.0000000e+00
  607   9.2257467e+00    1.0000000e+00    0.0000000e+00
  608   4.6447682e+00    1.0000000e+00    0.0000000e+00
  609   2.5823193e+02    1.0000000e+00    0.0000000e+00
  610   2.6297212e+02    1.0000000e+00    0.0000000e+00
  611   1.2794711e+03    1.0000000e+00    0.0000000e+00
  612   1.8541246e+03    1.0000000e+00    0.0000000e+00
  613   8.6029366e-01    1.0000000e+00    0.0000000e+00
  614   6.2350163e+00    1.0000000e+00    0.0000000e+00
  615   4.6456815e+01    1.0000000e+00    0.0000000e+00
  616   4.2843734e+01    1.0000000e+00    0.0000000e+00
  617   8.3379663e+02    1.0000000e+00    0.0000000e+00
  618   4.4268870e+01    1.6413525e+03    0.0000000e+00
  619   4.7835741e+00    1.0000000e+00    0.0000000e+00
  620   5.8593908e+00    1.0000000e+00    0.0000000e+00
  621   3.8455131e+01    1.0000000e+00    0.0000000e+00
  622   1.6247110e+02    1.0000000e+00    0.0000000e+00
  623   1.4662874e+03    1.0000000e+00    0.0000000e+00
  624   8.1668290e+02    1.0000000e+00    0.0000000e+00
  625   9.4243565e+00    1.0000000e+00    0.0000000e+00
  626   4.7662635e+00    1.0000000e+00    0.0000000e+00
  627   2.7749855e+02    1.0000000e+00    0.0000000e+00
  628   2.8062988e+02    1.0000000e+00    0.0000000e+00
  629   1.4140023e+03    1.0000000e+00    0.0000000e+00
  630   2.0982597e+03    1.0000000e+00    0.0000000e+00
  631   8.8414917e-01    1.0000000e+00    0.0000000e+00
  632   6.3347412e+00    1.0000000e+00    0.0000000e+00
  633   4.7696054e+01    1.0000000e+00    0.0000000e+00
  634   4.6352332e+01    1.0000000e+00    0.0000000e+00
  635   9.3300025e+02    1.0000000e+00    0.0000000e+00
  636   2.4242931e+01    2.4848508e+03    0.0000000e+00
  637   4.4236154e+00    1.0000000e+00    0.0000000e+00
  638   6.4047202e+00    1.0000000e+00    0.0000000e+00
  639   4.2044646e+01    1.0000000e+00    0.0000000e+00
  640   1.6956422e+02    1.0000000e+00    0.0000000e+00
  641   1.6921586e+03    1.0000000e+00    0.0000000e+00
  642   7.9667364e+02    1.0000000e+00    0.0000000e+00
  643   9.5808136e+00    1.0000000e+00    0.0000000e+00
  644   4.8569672e+00    1.0000000e+00    0.0000000e+00
  645   2.9331893e+02    1.0000000e+00    0.0000000e+00
  646   2.9448349e+02    1.0000000e+00    0.0000000e+00
  647   1.5206915e+03    1.0000000e+00    0.0000000e+00
  648   2.3082812e+03    1.0000000e+00    0.0000000e+00
  649   8.9444382e-01    1.4142136e+00    0.0000000e+00
  650   6.4075063e+00    1.0000000e+00    0.0000000e+00
  651   4.7987606e+01    1.0000000e+00    0.0000000e+00
  652   4.9344607e+01    1.0000000e+00    0.0000000e+00
  653   1.0135948e+03    1.0000000e+00    0.0000000e+00
  654   8.2194691e-07    4.5523275e+03    2.3784738e-05
  655   4.0301414e+00    1.0000000e+00    0.0000000e+00
  656   6.9227838e+00    1.0000000e+00    0.0000000e+00
  657   4.4984197e+01    1.0000000e+00    0.0000000e+00
  658   1.7401328e+02    1.0000000e+00    0.0000000e+00
  659   1.8957595e+03    1.0000000e+00    0.0000000e+00
  660   7.3958692e+02    1.0000000e+00    0.0000000e+00
  661   9.6909439e+00    1.0000000e+00    0.0000000e+00
  662   4.9129564e+00    1.0000000e+00    0.0000000e+00
  663   3.0475120e+02    1.0000000e+00    0.0000000e+00
  664   3.0357513e+02    1.0000000e+00    0.0000000e+00