Autonomous Path Planning for Road Vehicles in Narrow Environments: An Efficient Continuous Curvature Approach

In this paper we introduce a novel method for obtaining good quality paths for autonomous road vehicles (e.g., cars or buses) in narrow environments. There are many traffic situations in urban scenarios where nontrivial maneuvering in narrow places is necessary. Navigating in cluttered parking lots or having to avoid obstacles blocking the way and finding a detour even in narrow streets are challenging, especially if the vehicle has large dimensions like a bus. We present a combined approximation-based approach to solve the path planning problem in such situations. Our approach consists of a global planner which generates a preliminary path consisting of straight and turning-in-place primitives and a local planner which is used to make the preliminary path feasible to car-like vehicles. The approximation methodology is well known in the literature; however, both components proposed in this paper differ from existing similar planning methods. The approximation process with the proposed local planner is proven to be convergent for any preliminary global paths. The resulting path has continuous curvature which renders our method well suited for application on real vehicles. Simulation experiments show that the proposed method outperforms similar approaches in terms of path quality in complicated planning tasks.

[1]  Marilena Vendittelli,et al.  Nonholonomic distance to polygonal obstacles for a car-like robot of polygonal shape , 2006, IEEE Transactions on Robotics.

[2]  G. Swaminathan Robot Motion Planning , 2006 .

[3]  Domokos Kiss,et al.  Effective navigation in narrow areas: A planning method for autonomous cars , 2017, 2017 IEEE 15th International Symposium on Applied Machine Intelligence and Informatics (SAMI).

[4]  Jon Rigelsford,et al.  Introduction to Autonomous Mobile Robots , 2004 .

[5]  Akos Nagy,et al.  A Planning Method to Obtain Good Quality Paths for Autonomous Cars , 2015, 2015 4th Eastern European Regional Conference on the Engineering of Computer Based Systems.

[6]  Andreas Kugi,et al.  Optimisation based path planning for car parking in narrow environments , 2016, Robotics Auton. Syst..

[7]  J. Sussmann,et al.  SHORTEST PATHS FOR THE REEDS-SHEPP CAR: A WORKED OUT EXAMPLE OF THE USE OF GEOMETRIC TECHNIQUES IN NONLINEAR OPTIMAL CONTROL. 1 , 1991 .

[8]  Zexiang Li,et al.  A variational approach to optimal nonholonomic motion planning , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[9]  J. M. Chacón,et al.  Polynomial approximation to clothoids via s-power series , 2003, Comput. Aided Des..

[10]  Jean-Paul Laumond,et al.  Robot Motion Planning and Control , 1998 .

[11]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

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

[13]  Andras Poppe,et al.  BME VIK Annual Research Report on Electrical Engineering and Computer Science 2016 , 2016, Period. Polytech. Electr. Eng. Comput. Sci..

[14]  Joachim Deutscher,et al.  Continuous Curvature Trajectory Design and Feedforward Control for Parking a Car , 2007, IEEE Transactions on Control Systems Technology.

[15]  Florent Lamiraux,et al.  Motion planning and control for Hilare pulling a trailer: experimental issues , 1997, Proceedings of International Conference on Robotics and Automation.

[16]  Thierry Fraichard,et al.  From Reeds and Shepp's to continuous-curvature paths , 1999, IEEE Transactions on Robotics.

[17]  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.

[18]  S. Agrawal,et al.  Differential-Flatness-Based Planning and Control of a Wheeled Mobile Manipulator—Theory and Experiment , 2011, IEEE/ASME Transactions on Mechatronics.

[19]  Aurelio Piazzi,et al.  Quintic G2-splines for the iterative steering ofvision-based autonomous vehicles , 2002, IEEE Trans. Intell. Transp. Syst..

[20]  Frank H. P. Fitzek,et al.  Joint Design of Communication and Control for Connected Cars in 5G Communication Systems , 2016, 2016 IEEE Globecom Workshops (GC Wkshps).

[21]  Thierry Siméon,et al.  Dynamic-Domain RRTs: Efficient Exploration by Controlling the Sampling Domain , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

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

