复杂坏境下基于SINS/UWB的容错组合定位技术研究

针对超宽带无线定位系统在复杂坏境中出现的定位数据丢失以及粗大误差等导致SINS/UWB组合系统定位精度下降的问题,提出了一种基于超宽带定位系统容错判断的组合定位方法。首先根据捷联惯导测量值进行基于中值滤波的运动载体静止状态检测,进而利用最小二乘法实现静止状态下捷联惯导量测偏差矫正;然后在建立SINS/UWB组合定位模型的基础上,引入决策树容错判断机制,对超宽带定位系统在复杂环境中由于信号干扰以及非视距导致的测量数据丢失以及粗大定位误差进行实时评估,进而应用卡尔曼滤波算法,实现容错组合定位系统的构建。在搭建的SINS/UWB组合定位实验平台中进行模型验证,结果表明容错组合定位系统能够有效检测出UWB定位系统出现的定位数据丢失以及粗大定位误差,并且在UWB粗大误差状态持续6 s的情况下,容错组合定位系统仍然能够保持较高的定位精度。

Fault tolerant integrated positioning system based on SINS/UWB in complex environment

Because of the data lost and gross error of ultra wideband (UWB) positioning system in a complex environment, the tracking accuracy of SINS/UWB integrated positioning system is seriously decreased. Aimed at above problem, this paper proposes an SINS/UWB integrated positioning method based on fault tolerant detection for UWB. Firstly, the stationary state detection model is built with measurement of SINS using the Median filter. Moreover, the measured bias of SINS can be calibrated with Least Square algorithm for the stationary state. Secondly, the fault tolerant judgement model is used to detect the UWB, which includes the measured data lost and gross position error caused by None Line of Sight and interference signal. The fault tolerant integrated positioning system can be achieved by Kalman Filter using detected positioning results of UWB. Finally, some experiments are conducted to evaluate the proposed method using experimental platform of SINS/UWB integrated positioning system. The experimental results show the fault tolerant integrated positioning system can effectively detect the data lost and gross error for UWB, meanwhile, the fault tolerant positioning system can guarentee high tracking accuracy for a duration time of 6s for UWB inaccurate state.