Dual-Stage Quaternion Estimator: An advanced method for orientation and angular kinematics estimation based on IMU sensor fusion
DOI:
https://doi.org/10.54939/1859-1043.j.mst.106.2025.40-47Keywords:
Unscented Kalman filter; Quaternion; IMU; Platform stabilization; Angular velocity; Angular acceleration; Angular jerk; Sensor fusion.Abstract
In modern orientation and control applications such as robots, unmanned vehicles, or pan-tilt stabilization systems, accurately estimating orientation angles, angular velocities, and angular accelerations from inertial measurement unit (IMU) data is a significant challenge due to noise, gyroscope bias, and system nonlinearity. Solutions involving Extended Kalman Filter (EKF) have shown many advantages in significantly improving "filtering" quality; however, most only focus on orientation angles and angular velocities, neglecting angular acceleration—a crucial quantity in complex motion conditions. This paper proposes an improved filter, the "Dual-Stage Quaternion Estimator" (DSQE), which uses a two-stage structure with stage 1 applying an Unscented Kalman Filter (UKF) based on quaternions and stage 2 using a linear Kalman filter to estimate angular dynamics, including angular jerk. This method improves the accuracy of orientation estimation thanks to the second-order Taylor expansion and the UKF's ability to handle nonlinearity, while also providing accurate orientation angles in complex motion conditions. Simulation results show that DSQE with UKF outperforms traditional methods, especially in scenarios with strong vibrations or high accelerations.
References
[1]. S. B. Farahan et al., “9-DOF IMU-Based Attitude and Heading Estimation Using an Extended Kalman Filter With Bias Consideration,” Sensors, Vol. 22, No. 9, p. 3416, (2022).
[2]. M. M. Rahman et al., “Upper Limb Joint Angle Estimation Using Wearable IMUs and Personalized Calibration Algorithm,” Mathematics, Vol. 11, No. 4, p. 970, (2023).
[3]. M. Oei and O. Sawodny, “Quaternion Attitude and Disturbance Observer Mass Estimation With Low-Cost Sensors for Industrial Vehicles With Trailers,” Mechatronics, Vol. 86, (2023).
[4]. W. Youn, S. A. Gadsden, “Combined Quaternion-Based Error State Kalman Filtering and Smooth Variable Structure Filtering for Robust Attitude Estimation,” IEEE Access, Vol. 7, pp. 132–145, (2019).
[5]. L. Di, T. Fromm, and Y. Q. Chen, “A Data Fusion System for Attitude Estimation of Low-Cost Miniature UAVs,” J. Intell. Robot. Syst., Vol. 66, pp. 505–515, 2012.
[6]. S. Sabatelli et al., “A Double-Stage Kalman Filter for Orientation Tracking With an Integrated Processor in 9-D IMU,” IEEE Trans. Instrum. Meas., Vol. 61, No. 9, pp. 2530–2540, (2012).
[7]. D. S. Eliahu et al., “A Two-Stage multiplicative Kalman filter for attitude estimation of the human wrist” in Proc. IEEE/ION Position Location and Navigation Symposium (PLANS), pp. 944–951, (2018).
[8]. S. Majumder and M. J. Deen, “Wearable IMU-Based System for Real-Time Monitoring of Lower-Limb Joints,” IEEE Sensors J., Vol. 20, No. 23, pp. 14167–14175, (2020).
[9]. J. Lu, W. Nie, P. Xing, Z. Wang, Y. Cao, and Y. Wu, “An EKF Based on Aerodynamic Constraints for Fixed-Wing UAV Attitude Estimation,” IEEE Sensors Lett., vol. 9, no. 2, pp. 1–4, (2025).