DU Shaoyang, ZHAO Yiyang, CHE Yiting, JI Miaoxin, LI Qianlei, LU Mingkun
In complex emergency rescue scenarios such as semi-obstructed industrial sites, personnel positioning is easily affected by obstructions and signal attenuation, which makes traditional positioning solutions relying on fixed base stations difficult to be rapidly adapted to sudden rescue needs. While inertial navigation systems(INS) can provide autonomous positioning, they are afflicted with shortcomings such as cumulative errors over time and insufficient three-dimensional positioning accuracy. To address the issues of insufficient collaborative positioning accuracy and reliance on pre-existing infrastructure in emergency rescue operations within semi-obstructed industrial sites, a multi-person collaborative positioning technology combined with “ZigBee+INS” is focused on this study. The aim is to overcome the limitations of traditional positioning methods, as rapid deployment and high-precision positioning are enabled without the need for pre-established base stations, thereby rescue efficiency is improved and personnel safety is enhanced. Firstly, ZigBee anchors are deployed on the rescue personnel’s end, and the cross-power spectrum phase method is used to estimate the time delay of the time difference of arrival(TDOA). Secondly, by combining the location information of the rescue personnel and the commander, an improved TDOA algorithm is employed to suppress positioning errors. Thirdly, based on the results of the improved TDOA, the Taylor algorithm is used to determine the initial positions of the rescue personnel. Finally, position and heading constraints are established using ZigBee, barometers, and magnetometers, and multi-source information fusion and real-time position updates are achieved through an extended Kalman filter(EKF). Experimental results show that, compared with inertial navigation and classical collaborative positioning algorithms, the root mean square error and the absolute mean positioning error of the proposed algorithm are reduced by 55.42% and 62.36%, respectively. This algorithm achieves anchor-free and rapidly deployable multi-person collaborative positioning in semi-obstructed environments, and technical support is provided for precise command and control in emergency rescue operations.