Abstract:Safe trajectory planning for high-performance automated vehicles in an environment with both static and moving obstacles is a challenging problem. Part of the challenge is developing a formulation that can be solved in real-time while including the following set of specifications: minimum time-to-goal, a dynamic vehicle model, minimum control effort, both static and moving obstacle avoidance, simultaneous optimization of speed and steering, and a short execution horizon. This paper presents a nonlinear model predictive control-based trajectory planning formulation, tailored for a large, high-speed unmanned ground vehicle, that includes the above set of specifications. This paper also evaluates NLOptControl's ability to solve this formulation in real-time in conjunction with the KNITRO nonlinear programming problem solver; NLOptControl is our open-source, direct-collocation based, optimal control problem solver. This formulation is tested with various sets of the specifications. In particular, a parametric study relating execution horizon and obstacle speed, indicates that the moving obstacle avoidance specification is not needed for safety when the planner has a small execution horizon ($\leq0.375\;s$) and the obstacles are moving slowly ($\leq2.11\frac{m}{s}$). However, a moving obstacle avoidance specification is needed when the obstacles are moving faster, and this specification improves the overall safety by a factor of $6.73$ ($p=2.2\times10^{-16}$) without, in most cases, increasing the solve-times. Overall, the results indicate that (1) safe trajectory planners for high-performance automated vehicles should include the entire set of specifications mentioned above, unless a static or low-speed environment permits a less comprehensive planner; and (2) NLOptControl can solve the formulation in real-time.

Time-Optimal Paths for Simple Cars with Moving Obstacles in the Hamilton-Jacobi Formulation

A Hamilton-Jacobi Formulation for Time-Optimal Paths of Rectangular Nonholonomic Vehicles

Optimization-based Motion Planning for Autonomous Parking Considering Dynamic Obstacle: A Hierarchical Framework

Efficient Optimization-Based Trajectory Planning for Unmanned Systems in Confined Environments

Time Optimal Zermelo's Navigation Problem with Moving and Fixed Obstacles.

An Efficient Semi-Real-Time Algorithm for Path Planning in the Hamilton-Jacobi Formulation

Efficient and Scalable Path-Planning Algorithms for Curvature Constrained Motion in the Hamilton-Jacobi Formulation

Safe sequential path planning of multi-vehicle systems via double-obstacle Hamilton-Jacobi-Isaacs variational inequality

Computation of avoidance regions for driver assistance systems by using a Hamilton-Jacobi approach

Simultaneous dynamic optimization: A trajectory planning method for nonholonomic car-like robots

A Unified Motion Planning Method for Parking an Autonomous Vehicle in the Presence of Irregularly Placed Obstacles

A Hamilton-Jacobi Formulation for Optimal Coordination of Heterogeneous Multiple Vehicle Systems

Optimal Cooperative Maneuver Planning for Multiple Nonholonomic Robots in a Tiny Environment Via Adaptive-Scaling Constrained Optimization

Nonlinear programming for multi-vehicle motion planning with homotopy initialization strategies

On the Complexity of an Unregulated Traffic Crossing

Time-optimal Path Planning for Autonomous Vehicles Based on Bi-Level Programming

On Time-optimal Trajectories for a Car-like Robot with One Trailer

Homotopy Method for Optimal Motion Planning With Homotopy Class Constraints

Path Planning in Dynamic Environments with Adaptive Dimensionality

Real-time trajectory planning for automated vehicle safety and performance in dynamic environments