Online Estimation of Geometric and Inertia Parameters for Multirotor Aerial Vehicles

Accurate knowledge of geometric and inertia parameters are a necessity for precise and robust control of aerial vehicles. We propose a novel filter that is able to fuse motor speed, inertia, and pose measurements to estimate the vehicle’s key dynamic properties online. The presented framework is able to estimate the multirotor’s moment of inertia, mass, center of mass and each sensor module’s relative position. Obtaining these estimates in-flight allow the multirotor to be precisely controlled even during tasks such as load transportation or after configuration changes on scene. We provide a nonlinear observability analysis, proving that the presented model is locally weakly observable. Experimental results validate the proposed approach, showing the ability to estimate the dynamic properties accurately and demonstrate its capability to do so even while additional loads are added. The framework is flexible and can easily be adapted to a wide range of applications, including self-calibration, object grasping, and single robot or multi-robot payload transportation.

[1]  Darius Burschka,et al.  Toward a Fully Autonomous UAV: Research Platform for Indoor and Outdoor Urban Search and Rescue , 2012, IEEE Robotics & Automation Magazine.

[2]  Vijay Kumar,et al.  Estimation, Control, and Planning for Aggressive Flight With a Small Quadrotor With a Single Camera and IMU , 2017, IEEE Robotics and Automation Letters.

[3]  Vijay Kumar,et al.  Cooperative Transportation Using Small Quadrotors Using Monocular Vision and Inertial Sensing , 2018, IEEE Robotics and Automation Letters.

[4]  Gaurav S. Sukhatme,et al.  Visual-Inertial Sensor Fusion: Localization, Mapping and Sensor-to-Sensor Self-calibration , 2011, Int. J. Robotics Res..

[5]  Anastasios I. Mourikis,et al.  High-fidelity sensor modeling and self-calibration in vision-aided inertial navigation , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[6]  Ji Zhang,et al.  Laser–visual–inertial odometry and mapping with high robustness and low drift , 2018, J. Field Robotics.

[7]  Vijay Kumar,et al.  Tightly-coupled monocular visual-inertial fusion for autonomous flight of rotorcraft MAVs , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[8]  Kazuya Yoshida,et al.  Collaborative mapping of an earthquake‐damaged building via ground and aerial robots , 2012, J. Field Robotics.

[9]  Lorenzo Marconi,et al.  Impedance control of an aerial manipulator , 2012, 2012 American Control Conference (ACC).

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

[11]  C. Chang,et al.  On observability and unbiased estimation of nonlinear systems , 1982 .

[12]  Vijay Kumar,et al.  Vision-Based State Estimation and Trajectory Control Towards High-Speed Flight with a Quadrotor , 2013, Robotics: Science and Systems.

[13]  Vijay Kumar,et al.  Cooperative localization and mapping of MAVs using RGB-D sensors , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[14]  Vijay Kumar,et al.  Visual Servoing of Quadrotors for Perching by Hanging From Cylindrical Objects , 2016, IEEE Robotics and Automation Letters.

[15]  Roland Siegwart,et al.  A framework for maximum likelihood parameter identification applied on MAVs , 2018, J. Field Robotics.

[16]  Peter S. Maybeck,et al.  Stochastic Models, Estimation And Control , 2012 .

[17]  Joan Solà,et al.  Quaternion kinematics for the error-state Kalman filter , 2015, ArXiv.

[18]  Takeo Kanade,et al.  System identification of small-size unmanned helicopter dynamics , 1999 .

[19]  Frank C. Park,et al.  A Geometric Algorithm for Robust Multibody Inertial Parameter Identification , 2018, IEEE Robotics and Automation Letters.

[20]  Udo Frese,et al.  Integrating generic sensor fusion algorithms with sound state representations through encapsulation of manifolds , 2011, Inf. Fusion.

[21]  E. Kraft,et al.  A quaternion-based unscented Kalman filter for orientation tracking , 2003, Sixth International Conference of Information Fusion, 2003. Proceedings of the.

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