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.

$\mathsf{QuITO}$ $\textsf{v.2}$: Trajectory Optimization with Uniform Error Guarantees under Path Constraints

QuITO: Numerical software for constrained nonlinear optimal control problems -- extended version

A Quasi-Sequential Algorithm for PDE-constrained Optimization Based on Space–time Orthogonal Collocation on Finite Elements

An Improved Quasi-Sequential Approach To Large-Scale Dynamic Process Optimization

A quasi-sequential approach to large-scale dynamic optimization problems

A Novel Mesh Discretization Strategy for Numerical Solution of Optimal Control Problems in Aerospace Engineering.

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

Improved Sequential Convex Programming Based on Pseudospectral Discretization for Entry Trajectory Optimization

Direct Collocation for Quantum Optimal Control

Successive Convexification for Trajectory Optimization with Continuous-Time Constraint Satisfaction

GuSTO: Guaranteed Sequential Trajectory Optimization via Sequential Convex Programming

Simultaneous Trajectory Optimization and Contact Selection for Contact-rich Manipulation with High-Fidelity Geometry

Optimizing Trajectories with Closed-Loop Dynamic SQP

Revisiting Implicit Differentiation for Learning Problems in Optimal Control

Accurate Solutions to Optimal Control Problems via a Flexible Mesh and Integrated Residual Transcription

Constrained Trajectory Optimization for Hybrid Dynamical Systems

Solving quantum optimal control problems using projection-operator-based Newton steps

Direct Collocation Methods for Trajectory Optimization in Constrained Robotic Systems

Quadratic Interpolation Optimization (QIO): A new optimization algorithm based on generalized quadratic interpolation and its applications to real-world engineering problems

Generalizing Trajectory Retiming to Quadratic Objective Functions

Recent Advances in Path Integral Control for Trajectory Optimization: An Overview in Theoretical and Algorithmic Perspectives