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.

Precise trajectory optimization for articulated wheeled vehicles in cluttered environments

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

Discrete States-Based Trajectory Planning for Nonholonomic Robots

Trajectory Optimization for 3D Shape-Changing Robots with Differential Mobile Base.

An Efficient Trajectory Planner for Car-like Robots on Uneven Terrain

Alternating Minimization Based Trajectory Generation for Quadrotor Aggressive Flight

An Incremental Strategy for Tractor-Trailer Vehicle Global Trajectory Optimization in the Presence of Obstacles.

An Efficient Spatial-Temporal Trajectory Planner for Autonomous Vehicles in Unstructured Environments

Simultaneous dynamic optimization: A trajectory planning method for nonholonomic car-like robots

Optimal Cooperative Maneuver Planning for Multiple Nonholonomic Robots in a Tiny Environment Via Adaptive-Scaling Constrained Optimization

Tractor-Trailer Vehicle Trajectory Planning in Narrow Environments With a Progressively Constrained Optimal Control Approach

Hybrid Trajectory Optimization for Autonomous Terrain Traversal of Articulated Tracked Robots

Time-Optimal Trajectory Planning For Tractor-Trailer Vehicles Via Simultaneous Dynamic Optimization

Trajectory Optimization for Manipulation Considering Grasp Selection and Adjustment

Trajectory optimization for lunar rover performing vertical takeoff vertical landing maneuvers in the presence of terrain

A Real-Time Optimization-Based Trajectory Planning Method in Dynamic and Uncertain Environments

Optimization-Based Framework for Excavation Trajectory Generation

Trajectory Planning for an Autonomous Vehicle in Spatially Constrained Environments.

An Optimized Trajectory Planner and Motion Controller Framework for Autonomous Driving in Unstructured Environments

Chassis Global Dynamics-Oriented Trajectory Planning for Automated Vehicles