Abstract:In this work, we propose a trajectory optimization approach for robot navigation in cluttered 3D environments. We represent the robot's geometry as a semialgebraic set defined by polynomial inequalities such that robots with general shapes can be suitably characterized. To address the robot navigation task in obstacle-dense environments, we exploit the free space directly to construct a sequence of free regions, and allocate each waypoint on the trajectory to a specific region. Then, we incorporate a uniform scaling factor for each free region, and formulate a Sums-of-Squares (SOS) optimization problem that renders the containment relationship between the robot and the free space computationally tractable. The SOS optimization problem is further reformulated to a semidefinite program (SDP), and the collision-free constraints are shown to be equivalent to limiting the scaling factor along the entire trajectory. In this context, the robot at a specific configuration is tailored to stay within the free region. Next, to solve the trajectory optimization problem with the proposed safety constraints (which are implicitly dependent on the robot configurations), we derive the analytical solution to the gradient of the minimum scaling factor with respect to the robot configuration. As a result, this seamlessly facilitates the use of gradient-based methods in efficient solving of the trajectory optimization problem. Through a series of simulations and real-world experiments, the proposed trajectory optimization approach is validated in various challenging scenarios, and the results demonstrate its effectiveness in generating collision-free trajectories in dense and intricate environments populated with obstacles. Our code is available at: <a class="link-external link-https" href="https://github.com/lyl00/minimum_scaling_free_region" rel="external noopener nofollow">this https URL</a>

Provably Feasible Semi-Infinite Program Under Collision Constraints via Subdivision

Provably Robust Semi-Infinite Program Under Collision Constraints via Subdivision

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

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

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

Efficient and Robust Strain Limiting and Treatment of Simultaneous Collisions with Semidefinite Programming.

Creating Better Collision-Free Trajectory for Robot Motion Planning by Linearly Constrained Quadratic Programming.

Collision-Free Trajectory Optimization in Cluttered Environments Using Sums-of-Squares Programming

Semi-Infinite Optimization with Hybrid Models

Continuous Implicit SDF Based Any-shape Robot Trajectory Optimization

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

Semi-Infinite Programs for Robust Control and Optimization: Efficient Solutions and Extensions to Existence Constraints

Implicit Swept Volume SDF: Enabling Continuous Collision-Free Trajectory Generation for Arbitrary Shapes

Efficient collision avoidance for autonomous vehicles in polygonal domains

Contact-Rich Trajectory Generation in Confined Environments Using Iterative Convex Optimization

Second-Order Convergent Collision-Constrained Optimization-Based Planner

Collision-free Trajectory Planning for UAVs Based on Sequential Convex Programming

A Novel Optimization-Based Collision Avoidance For Autonomous On-Orbit Assembly

Embedded IPC: Fast and Intersection-free Simulation in Reduced Subspace for Robot Manipulation

Collision Avoidance using Iterative Dynamic and Nonlinear Programming with Adaptive Grid Refinements