[发明专利]一种基于WSN/MINS组合导航的导航信息无偏紧组合方法

说明书

技术领域

一种基于WSN/MINS组合导航的导航信息无偏紧组合方法，属于复杂环境下组合定位技术领域。

背景技术

对未知节点精确位置信息的需求推动了精确定位技术的发展，这种趋势在未来很长一段时间里仍将保持不变。近年来，无线传感器网络(Wireless Sensors Network，WSN)以其低成本、低功耗和低系统复杂度的特点在短距离定位领域表现出很大的潜力。WSN为在无GPS信号地区，即所谓的“盲区”时，如室内、高层建筑密集的市区、矿井、隧道等环境下未知节点定位提供了可能，但由于WSN采用的通信技术通常为短距离无线通信技术(如ZigBee、WIFI等)，因此若想完成长距离的目标跟踪定位，需要大量的网络节点共同完成，这并不符合WSN低成本、低功耗的需求。

微惯性导航系统(MEMS inertial navigation system，MINS)具有全自主、运动信息全面、短时、高精度的优点，虽然可以实现自主导航，但误差随时间积累，长航时运行条件下将导致导航精度严重下降。为了克服单独使用MINS或WSN定位的缺点，综合了二者的优点，许多学者将上述两种导航方式融合在一起，形成了WSN/MINS组合导航技术。传统的WSN/MINS组合方式较多的采用松组合的方式，即将WSN和MINS所测量的位置、速度等相关的导航信息进行融合，得到最后的最优的误差估计。这种方法思路简单，所需要的系统结构也很简单，计算量较小，工程实现较容易。但由于两个导航系统各自独立工作，彼此获得的导航信息具有一定冗余度。而且，SINS系统输出的载体速度和位置经滤波处理，也使得组合系统的滤波器存在相关性问题，导致状态误差估计难以达到最优。而目前在组合导航领域较为常用的紧组合方式基本采用将未知节点与已知节点之间的距离表达公式进行泰勒级数展开，从展开式中省略二次项之后与相应的WSN测量的距离作差。这种方法虽然将原始数据进行了融合，但是由于在推导过程中忽略了泰勒展开式中的二次项，使得滤波精度受到很大影响。

发明内容

为了解决上述问题，本发明提供了一种基于WSN/MINS组合导航的无需忽略泰勒展开式二次项的导航信息无偏紧组合方法，将微惯性导航系统(MINS)、无线传感器网络(WSN)通过无迹卡尔曼滤波(Unscented Kalman Filter，UKF)对得到的同步导航数据在导航计算机中进行数据融合，从而得到一种比上述任何单一导航方法精度更高，导航覆盖范围更大也更加稳定的新式组合导航方法。组合导航系统分为培训和自适应补偿两个阶段。将有WSN信号的区域称为培训阶段。而只有MINS信号的区域称之为自适应补偿阶段。在培训阶段通过UKF，利用本文提出的紧组合方案，对各种信号采集的导航信息进行数据融合。滤波模型仅需获得MINS所测量的每个时刻的位置、速度信息以及WSN测量的每个时刻未知节点与已知节点之间的距离信息。而不需要获取通过WSN测量的每个时刻未知节点的位置和速度等相关导航信息。克服了传统松组合必须需要同时获取3个以上的未知节点的信息才能够完成相应的数据滤波，给出最优估计。与此同时，由于在组合模型的推导过程中以MINS的测量值(X)与其误差(ΔX)的差值替代了该参数的真实值，减少了传统紧组合方法由于泰勒展开后忽略二次项对定位精度造成的影响。在滤波过程中，采用人工智能算法对MINS导航系统的导航误差模型进行训练，在MINS导航系统离开培训区域之后，依靠之前培训的误差模型对导航系统进行补偿，克服传统MINS导航系统定位精度随时间发生漂移的缺点，以及在密闭环境下无法提供有效的训练网络的问题，提供持久的高精度实时导航。

本发明为解决其技术问题采用如下技术方案：

1、在有WSN信号的培训阶段通过UKF，利用MINS所测量的每个时刻的位置、速度信息以及WSN测量的每个时刻未知节点与已知节点之间的距离信息进行数据融合，得到每一时刻在相对本地相对坐标系中MINS最优误差估计。而不需要获取通过WSN测量的每个时刻未知节点的位置和速度等相关导航信息。

3、无迹卡尔曼滤波器的系统方程以MINS每一时刻两个方向的位置误差(e_x，k，e_y，k)和速度误差(e_vx，k，e_vy，k)作为状态变量，以每一时刻MINS和WSN各自测量的未知节点与参考节点之间的距离的平方差和速度差作为观测量。系统方程如式(1)所示：

系统方程如式(2)所示：