Risk-Averse RRT* Planning with Nonlinear Steering and Tracking Controllers for Nonlinear Robotic Systems Under Uncertainty

We propose a two-phase risk-averse architecture for controlling stochastic nonlinear robotic systems. We present Risk-Averse Nonlinear Steering RRT* (RANS-RRT*) as an RRT* variant that incorporates nonlinear dynamics by solving a nonlinear program (NLP) and accounts for risk by approximating the state distribution and performing a distributionally robust (DR) collision check to promote safe planning. The generated plan is used as a reference for a low-level tracking controller. We demonstrate three controllers: finite horizon linear quadratic regulator (LQR) with linearized dynamics around the reference trajectory, LQR with robustness-promoting multiplicative noise terms, and a nonlinear model predictive control law (NMPC). We demonstrate the effectiveness of our algorithm using unicycle dynamics under heavy-tailed Laplace process noise in a cluttered environment.

[1]  J. How,et al.  Chance Constrained RRT for Probabilistic Robustness to Environmental Uncertainty , 2010 .

[2]  Insoon Yang,et al.  Risk-Aware Motion Planning and Control Using CVaR-Constrained Optimization , 2019, IEEE Robotics and Automation Letters.

[3]  Rudolph van der Merwe,et al.  The unscented Kalman filter for nonlinear estimation , 2000, Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium (Cat. No.00EX373).

[4]  Emilio Frazzoli,et al.  A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles , 2016, IEEE Transactions on Intelligent Vehicles.

[5]  Insoon Yang,et al.  Wasserstein Distributionally Robust Motion Control for Collision Avoidance Using Conditional Value-at-Risk , 2020, IEEE Transactions on Robotics.

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

[7]  Peyman Mohajerin Esfahani,et al.  Robust Control Design for Linear Systems via Multiplicative Noise , 2020, 2004.08019.

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

[9]  G. Martin,et al.  Nonlinear model predictive control , 1999, Proceedings of the 1999 American Control Conference (Cat. No. 99CH36251).

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

[11]  Insoon Yang,et al.  Wasserstein Distributionally Robust Motion Planning and Control with Safety Constraints Using Conditional Value-at-Risk , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[12]  Tyler Summers,et al.  Distributionally Robust Sampling-Based Motion Planning Under Uncertainty , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[13]  Tyler H. Summers,et al.  Towards Integrated Perception and Motion Planning with Distributionally Robust Risk Constraints , 2020, IFAC-PapersOnLine.

[14]  Tyler H. Summers,et al.  Control Design for Risk-Based Signal Temporal Logic Specifications , 2020, IEEE Control Systems Letters.

[15]  Moritz Diehl,et al.  CasADi: a software framework for nonlinear optimization and optimal control , 2018, Mathematical Programming Computation.

[16]  Jonathan P. How,et al.  Robust Sampling-based Motion Planning with Asymptotic Optimality Guarantees , 2013 .

[17]  Bryce Doerr,et al.  Motion Planning and Control for On-Orbit Assembly using LQR-RRT* and Nonlinear MPC. , 2020 .