IEEE Trans Neural Syst Rehabil Eng. 2021;29:1280-1289. doi: 10.1109/TNSRE.2021.3093006. Epub 2021 Jul 12.
Accurate and robust orientation estimation using magnetic and inertial measurement units (MIMUs) has been a challenge for many years in long-duration measurements of joint angles and pedestrian dead-reckoning systems and has limited several real-world applications of MIMUs. Thus, this research aimed at developing a full-state Robust Extended Kalman Filter (REKF) for accurate and robust orientation tracking with MIMUs, particularly during long-duration dynamic tasks. First, we structured a novel EKF by including the orientation quaternion, non-gravitational acceleration, gyroscope bias, and magnetic disturbance in the state vector. Next, the a posteriori error covariance matrix equation was modified to build a REKF. We compared the accuracy and robustness of our proposed REKF with four filters from the literature using optimal filter gains. We measured the thigh, shank, and foot orientation of nine participants while performing short- and long-duration tasks using MIMUs and a camera motion-capture system. REKF outperformed the filters from literature significantly (p < 0.05) in terms of accuracy and robustness for long-duration tasks. For example, for foot MIMU, the median RMSE of (roll, pitch, yaw) were (6.5, 5.5, 7.8) and (22.8, 23.9, 25) deg for REKF and the best filter from the literature, respectively. For short-duration trials, REKF achieved significantly (p < 0.05) better or similar performance compared to the literature. We concluded that including non-gravitational acceleration, gyroscope bias, and magnetic disturbance in the state vector, as well as using a robust filter structure, is required for accurate and robust orientation tracking, at least in long-duration tasks.
使用磁惯性测量单元(MIMU)进行准确和鲁棒的方向估计多年来一直是关节角度长时间测量和行人航位推算系统的挑战,限制了 MIMU 的许多实际应用。因此,本研究旨在开发一种全状态鲁棒扩展卡尔曼滤波器(REKF),用于 MIMU 进行准确和鲁棒的方向跟踪,特别是在长时间的动态任务中。首先,我们通过在状态向量中包含姿态四元数、非重力加速度、陀螺仪偏差和磁场干扰,构建了一种新颖的 EKF。接下来,修改了后验误差协方差矩阵方程以构建 REKF。我们使用最优滤波器增益将我们提出的 REKF 与文献中的四种滤波器进行了比较。我们使用 MIMU 和摄像机运动捕捉系统测量了九名参与者在进行短时间和长时间任务时的大腿、小腿和脚部方向。REKF 在准确性和鲁棒性方面明显优于文献中的滤波器(p < 0.05),尤其是在长时间任务中。例如,对于脚部 MIMU,REKF 和文献中最好的滤波器的(滚转、俯仰、偏航)的中位数 RMSE 分别为(6.5、5.5、7.8)和(22.8、23.9、25)度。对于短时间试验,REKF 的性能明显(p < 0.05)优于或与文献相当。我们得出结论,在状态向量中包含非重力加速度、陀螺仪偏差和磁场干扰,并使用稳健的滤波器结构,对于准确和鲁棒的方向跟踪是必要的,至少在长时间任务中是如此。