A Feedback Motion Plan for Vehicles with Bounded Curvature Constraints
This work addresses motion planning for autonomous vehicles with curvature limits, offering an incremental improvement over decoupled planning and control schemes.
The paper tackles the problem of generating feedback motion plans for vehicles with bounded curvature constraints, enabling offline validation of trajectories for different initial states. The result is a method that reduces undesired oscillations and is applicable to both single goal missions and path following, as demonstrated through simulation data.
The use of a feedback motion plan instead of the decoupled scheme consisting of separate plan and control phases can facilitate the task of proving the properties of an autonomous system. The advantage of using a feedback motion plan is the possibility to validate the whole plan offline before its execution, which means that trajectories having different initial states can be tested simultaneously. In this paper, we formulate a feedback motion plan based on the extension of the \emph{wavefront expansion} to the case of vehicles having bounded curvature. Additionally, the use of a transition function and a Gaussian filter limits undesired oscillations in the resultant trajectories. The method is suitable for both single goal missions and path following. The paper illustrates the algorithm for the generation of the plan and presents simulation data containing example trajectories and analysis of tuning parameters. Finally, future developments are discussed.