A motion planner for nonholonomic mobile robots

This paper considers the problem of motion planning for a car-like robot (i.e., a mobile robot with a nonholonomic constraint whose turning radius is lower-bounded). We present a fast and exact planner for our mobile robot model, based upon recursive subdivision of a collision-free path generated by a lower-level geometric planner that ignores the motion constraints. The resultant trajectory is optimized to give a path that is of near-minimal length in its homotopy class. Our claims of high speed are supported by experimental results for implementations that assume a robot moving amid polygonal obstacles. The completeness and the complexity of the algorithm are proven using an appropriate metric in the configuration space R/sup 2//spl times/S/sup 1/ of the robot. This metric is defined by using the length of the shortest paths in the absence of obstacles as the distance between two configurations. We prove that the new induced topology and the classical one are the same. Although we concentrate upon the car-like robot, the generalization of these techniques leads to new theoretical issues involving sub-Riemannian geometry and to practical results for nonholonomic motion planning. >

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

[2]  L. S. Pontryagin,et al.  Mathematical Theory of Optimal Processes , 1962 .

[3]  S. Sternberg Lectures on Differential Geometry , 1964 .

[4]  C. Lobry Contr^olabilite des systemes non lineaires , 1970 .

[5]  H. Sussmann,et al.  Controllability of nonlinear systems , 1972 .

[6]  M. Spivak A comprehensive introduction to differential geometry , 1979 .

[7]  A. Krener,et al.  Nonlinear controllability and observability , 1977 .

[8]  R. Abraham,et al.  Manifolds, Tensor Analysis, and Applications , 1983 .

[9]  J. Schwartz,et al.  On the “piano movers” problem. II. General techniques for computing topological properties of real algebraic manifolds , 1983 .

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

[11]  Chee-Keng Yap,et al.  A "Retraction" Method for Planning the Motion of a Disc , 1985, J. Algorithms.

[12]  Jean-Paul Laumond,et al.  Feasible Trajectories for Mobile Robots with Kinematic and Environment Constraints , 1986, IAS.

[13]  R. Strichartz Sub-Riemannian geometry , 1986 .

[14]  R. Strichartz The Campbell-Baker-Hausdorff-Dynkin formula and solutions of differential equations , 1987 .

[15]  Jean-Paul Laumond,et al.  Finding Collision-Free Smooth Trajectories for a Non-Holonomic Mobile Robot , 1987, IJCAI.

[16]  Pierre Tournassoud Motion planning for a mobile robot with a kinematic constraint , 1988, Geometry and Robotics.

[17]  Jean-Daniel Boissonnat,et al.  A practical exact motion planning algorithm for polygonal object amidst polygonal obstacles , 1988, Geometry and Robotics.

[18]  Gordon T. Wilfong,et al.  Planning constrained motion , 1988, STOC '88.

[19]  A. Vershik,et al.  Nonholonomic problems and the theory of distributions , 1988 .

[20]  Thierry Siméon,et al.  Trajectory planning and motion control for mobile robots , 1988, Geometry and Robotics.

[21]  J. Latombe,et al.  On nonholonomic mobile robots and optimal maneuvering , 1989, Proceedings. IEEE International Symposium on Intelligent Control 1989.

[22]  Micha Sharir,et al.  Algorithmic motion planning in robotics , 1991, Computer.

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

[24]  Georges Giralt,et al.  An Integrated Navigation and Motion Control System for Autonomous Multisensory Mobile Robots , 1990, Autonomous Robot Vehicles.

[25]  Zexiang Li,et al.  Motion of two rigid bodies with rolling constraint , 1990, IEEE Trans. Robotics Autom..

[26]  Jean-Paul Laumond,et al.  A motion planner for car-like robots based on a mixed global/local approach , 1990, EEE International Workshop on Intelligent Robots and Systems, Towards a New Frontier of Applications.

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

[28]  Yoshihiko Nakamura,et al.  Nonholonomic path planning of space robots via bi-directional approach , 1990, Proceedings., IEEE International Conference on Robotics and Automation.

[29]  Gordon Wilfong Motion Planning for an Autonomous Vehicle , 1990, Autonomous Robot Vehicles.

[30]  S. Sastry,et al.  Steering nonholonomic systems using sinusoids , 1990, 29th IEEE Conference on Decision and Control.

[31]  Claude Samson,et al.  Feedback control of a nonholonomic wheeled cart in Cartesian space , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[32]  Richard M. Murray,et al.  Robotic control and nonholonomic motion planning , 1991 .

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

[34]  Jean-Paul Laumond,et al.  Controllability of a multibody mobile robot , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[35]  P. S. Krishnaprasad,et al.  Geometric phases, anholonomy, and optimal movement , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[36]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[37]  Jean-Daniel Boissonnat,et al.  Shortest paths of Bounded Curvature in the Plane , 1991, Geometric Reasoning for Perception and Action.

[38]  H. Sussmann,et al.  Limits of highly oscillatory controls and the approximation of general paths by admissible trajectories , 1991, [1991] Proceedings of the 30th IEEE Conference on Decision and Control.

[39]  Carlos Canudas de Wit,et al.  Path following of a 2-DOF wheeled mobile robot under path and input torque constraints , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[40]  Jean-Claude Latombe A Fast Path Planner for a Car-Like Indoor Mobile Robot , 1991, AAAI.

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

[42]  S. Shankar Sastry,et al.  Steering car-like systems with trailers using sinusoids , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[43]  J. Laumond,et al.  NILPOTENT INFINITESIMAL APPROXIMATIONS TO A CONTROL LIE ALGEBRA , 1992 .

[44]  Georges Bastin,et al.  Dynamic feedback linearization of nonholonomic wheeled mobile robots , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[45]  Jean-Paul Laumond,et al.  Singularities and Topological Aspects in Nonholonomic Motion Planning , 1993 .

[46]  S. Sastry,et al.  Stabilization of trajectories for systems with nonholonomic constraints , 1994 .