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.

HySST: An Asymptotically Near-Optimal Motion Planning Algorithm for Hybrid Systems

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

cHyRRT and cHySST: Two Motion Planning Tools for Hybrid Dynamical Systems

Alternating Minimization Based Trajectory Generation for Quadrotor Aggressive Flight

Discrete States-Based Trajectory Planning for Nonholonomic Robots

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

Motion Planning for Hybrid Dynamical Systems: Framework, Algorithm Template, and a Sampling-based Approach

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

HyRRT-Connect: A Bidirectional Rapidly-Exploring Random Trees Motion Planning Algorithm for Hybrid Systems

SCTOMP: Spatially Constrained Time-Optimal Motion Planning

Homotopy Method for Optimal Motion Planning With Homotopy Class Constraints

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

Informed Anytime Fast Marching Tree for Asymptotically Optimal Motion Planning

Whole-Body Real-Time Motion Planning for Multicopters

Active Safe Motion Planning for Intelligent Vehicles in Dynamic Environments

AMSwarm: An Alternating Minimization Approach for Safe Motion Planning of Quadrotor Swarms in Cluttered Environments

Nearest-Neighbourless Asymptotically Optimal Motion Planning with Fully Connected Informed Trees (FCIT*)

Long-Horizon Motion Planning via Sampling and Segmented Trajectory Optimization

Synchronous Maneuver Searching and Trajectory Planning for Autonomous Vehicles in Dynamic Traffic Environments

Asymptotically Optimal Lazy Lifelong Sampling-based Algorithm for Efficient Motion Planning in Dynamic Environments

LSTP: Long Short-Term Motion Planning for Legged and Legged-Wheeled Systems