EXPERIMENTAL COMPARISON BETWEEN MAHONEY AND COMPLEMENTARY SENSOR FUSION ALGORITHM FOR ATTITUDE DETERMINATION BY RAW SENSOR DATA OF XSENS IMU ON BUOY

Abstract. The accurate measurement of platform orientation plays a critical role in a range of applications including marine, aerospace, robotics, navigation, human motion analysis, and machine interaction. We used Mahoney filter, Complementary filter and Xsens Kalman filter for achieving Euler angle of a dynamic platform by integration of gyroscope, accelerometer, and magnetometer measurements. The field test has been performed in Kish Island using an IMU sensor (Xsens MTi-G-700) that installed onboard a buoy so as to provide raw data of gyroscopes, accelerometers, magnetometer measurements about 25 minutes. These raw data were used to calculate the Euler angles by Mahoney filter and Complementary filter, while the Euler angles collected by XSense IMU sensor become the reference of the Euler angle estimations. We then compared Euler angles which calculated by Mahoney Filter and Complementary Filter with reference to the Euler angles recorded by the XSense IMU sensor. The standard deviations of the differences between the Mahoney Filter, Complementary Filter Euler angles and XSense IMU sensor Euler angles were about 0.5644, 0.3872, 0.4990 degrees and 0.6349, 0.2621, 2.3778 degrees for roll, pitch, and heading, respectively, so the numerical result assert that Mahoney filter is precise for roll and heading angles determination and Complementary filter is precise only for pitch determination, it should be noted that heading angle determination by Complementary filter has more error than Mahoney filter.

[1]  Ian Petersen,et al.  A robust gyroless attitude estimation scheme for a small fixed-wing unmanned aerial vehicle , 2009, 2009 7th Asian Control Conference.

[2]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

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

[4]  P.H. Veltink,et al.  Inclination measurement of human movement using a 3-D accelerometer with autocalibration , 2004, IEEE Transactions on Neural Systems and Rehabilitation Engineering.

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

[6]  Peter H. Veltink,et al.  Measuring orientation of human body segments using miniature gyroscopes and accelerometers , 2005, Medical and Biological Engineering and Computing.

[7]  Christian T.M. Baten,et al.  Estimation of orientation with gyroscopes and accelerometers , 1999, Proceedings of the First Joint BMES/EMBS Conference. 1999 IEEE Engineering in Medicine and Biology 21st Annual Conference and the 1999 Annual Fall Meeting of the Biomedical Engineering Society (Cat. N.

[8]  Hugh F. Durrant-Whyte,et al.  Inertial navigation systems for mobile robots , 1995, IEEE Trans. Robotics Autom..

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

[10]  Eric Foxlin,et al.  Inertial head-tracker sensor fusion by a complementary separate-bias Kalman filter , 1996, Proceedings of the IEEE 1996 Virtual Reality Annual International Symposium.

[11]  Mark Euston,et al.  A complementary filter for attitude estimation of a fixed-wing UAV , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.