然而,由于磁强计测量地磁噪声的影响,基于单点粒子滤波器的地磁定位算法在连续运行过程中可能会出现显著的误差甚至发散,从而限制了其远程定位精度。
为了解决这一问题,哈尔滨工业大学信息科学与工程学院罗清华团队提出了一种基于实时顺序粒子滤波器的地磁定位方法。
哈工大罗清华团队方案设计
为了解决算法对噪声的灵敏度和累计误差导致的精度下降的问题,罗清华团队提出了一种基于实时序列粒子滤波器(RSPF)的地磁/测程综合定位方法。
团队以差速机器人为实验对象,首先,通过实时连续粒子滤波,在保证实时性的同时,减轻了连续运行过程中噪声的影响;然后,通过测程校准参数对测程的轨迹形状进行校正,提高了该方法的远程定位精度;最后,通过MAGCOM算法对初步匹配结果进行二次匹配,进一步减小了该方法的定位误差:
计算结果表明,利用RSPF有效地降低了磁强计测量噪声的影响。通过将测程校准参数纳入粒子中,可以实时调整轨迹形状,避免刚性变换造成的误差。最后,利用MAGCOM对初步匹配结果进行二次匹配,进一步提高了定位精度。
为了进一步证明该算法的实用性,罗清华团队部署了一个真实差速机器人场地,将所提出的算法结果与通过元客视界FZMotion光学运动捕捉系统采集机器人的真实轨迹进行对比与评估。
实验中,由元客视界提供的FZMotion动捕系统在实验中作为系统真值ground truth(定位精度可以达到亚毫米级,角度精度达到0.01°)
在实验过程中,团队通过远程控制器控制机器人在实验区域内移动,共采集了10组真实轨迹进行匹配实验,并对相关算法的性能进行了比较分析。
实验结果表明,团队提出的算法比其他算法获得了更高水平的定位精度。该方法可以有效提高定位精度,为地磁辅助定位提供了重要参考,但仍需要进一步的研究来降低该方法的复杂性。
关于元客视界—FZMotion
元客视界是凌云光设立的全资子公司,主要面向元宇宙虚拟现实、Web3.0时代数字人、沉浸媒体、全息通信、计算光学成像等应用,已形成光场建模、运动捕捉、全景成像、XR 拍摄等在内的产品布局。
FZMotion光学运动捕捉系统是元客视界自主开发的运动捕捉采集与分析系统,可以实时跟踪测量并记录三维空间内点的轨迹、刚体的运动姿态以及人体动作,空间定位精度可以达到亚毫米级。