A Drag Model-LIDAR-IMU Fault-Tolerance Fusion Method for Quadrotors

In this paper, a drag model-aided fault-tolerant state estimation method is presented for quadrotors. Firstly, the drag model accuracy was improved by modeling an angular rate related item and an angular acceleration related item, which are related with flight maneuver. Then the drag model, light detection and ranging (LIDAR), and inertial measurement unit (IMU) were fused based on the Federal Kalman filter frame. In the filter, the LIDAR estimation fault was detected and isolated, and the disturbance to the drag model was estimated and compensated. Some experiments were carried out, showing that the velocity and position estimation were improved compared with the traditional LIDAR/IMU fusion scheme.

[1]  Frantisek Solc,et al.  Model-Based Attitude Estimation for Multicopters , 2014 .

[2]  Naser El-Sheimy,et al.  Hybrid Machine Learning VDM for UAVs in GNSS-denied Environment , 2018, Navigation.

[3]  Mark Koifman,et al.  Inertial navigation system aided by aircraft dynamics , 1999, IEEE Trans. Control. Syst. Technol..

[4]  Jianye Liu,et al.  A Thrust Model Aided Fault Diagnosis Method for the Altitude Estimation of a Quadrotor , 2018, IEEE Transactions on Aerospace and Electronic Systems.

[5]  Jean-Emmanuel Deschaud,et al.  IMLS-SLAM: Scan-to-Model Matching Based on 3D Data , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[6]  Jianye Liu,et al.  An analytical fault diagnosis method for yaw estimation of quadrotors , 2019, Control Engineering Practice.

[7]  Wenqi Wu,et al.  Observability Analysis of a Matrix Kalman Filter-Based Navigation System Using Visual/Inertial/Magnetic Sensors , 2012, Sensors.

[8]  Gamini Dissanayake,et al.  Visual-inertial fusion for quadrotor Micro Air Vehicles with improved scale observability , 2013, 2013 IEEE International Conference on Robotics and Automation.

[9]  Charles K. Toth,et al.  Using Adaptive Motion Constraints to Support UWB/IMU Based Navigation , 2018 .

[10]  Yukinori Kobayashi,et al.  A Novel Approach for Lidar-Based Robot Localization in a Scale-Drifted Map Constructed Using Monocular SLAM , 2019, Sensors.

[11]  John J. Leonard,et al.  Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age , 2016, IEEE Transactions on Robotics.

[12]  Jörg Stückler,et al.  Multilayered Mapping and Navigation for Autonomous Micro Aerial Vehicles , 2016, J. Field Robotics.

[13]  Jianye Liu,et al.  A Model-aided Optical Flow/Inertial Sensor Fusion Method for a Quadrotor , 2017 .

[14]  Timothy W. McLain,et al.  Analysis of an Improved IMU-Based Observer for Multirotor Helicopters , 2014, J. Intell. Robotic Syst..

[15]  Hadi Nobahari,et al.  A Model Aided Inertial Navigation System for Automatic Landing of Unmanned Aerial Vehicles , 2018 .

[16]  Nicolas Petit,et al.  The Navigation and Control technology inside the AR.Drone micro UAV , 2011 .

[17]  Agostino Martinelli,et al.  State Estimation Based on the Concept of Continuous Symmetry and Observability Analysis: The Case of Calibration , 2011, IEEE Transactions on Robotics.

[18]  Georg Scholz,et al.  Model-Aided Navigation for a Quadrotor Helicopter: A Novel Navigation System and First Experimental Results , 2014 .

[19]  Jizhou Lai,et al.  Autonomous cyanobacterial harmful algal blooms monitoring using multirotor UAS , 2017 .

[21]  John L. Crassidis,et al.  Survey of nonlinear attitude estimation methods , 2007 .

[22]  Tim D. Barfoot,et al.  Relative continuous-time SLAM , 2015, Int. J. Robotics Res..

[23]  Vijay Kumar,et al.  Autonomous multi-floor indoor navigation with a computationally constrained MAV , 2011, 2011 IEEE International Conference on Robotics and Automation.

[24]  Hassan Salarieh,et al.  Design and practical implementation of kinematic constraints in Inertial Navigation System‐Doppler Velocity Log (INS‐DVL)‐based navigation , 2018 .

[25]  Steven Lake Waslander,et al.  Aerodynamics and control of autonomous quadrotor helicopters in aggressive maneuvering , 2009, 2009 IEEE International Conference on Robotics and Automation.

[26]  Philippe Martin,et al.  The true role of accelerometer feedback in quadrotor control , 2010, 2010 IEEE International Conference on Robotics and Automation.

[27]  Vijay Kumar,et al.  Autonomous Navigation and Mapping for Inspection of Penstocks and Tunnels With MAVs , 2017, IEEE Robotics and Automation Letters.

[28]  Abdullah M. Almeshal,et al.  A Vision-Based Neural Network Controller for the Autonomous Landing of a Quadrotor on Moving Targets , 2018, Robotics.

[29]  Timothy W. McLain,et al.  Quadrotors and Accelerometers: State Estimation with an Improved Dynamic Model , 2014, IEEE Control Systems.

[30]  Wei Zhao,et al.  A Novel Fault-Tolerant Navigation and Positioning Method with Stereo-Camera/Micro Electro Mechanical Systems Inertial Measurement Unit (MEMS-IMU) in Hostile Environment , 2018, Micromachines.

[31]  Robert Mahony,et al.  Modelling and control of a large quadrotor robot , 2010 .

[32]  Wenbin Wang,et al.  Intensity-Assisted ICP for Fast Registration of 2D-LIDAR , 2019, Sensors.

[33]  Jingchuan Wang,et al.  MIM_SLAM: A Multi-Level ICP Matching Method for Mobile Robot in Large-Scale and Sparse Scenes , 2018 .

[34]  J. Skaloud,et al.  AUTONOMOUS NAVIGATION OF SMALL UAVS BASED ON VEHICLE DYNAMIC MODEL , 2016 .

[35]  Vijay Kumar,et al.  Multi-sensor fusion for robust autonomous flight in indoor and outdoor environments with a rotorcraft MAV , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).