基于人体/环境约束的行人导航系统三维空间定位方法

摘要

本发明涉及一种基于人体/环境约束的行人导航系统三维空间定位方法，解决了基于低成本MEMS惯性测量单元设计的行人导航系统在三维空间内的高精度定位问题；本方法采用鞋部安装MEMS惯性测量单元的方式进行数据采集并完成捷联导航解算，同时结合鞋底安装的压力传感器输出的数据对行人步态中的零速区间进行检测。本发明结合行人运动特点及周围环境中建筑物特点，以零速修正为基础，提出了抑制零速区间内磁场异常及抑制SINS高度通道发散的方案，并设计了扩展卡尔曼滤波器对导航解算结果进行误差修正，实现了行人在三维空间的高精度定位功能。