Practical and flexible path planning for car-like mobile robot using maximal-curvature cubic spiral

Abstract This paper presents a nonholonomic path planning method, aiming at taking into considerations of curvature constraint, length minimization, and computational demand, for car-like mobile robot based on cubic spirals. The generated path is made up of at most five segments: at most two maximal-curvature cubic spiral segments with zero curvature at both ends in connection with up to three straight line segments. A numerically efficient process is presented to generate a Cartesian shortest path among the family of paths considered for a given pair of start and destination configurations. Our approach is resorted to minimization via linear programming over the sum of length of each path segment of paths synthesized based on minimal locomotion cubic spirals linking start and destination orientations through a selected intermediate orientation. The potential intermediate configurations are not necessarily selected from the symmetric mean circle for non-parallel start and destination orientations. The novelty of the presented path generation method based on cubic spirals is: (i) Practical: the implementation is straightforward so that the generation of feasible paths in an environment free of obstacles is efficient in a few milliseconds; (ii) Flexible: it lends itself to various generalizations: readily applicable to mobile robots capable of forward and backward motion and Dubins’ car (i.e. car with only forward driving capability); well adapted to the incorporation of other constraints like wall-collision avoidance encountered in robot soccer games; straightforward extension to planning a path connecting an ordered sequence of target configurations in simple obstructed environment.

[1]  Vladimir J. Lumelsky,et al.  On calculation of optimal paths with constrained curvature: the case of long paths , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[2]  Yutaka Kanayama,et al.  Smooth local path planning for autonomous vehicles , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[3]  Guy Desaulniers,et al.  An efficient algorithm to find a shortest path for a car-like robot , 1993, IEEE Trans. Robotics Autom..

[4]  Thierry Fraichard,et al.  Collision-free and continuous-curvature path planning for car-like robots , 1997, Proceedings of International Conference on Robotics and Automation.

[5]  David A. Green,et al.  Design And Implementation Of A Trajectory Generator For An Indoor Mobile Robot , 1989, Proceedings. IEEE/RSJ International Workshop on Intelligent Robots and Systems '. (IROS '89) 'The Autonomous Mobile Robots and Its Applications.

[6]  Alonzo Kelly,et al.  Reactive Nonholonomic Trajectory Generation via Parametric Optimal Control , 2003, Int. J. Robotics Res..

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

[8]  Luciano E. Chiang,et al.  Nonholonomic path planning among obstacles subject to curvature restrictions , 2002, Robotica.

[9]  Jean-Paul Laumond,et al.  Primitives for smoothing mobile robot trajectories , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[10]  Vladimir J. Lumelsky,et al.  Curvature-constrained motion within a limited workspace , 1997, Proceedings of International Conference on Robotics and Automation.

[11]  Lakmal D. Seneviratne,et al.  A Shortest Path Based Path Planning Algorithm for Nonholonomic Mobile Robots , 1999, J. Intell. Robotic Syst..

[12]  Yoshiki Ninomiya,et al.  Local Path Planning And Motion Control For Agv In Positioning , 1989, Proceedings. IEEE/RSJ International Workshop on Intelligent Robots and Systems '. (IROS '89) 'The Autonomous Mobile Robots and Its Applications.

[13]  Katsushi Ikeuchi,et al.  Trajectory generation with curvature constraint based on energy minimization , 1991, Proceedings IROS '91:IEEE/RSJ International Workshop on Intelligent Robots and Systems '91.

[14]  T. Michael Knasel,et al.  Robotics and autonomous systems , 1988, Robotics Auton. Syst..

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

[16]  Yutaka Kanayama,et al.  Trajectory generation for mobile robots , 1984 .

[17]  Robert E. Beck,et al.  Elementary Linear Programming with Applications , 1979 .

[18]  F. G. Pin,et al.  Autonomous Trajectory Generation for Mobile Robots with Non-Holonomic and Steering Angle Constraints , 1990, Proceedings of the IEEE International Workshop on Intelligent Motion Control.

[19]  Winston Nelson,et al.  Continuous-curvature paths for autonomous vehicles , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[20]  Christian Laugier,et al.  Planning sub-optimal and continuous-curvature paths for car-like robots , 1998, Proceedings. 1998 IEEE/RSJ International Conference on Intelligent Robots and Systems. Innovations in Theory, Practice and Applications (Cat. No.98CH36190).

[21]  Birgit Graf,et al.  Flexible Path Planning for Nonholonomic Mobile Robots , 2001 .

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

[23]  Thierry Fraichard,et al.  Smooth path planning for cars , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[24]  Kazuo Tanie,et al.  Trajectory Design and Control of a Wheel-type Mobile Robot Using B-spline Curve , 1989, Proceedings. IEEE/RSJ International Workshop on Intelligent Robots and Systems '. (IROS '89) 'The Autonomous Mobile Robots and Its Applications.

[25]  John F. Canny,et al.  Planning smooth paths for mobile robots , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[26]  Wolfram Burgard,et al.  Proceedings of the Fourth European Workshop on Advanced Mobile Robots , 2001 .

[27]  A. Piazzi,et al.  Quintic G/sup 2/-splines for trajectory planning of autonomous vehicles , 2000, Proceedings of the IEEE Intelligent Vehicles Symposium 2000 (Cat. No.00TH8511).

[28]  Guy Desaulniers On shortest paths for a car-like robot maneuvering around obstacles , 1996, Robotics Auton. Syst..

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

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

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

[32]  Jing-Sin Liu,et al.  Realization of a ball passing strategy for a robot soccer game: a case study of integrated planning and control , 2004, Robotica.

[33]  François G. Pin,et al.  Navigation of a car-like mobile robot using a decomposition of the environment in convex cells , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.