[23]  Florent Lamiraux,et al.  Smooth motion planning for car-like vehicles , 2001, IEEE Trans. Robotics Autom..

[24]  Jean-Paul Laumond,et al.  Topological property for collision-free nonholonomic motion planning: the case of sinusoidal inputs for chained form systems , 1998, IEEE Trans. Robotics Autom..

[25]  S. Sastry,et al.  Nonholonomic motion planning: steering using sinusoids , 1993, IEEE Trans. Autom. Control..

[26]  Gerardo Lafferriere,et al.  Motion planning for controllable systems without drift , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[27]  Kenjiro T. Miura,et al.  An approximation approach of the clothoid curve defined in the interval [0, /2] and its offset by free-form curves , 2001, Comput. Aided Des..

[28]  Akos Nagy,et al.  RTR+C*CS: An effective geometric planner for car-like robots , 2015, Proceedings of the 2015 16th International Carpathian Control Conference (ICCC).

[29]  Benoit Vanholme,et al.  Maneuver-Based Trajectory Planning for Highly Autonomous Vehicles on Real Road With Traffic and Driver Interaction , 2010, IEEE Transactions on Intelligent Transportation Systems.

[30]  Richard M. Murray,et al.  A motion planner for nonholonomic mobile robots , 1994, IEEE Trans. Robotics Autom..

[31]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

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

[33]  Jean-Paul Laumond,et al.  Guidelines in nonholonomic motion planning for mobile robots , 1998 .

[34]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[35]  M. Fliess,et al.  Flatness and defect of non-linear systems: introductory theory and examples , 1995 .

[36]  Gabor Tevesz,et al.  A steering method for the kinematic car using C*CS paths , 2014, Proceedings of the 2014 15th International Carpathian Control Conference (ICCC).

[37]  S. LaValle Rapidly-exploring random trees : a new tool for path planning , 1998 .

[38]  Venkat Krovi,et al.  Kinematic Control of Nonholonomic Wheeled Mobile Manipulator: A Differential Flatness Approach , 2008 .

[39]  John F. Canny,et al.  Using skeletons for nonholonomic path planning among obstacles , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[40]  Woojin Chung,et al.  Car parking control using a trajectory tracking controller , 2006, 2006 SICE-ICASE International Joint Conference.

[41]  M. Fliess,et al.  Flatness, motion planning and trailer systems , 1993, Proceedings of 32nd IEEE Conference on Decision and Control.

[42]  S. Sastry,et al.  Trajectory generation for the N-trailer problem using Goursat normal form , 1993, Proceedings of 32nd IEEE Conference on Decision and Control.

[43]  Chin Pei Tang,et al.  Differential flatness-based kinematic and dynamic control of a differentially driven wheeled mobile robot , 2009, 2009 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[44]  Doran Wilde Computing clothoid segments for trajectory generation , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[45]  Akos Nagy,et al.  Path planning and control of differential and car-like robots in narrow environments , 2015, 2015 IEEE 13th International Symposium on Applied Machine Intelligence and Informatics (SAMI).

[46]  Woojin Chung,et al.  Practical motion planning for car-parking control in narrow environment , 2010 .

[47]  David González,et al.  A Review of Motion Planning Techniques for Automated Vehicles , 2016, IEEE Transactions on Intelligent Transportation Systems.

[48]  Florent Lamiraux,et al.  Flatness and small-time controllability of multibody mobile robots: Application to motion planning , 1997, 1997 European Control Conference (ECC).

[49]  R. Murray,et al.  Trajectory generation for the N-trailer problem using Goursat normal form , 1995 .

[50]  Jin-Woo Lee,et al.  A unified framework of the automated lane centering/changing control for motion smoothness adaptation , 2012, 2012 15th International IEEE Conference on Intelligent Transportation Systems.

[51]  Dereck S. Meek,et al.  A controlled clothoid spline , 2005, Comput. Graph..

[52]  Jean-Daniel Boissonnat,et al.  A note on shortest paths in the plane subject to a constraint on the derivative of the curvature , 1994 .