A 3D Range-Only SLAM Algorithm Based on Improved Derivative UKF

In this study, we constructed a 3D range-only (RO) localization algorithm based on improved unscented Kalman filtering (UKF). The algorithm can determine the location of unknown UWB nodes in a 3D environment through a moving node with low computational complexity, which can help agents to accurately identify feature points in 3D SLAM based only on the range. Specifically, we established an original UKF framework based the 3D RO localization algorithm, and developed a derivative UKF framework to reduce the computational complexity of the algorithm. We used singular value decomposition to compensate for the robustness of the algorithm. Next, we performed a theoretical analysis to show that our method reduces the computational burden without reducing the stability or accuracy of the system. Finally, we conducted numerical simulations and physical experiments to show the effectiveness of the developed 3D RO localization algorithm.