Model Predictive Trajectory Generator

This is a path optimization sample on model predictive trajectory generator.

This algorithm is used for state lattice planner.

Path optimization sample

https://github.com/AtsushiSakai/PythonRoboticsGifs/raw/master/PathPlanning/ModelPredictiveTrajectoryGenerator/kn05animation.gif

Lookup table generation sample

../../../_images/lookup_table.png

Ref:

Optimal rough terrain trajectory generation for wheeled mobile robots