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.

Safe Feedback Motion Planning: A Contraction Theory and $\mathcal{L}_1$-Adaptive Control Based Approach

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

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

Tube-Certified Trajectory Tracking for Nonlinear Systems With Robust Control Contraction Metrics

Safe Output Feedback Motion Planning from Images via Learned Perception Modules and Contraction Theory

Synthesis of output feedback control for motion planning based on LTL specifications

Safe Feedback Motion Planning in Unknown Environments: An Instantaneous Local Control Barrier Function Approach

Safe Set-Based Trajectory Planning for Robotic Manipulators

Spline Trajectory Tracking and Obstacle Avoidance for Mobile Agents via Convex Optimization

From Low to High Order Motion Planners: Safe Robot Navigation using Motion Prediction and Reference Governor

Fast and Accurate Motion Tracking of a Linear Motor System under Kinematic and Dynamic Constraints: an Integrated Planning and Control Approach

Real-Time Tube-Based Non-Gaussian Risk Bounded Motion Planning for Stochastic Nonlinear Systems in Uncertain Environments via Motion Primitives

Safe Motion Planning and Control for Mobile Robots: A Survey

Real-time Funnel Generation for Restricted Motion Planning

Constant-time Motion Planning with Anytime Refinement for Manipulation

Safe and Dynamically-Feasible Motion Planning using Control Lyapunov and Barrier Functions

CaRT: Certified Safety and Robust Tracking in Learning-based Motion Planning for Multi-Agent Systems

Learning Certified Control using Contraction Metric

Robust Lattice-based Motion Planning

Optimal Motion Planning under Dynamic Risk Region for Safe Human–Robot Cooperation

LQR-CBF-RRT*: Safe and Optimal Motion Planning