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>

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

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

Discrete States-Based Trajectory Planning for Nonholonomic Robots

Visualized Trajectory Planning of Flexible Redundant Robotic Arm Using A Novel Hybrid Algorithm

Dynamical Obstacle Avoidance of Task- Constrained Mobile Manipulation Using Model Predictive Control

Adaptive Model Prediction Control-Based Multi-Terrain Trajectory Tracking Framework for Mobile Spherical Robots

Universal Trajectory Optimization Framework for Differential Drive Robot Class

Trajectory Optimization for Manipulation Considering Grasp Selection and Adjustment

Hybrid Trajectory Optimization for Autonomous Terrain Traversal of Articulated Tracked Robots

Continuous Implicit SDF Based Any-shape Robot Trajectory Optimization

Online Dynamic Trajectory Optimization and Control for a Quadruped Robot

Topology-Driven Parallel Trajectory Optimization in Dynamic Environments

Online Decentralized Receding Horizon Trajectory Optimization for Multi-Robot systems

Towards Efficient Trajectory Generation for Ground Robots beyond 2D Environment

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

Trajectory Generation Method for Serial Robots in Hybrid Space Operations

Receding-Horizon Vision Guidance with Smooth Trajectory Blending in the Field of View of Mobile Robots

Optimal Trajectory Planning for Wheeled Robots (OTPWR): A Globally and Dynamically Optimal Trajectory Planning Method for Wheeled Mobile Robots

Trajectory optimization for a class of robots belonging to Constrained Collaborative Mobile Agents (CCMA) family

Trajectory optimisation in collaborative robotics based on simulations and genetic algorithms