An Emergency Seamless Positioning Technique Based on ad hoc UWB Networking Using Robust EKF

摘要

In this paper, a new emergency positioning technique is proposed based on ad hoc GNSS/UWB (Global Navigation Satellite System/Ultra-Wideband) network. The main innovations of the program are reflected in two aspects. First of all, a unified coordinate frame for indoor and outdoor environments is constructed dynamically with GNSS/UWB integration. In the outdoor environments, the high accuracy positioning can be achieved with GNSS/UWB equipment. The high-accuracy indoor coordinate is obtained by measuring the range observations between adjacent network nodes and outdoor GNSS/UWB nodes, and the range information of the UWB network is transmitted to the cloud server center. A network adjustment algorithm is proposed to improve the positioning accuracy of the UWB network. Secondly, a UWB indoor location algorithm based on robust EKF (Extended Kalman Filter) is proposed. By analyzing the transfer characteristics of gross error in EKF model, a new robust EKF model is established. The model is constructed based on the statistical characteristics of redundant observation components and prediction residual. The robust equivalent gain matrix is constructed, and the robust positioning solution of UWB is obtained with iteration. The global test is carried out first to further improve the real-time operation efficiency. Finally, a field indoor and outdoor seamless positioning experiment was carried out to verify the effectiveness of the proposed algorithm. The results show that the positioning accuracy of UWB emergency network nodes (anchors) can reach 0.35 m. Based on the network, the positioning accuracy of the tag can reach 0.38 m by applying the improved robust EKF positioning algorithm, which is improved by 20.83% and 73.43% compared with standard EKF and least square method, respectively.