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.

Fast and Bounded Probabilistic Collision Detection in Dynamic Environments for High-DOF Trajectory Planning

Robust Hierarchical Model Predictive Control for Trajectory Tracking with Obstacle Avoidance

A Guaranteed Collision‐free Trajectory Planning Method for Autonomous Parking

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

Predictive Probability Path Planning Model For Dynamic Environments

I-Planner: Intention-Aware Motion Planning Using Learning Based Human Motion Prediction

Scenario-Based Motion Planning with Bounded Probability of Collision

Online Trajectory Generation with Local Replanning for 7-Dof Serial Manipulator in Unforeseen Dynamic Environments

A Real-Time Approach for Chance-Constrained Motion Planning with Dynamic Obstacles

Fast Motion Planning for High-DOF Robot Systems Using Hierarchical System Identification

Real-Time Navigation In Dynamic Human Environments Using Optimal Reciprocal Collision Avoidance

Efficient Probabilistic Collision Detection for Non-Convex Shapes

Dynamical Obstacle Avoidance of Task- Constrained Mobile Manipulation Using Model Predictive Control

Model Predictive Contouring Control for Collision Avoidance in Unstructured Dynamic Environments

DREAM: Decentralized Real-time Asynchronous Probabilistic Trajectory Planning for Collision-free Multi-Robot Navigation in Cluttered Environments

Fast-reactive probabilistic motion planning for high-dimensional robots

An online collision-free trajectory generation algorithm for human–robot collaboration

Probabilistic Higher-Order Velocity Obstacle for Dynamic Collision Avoidance in Uncertain Environments

Chance-Constrained Trajectory Optimization for High-DOF Robots in Uncertain Environments

Intent-Aware Probabilistic Trajectory Estimation for Collision Prediction with Uncertainty Quantification

Exploration, Path Planning with Obstacle and Collision Avoidance in a Dynamic Environment