robotaxx.pro~orig

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

  428   2.4526157e+00    1.0000000e+00    0.0000000e+00
  429   5.8776329e+01    1.0000000e+00    0.0000000e+00
  430   4.8055594e+01    1.0000000e+00    0.0000000e+00
  431   1.1675699e+03    1.0000000e+00    0.0000000e+00
  432   1.0653085e+03    1.0000000e+00    0.0000000e+00
  433   9.3239883e-02    1.4142136e+00    0.0000000e+00
  434   4.0622399e+00    1.0000000e+00    0.0000000e+00
  435   4.5521290e+00    1.0000000e+00    0.0000000e+00
  436   1.3387090e+01    1.0000000e+00    0.0000000e+00
  437   2.0346784e+02    1.0000000e+00    0.0000000e+00
  438   4.0156076e+02    1.0000000e+00    0.0000000e+00
  439   5.3562432e+00    1.0000000e+00    0.0000000e+00
  440   8.7697647e-01    1.0000000e+00    0.0000000e+00
  441   1.1236860e+01    1.0000000e+00    0.0000000e+00
  442   2.9126382e+01    1.0000000e+00    0.0000000e+00
  443   7.1183444e+02    1.0000000e+00    0.0000000e+00
  444   8.6123993e+02    1.0000000e+00    0.0000000e+00
  445   5.8753798e+00    1.0000000e+00    0.0000000e+00
  446   2.4355798e+00    1.0000000e+00    0.0000000e+00
  447   5.9888541e+01    1.0000000e+00    0.0000000e+00
  448   5.2231575e+01    1.0000000e+00    0.0000000e+00
  449   1.2958975e+03    1.0000000e+00    0.0000000e+00
  450   1.1242169e+03    1.0000000e+00    0.0000000e+00
  451   5.4255583e-02    1.3838494e+00    0.0000000e+00
  452   4.2084609e+00    1.0000000e+00    0.0000000e+00
  453   7.1987166e+00    1.0000000e+00    0.0000000e+00
  454   1.2165474e+01    1.0000000e+00    0.0000000e+00
  455   2.6922008e+02    1.0000000e+00    0.0000000e+00
  456   4.1801021e+02    1.0000000e+00    0.0000000e+00
  457   5.3543995e+00    1.0000000e+00    0.0000000e+00
  458   1.0396752e+00    1.0000000e+00    0.0000000e+00
  459   7.4671802e+00    1.0000000e+00    0.0000000e+00
  460   3.6102249e+01    1.0000000e+00    0.0000000e+00
  461   8.0628555e+02    1.0000000e+00    0.0000000e+00
  462   9.8051320e+02    1.0000000e+00    0.0000000e+00
  463   6.0628721e+00    1.0000000e+00    0.0000000e+00
  464   2.4625608e+00    1.0000000e+00    0.0000000e+00
  465   6.2665358e+01    1.0000000e+00    0.0000000e+00
  466   5.8360835e+01    1.0000000e+00    0.0000000e+00
  467   1.4389363e+03    1.0000000e+00    0.0000000e+00
  468   1.3099849e+03    1.0000000e+00    0.0000000e+00
  469   3.6663406e-02    1.3565684e+00    0.0000000e+00
  470   4.3679486e+00    1.0000000e+00    0.0000000e+00
  471   9.8245902e+00    1.0000000e+00    0.0000000e+00
  472   1.1538446e+01    1.0000000e+00    0.0000000e+00
  473   3.5311016e+02    1.0000000e+00    0.0000000e+00
  474   4.5637393e+02    1.0000000e+00    0.0000000e+00
  475   5.3341813e+00    1.0000000e+00    0.0000000e+00
  476   1.2727366e+00    1.0000000e+00    0.0000000e+00
  477   4.5278563e+00    1.0000000e+00    0.0000000e+00
  478   4.3538975e+01    1.0000000e+00    0.0000000e+00
  479   9.6325707e+02    1.0000000e+00    0.0000000e+00
  480   1.1414016e+03    1.0000000e+00    0.0000000e+00
  481   6.2815022e+00    1.0000000e+00    0.0000000e+00
  482   2.5277217e+00    1.0000000e+00    0.0000000e+00
  483   6.7502158e+01    1.0000000e+00    0.0000000e+00
  484   6.6016817e+01    1.0000000e+00    0.0000000e+00
  485   1.6637158e+03    1.0000000e+00    0.0000000e+00
  486   1.5742206e+03    1.0000000e+00    0.0000000e+00
  487   3.5855269e-02    1.3838494e+00    0.0000000e+00
  488   4.5353301e+00    1.0000000e+00    0.0000000e+00
  489   1.2366187e+01    1.0000000e+00    0.0000000e+00
  490   1.1513384e+01    1.0000000e+00    0.0000000e+00
  491   4.6248295e+02    1.0000000e+00    0.0000000e+00
  492   5.1208971e+02    1.0000000e+00    0.0000000e+00
  493   5.2861987e+00    1.0000000e+00    0.0000000e+00
  494   1.5705794e+00    1.0000000e+00    0.0000000e+00
  495   2.3836836e+00    1.0000000e+00    0.0000000e+00
  496   5.1345350e+01    1.0000000e+00    0.0000000e+00
  497   1.1805830e+03    1.0000000e+00    0.0000000e+00
  498   1.3533059e+03    1.0000000e+00    0.0000000e+00
  499   6.5209578e+00    1.0000000e+00    0.0000000e+00
  500   2.6214130e+00    1.0000000e+00    0.0000000e+00
  501   7.4254110e+01    1.0000000e+00    0.0000000e+00
  502   7.4993206e+01    1.0000000e+00    0.0000000e+00
  503   1.9706416e+03    1.0000000e+00    0.0000000e+00
  504   1.9276491e+03    1.0000000e+00    0.0000000e+00
  505   4.7196725e-02    1.4142136e+00    0.0000000e+00
  506   4.7052592e+00    1.0000000e+00    0.0000000e+00
  507   1.4750311e+01    1.0000000e+00    0.0000000e+00
  508   1.2084239e+01    1.0000000e+00    0.0000000e+00
  509   6.0254597e+02    1.0000000e+00    0.0000000e+00
  510   5.8120555e+02    1.0000000e+00    0.0000000e+00
  511   5.2021854e+00    1.0000000e+00    0.0000000e+00
  512   1.9264985e+00    1.0000000e+00    0.0000000e+00
  513   9.8092413e-01    1.0000000e+00    0.0000000e+00
  514   5.9396812e+01    1.0000000e+00    0.0000000e+00
  515   1.4567890e+03    1.0000000e+00    0.0000000e+00
  516   1.6209649e+03    1.0000000e+00    0.0000000e+00
  517   6.7709497e+00    1.0000000e+00    0.0000000e+00
  518   2.7339622e+00    1.0000000e+00    0.0000000e+00
  519   8.2702670e+01    1.0000000e+00    0.0000000e+00
  520   8.5013265e+01    1.0000000e+00    0.0000000e+00
  521   2.3582555e+03    1.0000000e+00    0.0000000e+00
  522   2.3767505e+03    1.0000000e+00    0.0000000e+00
  523   6.6019676e-02    1.3838494e+00    0.0000000e+00
  524   4.8724086e+00    1.0000000e+00    0.0000000e+00
  525   1.6884012e+01    1.0000000e+00    0.0000000e+00
  526   1.3225676e+01    1.0000000e+00    0.0000000e+00
  527   7.7524193e+02    1.0000000e+00    0.0000000e+00
  528   6.5897154e+02    1.0000000e+00    0.0000000e+00
  529   5.0751642e+00    1.0000000e+00    0.0000000e+00
  530   2.3324782e+00    1.0000000e+00    0.0000000e+00
  531   2.3222272e-01    4.8828681e+01    0.0000000e+00
  532   6.7514576e+01    1.0000000e+00    0.0000000e+00
  533   1.7872164e+03    1.0000000e+00    0.0000000e+00
  534   1.9417387e+03    1.0000000e+00    0.0000000e+00
  535   7.0211968e+00    1.0000000e+00    0.0000000e+00
  536   2.8556597e+00    1.0000000e+00    0.0000000e+00
  537   9.2507497e+01    1.0000000e+00    0.0000000e+00
  538   9.5678055e+01    1.0000000e+00    0.0000000e+00
  539   2.8180431e+03    1.0000000e+00    0.0000000e+00
  540   2.9188108e+03    1.0000000e+00    0.0000000e+00
  541   8.7600533e-02    1.3565684e+00    0.0000000e+00
  542   5.0314482e+00    1.0000000e+00    0.0000000e+00
  543   1.8650508e+01    1.0000000e+00    0.0000000e+00
  544   1.4885225e+01    1.0000000e+00    0.0000000e+00
  545   9.7640578e+02    1.0000000e+00    0.0000000e+00
  546   7.3998575e+02    1.0000000e+00    0.0000000e+00
  547   4.8995490e+00    1.0000000e+00    0.0000000e+00
  548   2.7790241e+00    1.0000000e+00    0.0000000e+00
  549   1.0498535e-07    4.6103167e+01    1.1626219e-03
  550   7.5455398e+01    1.0000000e+00    0.0000000e+00
  551   2.1607894e+03    1.0000000e+00    0.0000000e+00
  552   2.3018285e+03    1.0000000e+00    0.0000000e+00
  553   7.2613827e+00    1.0000000e+00    0.0000000e+00
  554   2.9767147e+00    1.0000000e+00    0.0000000e+00
  555   1.0316754e+02    1.0000000e+00    0.0000000e+00
  556   1.0643079e+02    1.0000000e+00    0.0000000e+00
  557   3.3303344e+03    1.0000000e+00    0.0000000e+00
  558   3.5352317e+03    1.0000000e+00    0.0000000e+00
  559   1.0718206e-01    1.3838494e+00    0.0000000e+00
  560   5.1770671e+00    1.0000000e+00    0.0000000e+00
  561   1.9909330e+01    1.0000000e+00    0.0000000e+00
  562   1.6979074e+01    1.0000000e+00    0.0000000e+00
  563   1.1955299e+03    1.0000000e+00    0.0000000e+00
  564   8.1627785e+02    1.0000000e+00    0.0000000e+00
  565   4.6712591e+00    1.0000000e+00    0.0000000e+00
  566   3.2551146e+00    1.0000000e+00    0.0000000e+00
  567   8.6048203e-02    4.4917524e+01    0.0000000e+00
  568   8.2912860e+01    1.0000000e+00    0.0000000e+00
  569   2.5555203e+03    1.0000000e+00    0.0000000e+00
  570   2.6751797e+03    1.0000000e+00    0.0000000e+00
  571   7.4811993e+00    1.0000000e+00    0.0000000e+00
  572   3.0872990e+00    1.0000000e+00    0.0000000e+00
  573   1.1400648e+02    1.0000000e+00    0.0000000e+00
  574   1.1654604e+02    1.0000000e+00    0.0000000e+00
  575   3.8592729e+03    1.0000000e+00    0.0000000e+00
  576   4.1879579e+03    1.0000000e+00    0.0000000e+00
  577   1.1998064e-01    1.4142136e+00    0.0000000e+00
  578   5.3039806e+00    1.0000000e+00    0.0000000e+00
  579   2.0496347e+01    1.0000000e+00    0.0000000e+00
  580   1.9396014e+01    1.0000000e+00    0.0000000e+00
  581   1.4147875e+03    1.0000000e+00    0.0000000e+00
  582   8.7741485e+02    1.0000000e+00    0.0000000e+00
  583   4.3877456e+00    1.0000000e+00    0.0000000e+00
  584   3.7481963e+00    1.0000000e+00    0.0000000e+00
  585   2.2908387e-01    4.7553144e+01    0.0000000e+00
  586   8.9528730e+01    1.0000000e+00    0.0000000e+00
  587   2.9363206e+03    1.0000000e+00    0.0000000e+00
  588   3.0234054e+03    1.0000000e+00    0.0000000e+00
  589   7.6703613e+00    1.0000000e+00    0.0000000e+00
  590   3.1775613e+00    1.0000000e+00    0.0000000e+00
  591   1.2418682e+02    1.0000000e+00    0.0000000e+00
  592   1.2514044e+02    1.0000000e+00    0.0000000e+00
  593   4.3515432e+03    1.0000000e+00    0.0000000e+00
  594   4.8172661e+03    1.0000000e+00    0.0000000e+00
  595   1.2238147e-01    1.3838494e+00    0.0000000e+00
  596   5.4081259e+00    1.0000000e+00    0.0000000e+00
  597   2.0634837e+01    1.0000000e+00    0.0000000e+00
  598   2.1654894e+01    1.0000000e+00    0.0000000e+00
  599   1.5269568e+03    1.0000000e+00    0.0000000e+00
  600   9.9940121e+02    1.0000000e+00    0.0000000e+00
  601   4.0497249e+00    1.0000000e+00    0.0000000e+00
  602   4.2460361e+00    1.0000000e+00    0.0000000e+00
  603   1.6354268e-01    4.7463820e+01    0.0000000e+00
  604   9.4988352e+01    1.0000000e+00    0.0000000e+00
  605   3.2794912e+03    1.0000000e+00    0.0000000e+00
  606   3.2890398e+03    1.0000000e+00    0.0000000e+00
  607   7.8209965e+00    1.0000000e+00    0.0000000e+00
  608   3.2400181e+00    1.0000000e+00    0.0000000e+00
  609   1.3259743e+02    1.0000000e+00    0.0000000e+00
  610   1.3171338e+02    1.0000000e+00    0.0000000e+00
  611   4.8241087e+03    1.0000000e+00    0.0000000e+00
  612   5.2813236e+03    1.0000000e+00    0.0000000e+00
  613   1.1552398e-01    1.3565684e+00    0.0000000e+00
  614   5.4902466e+00    1.0000000e+00    0.0000000e+00
  615   2.0677565e+01    1.0000000e+00    0.0000000e+00
  616   2.3362300e+01    1.0000000e+00    0.0000000e+00
  617   1.6015884e+03    1.0000000e+00    0.0000000e+00
  618   1.1014154e+03    1.0000000e+00    0.0000000e+00
  619   3.6664196e+00    1.0000000e+00    0.0000000e+00
  620   4.7422363e+00    1.0000000e+00    0.0000000e+00
  621   1.3704212e-07    4.8617488e+01    1.1473108e-03
  622   9.9089696e+01    1.0000000e+00    0.0000000e+00
  623   3.5650282e+03    1.0000000e+00    0.0000000e+00
  624   3.4627818e+03    1.0000000e+00    0.0000000e+00
  625   7.9348171e+00    1.0000000e+00    0.0000000e+00
  626   3.2767241e+00    1.0000000e+00    0.0000000e+00
  627   1.3878796e+02    1.0000000e+00    0.0000000e+00
  628   1.3646119e+02    1.0000000e+00    0.0000000e+00
  629   5.1892660e+03    1.0000000e+00    0.0000000e+00
  630   5.6227493e+03    1.0000000e+00    0.0000000e+00
  631   1.0171641e-01    1.3838494e+00    0.0000000e+00
  632   5.5523085e+00    1.0000000e+00    0.0000000e+00
  633   2.0651825e+01    1.0000000e+00    0.0000000e+00
  634   2.4535138e+01    1.0000000e+00    0.0000000e+00
  635   1.6407208e+03    1.0000000e+00    0.0000000e+00
  636   1.1806400e+03    1.0000000e+00    0.0000000e+00
  637   3.2499662e+00    1.0000000e+00    0.0000000e+00
  638   5.2310711e+00    1.0000000e+00    0.0000000e+00
  639   5.5515798e-08    5.3679275e+01    5.4817745e-06
  640   1.0167067e+02    1.0000000e+00    0.0000000e+00
  641   3.7885509e+03    1.0000000e+00    0.0000000e+00
  642   3.5469870e+03    1.0000000e+00    0.0000000e+00
  643   8.0159481e+00    1.0000000e+00    0.0000000e+00
  644   3.2921016e+00    1.0000000e+00    0.0000000e+00
  645   1.4289203e+02    1.0000000e+00    0.0000000e+00
  646   1.3952649e+02    1.0000000e+00    0.0000000e+00
  647   5.4433531e+03    1.0000000e+00    0.0000000e+00
  648   5.8420898e+03    1.0000000e+00    0.0000000e+00
  649   8.3240626e-02    1.4142136e+00    0.0000000e+00
  650   5.5963031e+00    1.0000000e+00    0.0000000e+00
  651   2.0596691e+01    1.0000000e+00    0.0000000e+00
  652   2.5204878e+01    1.0000000e+00    0.0000000e+00
  653   1.6485720e+03    1.0000000e+00    0.0000000e+00
  654   1.2370357e+03    1.0000000e+00    0.0000000e+00
  655   2.8133366e+00    1.0000000e+00    0.0000000e+00
  656   5.7059791e+00    1.0000000e+00    0.0000000e+00
  657   4.1455591e-01    5.5230119e+01    0.0000000e+00
  658   1.0263897e+02    1.0000000e+00    0.0000000e+00
  659   3.9516426e+03    1.0000000e+00    0.0000000e+00
  660   3.5509376e+03    1.0000000e+00    0.0000000e+00
  661   8.0685375e+00    1.0000000e+00    0.0000000e+00
  662   3.2905500e+00    1.0000000e+00    0.0000000e+00
  663   1.4512678e+02    1.0000000e+00    0.0000000e+00
  664   1.4113302e+02    1.0000000e+00    0.0000000e+00