Robust Motion Planning in the Presence of Estimation Uncertainty

08/26/2021
by   Lars Lindemann, et al.
0

Motion planning is a fundamental problem and focuses on finding control inputs that enable a robot to reach a goal region while safely avoiding obstacles. However, in many situations, the state of the system may not be known but only estimated using, for instance, a Kalman filter. This results in a novel motion planning problem where safety must be ensured in the presence of state estimation uncertainty. Previous approaches to this problem are either conservative or integrate state estimates optimistically which leads to non-robust solutions. Optimistic solutions require frequent replanning to not endanger the safety of the system. We propose a new formulation to this problem with the aim to be robust to state estimation errors while not being overly conservative. In particular, we formulate a stochastic optimal control problem that contains robustified risk-aware safety constraints by incorporating robustness margins to account for state estimation errors. We propose a novel sampling-based approach that builds trees exploring the reachable space of Gaussian distributions that capture uncertainty both in state estimation and in future measurements. We provide robustness guarantees and show, both in theory and simulations, that the induced robustness margins constitute a trade-off between conservatism and robustness for planning under estimation uncertainty that allows to control the frequency of replanning.

READ FULL TEXT

page 1

page 2

page 3

page 4

research
01/31/2023

Chance-Constrained Trajectory Optimization for High-DOF Robots in Uncertain Environments

Many practical applications of robotics require systems that can operate...
research
01/10/2013

Robust Combination of Local Controllers

Planning problems are hard, motion planning, for example, isPSPACE-hard....
research
12/11/2020

Learning How to Trade-Off Safety with Agility Using Deep Covariance Estimation for Perception Driven UAV Motion Planning

We investigate how to utilize predictive models for selecting appropriat...
research
07/13/2023

CaRT: Certified Safety and Robust Tracking in Learning-based Motion Planning for Multi-Agent Systems

The key innovation of our analytical method, CaRT, lies in establishing ...
research
09/16/2021

Back to the Future: Efficient, Time-Consistent Solutions in Reach-Avoid Games

We study the class of reach-avoid dynamic games in which multiple agents...
research
03/03/2022

The RATTLE Motion Planning Algorithm for Robust Online Parametric Model Improvement with On-Orbit Validation

Certain forms of uncertainty that robotic systems encounter can be expli...
research
05/15/2022

Output-Feedback Path Planning with Robustness to State-Dependent Errors

We consider the problem of sample-based feedback motion planning from me...

Please sign up or login with your details

Forgot password? Click here to reset