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.

A Two-Stage Optimization-based Motion Planner for Safe Urban Driving

Rollout-Based Interactive Motion Planning for Automated Vehicles *

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

Hybrid Imitation-Learning Motion Planner for Urban Driving

Towards a Safe Real-Time Motion Planning Framework for Autonomous Driving Systems: An MPPI Approach

Optimal Control-Based Online Motion Planning For Cooperative Lane Changes Of Connected And Automated Vehicles

Synergizing Decision Making and Trajectory Planning Using Two-Stage Optimization for Autonomous Vehicles

Search-Based Optimal Motion Planning for Automated Driving

Motion Planning by Search in Derivative Space and Convex Optimization with Enlarged Solution Space

Motion Planning for Connected Automated Vehicles at Occluded Intersections With Infrastructure Sensors

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

Task-Motion Planning for Safe and Efficient Urban Driving

Integrated Behavior Planning and Motion Control for Autonomous Vehicles with Traffic Rules Compliance

Real-Time Optimal Trajectory Planning for Autonomous Driving with Collision Avoidance Using Convex Optimization

A Real-Time Motion Planner with Trajectory Optimization for Autonomous Vehicles

Optimal Control-Based Highway Pilot Motion Planner with Stochastic Traffic Consideration

A Risk and Comfort Optimizing Motion Planning Scheme for Merging Scenarios

Lab2Car: A Versatile Wrapper for Deploying Experimental Planners in Complex Real-world Environments

A Successive Linearization in Feasible Set Algorithm for Vehicle Motion Planning in Unstructured and Low-Speed Scenarios

DNFOMP: Dynamic Neural Field Optimal Motion Planner for Navigation of Autonomous Robots in Cluttered Environment

A Hybrid Motion Planning Framework for Autonomous Driving in Mixed Traffic Flow