Abstract:In the field of autonomous driving trajectory planning, it’s virtual to ensure real-time planning while guaranteeing feasibility and robustness. Current widely adopted approaches include decoupling path planning and velocity planning based on optimization method, which can’t always yield optimal solutions, especially in complex dynamic scenarios. Furthermore, search-based and sampling-based solutions encounter limitations due to their low resolution and high computational costs. This paper presents a novel spatio-temporal trajectory planning approach that integrates both search-based planning and optimization-based planning method. This approach retains the advantages of search-based method, allowing for the identification of a global optimal solution through search. To address the challenge posed by the non-convex nature of the original solution space, we introduce a spatio-temporal semantic corridor structure, which constructs a convex feasible set for the problem. Trajectory optimization is then performed through numerical optimization methods, resulting in real-time and robust spatio-temporal trajectory planning. The proposed approach initiates by constructing a 3D spatio- temporal map that incorporates information such as dynamic obstacles. Improved A* algorithm is used to search for a preliminary spatio- temporal trajectory, serving as an initial approximation for the trajectory. Based on this initial approximation, a spatio-temporal corridor is constructed as locally convex feasible driving area, then a quintic monomial polynomial is employed to represent a trajectory, considering vehicle kinematics, continuity, and other constraints, this formulation transforms the problem into a general quadratic programming problem. Ultimately, the generated trajectories are rigorously tested through simulations in scenarios involving overtaking and side car cut-in. The results indicate that the generated trajectories are feasible, reasonable, and exhibit good real-time performance.

Flexible Final-Time Stochastic Differential Dynamic Programming for Autonomous Vehicle Trajectory Optimization

Trajectory optimization of autonomous driving by differential dynamic programming

Secure Model Predictive Static Programming with Initial Value Generator for Online Computational Guidance of Near-Space Vehicles

Time-Optimal Trajectory Planning For Tractor-Trailer Vehicles Via Simultaneous Dynamic Optimization

Trajectory tracking control for underactuated autonomous vehicles via adaptive dynamic programming

Safety-Dominant Stochastic Model Predictive Decision-Making Considering Obstacle Trajectory Uncertainties for Intelligent Vehicles

A Real-Time Optimization-Based Trajectory Planning Method in Dynamic and Uncertain Environments

VS-DDP: Variable Splitting Based Differential Dynamic Programming Algorithm for Autonomous Trajectory Planning

Constrained Parameterized Differential Dynamic Programming for Waypoint-Trajectory Optimization

Suboptimal Trajectory Programming for Unmanned Aerial Vehicles with Dynamic Obstacle Avoidance

Time-Optimal Trajectory Generation for Dynamic Vehicles: A Bilevel Optimization Approach.

An Optimal Trajectory Planning for Autonomous Vehicles Based on Vehicle Dynamics Constraints

Stochastic trajectory optimization for mechanical systems with parametric uncertainties

Differential Dynamic Programming for time-delayed systems

Fast and Certifiable Trajectory Optimization

Solving Trajectory Optimization Problems in the Presence of Probabilistic Constraints

Spatio-Temporal Trajectory Planning Using Search And Optimizing Method for Autonomous Driving

Stochastic optimal control for autonomous driving applications via polynomial chaos expansions

Towards Fast and Safety-Guaranteed Trajectory Planning and Tracking for Time-Varying Systems

An Efficient Spatial-Temporal Trajectory Planner for Autonomous Vehicles in Unstructured Environments

Enable Faster and Smoother Spatio-Temporal Trajectory Planning for Autonomous Vehicles in Constrained Dynamic Environment