Multimodal sensor fusion for attitude estimation of micromechanical flying insects: A geometric approach

In this paper, we study sensor fusion for the attitude estimation of micro aerial vehicles (MAVs), in particular mechanical flying insects. First, following a geometric approach, a dynamic observer is proposed which estimates attitude based on kinematic data available from different and redundant bio-inspired sensors such as halteres, ocelli, gravitometers, magnetic compass and light polarization compass. In particular, the traditional structure of complementary filters, suitable for multiple sensor fusion, is specialized to the Lie group of rigid body rotations SO(3). Then, a numerical implementation of the filter is provided for the specific case of inertial/magnetic navigation, i.e. when gravitometers, magnetometer and gyroscopes are available. Finally, the filter performance is experimentally tested via a 3 degrees-of-freedom robotic flapper and a custom-made set of inertial/magnetic sensors. Experimental results show good agreement, upon proper tuning of the filter, between the actual kinematics of the robotic flapper and the kinematics reconstructed from the inertial/magnetic sensors via the proposed filter.

[1]  R. Murray,et al.  Proportional Derivative (PD) Control on the Euclidean Group , 1995 .

[2]  D. H. S. Maithripala,et al.  Almost-global tracking of simple mechanical systems on a general class of Lie Groups , 2005, IEEE Transactions on Automatic Control.

[3]  S. Shankar Sastry,et al.  Attitude control for a micromechanical flying insect via sensor output feedback , 2004, IEEE Transactions on Robotics and Automation.

[4]  Robert E. Mahony,et al.  Attitude estimation on SO[3] based on direct inertial measurements , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[5]  R.M. Murray,et al.  Biologically Inspired Feedback Design for Drosophila Flight , 2007, 2007 American Control Conference.

[6]  R. Hengstenberg.  Mechanosensory control of compensatory head roll during flight in the blowflyCalliphora erythrocephala Meig. , 1988, Journal of Comparative Physiology A.

[7]  Domenico Campolo,et al.  Inertial/Magnetic Sensors Based Orientation Tracking on the Group of Rigid Body Rotations with Application to Wearable Devices , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Jan Wessnitzer,et al.  Multimodal sensory integration in insects—towards insect brain control architectures , 2006, Bioinspiration & biomimetics.

[9]  Ronald S. Fearing,et al.  Wing transmission for a micromechanical flying insect , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[10]  A. D. Lewis,et al.  Geometric Control of Mechanical Systems , 2004, IEEE Transactions on Automatic Control.

[11]  The Commonwealth Scientific and Industrial Research Organisation , 1997, Current Biology.

[12]  V. Arnold.  Mathematical Methods of Classical Mechanics , 1974 .

[13]  W. Reichardt,et al.  Properties of individual movement detectors as derived from behavioural experiments on the visual system of the fly , 1988, Biological Cybernetics.

[14]  I. Kroo,et al.  Development of the Mesicopter : A Miniature Autonomous Rotorcraft , 1999 .

[15]  Sanjay P Sane,et al.  The aerodynamics of insect flight , 2003, Journal of Experimental Biology.

[16]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[17]  Richard M. Murray,et al.  Tracking for fully actuated mechanical systems: a geometric framework , 1999, Autom..

[18]  Robert J. Wood,et al.  Biomimetic sensor suite for flight control of a micromechanical flying insect: design and experimental results , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[19]  R. Hengstenberg,et al.  The halteres of the blowfly Calliphora , 1994, Journal of Comparative Physiology A.

[20]  PfeiferRolf,et al.  An autonomous agent navigating with a polarized light compass , 1997 .

[21]  D. Koditschek.  The Application of Total Energy as a Lyapunov Function for Mechanical Control Systems , 1989 .

[22]  Robert C. Michelson,et al.  BEYOND BIOLOGICALLY-INSPIRED INSECT FLIGHT , 2003 .

[23]  Eliane Wajnberg,et al.  Induced remanent magnetization of social insects , 2001 .

[24]  Matthew T. Keennon,et al.  Development of the Black Widow Micro Air Vehicle , 2001 .

[25]  Jordan M. Berg,et al.  Intrinsic Observer-Based Stabilization for Simple Mechanical Systems on Lie Groups , 2005, SIAM J. Control. Optim..

[26]  Michael H. Dickinson,et al.  Linear and Nonlinear Encoding Properties of an Identified Mechanoreceptor on the Fly wing Measured with Mechanical Noise Stimuli , 1990 .

[27]  T. Frankel.  The geometry of physics : an introduction , 2004 .

[28]  S. Shankar Sastry,et al.  A flight control system for aerial robots: algorithms and experiments , 2002 .

[29]  G K Taylor,et al.  Mechanics and aerodynamics of insect flight control , 2001, Biological reviews of the Cambridge Philosophical Society.

[30]  F. Daum.  Nonlinear filters: beyond the Kalman filter , 2005, IEEE Aerospace and Electronic Systems Magazine.

[31]  R. Hengstenberg,et al.  Optical properties of the ocelli of Calliphora erythrocephala and their role in the dorsal light response , 1993, Journal of Comparative Physiology A.

[32]  S. Shankar Sastry,et al.  Flapping flight for biomimetic robotic insects: part I-system modeling , 2006, IEEE Transactions on Robotics.

[33]  S. Shankar Sastry,et al.  Flapping flight for biomimetic robotic insects: part II-flight control design , 2006, IEEE Transactions on Robotics.

[34]  D. H. S. Maithripala,et al.  An intrinsic observer for a class of simple mechanical systems on a Lie group , 2004, Proceedings of the 2004 American Control Conference.

[35]  Richard A. Brown,et al.  Introduction to random signals and applied kalman filtering (3rd ed , 2012 .

[36]  S. Sastry.  Nonlinear Systems: Analysis, Stability, and Control , 1999 .

[37]  M. Dickinson,et al.  The control of flight force by a flapping wing: lift and drag production. , 2001, The Journal of experimental biology.

[38]  Mandyam V. Srinivasan,et al.  Bioinspired Engineering of Exploration Systems: A Horizon Sensor/Attitude Reference System Based on the Dragonfly Ocelli for Mars Exploration Applications , 2003, J. Field Robotics.

[39]  Robert J. Wood,et al.  Halteres for the micromechanical flying insect , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[40]  Yoshiaki Kuwata,et al.  Flight Demonstrations of Cooperative Control for UAV Teams , 2004 .