The final project of Numerical Optimization in Robotics.
The trajectory generation and time optimal path parameterization (TOPP) are solved using LBFGS Lite and MOSEK Fusion, respectively.
catkin_make
source devel/setup.bash
roslaunch TOPP global_planning.launch