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.

Energy optimal real-time trajectory re-planning of an uninhabited surface vehicle in a dynamically changing environment

Collision-free Trajectory Planning for Autonomous Surface Vehicle

Energy-based trajectory tracking control of under-actuated unmanned surface vessels

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

Alternating Minimization Based Trajectory Generation for Quadrotor Aggressive Flight

An Optimal Control-Based Path Planning Method for Unmanned Surface Vehicles in Complex Environments

Efficient Trajectory Planning and Control for USV with Vessel Dynamics and Differential Flatness

Optimal Path Planning of Unmanned Surface Vehicle under Current Environment

A USV-UAV Cooperative Trajectory Planning Algorithm with Hull Dynamic Constraints

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

Trajectory Planning of Autonomous Underwater Vehicles Based on Gauss Pseudospectral Method

Achieving optimal-dynamic path planning for unmanned surface vehicles: A rational multi-objective approach and a sensory-vector re-planner

Real-Time Spatial Trajectory Planning for Urban Environments Using Dynamic Optimization

Cooperative trajectory planning algorithm of USV-UAV with hull dynamic constraints

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

Online environmentally adaptive trajectory planning for rotorcraft unmanned aerial vehicles

Energy-Optimal Trajectory Planning for Near-Space Solar-Powered UAV Based on Hierarchical Reinforcement Learning

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

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

Online Trajectory Replanning for Avoiding Moving Obstacles Using Fusion Prediction and Gradient-Based Optimization

Real-Time Trajectory Replanning for MAVs using Uniform B-splines and a 3D Circular Buffer