DeepAI AI Chat
Log In Sign Up

Robust Motion Planning in the Presence of Estimation Uncertainty

by   Lars Lindemann, et al.
University of Pennsylvania

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.


page 1

page 2

page 3

page 4


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

Many practical applications of robotics require systems that can operate...

Robust Combination of Local Controllers

Planning problems are hard, motion planning, for example, isPSPACE-hard....

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 ...

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...

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...

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

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