Optimal motion planning of autonomous vehicles in three dimensional terrains

A method is presented for optimally planning the motions of autonomous vehicles, considering vehicle dynamics, terrain topography, obstacles, and surface mobility. The terrain is represented by a smooth cubic B patch, and the geometric path consists of a two dimensional B spline curve mapped to the three-dimensional surface. The path is optimized with a parameter optimization procedure, using motion time as the cost function. The optimal motion time along the path is computed by transforming the constraints between the vehicle and ground to limits on vehicle speeds. The optimal speeds which minimize motion time are then obtained below the velocity limits, using the maximum acceleration of deceleration at all times. Examples are presented which demonstrate the method for a simple dynamic model of a vehicle moving on mountainous terrain.<<ETX>>

[1]  Shin'ichi Yuta,et al.  Vehicle path specification by a sequence of straight lines , 1988, IEEE J. Robotics Autom..

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

[3]  J. Bobrow,et al.  Time-Optimal Control of Robotic Manipulators Along Specified Paths , 1985 .

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

[5]  Steven Dubowsky,et al.  Global time optimal motions of robotic manipulators in the presence of obstacles , 1988, Proceedings. 1988 IEEE International Conference on Robotics and Automation.

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

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

[8]  Steven Dubowsky,et al.  Robot Path Planning with Obstacles, Actuator, Gripper, and Payload Constraints , 1989, Int. J. Robotics Res..

[9]  Zvi Shiller,et al.  Robust computation of path constrained time optimal motions , 1990, Proceedings., IEEE International Conference on Robotics and Automation.

[10]  Alexandre M. Parodi.  Multi-goal real-time global path planning for an autonomous land vehicle using a high-speed graph search processor , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[11]  Z. Shiller,et al.  On the optimal control of robotic manipulators with actuator and end-effector constraints , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.