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.

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

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

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

Tractor-Trailer Vehicle Trajectory Planning in Narrow Environments With a Progressively Constrained Optimal Control Approach

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

An optimal trajectory planning for automated on-ramp merging

Trajectory Planning for a Tractor with Multiple Trailers in Extremely Narrow Environments: A Unified Approach*

A Guaranteed Collision‐free Trajectory Planning Method for Autonomous Parking

A symplectic method for trajectory planning of general tractor-trailer systems

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

Time-Optimal Maneuver Planning in Automatic Parallel Parking Using a Simultaneous Dynamic Optimization Approach

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

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

Autonomous Parking: A Unified Motion Planning Framework Based On Simultaneous Dynamic Optimization

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

Trajectory Re-Planning and Tracking Control for a Tractor–Trailer Mobile Robot Subject to Multiple Constraints

Real-Time Optimal Trajectory Planning for Autonomous Driving with Collision Avoidance Using Convex Optimization

Optimal Vehicle Trajectory Planning for Static Obstacle Avoidance using Nonlinear Optimization

Time-optimal and Jerk-continuous Trajectory Planning Algorithm for Manipulators

Chassis Global Dynamics-Oriented Trajectory Planning for Automated Vehicles

Time-Optimal Trajectory Planning for Robots with Identified Dynamics.