Optimal Rough Terrain Trajectory Generation for Wheeled Mobile Robots

An algorithm is presented for wheeled mobile robot trajectory generation that achieves a high degree of generality and efficiency. The generality derives from numerical linearization and inversion of forward models of propulsion, suspension, and motion for any type of vehicle. Efficiency is achieved by using fast numerical optimization techniques and effective initial guesses for the vehicle controls parameters. This approach can accommodate such effects as rough terrain, vehicle dynamics, models of wheel-terrain interaction, and other effects of interest. It can accommodate boundary and internal constraints while optimizing an objective function that might, for example, involve such criteria as obstacle avoidance, cost, risk, time, or energy consumption in any combination. The algorithm is efficient enough to use in real time due to its use of nonlinear programming techniques that involve searching the space of parameterized vehicle controls. Applications of the presented methods are demonstrated for planetary rovers.

[1]  N. DeClaris,et al.  Path planning for autonomous vehicles driving over rough terrain , 1998, Proceedings of the 1998 IEEE International Symposium on Intelligent Control (ISIC) held jointly with IEEE International Symposium on Computational Intelligence in Robotics and Automation (CIRA) Intell.

[2]  Bruce Randall Donald,et al.  On the complexity of kinodynamic planning , 1988, [Proceedings 1988] 29th Annual Symposium on Foundations of Computer Science.

[3]  Raffaello D'Andrea,et al.  Near-optimal dynamic trajectory generation and control of an omnidirectional vehicle , 2004, Robotics Auton. Syst..

[4]  Moëz Cherif,et al.  Motion planning for all-terrain vehicles: a physical modeling approach for coping with dynamic and contact interaction constraints , 1999, IEEE Trans. Robotics Autom..

[5]  Alonzo Kelly,et al.  Trajectory Generation on Rough Terrain Considering Actuator Dynamics , 2005, FSR.

[6]  Thierry Siméon,et al.  Motion generation for a rover on rough terrains , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

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

[8]  Christian Laugier,et al.  Planning the motions of an all-terrain vehicle by using geometric and physical models , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[9]  Zvi Shiller,et al.  Dynamic motion planning of autonomous vehicles , 1991, IEEE Trans. Robotics Autom..

[10]  Berthold K. P. Horn The Curve of Least Energy , 1983, TOMS.

[11]  Alonzo Kelly,et al.  Efficient Constrained Path Planning via Search in State Lattices , 2005 .

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

[13]  敏男 福田,et al.  IEEE International Workshop on Intelligent Robots and Systems '90, Towards a New Frontier of Applications, Proceedings. IROS 1990, July 3-6, 1990, Ibaraki, Japan , 1989, IROS.

[14]  Thierry Fraichard,et al.  Planning continuous-curvature paths for car-like robots , 1996, Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems. IROS '96.

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

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

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

[18]  J.W. Jackson,et al.  Curved path approaches and dynamic interpolation , 1990, 9th IEEE/AIAA/NASA Conference on Digital Avionics Systems.

[19]  Sunil K. Agrawal,et al.  Differentially Flat Systems , 2004 .

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

[21]  Alonzo Kelly,et al.  TERRAIN-ADAPTIVE GENERATION OF OPTIMAL CONTINUOUS TRAJECTORIES FOR MOBILE ROBOTS , 2005 .

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

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

[24]  John F. Canny,et al.  Time-optimal trajectories for a robot manipulator: a provably good approximation algorithm , 1990, Proceedings., IEEE International Conference on Robotics and Automation.

[25]  Mahmoud Tarokh,et al.  Kinematics modeling and analyses of articulated rovers , 2005, IEEE Transactions on Robotics.

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

[27]  Zvi Shiller,et al.  Optimal motion planning of autonomous vehicles in three dimensional terrains , 1990, Proceedings., IEEE International Conference on Robotics and Automation.

[28]  J. Betts Survey of Numerical Methods for Trajectory Optimization , 1998 .

[29]  Pietro Perona,et al.  Slip Prediction Using Visual Information , 2006, Robotics: Science and Systems.

[30]  Daniel R. Baker Exact solutions to some minimum time problems and their behavior near inequality state constraints , 1987 .

[31]  Peter Hilton,et al.  New Directions in Applied Mathematics , 1982 .

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

[33]  R. Murray,et al.  Trajectory Planning of Differentially Flat Systems with Dynamics and Inequalities , 2000 .

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

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

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

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

[38]  R. Brockett Control Theory and Singular Riemannian Geometry , 1982 .

[39]  Mark W. Maimone,et al.  Rover maneuvering for autonomous vision-based dexterous manipulation , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

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

[41]  Yang Cheng,et al.  Path following using visual odometry for a Mars rover in high-slip environments , 2004, 2004 IEEE Aerospace Conference Proceedings (IEEE Cat. No.04TH8720).

[42]  Alex Meystel,et al.  Minimum-time navigation of an unmanned mobile robot in a 2-1/2D world with obstacles , 1986, Proceedings. 1986 IEEE International Conference on Robotics and Automation.

[43]  S. Dubowsky,et al.  Planning and Control Algorithms for Enhanced Rough-Terrain Rover Mobility , 2001 .

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

[45]  J.-P. Laumond Nonholonomic motion planning via optimal control , 1995 .

[46]  Fethi Ben Ouezdou,et al.  On modeling and motion planning of planetary vehicles , 1993, Proceedings of 1993 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS '93).

[47]  Dawn M. Tilbury,et al.  Trajectory generation for a class of nonlinear systems with input and state constraints , 2001, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[48]  Alonzo Kelly,et al.  Trajectory and Spline Generation for All-Wheel Steering Mobile Robots , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[49]  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).

[50]  Ross A. Knepper,et al.  Constrained Optimization Path Following of Wheeled Robots in Natural Terrain , 2006, ISER.

[51]  A. Kelly,et al.  TRAJECTORY GENERATION FOR CAR-LIKE ROBOTS USING CUBIC CURVATURE POLYNOMIALS , 2001 .

[52]  C. Lin,et al.  Formulation and optimization of cubic polynomial joint trajectories for industrial robots , 1983 .

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

[54]  Johannes Reuter Mobile robots trajectories with continuously differentiable curvature: an optimal control approach , 1998, Proceedings. 1998 IEEE/RSJ International Conference on Intelligent Robots and Systems. Innovations in Theory, Practice and Applications (Cat. No.98CH36190).

[55]  Sanjiv Singh,et al.  Path Generation for Robot Vehicles Using Composite Clothoid Segments , 1990 .