Chance-Constrained Trajectory Optimization for High-DOF Robots in Uncertain Environments
Preprint
Abstract
Many practical applications of robotics require systems that can operate safely despite uncertainty. In the context of motion planning, two types of uncertainty are particularly important when planning safe robot trajectories. The first is environmental uncertainty -- uncertainty in the locations of nearby obstacles, stemming from sensor noise or (in the case of obstacles' future locations) prediction error. The second class of uncertainty is uncertainty in the robots own state, typically caused by tracking or estimation error. To achieve high levels of safety, it is necessary for robots to consider both of these sources of uncertainty. In this paper, we propose a risk-bounded trajectory optimization algorithm, known as Sequential Convex Optimization with Risk Optimization (SCORA), to solve chance-constrained motion planning problems despite both environmental uncertainty and tracking error. Through experiments in simulation, we demonstrate that SCORA significantly outperforms state-of-the-art risk-aware motion planners both in planning time and in the safety of the resulting trajectories.Keywords
All Related Versions
This publication has 12 references indexed in Scilit:
- Chance Constrained Motion Planning for High-Dimensional Robots2019
- Provably safe robot navigation with obstacle uncertaintyThe International Journal of Robotics Research, 2018
- Fast and Bounded Probabilistic Collision Detection for High-DOF Trajectory Planning in Dynamic EnvironmentsIEEE Transactions on Automation Science and Engineering, 2018
- Finding Locally Optimal, Collision-Free Trajectories with Sequential Convex Optimization2013
- Chance-Constrained Optimal Path Planning With ObstaclesIEEE Transactions on Robotics, 2011
- LQG-MP: Optimized path planning for robots with motion uncertainty and imperfect state informationThe International Journal of Robotics Research, 2011
- Rapidly-exploring Random Belief Trees for motion planning under uncertainty2011
- Iterative Risk Allocation: A new approach to robust Model Predictive Control with a joint chance constraint2008
- SNOPT: An SQP Algorithm for Large-Scale Constrained OptimizationSIAM Review, 2005
- A fast procedure for computing the distance between complex objects in three-dimensional spaceIEEE Journal on Robotics and Automation, 1988