Abstract:Human body motion tracking is a key technique in robotics, virtual reality and other human-computer interaction fields. This paper proposes a novel simple-structure Kalman filter to improve the accuracy of human body motion tracking, named the Second EStimator of the Optimal Quaternion Kalman Filter (E2QKF). The new algorithm is the combination of the Second Estimator of the Optimal Quaternion (ESOQ-2) algorithm, the linear Kalman filter and the joint angle constraint method. In the proposed filter, the ESOQ-2 algorithm is used to produce an observation quaternion by preprocessing accelerometer and magnetometer measurements. The compensation for the accelerometer added in the ESOQ-2 algorithm is to eliminate the influence of human body motion acceleration included in the results. The state vector of the filter is the quaternion, which is calculated with gyroscope measurements, and the Kalman filter is to calculate the optimal quaternion by fusing the state quaternion and the observation quaternion. Therefore, the filter becomes a simple first-order linear system model, which avoids the linearization error of measurement equations and reduces the computational complexity. Furthermore, the joint angle constraint is considered in the proposed algorithm, which makes the results more accurate. To verify the accuracy of the proposed algorithm, inertial/magnetic sensors are used to perform the upper limb motion experiment, and the result of E2QKF (without joint angle constraint) is compared with an optical motion capture system and two traditional methods. Test results demonstrate the effectiveness of the proposed filter: the root mean square error (RMSE) of E2QKF is less than 2.0° and the maximum error is less than 4.6°. The result of E2QKF (with joint angle constraint) is compared with E2QKF (without joint angle constraint). Test results demonstrate the superiority of E2QKF (with joint angle constraint): the joint angle constraint method can further improve the accuracy of human body motion tracking.

On generalized filtering methods for quaternion-based orientation estimation

Stirling's Interpolation Filtering and Extended Kalman Filtering for Orientation Estimation

QUATERNION-BASED FILTERING FOR GYROLESS ATTITUDE ESTIMATION WITHOUT AN ATTITUDE DYNAMICS MODEL

Quaternion-based algorithm for orientation estimation from MARG sensors

Gaussian Particle Filter Based Pose and Motion Estimation

A novel Gaussian sum quaternion constrained cubature Kalman filter algorithm for GNSS/SINS integrated attitude determination and positioning system

Novel Quaternion Kalman Filter for Gyro-less Attitude Determination

A Linear Kalman Filter for MARG Orientation Estimation Using the Algebraic Quaternion Algorithm

Kalman-filter-based Attitude and Parameters Estimation for Noncooperative Spacecraft

Keeping a Good Attitude: A Quaternion-Based Orientation Filter for IMUs and MARGs

The Geometric Unscented Kalman Filter

Huber-based unscented filtering and its application to vision-based relative navigation

Study of the Algorithm of Backtracking Decoupling and Adaptive Extended Kalman Filter Based on the Quaternion Expanded to the State Variable for Underwater Glider Navigation

Spacecraft Attitude Estimation by Unscented Filtering

A New Quaternion-Based Kalman Filter for Real-Time Attitude Estimation Using the Two-Step Geometrically-Intuitive Correction Algorithm

Clifford Algebra-Based Iterated Extended Kalman Filter with Application to Low-Cost INS/GNSS Navigation

Comparison of Attitude Determination Methodologies for Implementation with 9DOF, Low Cost Inertial Measurement Unit for Autonomous Aerial Vehicles

Multiplicative Quaternion Extended Consensus Kalman Filter for Attitude and Augmented State Estimation

Optimal Attitude Estimation and Filtering Without Using Local Coordinates Part I: Uncontrolled and Deterministic Attitude Dynamics

A New Quaternion-Based Kalman Filter for Human Body Motion Tracking Using the Second Estimator of the Optimal Quaternion Algorithm and the Joint Angle Constraint Method with Inertial and Magnetic Sensors

Guaranteed Performance of Nonlinear Attitude Filters on the Special Orthogonal Group SO(3)