MPC output value is very small in simulation

[NanziZh]

Hello, I encountered a problem. When calling your code, I passed in a trajectory. This trajectory includes 10 x, y coordinates and can be visualized in rviz.

But after publishing the trajectory to /reference_path, I used rostopic echo /twist_cmd and found that the speed and angular speed changed from 0 to about 0.05, and the simulation model did not move.

The simulation model uses turtlebot3. The above text is translated using Google. There may be some expression problems. Please forgive me.