“…In order to address this issue, autonomous navigation systems usually include a high-level path planner to generate smooth reference trajectories to be followed by the vehicle using a low-level controller. Usually a set of waypoints is given in GPS coordinates, normally from a map, in order to apply a smooth point-to-point control trajectory [11,12].…”