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.

Down-Sized Initialization for Optimization-Based Unstructured Trajectory Planning by Only Optimizing Critical Variables

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

An Incremental Strategy for Tractor-Trailer Vehicle Global Trajectory Optimization in the Presence of Obstacles.

Alternating Minimization Based Trajectory Generation for Quadrotor Aggressive Flight

Automatic Parameter Adaptation for Quadrotor Trajectory Planning

Trajectory Planning for an Autonomous Vehicle in Spatially Constrained Environments.

Improved Sequential Convex Programming Based on Pseudospectral Discretization for Entry Trajectory Optimization

Spatio-temporal decomposition: a knowledge-based initialization strategy for parallel parking motion optimization.

Optimization-Based Maneuver Planning for a Tractor-Trailer Vehicle in a Curvy Tunnel: A Weak Reliance on Sampling and Search

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

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

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

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

Precise trajectory optimization for articulated wheeled vehicles in cluttered environments

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

Efficient optimization-based trajectory planning

On-Road Trajectory Planning With Spatio-Temporal Rrt* And Always-Feasible Quadratic Program

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

A Real-Time Motion Planner with Trajectory Optimization for Autonomous Vehicles

Entry Trajectory Optimization with Virtual Motion Camouflage Principle

Learning-Initialized Trajectory Planning in Unknown Environments