基于分段RTS平滑算法的个人自主导航系统定位方法

摘要

本发明公开了一种基于分段RTS平滑算法的个人自主导航系统定位方法，先采集个人自主导航系统正常工作模式下输出的角速率信息、比力信息、磁力计信息；进而根据系统输出信息解算出未经误差补偿的个人定位信息；然后利用系统输出数据及公式确定运动过程中的零速区间并根据零速区间对数据进行分段；在每个分段中使用改进的RTS平滑算法以得到误差修正后的个人定位信息。本发明在使用零速校正作为误差补偿修正算法的基础上，根据让个人行走时各传感器输出数据特点，利用零速区间对各数据进行分段，设计基于分段RTS平滑算法的个人自主导航系统定位方法。在不增加系统成本的条件下，提高了个人自主导航系统定位精度；本发明方法简单，稳定性和可靠性高。