摘要:针对室内复杂应用场景下待定位行人接收到的超宽带(UWB)测距信息数量不确定问题,提出一种基于因子图的 INS / UWB 室内行人紧组合定位算法,实现对动态随遇接入与退出的 UWB 量测信息有效融合。 首先,基于室内行人运动模型以及 UWB 量测模型构建 INS / UWB 紧组合因子图模型,由于对行人位置与速度同时进行建模估计,导致该因子图模型含有环结构。 在此基础上,针对有环因子图模型基于和积算法(SPA)通过两次迭代推导因子图中各节点间消息传递算法,计算行人位置与速 度的后验概率密度。 进一步,针对特殊量测矢量条件下因子图算法定位误差跳变问题,提出一种基于坐标变换的因子图改进方 法,从而有效提高行人位置与速度估计精度。 仿真结果表明,本文提出的 INS / UWB 紧组合定位算法可以有效融合动态随遇接 入与退出的 UWB 测距信息。 在满足计算量与内存消耗需求的前提下,与变结构多模型扩展卡尔曼滤波(EKF)相比,本文提出 算法的定位精度与速度估计精度可以分别提高 14. 94% 与 56. 42% 。