基于图优化的室内外无缝定位算法研究

针对混合场景的无缝定位问题,本文提出了一种基于图优化的室内外无缝定位算法,使用GNSS和UWB技术,通过构建图优化模型,将GNSS定位数据,UWB定位数据,UWB测距作为观测信息,融入到图优化模型中,并通过速度估计回环构建平滑约束,兼顾了最大似然估计和滤波的优点,可适用于室内、室外、过渡区域等多种场景.实验结果表明,基于图优化的室内外无缝定位算法增强了室外定位的稳定性,消除了室内外过渡区域的定位跳动,有效避免了乒乓效应,取得了较好的定位效果.