双端惯性预积分提升6自由度相对定位精度,尤其在快速旋转场景下更稳定。
Dual Preintegration for Relative State Estimation
- 利用双平台惯性数据预积分构建运动约束,实现高效重线性化
- 在模拟与实测中均显著降低快速旋转时的位置误差
- 适合高动态VR追踪等对实时性与精度要求高的场景
相对状态估计用于两个移动体间的六自由度相互定位。基于圆周运动原理,估计精度对参考平台的非线性旋转敏感,尤其在两平台距离较大时更为明显。即使采用线性化运动模型,累积线性化误差也会显著降低精度。在虚拟现实(VR)应用中,表现为头戴设备快速旋转时控制器六自由度跟踪出现明显位置偏差。线性化误差导致估计漂移,使估计算法不一致。在里程计领域,惯性测量单元(IMU)预积分被提出作为运动观测,以实现高效重线性化,从而缓解线性化误差。本文基于此理论,提出双预积分方法,即从两个平台分别进行IMU预积分,构建连续相对状态的运动约束,并支持高效重线性化。同时,我们对状态进行了可观测性分析,并解析给出了对应的零空间。算法评估包含仿真与真实实验。通过模拟参考平台多种非线性旋转,对比了所提方法与现有最先进(SOTA)算法的精度;实地测试则从偏置可观测性、非线性旋转及背景纹理三个角度,比较了所提方法与SOTA算法在VR控制器追踪中的表现。结果表明,所提方法在精度和鲁棒性上均优于SOTA算法。
原文摘要 · Abstract (English)
Relative State Estimation perform mutually localization between two mobile agents undergoing six-degree-of-freedom motion. Based on the principle of circular motion, the estimation accuracy is sensitive to nonlinear rotations of the reference platform, particularly under large inter-platform distances. This phenomenon is even obvious for linearized kinematics, because cumulative linearization errors significantly degrade precision. In virtual reality (VR) applications, this manifests as substantial positional errors in 6-DoF controller tracking during rapid rotations of the head-mounted display. The linearization errors introduce drift in the estimate and render the estimator inconsistent. In the field of odometry, IMU preintegration is proposed as a kinematic observation to enable efficient relinearization, thus mitigate linearized error. Building on this theory, we propose dual preintegration, a novel observation integrating IMU preintegration from both platforms. This method serves as kinematic constraints for consecutive relative state and supports efficient relinearization. We also perform observability analysis of the state and analytically formulate the accordingly null space. Algorithm evaluation encompasses both simulations and real-world experiments. Multiple nonlinear rotations on the reference platform are simulated to compare the precision of the proposed method with that of other state-of-the-art (SOTA) algorithms. The field test compares the proposed method and SOTA algorithms in the application of VR controller tracking from the perspectives of bias observability, nonlinear rotation, and background texture. The results demonstrate that the proposed method is more precise and robust than the SOTA algorithms.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。