Chance-Constrained Sequential Convex Programming for Robust Trajectory Optimization

Planning safe trajectories for nonlinear dynamical systems subject to model uncertainty and disturbances is challenging. In this work, we present a novel approach to tackle chance-constrained trajectory planning problems with nonconvex constraints, whereby obstacle avoidance chance constraints are reformulated using the signed distance function. We propose a novel sequential convex programming algorithm and prove that under a discrete time problem formulation, it is guaranteed to converge to a solution satisfying first-order optimality conditions. We demonstrate the approach on an uncertain 6 degrees of freedom spacecraft system and show that the solutions satisfy a given set of chance constraints.

[1]  Lukas Hewing,et al.  Stochastic Model Predictive Control for Linear Systems Using Probabilistic Reachable Sets , 2018, 2018 IEEE Conference on Decision and Control (CDC).

[2]  Marco Pavone,et al.  Meta-Learning Priors for Efficient Online Bayesian Regression , 2018, WAFR.

[3]  Marco Pavone,et al.  Monte Carlo Motion Planning for Robot Trajectory Optimization Under Uncertainty , 2015, ISRR.

[4]  Marco Pavone,et al.  Chance-constrained dynamic programming with application to risk-aware robotic space exploration , 2015, Autonomous Robots.

[5]  G. Calafiore,et al.  On Distributionally Robust Chance-Constrained Linear Programs , 2006 .

[6]  Yuanqi Mao,et al.  Successive Convexification of Non-Convex Optimal Control Problems with State Constraints , 2017, 1701.00558.

[7]  Alberto Bemporad,et al.  Robust model predictive control: A survey , 1998, Robustness in Identification and Control.

[8]  Robin Deits,et al.  Aggressive quadrotor flight through cluttered environments using mixed integer programming , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Thomas Lew,et al.  Chance-Constrained Optimal Altitude Control of a Rocket , 2019 .

[10]  Rodrigo Ventura,et al.  On the Accuracy of Inertial Parameter Estimation of a Free-Flying Robot While Grasping an Object , 2020, J. Intell. Robotic Syst..

[11]  Riccardo Bonalli,et al.  GuSTO: Guaranteed Sequential Trajectory optimization via Sequential Convex Programming , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[12]  Ping Lu,et al.  Solving Nonconvex Optimal Control Problems by Convex Optimization , 2014 .

[13]  Yi Yang,et al.  Sequential Convex Approximations to Joint Chance Constrained Programs: A Monte Carlo Approach , 2011, Oper. Res..

[14]  Brian Williams,et al.  Approximate Branch and Bound for Fast, Risk-Bound Stochastic Path Planning , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[15]  Pieter Abbeel,et al.  Motion planning with sequential convex optimization and convex collision checking , 2014, Int. J. Robotics Res..

[16]  Stephen P. Boyd,et al.  OSQP: an operator splitting solver for quadratic programs , 2017, 2018 UKACC 12th International Conference on Control (CONTROL).

[17]  Riccardo Bonalli,et al.  Trajectory Optimization on Manifolds: A Theoretically-Guaranteed Embedded Sequential Convex Programming Approach , 2019, Robotics: Science and Systems.

[18]  Alexander Shapiro,et al.  Convex Approximations of Chance Constrained Programs , 2006, SIAM J. Optim..

[19]  Marco Pavone,et al.  How Should a Robot Assess Risk? Towards an Axiomatic Theory of Risk in Robotics , 2017, ISRR.

[20]  Mrinal Kumar,et al.  Split-Bernstein Approach to Chance-Constrained Optimal Control , 2017 .

[21]  Torsten Koller,et al.  Learning-based Model Predictive Control for Safe Exploration and Reinforcement Learning , 2019, ArXiv.

[22]  Giuseppe Carlo Calafiore,et al.  Uncertain convex programs: randomized solutions and confidence levels , 2005, Math. Program..

[23]  Ron Alterovitz,et al.  Estimating probability of collision for safe motion planning under Gaussian motion and sensing uncertainty , 2012, 2012 IEEE International Conference on Robotics and Automation.

[24]  Behçet Açikmese,et al.  Successive convexification of non-convex optimal control problems and its convergence properties , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[25]  Javier Alonso-Mora,et al.  Chance-Constrained Collision Avoidance for MAVs in Dynamic Environments , 2019, IEEE Robotics and Automation Letters.

[26]  Masahiro Ono,et al.  Chance-Constrained Optimal Path Planning With Obstacles , 2011, IEEE Transactions on Robotics.

[27]  Lukas Hewing,et al.  On a Correspondence between Probabilistic and Robust Invariant Sets for Linear Systems , 2018, 2018 European Control Conference (ECC).

[28]  R. T. Rockafellar,et al.  The Generic Nature of Optimality Conditions in Nonlinear Programming , 1979, Math. Oper. Res..