Curvature-Bounded Lengthening and Shortening for Restricted Vehicle Path Planning

In this paper, the traditional shortest path planning problem for vehicle is advanced to length-targeted path planning problem, i.e., to plan path with its length being as close to a specified value as possible. Lengthening and shortening of given initial paths are used to solve this problem. Based on an operation set consisting of three basic path homotopies, we build a comprehensive and systematic framework to plan paths with target length, which is a generalization of the existing related studies. Thereby, the expected paths can be independently searched through such deformation processes within topological classes. The proposed framework can produce the largest length coverage in different scenarios and under different conditions, and it can also generate expected paths with arbitrary topological classification in terms of the curvature constraint and the obstacle constraint. Examples show that our lengthening and shortening method can effectively solve the length-targeted path planning problem in environment without or with obstacles. Note to Practitioners—This paper presents a curvature-bounded lengthening and shortening approach for path planning of vehicles. The curvature and obstacle constraints in the path planning problem are handled using the topological technique. In addition, a rigorous classification system is presented to systematically categorize the potential paths. Within a path class, any path can be deformed to other paths while keeping the curvature bounded. Then, the path deformation process is conducted via a series of basic homotopy operations to approach the target length. The length coverage range of this process is reduced when some endpoint conditions are meet or the vehicle is trapped into a closed region.

[1]  George J. Pappas,et al.  Elastic multi-particle systems for bounded-curvature path planning , 2008, 2008 American Control Conference.

[2]  Valerii Patsko,et al.  From Dubins’ car to Reeds and Shepp’s mobile robot , 2009 .

[3]  L. Shepp,et al.  OPTIMAL PATHS FOR A CAR THAT GOES BOTH FORWARDS AND BACKWARDS , 1990 .

[4]  Subhash Suri,et al.  Curvature-constrained shortest paths in a convex polygon (extended abstract) , 1998, SCG '98.

[5]  Jirí Matousek,et al.  Reachability by Paths of Bounded Curvature in a Convex Polygon , 2012, Comput. Geom..

[6]  Antonios Tsourdos,et al.  Co-operative path planning of multiple UAVs using Dubins paths with clothoid arcs , 2010 .

[7]  Pere Ridao,et al.  A comparison of homotopic path planning algorithms for robotic applications , 2015, Robotics Auton. Syst..

[8]  Simeon Ntafos,et al.  Watchman routes under limited visibility , 1992 .

[9]  Mario F. M. Campos,et al.  Bi-objective data gathering path planning for vehicles with bounded curvature , 2017, Comput. Oper. Res..

[10]  Jos'e Ayala,et al.  Length minimising bounded curvature paths in homotopy classes , 2014, 1403.4930.

[11]  Maciej Marcin Michalek,et al.  A G3-Continuous Extend Procedure for Path Planning of Mobile Robots with Limited Motion Curvature and State Constraints , 2018, Applied Sciences.

[12]  Tal Shima,et al.  Discretization-Based and Look-Ahead Algorithms for the Dubins Traveling Salesperson Problem , 2017, IEEE Transactions on Automation Science and Engineering.

[13]  Luis Hernandez-Martinez,et al.  Homotopy Path Planning for Terrestrial Robots Using Spherical Algorithm , 2018, IEEE Transactions on Automation Science and Engineering.

[14]  Tal Shima,et al.  On Dubins paths to intercept a moving target , 2015, Autom..

[15]  Marilena Vendittelli,et al.  Shortest Paths to Obstacles for a Polygonal Dubins Car , 2009, IEEE Transactions on Robotics.

[16]  Neng Wan,et al.  Hierarchical path generation for distributed mission planning of UAVs , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

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

[18]  Otfried Cheong,et al.  The cost of bounded curvature , 2011, Comput. Geom..

[19]  Karl Iagnemma,et al.  Homotopy-Based Divide-and-Conquer Strategy for Optimal Trajectory Planning via Mixed-Integer Programming , 2015, IEEE Transactions on Robotics.

