一种面向室内行人导航的AHRS/UWB无缝组合导航方法

摘要

本发明公开了一种面向室内行人导航的AHRS/UWB无缝组合导航方法，包括：将整个导航方法分为培训和预估两个阶段，在UWB信号正常的情况下，将AHRS采集到的位置和速度信息与UWB采集到的位置和速度信息的差值作为主数据融合滤波器的观测量，对当前时刻最优的位置、速度和姿态误差进行预估；一旦UWB信号出现失锁，AHRS中输出的位置、速度和姿态信息作为预估输入传送到人工智能算法中，通过构建的映射关系，对主数据融合滤波器失锁的观测向量进行预估，保证主数据融合滤波器的正常工作，进而保证整个导航系统的无缝导航。