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.

Collision Detection Between Convex Objects Using Pseudo-Distance and Unconstrained Optimization

Polyhedron-bounded Collision Checks for Robotic Assembly of Structural Components

Exact Obstacle Avoidance for Autonomous Vehicles in Polygonal Domains

A Linear and Exact Algorithm for Whole-Body Collision Evaluation Via Scale Optimization

Efficient Probabilistic Collision Detection for Non-Convex Shapes

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

Differentiable Collision Detection for a Set of Convex Primitives

Collision Detection Accelerated: An Optimization Perspective

An Overview on Distance and Pseudo Distance Functions and Their Applications

Optimized Space Decomposition Algorithm for Parallel Continuous Collision Detection

Continuous Collision Detection for Non-Rigid Contact Computations Using Local Advancement.

PolyDepth

A Parallel Collision Detection Algorithm Based On Hybrid Bounding Volume Hierarchy

PolyDepth: Real-time Penetration Depth Computation Using Iterative Contact-Space Projection

ICCD: Interactive Continuous Collision Detection Between Deformable Models Using Connectivity-Based Culling

Fast and accurate continuous collision detection between rigid bodies

Proximity Query Based on Second Order Cone Programming Using Convex Superquadrics: a Static Collision Detection Algorithm for Narrow-Phase

Parallel Collision Detection Between Deformable Objects Using SIMD Instructions

Multi-core collision detection between deformable models

Accurate Self-Collision Detection Using Enhanced Dual-Cone Method

Simple and Rapid Collision Detection Using Multiple Viewing Volumes.