[20]  Panagiotis Tsiotras,et al.  Curvature-Bounded Traversability Analysis in Motion Planning for Mobile Robots , 2014, IEEE Transactions on Robotics.

[21]  Magnus Egerstedt,et al.  Multi-UAV Convoy Protection: An Optimal Approach to Path Planning and Coordination , 2010, IEEE Transactions on Robotics.

[22]  Weiran Yao,et al.  Online Trajectory Generation with Rendezvous for UAVs Using Multistage Path Prediction , 2017 .

[23]  J. Hyam Rubinstein,et al.  Curvature-constrained directional-cost paths in the plane , 2012, J. Glob. Optim..

[24]  Aurelio Piazzi,et al.  Path Generation Using ${\mbi \eta}^4$-Splines for a Truck and Trailer Vehicle , 2014, IEEE Transactions on Automation Science and Engineering.

[25]  Neng Wan,et al.  An iterative strategy for task assignment and path planning of distributed multiple unmanned aerial vehicles , 2019, Aerospace Science and Technology.

[26]  P. Souéres,et al.  Shortest paths synthesis for a car-like robot , 1996, IEEE Trans. Autom. Control..

[27]  Ricardo G. Sanfelice,et al.  On minimum-time paths of bounded curvature with position-dependent constraints , 2013, Autom..

[28]  Hyam Rubinstein,et al.  The classification of homotopy classes of bounded curvature paths , 2014 .

[29]  Vijay Kumar,et al.  Persistent Homology for Path Planning in Uncertain Environments , 2015, IEEE Transactions on Robotics.

[30]  Håkan Jonsson,et al.  Planning Smooth and Obstacle-Avoiding B-Spline Paths for Autonomous Mining Vehicles , 2010, IEEE Transactions on Automation Science and Engineering.

[31]  Vijay Kumar,et al.  Topological constraints in search-based robot path planning , 2012, Auton. Robots.

[32]  Antonio Bicchi,et al.  Planning shortest bounded-curvature paths for a class of nonholonomic vehicles among obstacles , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

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

[34]  Tomasz Gawron,et al.  The VFO-Driven Motion Planning and Feedback Control in Polygonal Worlds for a Unicycle with Bounded Curvature of Motion , 2018, J. Intell. Robotic Syst..

[35]  Byung Kook Kim,et al.  Minimum-Time Trajectory for Three-Wheeled Omnidirectional Mobile Robots Following a Bounded-Curvature Path With a Referenced Heading Profile , 2011, IEEE Transactions on Robotics.

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

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

[38]  Emilio Frazzoli,et al.  On the Dubins Traveling Salesman Problem , 2012, IEEE Transactions on Automatic Control.

[39]  Jean-Daniel Boissonnat,et al.  An Algorithm for Computing a Convex and Simple Path of Bounded Curvature in a Simple Polygon , 2002, Algorithmica.

[40]  Jun Zhao,et al.  Bounded curvature path planning with expected length for Dubins vehicle entering target manifold , 2017, Robotics Auton. Syst..

[41]  E. Frazzoli,et al.  Decentralized algorithm for minimum-time rendezvous of Dubins vehicles , 2008, 2008 American Control Conference.

[42]  Corey Schumacher,et al.  Path Elongation for UAV Task Assignment , 2003 .

[43]  Subhash Suri,et al.  Curvature-Constrained Shortest Paths in a Convex Polygon , 2002, SIAM J. Comput..

[44]  Hyondong Oh,et al.  Coordinated Standoff Tracking Using Path Shaping for Multiple UAVs , 2014, IEEE Transactions on Aerospace and Electronic Systems.

[45]  Mariette Yvinec,et al.  Convex tours of bounded curvature , 1999, Comput. Geom..

[46]  Weiran Yao,et al.  Triple-stage path prediction algorithm for real-time mission planning of multi-UAV , 2015 .

[47]  Ashwini Ratnoo,et al.  Continuous-Curvature Path Planning With Obstacle Avoidance Using Four Parameter Logistic Curves , 2016, IEEE Robotics and Automation Letters.