An Iterative Dynamic Programming Approach to the Multipoint Markov-Dubins Problem

A new solution to the multipoint Markov-Dubins problem via iterative dynamic programming is herein presented. The shortest path problem connecting a sequence of given points in the plane while maintaining angle continuity and bounded curvature is presented. As in the classic two points Dubins problem, the solution is a juxtaposition of line segments and circle arcs. This problem is relevant for the path planning of a non-holonomic robot, such as a wheeled vehicle. The proposed method is robust and computationally inexpensive with respect to existing solutions and is therefore suitable to be integrated as motion primitive into Dubins-based applications, e.g. orienteering problems or waypoint following robotics.

[1]  Enrico Bertolazzi,et al.  Efficient intersection between splines of clothoids , 2020, Math. Comput. Simul..

[2]  Emilio Frazzoli,et al.  Traveling Salesperson Problems for the Dubins Vehicle , 2008, IEEE Transactions on Automatic Control.

[3]  Eloy García,et al.  Tightly Bounding the Shortest Dubins Paths Through a Sequence of Points , 2017, Journal of Intelligent & Robotic Systems.

[4]  Enrico Bertolazzi,et al.  On the G2 Hermite Interpolation Problem with clothoids , 2018, J. Comput. Appl. Math..

[5]  Xavier Goaoc,et al.  Bounded-Curvature Shortest Paths through a Sequence of Points Using Convex Optimization , 2013, SIAM J. Comput..

[6]  L. Dubins.  On Curves of Minimal Length with a Constraint on Average Curvature, and with Prescribed Initial and Terminal Positions and Tangents , 1957 .

[7]  Luigi Palopoli,et al.  Semi-analytical minimum time solutions with velocity constraints for trajectory following of vehicles , 2017, Autom..

[8]  L. Dagum,et al.  OpenMP: an industry standard API for shared-memory programming , 1998 .

[9]  Zheng Chen,et al.  Shortest Dubins paths through three points , 2019, Autom..

[10]  P. Souéres,et al.  The Shortest path synthesis for non-holonomic robots moving forwards , 1994 .

[11]  B. P,et al.  A novel formalisation of the Markov-Dubins problem , 2020, 2020 European Control Conference (ECC).

[12]  Luigi Palopoli,et al.  Harnessing steering singularities in passive path following for robotic walkers , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Enrico Bertolazzi,et al.  A Note on Robust Biarc Computation , 2017, Computer-Aided Design and Applications.

[14]  David M. Lane,et al.  DCOP: Dubins Correlated Orienteering Problem Optimizing Sensing Missions of a Nonholonomic Vehicle Under Budget Constraints , 2018, IEEE Robotics and Automation Letters.

[15]  Emilio Frazzoli,et al.  Numerical Approach to Reachability-Guided Sampling-Based Motion Planning Under Differential Constraints , 2017, IEEE Robotics and Automation Letters.

[16]  Shalabh Gupta,et al.  T$^\star$: Time-Optimal Risk-Aware Motion Planning for Curvature-Constrained Vehicles , 2019, IEEE Robotics and Automation Letters.

[17]  Luigi Palopoli,et al.  Efficient Re-planning for Robotic Cars , 2018, 2018 European Control Conference (ECC).

[18]  C. Yalçın Kaya,et al.  Markov–Dubins path via optimal control theory , 2017, Comput. Optim. Appl..

[19]  Martin Saska,et al.  Dubins Orienteering Problem , 2017, IEEE Robotics and Automation Letters.

[20]  E. Cockayne,et al.  Plane Motion of a Particle Subject to Curvature Constraints , 1975 .

[21]  Jean-Daniel Boissonnat,et al.  Accessibility region for a car that only moves forwards along optimal paths , 1993 .

[22]  Jean-Daniel Boissonnat,et al.  Shortest path synthesis for Dubins non-holonomic robot , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[23]  Luigi Palopoli,et al.  Reactive Planning for Assistive Robots , 2018, IEEE Robotics and Automation Letters.

[24]  Stefan Mitsch,et al.  A Formal Safety Net for Waypoint-Following in Ground Robots , 2019, IEEE Robotics and Automation Letters.

[25]  Vladimir J. Lumelsky,et al.  Classification of the Dubins set , 2001, Robotics Auton. Syst..

[26]  Sung Yong Shin,et al.  Approximation of Curvature-Constrained Shortest Paths through a Sequence of Points , 2000, ESA.

[27]  Jean-Daniel Boissonnat,et al.  Shortest paths of bounded curvature in the plane , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[28]  E. Bertolazzi,et al.  Interpolating clothoid splines with curvature continuity , 2018 .

[29]  C. Yalçin Kaya,et al.  Shortest Interpolating Curves with Constrained Curvature , 2018 .