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.

Simultaneous Arrival Planning for Multiple Unmanned Vehicles Formation Reconfiguration

Formation Control of Multi-UAV Systems with Time and Angle Constraints

Multivehicle Motion Planning with Posture Constraints in Real World

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

Vision-Based Formation Control for a Heterogeneous Multi-Robot System

Shunted Collision Avoidance for Multi-UAV Motion Planning with Posture Constraints.

Optimal Formation Control and Visual Simulation for Multiple Unmanned Aerial Vehicles (Uavs)

Vision-Based Formation Control Of A Heterogeneous Unmanned System

A survey of formation control and motion planning of multiple unmanned vehicles

Simultaneous Versus Joint Computing: A Case Study of Multi-Vehicle Parking Motion Planning.

Path planning for multiple heterogeneous Unmanned Vehicles with uncertain service times

Path Planning for the Rapid Reconfiguration of a Multi-Robot Formation Using an Integrated Algorithm

Decentralized Asynchronous Formation Planning of Multirotor Aerial Vehicles in Dynamic Environments Using Flexible Formation Graphs and Tight Trajectory Hulls

Path Planning for Vehicle-borne System Consisting of Multi Air–ground Robots

Model Based Planning Using Dubins Curve for Gliding Vehicles Rendezvous with Multiple Constraints

Formation Reconfiguration for Fixed-Wing UAVs

Multi-Vehicle Collaborative Planning Technology under Automatic Driving

Constrained Heterogeneous Vehicle Path Planning for Large-area Coverage

Efficient unmanned aerial vehicle formation rendezvous trajectory planning using Dubins path and sequential convex programming

Fast Marching based Rendezvous Path Planning for a Team of Heterogeneous Vehicle

Multiple Unmanned Ground Vehicles Cooperative Trajectory Planning with Flexible Safety Guarantees