Hypha-ROS / hypharos_minicar

1/20 MiniCar: An ackermann based rover for MPC and Pure-Pursuit controller
https://hypharosworkshop.wordpress.com/
Apache License 2.0
312 stars 113 forks source link

Can't get solution from ipopt #17

Open Tengyun-Mo opened 3 years ago

Tengyun-Mo commented 3 years ago

When I run the MPCNode.cpp I got this error:

cppad-20200905 error from a known source:
vector: index greater than or equal vector size
Error detected by false result for
    i < length_
at line 341 in the file 
    /usr/local/include/cppad/utility/vector.hpp
MPC_Node: /usr/local/include/cppad/utility/error_handler.hpp:206: static void CppAD::ErrorHandler::Default(bool, int, const char*, const char*, const char*): Assertion `false' failed.
Aborted (core dumped)

And I print the vars,the vars' value are zero,like this:

vars :
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }
vars_lowerbound :
{ -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -1000, -0.523, -0.523, -0.523, -0.523, -0.523, -0.523, -0.523, -0.523, -0.523, -1, -1, -1, -1, -1, -1, -1, -1, -1 }
vars_upperbound :
{ 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 0.523, 0.523, 0.523, 0.523, 0.523, 0.523, 0.523, 0.523, 0.523, 1, 1, 1, 1, 1, 1, 1, 1, 1 }

And the solution.x is none:

fg0 :16000
solution.x:
{  }
Cost 6.42285e-323

How to fix it?I'm very appreciate it!Thanks.