Abstract:This research addresses the increasing demand for advanced navigation systems capable of operating within confined surroundings. A significant challenge in this field is developing an efficient planning framework that can generalize across various types of collision avoidance missions. Utilizing numerical optimal control techniques, this study proposes a unified optimization-based planning framework to meet these demands. We focus on handling two collision avoidance problems, i.e., the object not colliding with obstacles and not colliding with boundaries of the constrained region. The object or obstacle is denoted as a union of convex polytopes and ellipsoids, and the constrained region is denoted as an intersection of such convex sets. Using these representations, collision avoidance can be approached by formulating explicit constraints that separate two convex sets, or ensure that a convex set is contained in another convex set, referred to as separating constraints and containing constraints, respectively. We propose to use the hyperplane separation theorem to formulate differentiable separating constraints, and utilize the S-procedure and geometrical methods to formulate smooth containing constraints. We state that compared to the state of the art, the proposed formulations allow a considerable reduction in nonlinear program size and geometry-based initialization in auxiliary variables used to formulate collision avoidance constraints. Finally, the efficacy of the proposed unified planning framework is evaluated in two contexts, autonomous parking in tractor-trailer vehicles and overtaking on curved lanes. The results in both cases exhibit an improved computational performance compared to existing methods.

Interaction-Aware Vehicle Motion Planning with Collision Avoidance Constraints in Highway Traffic

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

A Guaranteed Collision‐free Trajectory Planning Method for Autonomous Parking

Optimal Control-Based Online Motion Planning For Cooperative Lane Changes Of Connected And Automated Vehicles

Collision avoidance for autonomous vehicles using reachability-based trajectory planning in highway driving

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

A Hybrid Trajectory Planning Strategy for Intelligent Vehicles with Collision Avoidance

Dynamic motion planner with trajectory optimisation for automated highway lane‐changing driving

Efficient optimization-based trajectory planning

Computational Efficient Motion Planning Method for Automated Vehicles Considering Dynamic Obstacle Avoidance and Traffic Interaction

Interaction-Aware Trajectory Prediction and Planning in Dense Highway Traffic using Distributed Model Predictive Control

Integrated Avoid Collision Control of Autonomous Vehicle Based on Trajectory Re-Planning and V2V Information Interaction

Trajectory planning for vehicle collision avoidance imitating driver behavior

Occlusion-aware collision avoidance trajectory planning with potential collision risk assessment for autonomous vehicle

Online trajectory optimization for safe autonomous overtaking with active obstacle avoidance

An Optimized Trajectory Planner and Motion Controller Framework for Autonomous Driving in Unstructured Environments

On-Road Trajectory Planning of Connected and Automated Vehicles in Complex Traffic Settings: A Hierarchical Framework of Trajectory Refinement

A Trajectory Optimization-Based Intersection Coordination Framework for Cooperative Autonomous Vehicles

Trajectory Planning for Automated Driving in Intersection Scenarios using Driver Models

On Infusing Reachability-Based Safety Assurance within Planning Frameworks for Human-Robot Vehicle Interactions

Collision-Free Cooperative Motion Planning and Decision-Making for Connected and Automated Vehicles at Unsignalized Intersections