摘要
基于手机陀螺仪的航向推算误差是影响行人航位推算定位的重要误差源之一。为了修正陀螺仪引起的航向漂移、抖动等误差,借助高级启发式漂移消除法(AHDE)在航向修正上的特点,将基于足绑式IMU的AHDE算法改进并应用于智能手机的行人航向推算中。首先利用互补滤波算法初步估算航向,通过时域内航向及其变化幅度判断行人是否直行或者沿主导方向直行,并将其与行人航向的差值作为输入量推算可靠的行人航向,从而简化原AHDE算法并降低修正延迟;同时,针对直线路径下航向抖动过大引起的误判和偏差,利用航向平滑模型改正。另外,为进一步适应室内的复杂路线,通过分析行人停顿时加速度数据变化特点,提出了停顿点的识别方法;通过对比手机不同姿态下传感器数据的特点,建立动态转换矩阵,将贴耳打电话时的手机传感器数据转换至平放状态,进而采用上述算法推算行人航向。综合实验表明所提出的方法相较于互补滤波算法在相对闭合差上精度平均提升60%以上。
- 单位