Abstract:To move through the world, mobile robots typically use a receding-horizon strategy, wherein they execute an old plan while computing a new plan to incorporate new sensor information. A plan should be dynamically feasible, meaning it obeys constraints like the robot's dynamics and obstacle avoidance; it should have liveness, meaning the robot does not stop to plan so frequently that it cannot accomplish tasks; and it should be optimal, meaning that the robot tries to satisfy a user-specified cost function such as reaching a goal location as quickly as possible. Reachability-based Trajectory Design (RTD) is a planning method that can generate provably dynamically-feasible plans. However, RTD solves a nonlinear polynmial optimization program at each planning iteration, preventing optimality guarantees; furthermore, RTD can struggle with liveness because the robot must brake to a stop when the solver finds local minima or cannot find a feasible solution. This paper proposes RTD*, which certifiably finds the globally optimal plan (if such a plan exists) at each planning iteration. This method is enabled by a novel Parallelized Constrained Bernstein Algorithm (PCBA), which is a branch-and-bound method for polynomial optimization. The contributions of this paper are: the implementation of PCBA; proofs of bounds on the time and memory usage of PCBA; a comparison of PCBA to state of the art solvers; and the demonstration of PCBA/RTD* on a mobile robot. RTD* outperforms RTD in terms of optimality and liveness for real-time planning in a variety of environments with randomly-placed obstacles.

Real-time Trajectory Planning for Free-Floating Space Robot in Close Range Using Continuous Thrust

Real-Time Trajectory Planning for Aerial Perching.

Alternating Minimization Based Trajectory Generation for Quadrotor Aggressive Flight

Real-Time Path Planning for Mobile Robots

Discrete States-Based Trajectory Planning for Nonholonomic Robots

Real-time Generation of a Continuous Acceleration Trajectory for Mobile Robots

Optimal Predefined-time Trajectory Planning for a Free-floating Space Robot

On-Road Trajectory Planning With Spatio-Temporal Rrt* And Always-Feasible Quadratic Program

Autonomous Trajectory Planning of Free-floating Robot for Capturing Space Target.

Collision-Free Optimal Trajectory for a Controlled Floating Space Robot

A Multi-Target Trajectory Planning of a 6-Dof Free-Floating Space Robot Via Reinforcement Learning

An End-to-End Trajectory Planning Strategy for Free-floating Space Robots

Predefined-Time Trajectory Planning For A Dual-Arm Free-Floating Space Robot

Motion Planning and Control for On-Orbit Assembly using LQR-RRT* and Nonlinear MPC

Real-time Acceleration-continuous Path-constrained Trajectory Planning With Built-in Tradability Between Cruise and Time-optimal Motions

Safe Trajectory Planning for Incremental Robots Based on a Spatiotemporal Variable-Step-Size A* Algorithm

Safe, Optimal, Real-time Trajectory Planning with a Parallel Constrained Bernstein Algorithm

Trajectory Optimization and Tracking Control of Free-flying Space Robots for Capturing Non-cooperative Tumbling Objects

Real-time motion planning for an autonomous mobile robot with wheel-ground adhesion constraint

Real-Time Motion Planning for Quadrotor MAVs in Three-dimensional Complex Environment