Abstract:Trajectory planning is of vital importance to decision-making for autonomous vehicles. Currently, there are three popular classes of cost-based trajectory planning methods: sampling-based, graph-search-based, and optimization-based. However, each of them has its own shortcomings, for example, high computational expense for sampling-based methods, low resolution for graph-search-based methods, and lack of global awareness for optimization-based methods. It leads to one of the challenges for trajectory planning for autonomous vehicles, which is improving planning efficiency while guaranteeing model feasibility. Therefore, this paper proposes a hybrid planning framework composed of two modules, which preserves the strength of both graph-search-based methods and optimization-based methods, thus enabling faster and smoother spatio-temporal trajectory planning in constrained dynamic environment. The proposed method first constructs spatio-temporal driving space based on directed acyclic graph and efficiently searches a spatio-temporal trajectory using the improved A* algorithm. Then taking the search result as reference, locally convex feasible driving area is designed and model predictive control is applied to further optimize the trajectory with a comprehensive consideration of vehicle kinematics and moving obstacles. Results simulated in four different scenarios all demonstrated feasible trajectories without emergency stop or abrupt steering change, which is kinematic-smooth to follow. Moreover, the average planning time was 31 ms, which only took 59.05%, 18.87%, and 0.69%, respectively, of that consumed by other state-of-the-art trajectory planning methods, namely, maximum interaction defensive policy, sampling-based method with iterative optimizations, and Graph-search-based method with Dynamic Programming.

STD-Trees: Spatio-temporal Deformable Trees for Multirotors Kinodynamic Planning

Integrating Fast Regional Optimization into Sampling-based Kinodynamic Planning for Multirotor Flight

Efficient Sampling-based Multirotors Kinodynamic Planning with Fast Regional Optimization and Post Refining

Discrete States-Based Trajectory Planning for Nonholonomic Robots

Alternating Minimization Based Trajectory Generation for Quadrotor Aggressive Flight

Model Predictive Trees: Sample-Efficient Receding Horizon Planning with Reusable Tree Search

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

A Riemannian Approach for Spatiotemporal Analysis and Generation of 4D Tree-shaped Structures

L4KDE: Learning for KinoDynamic Tree Expansion

TGK-Planner: An Efficient Topology Guided Kinodynamic Planner for Autonomous Quadrotors

iDb-RRT: Sampling-based Kinodynamic Motion Planning with Motion Primitives and Trajectory Optimization

Multi-Tree Guided Efficient Robot Motion Planning

HySST: A Stable Sparse Rapidly-Exploring Random Trees Optimal Motion Planning Algorithm for Hybrid Dynamical Systems

Rapidly-exploring Random Forest: Adaptively Exploits Local Structure with Generalised Multi-Trees Motion Planning

Multi-Objective and Model-Predictive Tree Search for Spatiotemporal Informative Planning

Extended Tree Search for Robot Task and Motion Planning

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

Joint-Space Multi-Robot Motion Planning with Learned Decentralized Heuristics

Sampling-Based Trajectory (re)planning for Differentially Flat Systems: Application to a 3D Gantry Crane

FRTree Planner: Robot Navigation in Cluttered and Unknown Environments with Tree of Free Regions

RDT-RRT: Real-time double-tree rapidly-exploring random tree path planning for autonomous vehicles