面向具有数据缺失UWB行人导航的自适应预估EKF滤波算法及系统
摘要:
本发明公开了面向具有数据缺失UWB行人导航的自适应预估EKF滤波算法及系统,包括:通过UWB系统和惯性导航器件INS系统分别测量参考节点到目标节点之间的距离;在此基础上,将两种系统测量得到的距离信息作差,差值作为数据融合算法所使用的滤波模型的观测量;在此基础上,对传统的自适应EKF滤波算法进行改进,引入变量表示第i个信道的距离信息是否可用。一旦距离信息不可用,则对不可用的距离信息进行预估,以弥补不可用的距离信息,保证滤波器对位置误差的预估;在此基础上,将惯性导航器件INS测量得到的行人位置与EFIR滤波器得到的位置误差预估作差,最终得到当前时刻最优的行人位置预估。
0/0