Robust nonlinear control approach to nontrivial maneuvers and obstacle avoidance for quadrotor UAV under disturbances

Abstract In this paper, we present an onboard robust nonlinear control approach for quadrotor Unmanned Aerial Vehicles (UAVs) in the environments with disturbances and obstacles. The complete framework consists of an attitude controller based on the solution of global output regulation problems for SO( 3 ), a backstepping-like position controller, a 6 -dimensional wrench observer to estimate the unknown force and torque disturbances, and an online trajectory planner based on a model predictive control method with obstacle avoiding constraints. We prove the strong convergence properties of the proposed method both in theory and via real-robot experiments. The control approach is onboard implemented on a quadrotor UAV, and has been validated through intensive experiments and compared with other nonlinear control methods for waypoint navigation and large-tilted path following tasks in the presence of external disturbances, e.g. wind gusts. The presented approach has also been evaluated in the scenarios with randomly located obstacles.

[1]  Claire J. Tomlin,et al.  Quadrotor Helicopter Flight Dynamics and Control: Theory and Experiment , 2007 .

[2]  Marc Pollefeys,et al.  Autonomous obstacle avoidance and maneuvering on a vision-guided MAV using on-board processing , 2011, 2011 IEEE International Conference on Robotics and Automation.

[3]  Vijay Kumar,et al.  Minimum snap trajectory generation and control for quadrotors , 2011, 2011 IEEE International Conference on Robotics and Automation.

[4]  Guilherme V. Raffo,et al.  An integral predictive/nonlinear Hinfinity control structure for a quadrotor helicopter , 2010, Autom..

[5]  Frank Allgöwer,et al.  Output regulation for attitude control: A global approach , 2013, 2013 American Control Conference.

[6]  Rafael Fierro,et al.  Agile Load Transportation : Safe and Efficient Load Manipulation with Aerial Robots , 2012, IEEE Robotics & Automation Magazine.

[7]  Claire J. Tomlin,et al.  Learning-based model predictive control on a quadrotor: Onboard implementation and experimental results , 2012, 2012 IEEE International Conference on Robotics and Automation.

[8]  René van de Molengraft,et al.  Realtime motion path generation using subtargets in a rapidly changing environment , 2007, Robotics Auton. Syst..

[9]  Marc Pollefeys,et al.  Vision-based autonomous mapping and exploration using a quadrotor MAV , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Roland Siegwart,et al.  Full control of a quadrotor , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Raffaello D'Andrea,et al.  A simple learning strategy for high-speed quadrocopter multi-flips , 2010, 2010 IEEE International Conference on Robotics and Automation.

[12]  Sami Haddadin,et al.  Simultaneous estimation of aerodynamic and contact forces in flying robots: Applications to metric wind estimation and collision detection , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Joris De Schutter,et al.  A hybrid pose / wrench control framework for quadrotor helicopters , 2012, 2012 IEEE International Conference on Robotics and Automation.

[14]  Anthony Tzes,et al.  Switching model predictive attitude control for a quadrotor helicopter subject to atmospheric disturbances , 2011 .

[15]  Roland Siegwart,et al.  Backstepping and Sliding-mode Techniques Applied to an Indoor Micro Quadrotor , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[16]  Taeyoung Lee,et al.  Geometric tracking control of a quadrotor UAV on SE(3) , 2010, 49th IEEE Conference on Decision and Control (CDC).

[17]  Juwan Kim,et al.  Obstacle avoidance methods in the chaotic UAV , 2004, The 23rd Digital Avionics Systems Conference (IEEE Cat. No.04CH37576).

[18]  Ugur Zengin,et al.  Real-Time Target Tracking for Autonomous UAVs in Adversarial Environments: A Gradient Search Algorithm , 2007, IEEE Transactions on Robotics.

[19]  Wisama Khalil,et al.  Modeling, Identification and Control of Robots , 2003 .

[20]  Antonio Franchi,et al.  A nonlinear force observer for quadrotors and application to physical interactive tasks , 2014, 2014 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[21]  Andrew Roberts,et al.  Adaptive Position Tracking of VTOL UAVs , 2009, IEEE Transactions on Robotics.

[22]  Toshiyuki Murakami,et al.  An approach to collision detection and recovery motion in industrial robot , 1989, 15th Annual Conference of IEEE Industrial Electronics Society.

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

[24]  Leonid M. Fridman,et al.  Super twisting control algorithm for the attitude tracking of a four rotors UAV , 2012, J. Frankl. Inst..

[25]  Albert Albers,et al.  Semi-autonomous flying robot for physical interaction with environment , 2010, 2010 IEEE Conference on Robotics, Automation and Mechatronics.

[26]  Alessandro De Luca,et al.  Actuator failure detection and isolation using generalized momenta , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[27]  Andreas Zell,et al.  A robust nonlinear controller for nontrivial quadrotor maneuvers: Approach and verification , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[28]  Wen-Hua Chen,et al.  Tracking control of small-scale helicopters using explicit nonlinear MPC augmented with disturbance observers , 2012 .

[29]  Septimiu E. Salcudean,et al.  Estimation of environment forces and rigid-body velocities using observers , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[30]  Heinrich H. Bülthoff,et al.  Obstacle detection, tracking and avoidance for a teleoperated UAV , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[31]  Dongjun Lee,et al.  Hybrid force/motion control and internal dynamics of quadrotors for tool operation , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[32]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[33]  Gianluca Antonelli,et al.  Adaptive trajectory tracking for quadrotor MAVs in presence of parameter uncertainties and external disturbances , 2013, 2013 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[34]  Sergei Lupashin,et al.  The Flight Assembled Architecture installation: Cooperative construction with flying machines , 2014, IEEE Control Systems.

[35]  G. Abba,et al.  Robust Nonlinear Controls of Model-Scale Helicopters Under Lateral and Vertical Wind Gusts , 2012, IEEE Transactions on Control Systems Technology.

[36]  Yisheng Zhong,et al.  Robust Three-Loop Trajectory Tracking Control for Quadrotors With Multiple Uncertainties , 2016, IEEE Transactions on Industrial Electronics.

[37]  Eric C. Kerrigan,et al.  Predictive Control Using an FPGA With Application to Aircraft Control , 2014, IEEE Transactions on Control Systems Technology.

[38]  Flavio Fontana,et al.  Aerial-guided navigation of a ground robot among movable obstacles , 2014, 2014 IEEE International Symposium on Safety, Security, and Rescue Robotics (2014).

[39]  Raffaello D'Andrea,et al.  Cooperative quadrocopter ball throwing and catching , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[40]  Raffaello D'Andrea,et al.  Admittance control for physical human-quadrocopter interaction , 2013, 2013 European Control Conference (ECC).

[41]  Alessandro De Luca,et al.  Collision Detection and Safe Reaction with the DLR-III Lightweight Manipulator Arm , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.