Robust MPS-INS UKF Integration and SIR-Based Hyperparameter Estimation in a 3D Flight Environment

This study introduces a pose estimation algorithm integrating an Inertial Navigation System (INS) with an Alternating Current (AC) magnetic field-based navigation system, referred to as the Magnetic Positioning System (MPS), evaluated using a 6 Degrees of Freedom (DoF) drone. The study addresses significant challenges such as the magnetic vector distortions and model uncertainties caused by motor noise, which degrade attitude estimation and limit the effectiveness of traditional Extended Kalman Filter (EKF)-based fusion methods. To mitigate these issues, a Tightly Coupled Unscented Kalman Filter (TC UKF) was developed to enhance robustness and navigation accuracy in dynamic environments. The proposed Unscented Kalman Filter (UKF) demonstrated a superior attitude estimation performance within a 6 m coil spacing area, outperforming both the MPS 3D LS (Least Squares) and EKF-based approaches. Furthermore, hyperparameters such as alpha, beta, and kappa were optimized using the Sequential Importance Resampling (SIR) process of the Particle Filter. This adaptive hyperparameter adjustment achieved improved navigation results compared to the default UKF settings, particularly in environments with high model uncertainty.