Attitude Stabilization of a Biologically Inspired Robotic Housefly via Dynamic Multimodal Attitude Estimation

In this paper, we study sensor fusion for the attitude stabilization of micro aerial vehicles, particularly mechanical flying insects. Following a geometric approach, a dynamic observer is proposed that estimates attitude based on kinematic data available from different and redundant bioinspired 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). The filter performance based on a three-axis accelerometer and a three-axis gyroscope is experimentally tested on a 2-d.o.f. support, showing its effectiveness. Finally, attitude stabilization is proposed based on a feedback scheme with dynamic estimation of the state, i.e., the orientation and the angular velocity. Almost-global stability of the proposed controller in the case of dynamic state estimation is demonstrated via the separation principle, and realistic numerical simulations with noisy sensors and external disturbances are provided to validate the proposed control scheme.

[1]  Nicolas Marchand,et al.  Bounded attitude control of a biomimetic flapping robot , 2007, 2007 IEEE International Conference on Robotics and Biomimetics (ROBIO).

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

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

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

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

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

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

[8]  Robert J. Wood,et al.  Design, fabrication, and analysis of a 3DOF, 3cm flapping-wing MAV , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[10]  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.

[11]  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.

[12]  Robert J. Wood,et al.  The First Takeoff of a Biologically Inspired At-Scale Robotic Insect , 2008, IEEE Transactions on Robotics.

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

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

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

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

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

[18]  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.

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

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

[21]  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.

[22]  Guanrong Chen,et al.  Introduction to random signals and applied Kalman filtering, 2nd edn. Robert Grover Brown and Patrick Y. C. Hwang, Wiley, New York, 1992. ISBN 0‐471‐52573‐1, 512 pp., $62.95. , 1992 .

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

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

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

[26]  M. Dickinson,et al.  Wing rotation and the aerodynamic basis of insect flight. , 1999, Science.

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

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

[29]  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).

[30]  C. A. Desoer,et al.  Nonlinear Systems Analysis , 1978 .

[31]  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).

[32]  Joel W. Burdick,et al.  Trajectory stabilization for a planar carangiform robot fish , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

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

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

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

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