robotaxx.pro~orig

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

  902   5.0059669e+00    1.0000000e+00    0.0000000e+00
  903   1.2531004e+01    1.0000000e+00    0.0000000e+00
  904   2.0013075e+01    1.0000000e+00    0.0000000e+00
  905   8.9550055e+02    1.0000000e+00    0.0000000e+00
  906   7.3713789e+02    1.0000000e+00    0.0000000e+00
  907   6.3500637e-02    2.0348526e+00    0.0000000e+00
  908   7.5386287e+00    1.0000000e+00    0.0000000e+00
  909   4.0906911e+01    1.0000000e+00    0.0000000e+00
  910   3.2317267e+01    1.0000000e+00    0.0000000e+00
  911   2.6472820e+03    1.0000000e+00    0.0000000e+00
  912   1.5975780e+03    1.0000000e+00    0.0000000e+00
  913   7.2104202e+00    1.0000000e+00    0.0000000e+00
  914   2.9257522e+00    1.0000000e+00    0.0000000e+00
  915   1.0494248e+02    1.0000000e+00    0.0000000e+00
  916   9.8458018e+01    1.0000000e+00    0.0000000e+00
  917   3.1966531e+03    1.0000000e+00    0.0000000e+00
  918   3.3339007e+03    1.0000000e+00    0.0000000e+00
  919   2.4479498e-02    1.3838494e+00    0.0000000e+00
  920   4.8308684e+00    1.0000000e+00    0.0000000e+00
  921   1.1166066e+01    1.0000000e+00    0.0000000e+00
  922   1.7449417e+01    1.0000000e+00    0.0000000e+00
  923   5.9791874e+02    1.0000000e+00    0.0000000e+00
  924   7.1964557e+02    1.0000000e+00    0.0000000e+00
  925   1.1841409e-01    2.0757740e+00    0.0000000e+00
  926   7.1646078e+00    1.0000000e+00    0.0000000e+00
  927   3.9723052e+01    1.0000000e+00    0.0000000e+00
  928   2.4661784e+01    1.0000000e+00    0.0000000e+00
  929   1.9655359e+03    1.0000000e+00    0.0000000e+00
  930   1.4601313e+03    1.0000000e+00    0.0000000e+00
  931   6.9381164e+00    1.0000000e+00    0.0000000e+00
  932   2.7725794e+00    1.0000000e+00    0.0000000e+00
  933   9.2146168e+01    1.0000000e+00    0.0000000e+00
  934   8.6700598e+01    1.0000000e+00    0.0000000e+00
  935   2.6878769e+03    1.0000000e+00    0.0000000e+00
  936   2.5823803e+03    1.0000000e+00    0.0000000e+00
  937   4.8282436e-05    1.4142136e+00    0.0000000e+00
  938   4.6581108e+00    1.0000000e+00    0.0000000e+00
  939   1.1416040e+01    1.0000000e+00    0.0000000e+00
  940   1.3852663e+01    1.0000000e+00    0.0000000e+00
  941   3.7317664e+02    1.0000000e+00    0.0000000e+00
  942   6.9770536e+02    1.0000000e+00    0.0000000e+00
  943   2.1300768e-01    1.0000000e+00    0.0000000e+00
  944   6.7742309e+00    1.0000000e+00    0.0000000e+00
  945   4.0285876e+01    1.0000000e+00    0.0000000e+00
  946   1.6568706e+01    1.0000000e+00    0.0000000e+00
  947   1.4218219e+03    1.0000000e+00    0.0000000e+00
  948   1.3624713e+03    1.0000000e+00    0.0000000e+00
  949   6.6766528e+00    1.0000000e+00    0.0000000e+00
  950   2.6396653e+00    1.0000000e+00    0.0000000e+00
  951   8.0020567e+01    1.0000000e+00    0.0000000e+00
  952   7.7908827e+01    1.0000000e+00    0.0000000e+00
  953   2.2823931e+03    1.0000000e+00    0.0000000e+00
  954   2.0011349e+03    1.0000000e+00    0.0000000e+00
  955   0.0000000e+00    1.3838494e+00    2.7992325e-02
  956   4.4994749e+00    1.0000000e+00    0.0000000e+00
  957   1.2492447e+01    1.0000000e+00    0.0000000e+00
  958   1.0280828e+01    1.0000000e+00    0.0000000e+00
  959   3.4871471e+02    1.0000000e+00    0.0000000e+00
  960   5.5177591e+02    1.0000000e+00    0.0000000e+00
  961   3.5661265e-01    1.0000000e+00    0.0000000e+00
  962   6.3925996e+00    1.0000000e+00    0.0000000e+00
  963   4.1539314e+01    1.0000000e+00    0.0000000e+00
  964   9.7005552e+00    1.0000000e+00    0.0000000e+00
  965   1.2029062e+03    1.0000000e+00    0.0000000e+00
  966   1.1383694e+03    1.0000000e+00    0.0000000e+00
  967   6.4492473e+00    1.0000000e+00    0.0000000e+00
  968   2.5497024e+00    1.0000000e+00    0.0000000e+00
  969   7.0208117e+01    1.0000000e+00    0.0000000e+00
  970   7.2124854e+01    1.0000000e+00    0.0000000e+00
  971   1.8889744e+03    1.0000000e+00    0.0000000e+00
  972   1.7129881e+03    1.0000000e+00    0.0000000e+00
  973   2.3231771e-02    1.3565684e+00    0.0000000e+00
  974   4.3545169e+00    1.0000000e+00    0.0000000e+00
  975   1.3467481e+01    1.0000000e+00    0.0000000e+00
  976   7.5070613e+00    1.0000000e+00    0.0000000e+00
  977   3.3450049e+02    1.0000000e+00    0.0000000e+00
  978   4.5059808e+02    1.0000000e+00    0.0000000e+00
  979   5.4036102e-01    1.0000000e+00    0.0000000e+00
  980   6.0262620e+00    1.0000000e+00    0.0000000e+00
  981   4.2200957e+01    1.0000000e+00    0.0000000e+00
  982   4.9917633e+00    1.0000000e+00    0.0000000e+00
  983   1.0371628e+03    1.0000000e+00    0.0000000e+00
  984   1.0040935e+03    1.0000000e+00    0.0000000e+00
  985   6.2546389e+00    1.0000000e+00    0.0000000e+00
  986   2.5008585e+00    1.0000000e+00    0.0000000e+00
  987   6.2962596e+01    1.0000000e+00    0.0000000e+00
  988   6.8128293e+01    1.0000000e+00    0.0000000e+00
  989   1.6205061e+03    1.0000000e+00    0.0000000e+00
  990   1.5198882e+03    1.0000000e+00    0.0000000e+00
  991   6.5551630e-02    1.3838494e+00    0.0000000e+00
  992   4.2197570e+00    1.0000000e+00    0.0000000e+00
  993   1.4266936e+01    1.0000000e+00    0.0000000e+00
  994   5.4067763e+00    1.0000000e+00    0.0000000e+00
  995   3.2708089e+02    1.0000000e+00    0.0000000e+00
  996   3.7855482e+02    1.0000000e+00    0.0000000e+00
  997   7.5122843e-01    1.0000000e+00    0.0000000e+00
  998   5.6767344e+00    1.0000000e+00    0.0000000e+00
  999   4.2216077e+01    1.0000000e+00    0.0000000e+00
 1000   2.0497749e+00    1.0000000e+00    0.0000000e+00
 1001   9.1164598e+02    1.0000000e+00    0.0000000e+00
 1002   9.2300687e+02    1.0000000e+00    0.0000000e+00
 1003   6.0854642e+00    1.0000000e+00    0.0000000e+00
 1004   2.4851529e+00    1.0000000e+00    0.0000000e+00
 1005   5.7640948e+01    1.0000000e+00    0.0000000e+00
 1006   6.5319753e+01    1.0000000e+00    0.0000000e+00
 1007   1.4335768e+03    1.0000000e+00    0.0000000e+00
 1008   1.3889661e+03    1.0000000e+00    0.0000000e+00
 1009   1.2274124e-01    1.4142136e+00    0.0000000e+00
 1010   4.0917412e+00    1.0000000e+00    0.0000000e+00
 1011   1.4838846e+01    1.0000000e+00    0.0000000e+00
 1012   3.8754189e+00    1.0000000e+00    0.0000000e+00
 1013   3.2452551e+02    1.0000000e+00    0.0000000e+00
 1014   3.2469363e+02    1.0000000e+00    0.0000000e+00
 1015   9.7684109e-01    1.0000000e+00    0.0000000e+00
 1016   5.3448826e+00    1.0000000e+00    0.0000000e+00
 1017   4.1583237e+01    1.0000000e+00    0.0000000e+00
 1018   5.2385870e-01    1.0000000e+00    0.0000000e+00
 1019   8.1750340e+02    1.0000000e+00    0.0000000e+00
 1020   8.7046636e+02    1.0000000e+00    0.0000000e+00
 1021   5.9343825e+00    1.0000000e+00    0.0000000e+00
 1022   2.4945825e+00    1.0000000e+00    0.0000000e+00
 1023   5.3731259e+01    1.0000000e+00    0.0000000e+00
 1024   6.3232896e+01    1.0000000e+00    0.0000000e+00
 1025   1.2985111e+03    1.0000000e+00    0.0000000e+00
 1026   1.2983654e+03    1.0000000e+00    0.0000000e+00
 1027   1.9099205e-01    1.3838494e+00    0.0000000e+00
 1028   3.9674786e+00    1.0000000e+00    0.0000000e+00
 1029   1.5251966e+01    1.0000000e+00    0.0000000e+00
 1030   2.7260161e+00    1.0000000e+00    0.0000000e+00
 1031   3.0848820e+02    1.0000000e+00    0.0000000e+00
 1032   2.9872089e+02    1.0000000e+00    0.0000000e+00
 1033   1.2062900e+00    1.0000000e+00    0.0000000e+00
 1034   5.0314160e+00    1.0000000e+00    0.0000000e+00
 1035   4.0450459e+01    1.0000000e+00    0.0000000e+00
 1036   3.7303494e-13    4.2677224e+01    7.8506904e-04
 1037   7.2854883e+02    1.0000000e+00    0.0000000e+00
 1038   8.5019480e+02    1.0000000e+00    0.0000000e+00
 1039   5.7949482e+00    1.0000000e+00    0.0000000e+00
 1040   2.5219932e+00    1.0000000e+00    0.0000000e+00
 1041   5.0753282e+01    1.0000000e+00    0.0000000e+00
 1042   6.1609105e+01    1.0000000e+00    0.0000000e+00
 1043   1.2101857e+03    1.0000000e+00    0.0000000e+00
 1044   1.2186507e+03    1.0000000e+00    0.0000000e+00
 1045   2.6821369e-01    1.0000000e+00    0.0000000e+00
 1046   3.8457489e+00    1.0000000e+00    0.0000000e+00
 1047   1.5592585e+01    1.0000000e+00    0.0000000e+00
 1048   1.8142978e+00    1.0000000e+00    0.0000000e+00
 1049   2.9605576e+02    1.0000000e+00    0.0000000e+00
 1050   2.7934671e+02    1.0000000e+00    0.0000000e+00
 1051   1.4321997e+00    1.0000000e+00    0.0000000e+00
 1052   4.7387441e+00    1.0000000e+00    0.0000000e+00
 1053   3.8993792e+01    1.0000000e+00    0.0000000e+00
 1054   1.7169453e-01    3.8952817e+01    0.0000000e+00
 1055   6.5997454e+02    1.0000000e+00    0.0000000e+00
 1056   8.3607185e+02    1.0000000e+00    0.0000000e+00
 1057   5.6642278e+00    1.0000000e+00    0.0000000e+00
 1058   2.5636973e+00    1.0000000e+00    0.0000000e+00
 1059   4.8425918e+01    1.0000000e+00    0.0000000e+00
 1060   6.0367100e+01    1.0000000e+00    0.0000000e+00
 1061   1.1435643e+03    1.0000000e+00    0.0000000e+00
 1062   1.1580455e+03    1.0000000e+00    0.0000000e+00
 1063   3.5272560e-01    1.0000000e+00    0.0000000e+00
 1064   3.7257942e+00    1.0000000e+00    0.0000000e+00
 1065   1.5848987e+01    1.0000000e+00    0.0000000e+00
 1066   1.1118674e+00    1.0000000e+00    0.0000000e+00
 1067   2.8642819e+02    1.0000000e+00    0.0000000e+00
 1068   2.6461155e+02    1.0000000e+00    0.0000000e+00
 1069   1.6488203e+00    1.0000000e+00    0.0000000e+00
 1070   4.4689594e+00    1.0000000e+00    0.0000000e+00
 1071   3.7281740e+01    1.0000000e+00    0.0000000e+00
 1072   8.8018291e-01    3.2829443e+01    0.0000000e+00
 1073   6.0859842e+02    1.0000000e+00    0.0000000e+00
 1074   8.2410490e+02    1.0000000e+00    0.0000000e+00
 1075   5.5401829e+00    1.0000000e+00    0.0000000e+00
 1076   2.6168567e+00    1.0000000e+00    0.0000000e+00
 1077   4.6616585e+01    1.0000000e+00    0.0000000e+00
 1078   5.9388756e+01    1.0000000e+00    0.0000000e+00
 1079   1.0926256e+03    1.0000000e+00    0.0000000e+00
 1080   1.1115334e+03    1.0000000e+00    0.0000000e+00
 1081   4.4282080e-01    1.0000000e+00    0.0000000e+00
 1082   3.6068833e+00    1.0000000e+00    0.0000000e+00
 1083   1.6011670e+01    1.0000000e+00    0.0000000e+00
 1084   5.9222191e-01    2.5123302e+01    0.0000000e+00
 1085   2.7889302e+02    1.0000000e+00    0.0000000e+00
 1086   2.5295373e+02    1.0000000e+00    0.0000000e+00
 1087   1.8513807e+00    1.0000000e+00    0.0000000e+00
 1088   4.2231755e+00    1.0000000e+00    0.0000000e+00
 1089   3.5381126e+01    1.0000000e+00    0.0000000e+00
 1090   1.9776296e+00    1.0000000e+00    0.0000000e+00
 1091   5.7130545e+02    1.0000000e+00    0.0000000e+00
 1092   8.1149610e+02    1.0000000e+00    0.0000000e+00
 1093   5.4207979e+00    1.0000000e+00    0.0000000e+00
 1094   2.6786104e+00    1.0000000e+00    0.0000000e+00
 1095   4.5205400e+01    1.0000000e+00    0.0000000e+00
 1096   5.8568921e+01    1.0000000e+00    0.0000000e+00
 1097   1.0524531e+03    1.0000000e+00    0.0000000e+00
 1098   1.0749339e+03    1.0000000e+00    0.0000000e+00
 1099   5.3666389e-01    1.0000000e+00    0.0000000e+00
 1100   3.4882091e+00    1.0000000e+00    0.0000000e+00
 1101   1.6052923e+01    1.0000000e+00    0.0000000e+00
 1102   2.4741204e-01    2.7650347e+01    0.0000000e+00
 1103   2.7587039e+02    1.0000000e+00    0.0000000e+00
 1104   2.3986973e+02    1.0000000e+00    0.0000000e+00
 1105   2.0359029e+00    1.0000000e+00    0.0000000e+00
 1106   4.0014065e+00    1.0000000e+00    0.0000000e+00
 1107   3.3337900e+01    1.0000000e+00    0.0000000e+00
 1108   3.3378539e+00    1.0000000e+00    0.0000000e+00
 1109   5.4729347e+02    1.0000000e+00    0.0000000e+00
 1110   7.9363085e+02    1.0000000e+00    0.0000000e+00
 1111   5.3038758e+00    1.0000000e+00    0.0000000e+00
 1112   2.7458700e+00    1.0000000e+00    0.0000000e+00
 1113   4.4089492e+01    1.0000000e+00    0.0000000e+00
 1114   5.7787602e+01    1.0000000e+00    0.0000000e+00
 1115   1.0158800e+03    1.0000000e+00    0.0000000e+00
 1116   1.0470805e+03    1.0000000e+00    0.0000000e+00
 1117   6.3198460e-01    1.0000000e+00    0.0000000e+00
 1118   3.3685823e+00    1.0000000e+00    0.0000000e+00
 1119   1.5944792e+01    1.0000000e+00    0.0000000e+00
 1120   6.2011068e-02    2.6781300e+01    0.0000000e+00
 1121   2.7325135e+02    1.0000000e+00    0.0000000e+00
 1122   2.2710304e+02    1.0000000e+00    0.0000000e+00
 1123   2.1986777e+00    1.0000000e+00    0.0000000e+00
 1124   3.8021726e+00    1.0000000e+00    0.0000000e+00
 1125   3.1185701e+01    1.0000000e+00    0.0000000e+00
 1126   4.8296062e+00    1.0000000e+00    0.0000000e+00
 1127   5.3029184e+02    1.0000000e+00    0.0000000e+00
 1128   7.7062956e+02    1.0000000e+00    0.0000000e+00
 1129   5.1864258e+00    1.0000000e+00    0.0000000e+00
 1130   2.8147079e+00    1.0000000e+00    0.0000000e+00
 1131   4.3138722e+01    1.0000000e+00    0.0000000e+00
 1132   5.6903798e+01    1.0000000e+00    0.0000000e+00
 1133   9.8071116e+02    1.0000000e+00    0.0000000e+00
 1134   1.0207064e+03    1.0000000e+00    0.0000000e+00
 1135   7.2638421e-01    1.0000000e+00    0.0000000e+00
 1136