Time-varying complementary filtering for attitude estimation

Complementary filtering (CF) is a well known method that can effectively fuse a gyroscope and accelerometer measurement in order to robustly estimate the attitude of a rigid body in a planar single degree of freedom (DOF) setting. The attitude can be estimated individually by either integrating the gyroscope measurement or by calculating the inverse tangent of the components of a 2-axis accelerometer. The gyroscope can adequately estimate the angle in the higher frequency region, but suffers from drift issues at low frequency, whereas the accelerometer can accurately measure the acceleration and thus direction of gravity, but loses this accuracy when faced with motion accelerations. CF traditionally uses linear time invariant filters, however, this paper presents an extension to the CF method by proposing time-varying parameters. A fuzzy logic method is developed to adjust the parameters. Stability analysis as well as experimental results are presented to verify the proposed method.

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

[2]  Gene F. Franklin,et al.  Digital control of dynamic systems , 1980 .

[3]  Robert Grover Brown,et al.  Introduction to random signal analysis and Kalman filtering , 1983 .

[4]  Wolfgang D. Rencken,et al.  Concurrent localisation and map building for mobile robots using ultrasonic sensors , 1993, Proceedings of 1993 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS '93).

[5]  A.-J. Baerveldt,et al.  A low-cost and low-weight attitude estimation system for an autonomous helicopter , 1997, Proceedings of IEEE International Conference on Intelligent Engineering Systems.

[6]  Jonathan P. How,et al.  Formation sensing and control technologies for a separated spacecraft interferometer , 1998, Proceedings of the 1998 American Control Conference. ACC (IEEE Cat. No.98CH36207).

[7]  Masayoshi Tomizuka,et al.  Multirate optimal state estimation with sensor fusion , 2003, Proceedings of the 2003 American Control Conference, 2003..

[8]  Joachim Hertzberg,et al.  An autonomous mobile robot with a 3D laser range finder for 3D exploration and digitalization of indoor environments , 2003, Robotics Auton. Syst..

[9]  Michael Zyda,et al.  Design and implementation of MARG sensors for 3-DOF orientation measurement of rigid bodies , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[10]  H. Ulbrich,et al.  Sensor system and trajectory control of a biped robot , 2004, The 8th IEEE International Workshop on Advanced Motion Control, 2004. AMC '04..

[11]  I. D. Landau,et al.  Digital Control Systems: Design, Identification and Implementation , 2006 .

[12]  M. Tomizuka,et al.  Benefits of acceleration measurement in velocity estimation and motion control , 2004 .

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

[14]  Abdelaziz Benallegue,et al.  Attitude estimation with gyros-bias compensation using low-cost sensors , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[15]  Soo Jeon,et al.  Kinematic Kalman Filter (KKF) for Robot End-Effector Sensing , 2009 .