A Nonlinear Filtering Approach for the Attitude and Dynamic Body Acceleration Estimation Based on Inertial and Magnetic Sensors: Bio-Logging Application

This paper addresses the problem of rigid body orientation and Dynamic Body Acceleration (DBA) estimation. This work is applied in bio-logging, an interdisciplinary research area at the intersection of animal behavior and bioengineering. The proposed approach combines a quaternion-based nonlinear filter with the Levenberg Marquardt Algorithm (LMA). The algorithm has a complementary structure design that exploits measurements from a three-axis accelerometer, a three-axis magnetometer, and a three-axis gyroscope. Attitude information is necessary to calculate the animal's DBA in order to evaluate its energy expenditure. Some numerical simulations illustrate the nonlinear filter performance. Some quantitative assessments prove this efficiency such as the time constant of the filter ( ) and the rms magnitude of the quaternion error ( ). Moreover, the effectiveness of the algorithm is experimentally demonstrated. In the experiments a domestic animal is equipped with an Inertial Measurement Unit (MTi-G), which provides a truth attitude for comparison with the complementary nonlinear filter. The rms difference between the filter and MTi-G outputs in the free movement experiments is within 0.392 rms on roll, 0.577 rms on pitch, and 2.521 rms on yaw.

[1]  P. Veltink,et al.  Compensation of magnetic disturbances improves inertial and magnetic sensing of human body segment orientation , 2005, IEEE Transactions on Neural Systems and Rehabilitation Engineering.

[2]  E.B. Decker,et al.  Marine Mammal Marker (MAMMARK) Dead Reckoning Sensor for In-Situ Environmental Monitoring , 2006, 2006 IEEE/ION Position, Location, And Navigation Symposium.

[3]  Norbert Wiener,et al.  Extrapolation, Interpolation, and Smoothing of Stationary Time Series , 1964 .

[4]  Noureddine Manamanni,et al.  Rigid body motions estimation using inertial sensors: Bio-logging application , 2009 .

[5]  Noureddine Manamanni,et al.  A rigid body attitude estimation for Bio-logging application: A quaternion-based nonlinear filter approach , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Robert M. Sanner,et al.  A coupled nonlinear spacecraft attitude controller and observer with an unknown constant gyro bias and gyro noise , 2003, IEEE Trans. Autom. Control..

[7]  Dong Sun,et al.  A linear fusion algorithm for attitude determination using low cost MEMS-based sensors , 2007 .

[8]  M A Brodie,et al.  Dynamic accuracy of inertial measurement units during simple pendulum motion , 2008, Computer methods in biomechanics and biomedical engineering.

[9]  Christian Rutz,et al.  New frontiers in biologging science , 2009, Biology Letters.

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

[11]  Roman Kamnik,et al.  An inertial and magnetic sensor based technique for joint angle measurement. , 2007, Journal of biomechanics.

[12]  S. Beeby,et al.  MEMS Mechanical Sensors , 2004 .

[13]  Rong Zhu,et al.  A real-time articulated human motion tracking using tri-axis inertial/magnetic sensors package , 2004, IEEE Transactions on Neural Systems and Rehabilitation Engineering.

[14]  Hongzhang Jin,et al.  Design a mini-type marine attitude measurement system for self-propelled model trials , 2009 .

[15]  Yasuhiko Naito,et al.  A new technique for monitoring the detailed behaviour of terrestrial animals: A case study with the domestic cat , 2005 .

[16]  Yan Ropert-Coudert,et al.  Diving into the world of biologging , 2009 .

[17]  Peter L. Tyack,et al.  A digital acoustic recording tag for measuring the response of wild marine mammals to sound , 2003 .

[18]  Mohinder S. Grewal,et al.  Global Positioning Systems, Inertial Navigation, and Integration , 2000 .

[19]  John E. Dennis,et al.  Numerical methods for unconstrained optimization and nonlinear equations , 1983, Prentice Hall series in computational mathematics.

[20]  Rong Zhu,et al.  A Small Low-Cost Hybrid Orientation System and Its Error Analysis , 2009, IEEE Sensors Journal.

[21]  Noureddine Manamanni,et al.  Nonlinear attitude estimation based on fusion of inertial and magnetic sensors: Bio-logging application , 2009, ICONS.

[22]  M. Shuster.  A survey of attitude representation , 1993 .

[23]  Angelo M. Sabatini,et al.  Quaternion-based extended Kalman filter for determining orientation by inertial and magnetic sensing , 2006, IEEE Transactions on Biomedical Engineering.

[24]  Andreas Fahlman,et al.  Fine-scale analyses of diving energetics in king penguins Aptenodytes patagonicus: how behaviour affects costs of a foraging dive , 2007 .

[25]  W. F. Phillips,et al.  Review of attitude representations used for aircraft kinematics , 2001 .

[26]  Walter Higgins,et al.  A Comparison of Complementary and Kalman Filtering , 1975, IEEE Transactions on Aerospace and Electronic Systems.

[27]  Malcolm D. Shuster.  Survey of attitude representations , 1993 .

[28]  Robert E. Mahony,et al.  Nonlinear Complementary Filters on the Special Orthogonal Group , 2008, IEEE Transactions on Automatic Control.

[29]  J. Kuipers.  Quaternions and Rotation Sequences , 1998 .

[30]  Rory P. Wilson,et al.  Prying into the intimate details of animal lives: use of a daily diary on animals , 2008 .

[31]  D. Marquardt.  An Algorithm for Least-Squares Estimation of Nonlinear Parameters , 1963 .