An improved model-based observer for inertial navigation for quadrotors with low cost IMUs

In this paper, we present a model-based observer for inertial navigation of quadrotors and other multirotor aircraft. We include in our model a Coriolis term that has been neglected in prior work. Doing so allows us to estimate the entire velocity vector in the quadrotor’s frame of reference—including along the z-axis of this frame—with data only from a low-cost inertial measurement unit (IMU): something that has not been demonstrated previously. An observability analysis predicts that our proposed observer will perform well. Experimental results over 110 flight trials verify this prediction, showing that our proposed observer achieves lower root mean square error than three other stateof-the-art model-based observers.

[1]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .

[2]  Stefano Soatto,et al.  Observability, identifiability and sensitivity of vision-aided inertial navigation , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Rafael Canetti,et al.  Design and implementation of sensor data fusion for an autonomous quadrotor , 2014, 2014 IEEE International Instrumentation and Measurement Technology Conference (I2MTC) Proceedings.

[4]  Valery Z. Gusinsky,et al.  Two New Classes of Strapdown Navigation Algorithms , 2000 .

[5]  S. Rohan Munasinghe,et al.  Performance analysis of a Kalman Filter based attitude estimator for a Quad Rotor UAV , 2010, International Congress on Ultra Modern Telecommunications and Control Systems.

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

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

[8]  Roland Siegwart,et al.  Vision-Controlled Micro Flying Robots , 2014 .

[9]  Gamini Dissanayake,et al.  Improved State Estimation in Quadrotor MAVs: A Novel Drift-Free Velocity Estimator , 2015, IEEE Robotics & Automation Magazine.

[10]  P. Savage.  Strapdown Sculling Algorithm Design for Sensor Dynamic Amplitude And Phase-Shift Error , 2012 .

[11]  Zheyao Wang,et al.  Motion Measurement Using Inertial Sensors, Ultrasonic Sensors, and Magnetometers With Extended Kalman Filter for Data Fusion , 2012, IEEE Sensors Journal.

[12]  Arthur J. Krener,et al.  Measures of unobservability , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[13]  Seon Ki Park,et al.  Data Assimilation for Atmospheric, Oceanic and Hydrologic Applications (Vol. III) , 2009 .

[14]  Peter I. Corke,et al.  System identification, estimation and control for a cost effective open-source quadcopter , 2012, 2012 IEEE International Conference on Robotics and Automation.

[15]  A. Krener,et al.  Nonlinear controllability and observability , 1977 .

[16]  M. V. L. A. W. Heemink,et al.  Data Assimilation For AtmosphericChemistry Models , 1997 .

[17]  Wolfram Burgard,et al.  Towards a navigation system for autonomous indoor flying , 2009, 2009 IEEE International Conference on Robotics and Automation.

[18]  P. Savage.  A Unified Mathematical Framework for Strapdown Algorithm Design , 2006 .

[19]  P. Savage.  Coning Algorithm Design by Explicit Frequency Shaping , 2010 .

[20]  M. B. Ignagni,et al.  Optimal strapdown attitude integration algorithms , 1990 .

[21]  P. Savage.  Explicit Frequency-Shaped Coning Algorithms for Pseudoconing Environments , 2011 .

[22]  P. Savage.  Strapdown Inertial Navigation Integration Algorithm Design Part 1: Attitude Algorithms , 1998 .

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

[24]  Yangquan Chen,et al.  A comparative evaluation of low-cost IMUs for unmanned autonomous systems , 2010, 2010 IEEE Conference on Multisensor Fusion and Integration.

[25]  Ricardo Sanz,et al.  Improving attitude estimation using inertial sensors for quadrotor control systems , 2014, 2014 International Conference on Unmanned Aircraft Systems (ICUAS).

[26]  Randal W. Beard,et al.  Real-Time Attitude and Position Estimation for Small UAVs Using Low-Cost Sensors , 2004 .

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

[28]  P. Savage.  STRAPDOWN INERTIAL NAVIGATION INTEGRATION ALGORITHM DESIGN. PART 2: VELOCITY AND POSITION ALGORITHMS , 1998 .