robotcxx.pro~orig

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

  902   5.1303715e+00    1.0000000e+00    0.0000000e+00
  903   2.0221265e+01    1.0000000e+00    0.0000000e+00
  904   1.7355065e+01    1.0000000e+00    0.0000000e+00
  905   2.2036025e+01    1.5304100e+03    0.0000000e+00
  906   1.8543652e+02    1.0000000e+00    0.0000000e+00
  907   2.5010755e-01    2.0348526e+00    0.0000000e+00
  908   7.7252356e+00    1.0000000e+00    0.0000000e+00
  909   5.4880061e+01    1.0000000e+00    0.0000000e+00
  910   2.9666683e+01    1.0000000e+00    0.0000000e+00
  911   5.2418337e+02    1.0000000e+00    0.0000000e+00
  912   1.5245256e+01    1.7994203e+03    0.0000000e+00
  913   7.4592294e+00    1.0000000e+00    0.0000000e+00
  914   3.1745614e+00    1.0000000e+00    0.0000000e+00
  915   1.1618401e+02    1.0000000e+00    0.0000000e+00
  916   1.1866805e+02    1.0000000e+00    0.0000000e+00
  917   4.8575198e+02    1.0000000e+00    0.0000000e+00
  918   3.4413822e+02    1.0000000e+00    0.0000000e+00
  919   2.0620668e-01    1.3838494e+00    0.0000000e+00
  920   5.0125956e+00    1.0000000e+00    0.0000000e+00
  921   2.1215206e+01    1.0000000e+00    0.0000000e+00
  922   1.4319485e+01    1.0000000e+00    0.0000000e+00
  923   2.6171250e+01    2.0580477e+03    0.0000000e+00
  924   1.6285593e+02    1.7540851e+03    0.0000000e+00
  925   3.9100487e-01    2.0757740e+00    0.0000000e+00
  926   7.4371986e+00    1.0000000e+00    0.0000000e+00
  927   5.8075943e+01    1.0000000e+00    0.0000000e+00
  928   2.1877111e+01    1.0000000e+00    0.0000000e+00
  929   4.2944457e+02    1.0000000e+00    0.0000000e+00
  930   6.2026113e+01    2.3728382e+03    0.0000000e+00
  931   7.3015708e+00    1.0000000e+00    0.0000000e+00
  932   3.1360338e+00    1.0000000e+00    0.0000000e+00
  933   1.0805776e+02    1.0000000e+00    0.0000000e+00
  934   1.1403405e+02    1.0000000e+00    0.0000000e+00
  935   4.3728440e+02    1.0000000e+00    0.0000000e+00
  936   3.1882434e+02    1.0000000e+00    0.0000000e+00
  937   2.4575936e-01    1.0000000e+00    0.0000000e+00
  938   4.9038219e+00    1.0000000e+00    0.0000000e+00
  939   2.2413156e+01    1.0000000e+00    0.0000000e+00
  940   1.1726233e+01    1.0000000e+00    0.0000000e+00
  941   2.5838379e+01    3.0867320e+03    0.0000000e+00
  942   1.5098090e+02    2.8072158e+03    0.0000000e+00
  943   5.8157430e-01    1.0000000e+00    0.0000000e+00
  944   7.1427975e+00    1.0000000e+00    0.0000000e+00
  945   6.0940224e+01    1.0000000e+00    0.0000000e+00
  946   1.5873401e+01    1.0000000e+00    0.0000000e+00
  947   3.2800215e+02    1.0000000e+00    0.0000000e+00
  948   1.3172797e+02    3.9757642e+03    0.0000000e+00
  949   7.1680750e+00    1.0000000e+00    0.0000000e+00
  950   3.1310875e+00    1.0000000e+00    0.0000000e+00
  951   1.0205459e+02    1.0000000e+00    0.0000000e+00
  952   1.1131659e+02    1.0000000e+00    0.0000000e+00
  953   4.0786698e+02    1.0000000e+00    0.0000000e+00
  954   2.9941013e+02    1.0000000e+00    0.0000000e+00
  955   3.0425043e-01    1.0000000e+00    0.0000000e+00
  956   4.8037253e+00    1.0000000e+00    0.0000000e+00
  957   2.3717494e+01    1.0000000e+00    0.0000000e+00
  958   9.6010862e+00    1.0000000e+00    0.0000000e+00
  959   3.4403329e+01    1.0000000e+00    0.0000000e+00
  960   1.3538748e+02    1.7267860e+03    0.0000000e+00
  961   8.1298830e-01    1.0000000e+00    0.0000000e+00
  962   6.8489753e+00    1.0000000e+00    0.0000000e+00
  963   6.3340133e+01    1.0000000e+00    0.0000000e+00
  964   1.1626672e+01    1.0000000e+00    0.0000000e+00
  965   2.4329976e+02    1.0000000e+00    0.0000000e+00
  966   1.9815633e+02    1.0000000e+00    0.0000000e+00
  967   7.0577482e+00    1.0000000e+00    0.0000000e+00
  968   3.1582033e+00    1.0000000e+00    0.0000000e+00
  969   9.8003452e+01    1.0000000e+00    0.0000000e+00
  970   1.1023767e+02    1.0000000e+00    0.0000000e+00
  971   3.8334141e+02    1.0000000e+00    0.0000000e+00
  972   2.9582181e+02    1.0000000e+00    0.0000000e+00
  973   3.7981188e-01    1.0000000e+00    0.0000000e+00
  974   4.7110970e+00    1.0000000e+00    0.0000000e+00
  975   2.5029019e+01    1.0000000e+00    0.0000000e+00
  976   7.9567029e+00    1.0000000e+00    0.0000000e+00
  977   4.0010818e+01    1.0000000e+00    0.0000000e+00
  978   1.2696235e+02    1.0767554e+03    0.0000000e+00
  979   1.0752312e+00    1.0000000e+00    0.0000000e+00
  980   6.5611322e+00    1.0000000e+00    0.0000000e+00
  981   6.5166444e+01    1.0000000e+00    0.0000000e+00
  982   9.0514296e+00    1.0000000e+00    0.0000000e+00
  983   1.6265574e+02    1.0000000e+00    0.0000000e+00
  984   2.7147449e+02    1.0000000e+00    0.0000000e+00
  985   6.9677991e+00    1.0000000e+00    0.0000000e+00
  986   3.2140187e+00    1.0000000e+00    0.0000000e+00
  987   9.5682376e+01    1.0000000e+00    0.0000000e+00
  988   1.1047838e+02    1.0000000e+00    0.0000000e+00
  989   3.7162533e+02    1.0000000e+00    0.0000000e+00
  990   2.9626733e+02    1.0000000e+00    0.0000000e+00
  991   4.7032175e-01    1.0000000e+00    0.0000000e+00
  992   4.6245271e+00    1.0000000e+00    0.0000000e+00
  993   2.6317935e+01    1.0000000e+00    0.0000000e+00
  994   6.7444300e+00    1.0000000e+00    0.0000000e+00
  995   4.4255728e+01    1.0000000e+00    0.0000000e+00
  996   1.2336455e+02    1.3427505e+03    0.0000000e+00
  997   1.3583836e+00    1.0000000e+00    0.0000000e+00
  998   6.2838896e+00    1.0000000e+00    0.0000000e+00
  999   6.6431192e+01    1.0000000e+00    0.0000000e+00
 1000   7.9591287e+00    1.0000000e+00    0.0000000e+00
 1001   9.1009316e+01    1.0000000e+00    0.0000000e+00
 1002   3.4480341e+02    1.0000000e+00    0.0000000e+00
 1003   6.8950045e+00    1.0000000e+00    0.0000000e+00
 1004   3.2946932e+00    1.0000000e+00    0.0000000e+00
 1005   9.4838038e+01    1.0000000e+00    0.0000000e+00
 1006   1.1180174e+02    1.0000000e+00    0.0000000e+00
 1007   3.6952105e+02    1.0000000e+00    0.0000000e+00
 1008   3.0096007e+02    1.0000000e+00    0.0000000e+00
 1009   5.7363175e-01    1.0000000e+00    0.0000000e+00
 1010   4.5426317e+00    1.0000000e+00    0.0000000e+00
 1011   2.7560257e+01    1.0000000e+00    0.0000000e+00
 1012   5.9207662e+00    1.0000000e+00    0.0000000e+00
 1013   4.8433287e+01    1.0000000e+00    0.0000000e+00
 1014   1.2273944e+02    2.4132774e+03    0.0000000e+00
 1015   1.6531768e+00    1.0000000e+00    0.0000000e+00
 1016   6.0212184e+00    1.0000000e+00    0.0000000e+00
 1017   6.7172474e+01    1.0000000e+00    0.0000000e+00
 1018   8.1598281e+00    1.0000000e+00    0.0000000e+00
 1019   3.1936287e+01    1.0000000e+00    0.0000000e+00
 1020   4.1311280e+02    1.0000000e+00    0.0000000e+00
 1021   6.8361635e+00    1.0000000e+00    0.0000000e+00
 1022   3.3963635e+00    1.0000000e+00    0.0000000e+00
 1023   9.5251084e+01    1.0000000e+00    0.0000000e+00
 1024   1.1400531e+02    1.0000000e+00    0.0000000e+00
 1025   3.7454478e+02    1.0000000e+00    0.0000000e+00
 1026   3.1014612e+02    1.0000000e+00    0.0000000e+00
 1027   6.8723343e-01    1.0000000e+00    0.0000000e+00
 1028   4.4637200e+00    1.0000000e+00    0.0000000e+00
 1029   2.8651581e+01    1.0000000e+00    0.0000000e+00
 1030   5.5151067e+00    1.0000000e+00    0.0000000e+00
 1031   7.0619526e+01    1.0000000e+00    0.0000000e+00
 1032   1.0643546e+02    1.0000000e+00    0.0000000e+00
 1033   1.9506521e+00    1.0000000e+00    0.0000000e+00
 1034   5.7757781e+00    1.0000000e+00    0.0000000e+00
 1035   6.7349400e+01    1.0000000e+00    0.0000000e+00
 1036   9.5256481e+00    1.0000000e+00    0.0000000e+00
 1037   7.0259411e+00    2.6868809e+03    0.0000000e+00
 1038   4.5331703e+02    1.0000000e+00    0.0000000e+00
 1039   6.7874310e+00    1.0000000e+00    0.0000000e+00
 1040   3.5144759e+00    1.0000000e+00    0.0000000e+00
 1041   9.6745094e+01    1.0000000e+00    0.0000000e+00
 1042   1.1679671e+02    1.0000000e+00    0.0000000e+00
 1043   3.6963022e+02    1.0000000e+00    0.0000000e+00
 1044   3.3858974e+02    1.0000000e+00    0.0000000e+00
 1045   8.0725694e-01    1.0000000e+00    0.0000000e+00
 1046   4.3847921e+00    1.0000000e+00    0.0000000e+00
 1047   2.9471454e+01    1.0000000e+00    0.0000000e+00
 1048   5.5195471e+00    1.0000000e+00    0.0000000e+00
 1049   9.6052006e+01    1.0000000e+00    0.0000000e+00
 1050   8.8179530e+01    1.0000000e+00    0.0000000e+00
 1051   2.2407646e+00    1.0000000e+00    0.0000000e+00
 1052   5.5473090e+00    1.0000000e+00    0.0000000e+00
 1053   6.6895604e+01    1.0000000e+00    0.0000000e+00
 1054   1.1834148e+01    1.0000000e+00    0.0000000e+00
 1055  -6.2088020e-08    1.9565867e+03    2.4484466e-05
 1056   4.7900199e+02    1.0000000e+00    0.0000000e+00
 1057   6.7423143e+00    1.0000000e+00    0.0000000e+00
 1058   3.6417838e+00    1.0000000e+00    0.0000000e+00
 1059   9.8967718e+01    1.0000000e+00    0.0000000e+00
 1060   1.1972604e+02    1.0000000e+00    0.0000000e+00
 1061   3.6505167e+02    1.0000000e+00    0.0000000e+00
 1062   3.7187448e+02    1.0000000e+00    0.0000000e+00
 1063   9.2947226e-01    1.0000000e+00    0.0000000e+00
 1064   4.3025409e+00    1.0000000e+00    0.0000000e+00
 1065   2.9972013e+01    1.0000000e+00    0.0000000e+00
 1066   5.8332183e+00    1.0000000e+00    0.0000000e+00
 1067   1.2447838e+02    1.0000000e+00    0.0000000e+00
 1068   6.6953456e+01    1.0000000e+00    0.0000000e+00
 1069   2.5139403e+00    1.0000000e+00    0.0000000e+00
 1070   5.3340794e+00    1.0000000e+00    0.0000000e+00
 1071   6.5817119e+01    1.0000000e+00    0.0000000e+00
 1072   1.4744651e+01    1.0000000e+00    0.0000000e+00
 1073   8.6829765e+00    1.5707886e+03    0.0000000e+00
 1074   4.8903980e+02    1.0000000e+00    0.0000000e+00
 1075   6.6936762e+00    1.0000000e+00    0.0000000e+00
 1076   3.7703501e+00    1.0000000e+00    0.0000000e+00
 1077   1.0143120e+02    1.0000000e+00    0.0000000e+00
 1078   1.2235149e+02    1.0000000e+00    0.0000000e+00
 1079   3.5793621e+02    1.0000000e+00    0.0000000e+00
 1080   4.0779114e+02    1.0000000e+00    0.0000000e+00
 1081   1.0496230e+00    1.0000000e+00    0.0000000e+00
 1082   4.2136855e+00    1.0000000e+00    0.0000000e+00
 1083   3.0101660e+01    1.0000000e+00    0.0000000e+00
 1084   6.3499317e+00    1.0000000e+00    0.0000000e+00
 1085   1.5464676e+02    1.0000000e+00    0.0000000e+00
 1086   4.2579255e+01    1.9927660e+03    0.0000000e+00
 1087   2.7615840e+00    1.0000000e+00    0.0000000e+00
 1088   5.1333788e+00    1.0000000e+00    0.0000000e+00
 1089   6.4105973e+01    1.0000000e+00    0.0000000e+00
 1090   1.7910109e+01    1.0000000e+00    0.0000000e+00
 1091   2.9159930e+01    1.0000000e+00    0.0000000e+00
 1092   4.8362771e+02    1.0000000e+00    0.0000000e+00
 1093   6.6344023e+00    1.0000000e+00    0.0000000e+00
 1094   3.8922148e+00    1.0000000e+00    0.0000000e+00
 1095   1.0361881e+02    1.0000000e+00    0.0000000e+00
 1096   1.2420364e+02    1.0000000e+00    0.0000000e+00
 1097   3.4588944e+02    1.0000000e+00    0.0000000e+00
 1098   4.4301461e+02    1.0000000e+00    0.0000000e+00
 1099   1.1646645e+00    1.0000000e+00    0.0000000e+00
 1100   4.1162097e+00    1.0000000e+00    0.0000000e+00
 1101   3.0056874e+01    1.0000000e+00    0.0000000e+00
 1102   6.7608947e+00    1.0000000e+00    0.0000000e+00
 1103   1.3323397e+02    1.0000000e+00    0.0000000e+00
 1104   6.7305170e+01    1.0000000e+00    0.0000000e+00
 1105   2.9779038e+00    1.0000000e+00    0.0000000e+00
 1106   4.9434075e+00    1.0000000e+00    0.0000000e+00
 1107   6.1952702e+01    1.0000000e+00    0.0000000e+00
 1108   2.0887278e+01    1.0000000e+00    0.0000000e+00
 1109   1.6761989e+01    1.0000000e+00    0.0000000e+00
 1110   5.0463977e+02    1.0000000e+00    0.0000000e+00
 1111   6.5598771e+00    1.0000000e+00    0.0000000e+00
 1112   4.0018713e+00    1.0000000e+00    0.0000000e+00
 1113   1.0496060e+02    1.0000000e+00    0.0000000e+00
 1114   1.2515045e+02    1.0000000e+00    0.0000000e+00
 1115   3.7250913e+02    1.0000000e+00    0.0000000e+00
 1116   4.2964742e+02    1.0000000e+00    0.0000000e+00
 1117   1.2764776e+00    1.0000000e+00    0.0000000e+00
 1118   4.0130752e+00    1.0000000e+00    0.0000000e+00
 1119   3.0096731e+01    1.0000000e+00    0.0000000e+00
 1120   6.9028560e+00    1.0000000e+00    0.0000000e+00
 1121   1.0827074e+02    1.0000000e+00    0.0000000e+00
 1122   9.3921667e+01    1.0000000e+00    0.0000000e+00
 1123   3.1654172e+00    1.0000000e+00    0.0000000e+00
 1124   4.7689120e+00    1.0000000e+00    0.0000000e+00
 1125   5.9691240e+01    1.0000000e+00    0.0000000e+00
 1126   2.3557832e+01    1.0000000e+00    0.0000000e+00
 1127   6.2311175e+00    1.2464047e+03    0.0000000e+00
 1128   5.1946913e+02    1.0000000e+00    0.0000000e+00
 1129   6.4754118e+00    1.0000000e+00    0.0000000e+00
 1130   4.1036938e+00    1.0000000e+00    0.0000000e+00
 1131   1.0557303e+02    1.0000000e+00    0.0000000e+00
 1132   1.2567439e+02    1.0000000e+00    0.0000000e+00
 1133   3.9816688e+02    1.0000000e+00    0.0000000e+00
 1134   4.1060274e+02    1.0000000e+00    0.0000000e+00
 1135   1.3881548e+00    1.0000000e+00    0.0000000e+00
 1136