Generalized Linear Quaternion Complementary Filter for Attitude Estimation From Multisensor Observations: An Optimization Approach

Focusing on generalized sensor combinations, this paper deals with the attitude estimation problem using a linear complementary filter (CF). The quaternion observation model is obtained via a gradient descent algorithm. An additive measurement model is then established according to derived results. The filter is named as the generalized CF where the observation model is simplified as a linear one that is quite different from previous-reported brute-force nonlinear results. Moreover, we prove that representative derivative-based optimization algorithms are essentially equivalent to each other. Derivations are given to establish the state model based on the quaternion kinematic equation. The proposed algorithm is validated under several experimental conditions involving the free-living environment, harsh external field disturbances, and aerial flight test aided by robotic vision. Using the specially designed experimental devices, data acquisition and algorithm computations are performed to give comparisons on accuracy, robustness, time-consumption, and so on with representative methods. The results show that not only the proposed filter can give fast, accurate, and stable estimates in terms of various sensor combinations but also produces robust attitude estimation in the scenario of harsh situations, e.g., irregular magnetic distortion. Note to Practitioners—Multisensor attitude estimation is a crucial technique in robotic devices. Many existing methods focus on the orientation fusion of specific sensor combinations. In this paper, we make the problem more concise. The results given in this paper are very general and can significantly decrease the space consumption and computation burden without losing the original estimation accuracy. Such performance will be of benefit to robotic platforms requiring flexible and easy-to-tune attitude estimation in the future.

[1]  Fuchun Sun,et al.  Robotic Room-Level Localization Using Multiple Sets of Sonar Measurements , 2017, IEEE Transactions on Instrumentation and Measurement.

[2]  F. Markley Attitude determination using vector observations: A fast optimal matrix algorithm , 1993 .

[3]  Lei Guo,et al.  Event-Triggered Strategy Design for Discrete-Time Nonlinear Quadratic Games With Disturbance Compensations: The Noncooperative Case , 2018, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

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

[6]  Yong Li,et al.  Equality Constrained Robust Measurement Fusion for Adaptive Kalman-Filter-Based Heterogeneous Multi-Sensor Navigation , 2013, IEEE Transactions on Aerospace and Electronic Systems.

[7]  Yong Li,et al.  Integrated Navigation System for a Low-Cost Quadrotor Aerial Vehicle in the Presence of Rotor Influences , 2017 .

[8]  Panos Marantos,et al.  UAV State Estimation Using Adaptive Complementary Filters , 2016, IEEE Transactions on Control Systems Technology.

[9]  Ya Tian,et al.  Accurate Human Navigation Using Wearable Monocular Visual and Inertial Sensors , 2014, IEEE Transactions on Instrumentation and Measurement.

[10]  Hassen Fourati,et al.  Optimal, Recursive and Sub-Optimal Linear Solutions to Attitude Determination from Vector Observations for GNSS/Accelerometer/Magnetometer Orientation Measurement , 2018, Remote. Sens..

[11]  Noureddine Manamanni,et al.  Complementary Observer for Body Segments Motion Capturing by Inertial and Magnetic Sensors , 2014, IEEE/ASME Transactions on Mechatronics.

[12]  Luc Van Gool,et al.  Speeded-Up Robust Features (SURF) , 2008, Comput. Vis. Image Underst..

[13]  Hassen Fourati,et al.  A comparative analysis of attitude estimation for pedestrian navigation with smartphones , 2015, 2015 International Conference on Indoor Positioning and Indoor Navigation (IPIN).

[14]  Zhengyou Zhang,et al.  A Flexible New Technique for Camera Calibration , 2000, IEEE Trans. Pattern Anal. Mach. Intell..

[15]  Andreas Kugi,et al.  Attitude Estimation Using Redundant Inertial Measurement Units for the Control of a Camera Stabilization Platform , 2016, IEEE Transactions on Control Systems Technology.

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

[17]  Jean-Yves Fourniols,et al.  Smart wearable systems: Current status and future challenges , 2012, Artif. Intell. Medicine.

[18]  F. Markley Attitude Error Representations for Kalman Filtering , 2003 .

[19]  Marc Pollefeys,et al.  An open source and open hardware embedded metric optical flow CMOS camera for indoor and outdoor applications , 2013, 2013 IEEE International Conference on Robotics and Automation.

[20]  Gary To,et al.  Quaternionic Attitude Estimation for Robotic and Human Motion Tracking Using Sequential Monte Carlo Methods With von Mises-Fisher and Nonuniform Densities Simulations , 2013, IEEE Transactions on Biomedical Engineering.

[21]  K. S. Arun,et al.  Least-Squares Fitting of Two 3-D Point Sets , 1987, IEEE Transactions on Pattern Analysis and Machine Intelligence.

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

[23]  Daniele Mortari,et al.  How to Estimate Attitude from Vector Observations , 1999 .

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

[25]  Zebo Zhou Optimal Batch Distributed Asynchronous Multisensor Fusion With Feedback , 2019, IEEE Transactions on Aerospace and Electronic Systems.

[26]  Young Soo Suh Orientation Estimation Using a Quaternion-Based Indirect Kalman Filter With Adaptive Estimation of External Acceleration , 2010, IEEE Transactions on Instrumentation and Measurement.

[27]  Rita Cunha,et al.  A Nonlinear Attitude Observer Based on Active Vision and Inertial Measurements , 2011, IEEE Transactions on Robotics.

[28]  Jin Wu,et al.  Convexity Analysis of Optimization Framework of Attitude Determination from Vector Observations , 2018, 2019 6th International Conference on Control, Decision and Information Technologies (CoDIT).

[29]  Qiang Chen,et al.  A novel approach for attitude estimation using MEMS inertial sensors , 2014, IEEE SENSORS 2014 Proceedings.

