用连续时间建模提升稀疏锚点下的室内定位精度与稳定性
CT-VIR: Continuous-Time Visual-Inertial-Ranging Fusion for Indoor Localization with Sparse Anchors

- 基于B样条构建连续时间轨迹,融合视觉、惯性与测距数据
- 在仅有少量锚点条件下实现亚米级定位误差,优于传统离散方法
- 适合资源受限的窄空间场景,如仓库、管道等复杂环境
视觉-惯性里程计(VIO)广泛用于移动机器人定位,但缺乏全局约束时长期精度会下降。引入超宽带(UWB)测距可缓解漂移,但高精度测距通常需部署大量锚点,在狭小或低功耗环境中难以实现。此外,现有视觉-惯性-测距(VIR)融合方法多依赖离散时间滤波或优化,难以在异步多传感器采样下兼顾定位精度、轨迹一致性和融合效率。为此,本文提出一种基于样条的连续时间状态估计方法用于VIR融合定位。预处理阶段,利用VIO运动先验和UWB测距构建虚拟锚点并剔除异常值,降低几何退化风险,提升测距可靠性。估计阶段,采用B样条对位姿轨迹进行连续时间参数化,将惯性、视觉和测距约束作为滑动窗口图中的因子。联合优化样条控制点与少量辅助参数,获得连续时间轨迹估计。在公开数据集与真实实验中均验证了该方法的有效性与实用性。
原文摘要 · Abstract (English)
Visual-inertial odometry (VIO) is widely used for mobile robot localization, but its long-term accuracy degrades without global constraints. Incorporating ranging sensors such as ultra-wideband (UWB) can mitigate drift; however, high-accuracy ranging usually requires well-deployed anchors, which is difficult to ensure in narrow or low-power environments. Moreover, most existing visual-inertial-ranging (VIR) fusion methods rely on discrete time-based filtering or optimization, making it difficult to balance positioning accuracy, trajectory consistency, and fusion efficiency under asynchronous multi-sensor sampling. To address these issues, we propose a spline-based continuous-time state estimation method for VIR fusion localization. In the preprocessing stage, VIO motion priors and UWB ranging measurements are used to construct virtual anchors and reject outliers, thereby alleviating geometric degeneration and improving range reliability. In the estimation stage, the pose trajectory is parameterized in continuous time using a B-spline, while inertial, visual, and ranging constraints are formulated as factors in a sliding-window graph. The spline control points, together with a small set of auxiliary parameters, are then jointly optimized to obtain a continuous-time trajectory estimate. Evaluations on public datasets and real-world experiments demonstrate the effectiveness and practical potential of the proposed approach.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。