[发明专利]一种面向室内行人导航的AHRS/UWB无缝组合导航方法

说明书

技术领域

本发明涉及复杂环境下组合定位技术领域，尤其涉及一种面向室内行人导航的AHRS/UWB无缝组合导航方法。

背景技术

近年来，行人导航(Pedestrian Navigation,PN)作为导航技术应用的新兴领域，正越来越受到各国学者的重视，并逐渐成为该领域的研究热点。然而在隧道、大型仓库、地下停车场等室内环境下，外界无线电信号微弱、电磁干扰强烈等因素都会对目标行人导航信息获取的准确性、实时性及鲁棒性有很大影响。如何将室内环境下获取的有限信息进行有效的融合以消除室内复杂环境影响，保证行人导航精度的持续稳定，具有重要的科学理论意义和实际应用价值。

在现有的定位方式中，全球卫星导航系统(Global Navigation Satellite System,GNSS)是最为常用的一种方式。虽然GNSS能够通过精度持续稳定的位置信息，但是其易受电磁干扰、遮挡等外界环境影响的缺点限制了其应用范围，特别是在室内、地下巷道等一些密闭的、环境复杂的场景，GNSS信号被严重遮挡，无法进行有效的工作。

近年来，WSN以其低成本、低功耗和低系统复杂度的特点在短距离局部定位领域表现出很大的潜力。学者们提出将基于WSN的目标跟踪应用于GNSS失效环境下的行人导航。这种方式虽然能够实现室内定位，但是如在如下不足：

1、由于室内环境复杂多变，WSN信号十分容易受到干扰而导致定位精度下降甚至失锁；

2、目前的导航定位精度为米级，不能保证对室内行人高精度的导航需求；

3、由于WSN采用的通信技术通常为短距离无线通信技术，因此若想完成大范围的室内目标跟踪定位，需要大量的网络节点共同完成，这必将引入网络组织结构优化设计、多节点多簇网络协同通信等一系列问题。

因此现阶段基于WSN的目标跟踪在室内导航领域仍旧面临很多挑战。

AHRS具有全自主、运动信息全面、短时、高精度的优点，适用于小区域目标跟踪领域；虽然其可以实现自主导航，但误差随时间积累，长航时运行条件下将导致导航精度的严重下降。

对于现有的组合式导航技术，大多完全依靠人工智能算法直接替代信号失锁时不能工作的数据融合滤波器对位置、速度和姿态等导航信息的解算误差进行预估，并没有充分有效的利用前一时刻的测量值，产生野值的概率非常高。

发明内容

本发明的目的就是解决上述问题，提供一种面向室内行人导航的AHRS/UWB无缝组合导航方法，该方法克服了单一导航技术存在的不同程度的缺陷，保证整个导航系统的无缝导航。

为实现上述目的，本发明采用下述技术方案，包括：

一种面向室内行人导航的AHRS/UWB无缝组合导航方法，包括以下步骤：

(1)分别将AHRS与UWB无线发送模块安装在行人的鞋上，将UWB无线发送模块固定在设定位置；

(2)通过AHRS对鞋子的运行状态进行识别，在鞋子处于静止状态时，通过局部数据融合滤波器对AHRS解算的导航信息误差进行预估和补偿，得到当前时刻鞋子的位置、速度和姿态的导航信息的最优估计；

(3)根据UWB信号是否正常，将整个导航算法分为培训和预估两个阶段；

(4)培训阶段，UWB信号正常，通过对AHRS与UWB两种模块之间的距离和距离变化率的测量，完成对行人鞋子位置和速度的预估；

(5)将步骤(4)中采集到的位置和速度信息与步骤(2)中采集到的位置和速度信息做差，所述差值作为主数据融合滤波器的观测量，通过主数据融合滤波器对当前时刻最优的位置、速度和姿态误差进行预估，并对AHRS采集到的数据进行误差补偿，最终得到当前时刻最优的导航信息预估；

(6)将AHRS采集到的位置、速度和姿态信息与主数据融合滤波器输出的最优误差预估分别作为人工智能算法的培训输入和目标输入，通过人工智能算法对两者之间的映射关系进行构建；

(7)一旦UWB信号出现失锁，整个导航算法进入预估阶段；在这一阶段，将步骤(2)中输出的当前时刻鞋子的导航信息作为预估输入传送到人工智能算法中，利用步骤(6)中构建的映射关系，对UWB采集到的位置和速度信息进行预估；

(8)返回步骤(5)，将对UWB采集到的位置和速度信息的预估值与步骤(2)中采集到的位置和速度信息做差，所述差值作为主数据融合滤波器的观测量，保证主数据融合滤波器的正常工作，进而保证整个导航系统的无缝导航。

所述步骤(2)中通过AHRS对鞋子的运行状态进行识别的具体方法为：