Chance-Constrained Collision Avoidance for MAVs in Dynamic Environments

Safe autonomous navigation of microair vehicles in cluttered dynamic environments is challenging due to the uncertainties arising from robot localization, sensing, and motion disturbances. This letter presents a probabilistic collision avoidance method for navigation among other robots and moving obstacles, such as humans. The approach explicitly considers the collision probability between each robot and obstacle and formulates a chance constrained nonlinear model predictive control problem (CCNMPC). A tight bound for approximation of collision probability is developed, which makes the CCNMPC formulation tractable and solvable in real time. For multirobot coordination, we describe three approaches, one distributed without communication (constant velocity assumption), one distributed with communication (of previous plans), and one centralized (sequential planning). We evaluate the proposed method in experiments with two quadrotors sharing the space with two humans and verify the multirobot coordination strategy in simulation with up to sixteen quadrotors.

[1]  Joel W. Burdick,et al.  Probabilistic Collision Checking With Chance Constraints , 2011, IEEE Transactions on Robotics.

[2]  Soon-Jo Chung,et al.  Swarm assignment and trajectory optimization using variable-swarm, distributed auction assignment and sequential convex programming , 2016, Int. J. Robotics Res..

[3]  Roland Siegwart,et al.  Robust collision avoidance for multiple micro aerial vehicles using nonlinear model predictive control , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[4]  Paul A. Beardsley,et al.  Collision avoidance for aerial vehicles in multi-agent scenarios , 2015, Auton. Robots.

[5]  Daniel Lyons,et al.  Chance constrained model predictive control for multi-agent systems with coupling constraints , 2012, 2012 American Control Conference (ACC).

[6]  N-DIMENSIONAL CUMULATIVE FUNCTION, AND OTHER USEFUL FACTS ABOUT GAUSSIANS AND NORMAL DENSITIES by Michaël Bensimhoun (reviewed by David Arnon) , 2013 .

[7]  Mark E. Campbell,et al.  Contingency Planning Over Probabilistic Obstacle Predictions for Autonomous Road Vehicles , 2013, IEEE Transactions on Robotics.

[8]  Alexei Yu. Uteshev,et al.  Point-to-ellipse and point-to-ellipsoid distance equation analysis , 2018, J. Comput. Appl. Math..

[9]  Javier Alonso-Mora,et al.  Sample Efficient Learning of Path Following and Obstacle Avoidance Behavior for Quadrotors , 2018, IEEE Robotics and Automation Letters.

[10]  Pieter Abbeel,et al.  Sigma hulls for Gaussian belief space planning for imprecise articulated robots amid obstacles , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Chonhyon Park,et al.  Fast and Bounded Probabilistic Collision Detection for High-DOF Trajectory Planning in Dynamic Environments , 2018, IEEE Transactions on Automation Science and Engineering.

[12]  S. Shankar Sastry,et al.  Decentralized nonlinear model predictive control of multiple flying robots , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[13]  Masahiro Ono,et al.  A Probabilistic Particle-Control Approximation of Chance-Constrained Stochastic Predictive Control , 2010, IEEE Transactions on Robotics.

[14]  Javier Alonso-Mora,et al.  Parallel autonomy in automated vehicles: Safe motion generation with minimal intervention , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[15]  Mo Chen,et al.  FaSTrack: A modular framework for fast and guaranteed safe motion planning , 2017, 2017 IEEE 56th Annual Conference on Decision and Control (CDC).

[16]  Richard D. Braatz,et al.  Stochastic nonlinear model predictive control with probabilistic constraints , 2014, 2014 American Control Conference.

[17]  Alexander Liniger,et al.  Cautious NMPC with Gaussian Process Dynamics for Miniature Race Cars , 2017, ArXiv.

[18]  Knut Graichen,et al.  Stochastic model predictive control of nonlinear continuous-time systems using the unscented transformation , 2015, 2015 European Control Conference (ECC).

[19]  Dinesh Manocha,et al.  Chance constraint based multi agent navigation under uncertainty , 2017, AIR '17.

[20]  Alexander Domahidi,et al.  Real-time planning for automated multi-view drone cinematography , 2017, ACM Trans. Graph..

[21]  Marcelo H. Ang,et al.  Incremental sampling-based algorithm for risk-aware planning under motion uncertainty , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[22]  Francesco Borrelli,et al.  Robust Predictive Control for semi-autonomous vehicles with an uncertain driver model , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

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

[24]  Alexander Domahidi,et al.  Real-Time Motion Planning for Aerial Videography With Real-Time With Dynamic Obstacle Avoidance and Viewpoint Optimization , 2017, IEEE Robotics and Automation Letters.

[25]  Mark Cannon,et al.  Stochastic Model Predictive Control with Discounted Probabilistic Constraints , 2018, 2018 European Control Conference (ECC).

[26]  Ya-Zhong Luo,et al.  A review of uncertainty propagation in orbital mechanics , 2017 .