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

03/03/2020
by   Shreyas Kousik, et al.
0

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.

READ FULL TEXT

page 1

page 14

research
09/18/2018

Bridging the Gap Between Safety and Real-Time Performance in Receding-Horizon Trajectory Design for Mobile Robots

Autonomous mobile robots must operate with limited sensor horizons in un...
research
05/30/2020

A real-time multi-constraints obstacle avoidance method based on LiDAR

Obstacle avoidance is one of the essential and indispensable functions f...
research
03/01/2021

LTO: Lazy Trajectory Optimization with Graph-Search Planning for High DOF Robots in Cluttered Environments

Although Trajectory Optimization (TO) is one of the most powerful motion...
research
02/24/2023

RLSS: Real-time, Decentralized, Cooperative, Networkless Multi-Robot Trajectory Planning using Linear Spatial Separations

Trajectory planning for multiple robots in shared environments is a chal...
research
04/11/2019

Safe, Aggressive Quadrotor Flight via Reachability-based Trajectory Design

Quadrotors can provide services such as infrastructure inspection and se...
research
11/26/2021

Rapid and Reliable Trajectory Planning Involving Omnidirectional Jumping of Quadruped Robots

Dynamic jumping with multi-legged robots poses a challenging problem in ...
research
02/23/2022

Trajectory planning in Dynamics Environment : Application for Haptic Perception in Safe HumanRobot Interaction

In a human-robot interaction system, the most important thing to conside...

Please sign up or login with your details

Forgot password? Click here to reset