Add an algorithm such that the path is modified in order to fit the vehicle's dynamics
Add an algorithm such that the path is modified in order to fit the vehicle's dynamics