[30]  Matthew A. Brown,et al.  Automatic Panoramic Image Stitching using Invariant Features , 2007, International Journal of Computer Vision.

[31]  G. Wahba A Least Squares Estimate of Satellite Attitude , 1965 .

[32]  Jun Zhou,et al.  A Two-Step Approach for an Enhanced Quadrotor Attitude Estimation via IMU Data , 2018, IEEE Transactions on Control Systems Technology.

[33]  Cordelia Schmid,et al.  A performance evaluation of local descriptors , 2005, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[34]  Marc Pollefeys,et al.  PIXHAWK: A system for autonomous flight using onboard computer vision , 2011, 2011 IEEE International Conference on Robotics and Automation.

[35]  T. Hamel,et al.  Complementary filter design on the special orthogonal group SO(3) , 2005, Proceedings of the 44th IEEE Conference on Decision and Control.

[36]  Jerry D. Gibson,et al.  Filtering of colored noise for speech enhancement and coding , 1991, IEEE Trans. Signal Process..

[37]  Piotr Skrzypczynski,et al.  Performance Comparison of EKF-Based Algorithms for Orientation Estimation on Android Platform , 2015, IEEE Sensors Journal.

[38]  Yuanxin Wu,et al.  Dynamic Magnetometer Calibration and Alignment to Inertial Sensors by Kalman Filtering , 2016, IEEE Transactions on Control Systems Technology.

[39]  Gwanyoung Moon,et al.  Sliding-Mode-Based Missile-Integrated Attitude Control Schemes Considering Velocity Change , 2016 .

[40]  M. Shuster,et al.  Three-axis attitude determination from vector observations , 1981 .

[41]  Sebastian Madgwick,et al.  Estimation of IMU and MARG orientation using a gradient descent algorithm , 2011, 2011 IEEE International Conference on Rehabilitation Robotics.

[42]  Jizhong Xiao,et al.  A Linear Kalman Filter for MARG Orientation Estimation Using the Algebraic Quaternion Algorithm , 2016, IEEE Transactions on Instrumentation and Measurement.

[43]  Daniele Mortari,et al.  ESOQ: A Closed-Form Solution to the Wahba Problem , 1997 .

[44]  Amirhossein Tamjidi,et al.  6-DOF Pose Estimation of a Robotic Navigation Aid by Tracking Visual and Geometric Features , 2015, IEEE Transactions on Automation Science and Engineering.

[45]  Manuela Herman,et al.  Aided Navigation Gps With High Rate Sensors , 2016 .

[46]  F. Markley,et al.  Unscented Filtering for Spacecraft Attitude Estimation , 2003 .

[47]  Lei Guo,et al.  Distributed quantized multi-modal H∞ fusion filtering for two-time-scale systems , 2017, Inf. Sci..

[48]  Shashi Poddar,et al.  Multiple Model Adaptive Complementary Filter for Attitude Estimation , 2017 .

[49]  Wenzeng Zhang,et al.  A Novel Approach for Attitude Estimation Based on MEMS Inertial Sensors Using Nonlinear Complementary Filters , 2016, IEEE Sensors Journal.

[50]  Rui Li,et al.  Fast Linear Quaternion Attitude Estimator Using Vector Observations , 2018, IEEE Transactions on Automation Science and Engineering.

[51]  A. Makni,et al.  Energy-Aware Adaptive Attitude Estimation Under External Acceleration for Pedestrian Navigation , 2016, IEEE/ASME Transactions on Mechatronics.

[52]  Shashi Poddar,et al.  PSO Aided Adaptive Complementary Filter for Attitude Estimation , 2017, J. Intell. Robotic Syst..

[53]  F. Markley Attitude determination using vector observations and the singular value decomposition , 1988 .

[54]  Hassen Fourati,et al.  Attitude determination using a single sensor observation: analytic quaternion solutions and property discussion , 2017 .

[55]  Tor Arne Johansen,et al.  Nonlinear Observer for Tightly Integrated Inertial Navigation Aided by Pseudo-Range Measurements , 2017 .

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

[57]  Ya Tian,et al.  An Adaptive-Gain Complementary Filter for Real-Time Human Motion Tracking With MARG Sensors in Free-Living Environments , 2013, IEEE Transactions on Neural Systems and Rehabilitation Engineering.

[58]  Jinling Wang,et al.  Effective Adaptive Kalman Filter for MEMS-IMU/Magnetometers Integrated Attitude and Heading Reference Systems , 2012, Journal of Navigation.

[59]  Hassen Fourati,et al.  Heterogeneous Data Fusion Algorithm for Pedestrian Navigation via Foot-Mounted Inertial Measurement Unit and Complementary Filter , 2015, IEEE Transactions on Instrumentation and Measurement.

[60]  Yuanxin Wu,et al.  Calibration of three-axis strapdown magnetometers using Particle Swarm Optimization algorithm , 2011, 2011 IEEE International Symposium on Robotic and Sensors Environments (ROSE).

[61]  Noureddine Manamanni,et al.  A Nonlinear Filtering Approach for the Attitude and Dynamic Body Acceleration Estimation Based on Inertial and Magnetic Sensors: Bio-Logging Application , 2011, IEEE Sensors Journal.

[62]  Robert B. McGhee,et al.  An extended Kalman filter for quaternion-based orientation estimation using MARG sensors , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[63]  Andreas Geiger,et al.  Vision meets robotics: The KITTI dataset , 2013, Int. J. Robotics Res..

[64]  Yuanxin Wu,et al.  A New Technique for INS/GNSS Attitude and Parameter Estimation Using Online Optimization , 2014, IEEE Transactions on Signal Processing.