Robust Trajectory Planning for a Multirotor against Disturbance based on Hamilton-Jacobi Reachability Analysis

Ensuring safety in trajectory planning of multirotor systems is an essential element for risk-free operation. Even if the generated trajectory is known to be safe in the planning phase, unknown disturbance during an actual operation can lead to a dangerous situation. This paper proposes safety-guaranteed receding horizon planning against unknown, but bounded, disturbances. We first characterize forward reachable set (FRS) of the system, the set of states after a certain duration considering all possible disturbances, using Hamilton-Jacobi (HJ) reachability analysis. To compute the FRSs in real-time, we conservatively approximate the true FRS and perform ellipsoidal parameterization on the FRSs. Using the FRSs, we can plan a robust trajectory that avoids risky regions and rapidly re-plan the trajectory when the system encounters sudden disturbance. The proposed method is validated through an experiment of avoiding obstacles in a wind.

[1]  Scott Kuindersma,et al.  Constrained unscented dynamic programming , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[2]  Mo Chen,et al.  Hamilton-Jacobi reachability: A brief overview and recent advances , 2017, 2017 IEEE 56th Annual Conference on Decision and Control (CDC).

[3]  Davide Scaramuzza,et al.  Computing the Forward Reachable Set for a Multirotor Under First-Order Aerodynamic Effects , 2018, IEEE Robotics and Automation Letters.

[4]  Shaojie Shen,et al.  Online generation of collision-free trajectories for quadrotor flight in unknown cluttered environments , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[5]  A. Kurzhanski,et al.  On the Theory of Trajectory Tubes — A Mathematical Formalism for Uncertain Dynamics, Viability and Control , 1993 .

[6]  Tarek Hamel,et al.  Nonlinear feedback control of Quadrotors exploiting First-Order Drag Effects , 2017 .

[7]  Alexandre M. Bayen,et al.  A time-dependent Hamilton-Jacobi formulation of reachable sets for continuous dynamic games , 2005, IEEE Transactions on Automatic Control.

[8]  Jaime F. Fisac,et al.  Planning, Fast and Slow: A Framework for Adaptive Real-Time Safe Trajectory Planning , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Marc Pollefeys,et al.  PIXHAWK: A system for autonomous flight using onboard computer vision , 2011, 2011 IEEE International Conference on Robotics and Automation.

[10]  S. Osher,et al.  Algorithms for overcoming the curse of dimensionality for certain Hamilton–Jacobi equations arising in control theory and elsewhere , 2016, Research in the Mathematical Sciences.

[11]  Antonio Franchi,et al.  Differential Flatness of Quadrotor Dynamics Subject to Rotor Drag for Accurate Tracking of High-Speed Trajectories , 2017, IEEE Robotics and Automation Letters.

[12]  P. Lions,et al.  Hopf formula and multitime Hamilton-Jacobi equations , 1986 .

[13]  Roland Siegwart,et al.  Continuous-time trajectory optimization for online UAV replanning , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[14]  Charles Richter,et al.  Polynomial Trajectory Planning for Aggressive Quadrotor Flight in Dense Indoor Environments , 2016, ISRR.

[15]  Vijay Kumar,et al.  Planning Dynamically Feasible Trajectories for Quadrotors Using Safe Flight Corridors in 3-D Complex Environments , 2017, IEEE Robotics and Automation Letters.

[16]  Moritz Diehl,et al.  Robust MPC via min-max differential inequalities , 2016, Autom..

[17]  Russ Tedrake,et al.  Funnel libraries for real-time robust feedback motion planning , 2016, Int. J. Robotics Res..

[18]  Benoît Chachuat,et al.  Unified framework for the propagation of continuous-time enclosures for parametric nonlinear ODEs , 2015, J. Glob. Optim..

[19]  Daniel Cremers,et al.  Real-time trajectory replanning for MAVs using uniform B-splines and a 3D circular buffer , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[20]  Vijay Kumar,et al.  Trajectory generation and control for precise aggressive maneuvers with quadrotors , 2012, Int. J. Robotics Res..

[21]  Stanley Osher,et al.  Time-Optimal Collaborative Guidance Using the Generalized Hopf Formula , 2018, IEEE Control Systems Letters.

[22]  Jérôme Darbon,et al.  On Convex Finite-Dimensional Variational Methods in Imaging Sciences and Hamilton-Jacobi Equations , 2015, SIAM J. Imaging Sci..

[23]  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).