Abstract
Aiming at the problem that ultra-wide band (UWB) cannot be accurately localized in environments with large noise variations and unknown statistical properties, a combinatorial localization method based on improved cubature (CKF) is proposed. First, in order to overcome the problem of inaccurate local approximation or even the inability to converge due to the initial value not being set near the optimal solution in the process of solving the UWB position by the least-squares method, the Levenberg-Marquardt algorithm (L-M) is adopted to optimally solve the UWB position. Secondly, because UWB and IMU information are centrally fused, an adaptive factor is introduced to update the measurement noise covariance matrix in real time to update the observation noise, and the fading factor is added to suppress the filtering divergence to achieve an improvement for the traditional CKF algorithm. Finally, the performance of the proposed combined localization method is verified by field experiments in line-of-sight (LOS) and non-line-of-sight (NLOS) scenarios, respectively. The results show that the proposed method can maintain high localization accuracy in both LOS and NLOS scenarios. Compared with the Extended Kalman filter (EKF), unbiased Kalman filter (UKF), and CKF algorithms, the localization accuracies of the proposed method in NLOS scenarios are improved by 25.2%, 18.3%, and 11.3%, respectively.