专利名称：用于wsn/ins高精度实时组合导航的h无穷信息融合方法
技术领域：
本发明涉及一种用于WSN/INS高精度实时组合导航的H⑴信息融合方法，属于多传感器数据融合领域。
背景技术：
对未知节点精确位置信息的需求推动了精确定位技术的发展，这种趋势在未来很长一段时间里仍将保持不变。近年来，无线传感器网络(Wireless Sensors Network,WSN) 以其低成本、低功耗和低系统复杂度的特点在短距离定位领域表现出很大的潜力。WSN为在无GPS信号地区，即所谓的“盲区”时，如室内、高层建筑密集的市区、矿井、隧道等环境下未知节点定位提供了可能，但由于WSN采用的通信技术通常为短距离无线通信技术(如 ZigBee, WIFI等)，因此若想完成长距离的目标跟踪定位，需要大量的网络节点共同完成， 这给WSN的实际网络拓扑实现带来了一定困难，同时也与WSN低成本、低功耗的特点不相符
微惯性导航系统(MEMS inertial navigation system，MINS)具有全自主、运动信息全面、短时、高精度的优点，虽然可以实现自主导航，但误差随时间积累，长航时运行条件下将导致导航精度严重下降。为了克服在无GPS导航信号的密闭环境下单独使用MINS长航时运行时导航精度严重下降的问题，本发明提出将WSN和INS进行组合的高精度实时组合导航系统。利用基于WSN的无线定位技术测量未知节点的相对导航信息，将相对导航信息与MINS上得到的绝对导航信息通过滤波器进行数据融合，得到理想的导航信息，充分利用了未知节点的环境信息，实现了相对导航信息与绝对导航信息的融合，得到一种比上述任何单一导航方法精度更高的导航信息。
在处理组合导航数据融合的问题时，最常用的方法是使用滤波器。最著名的方法是卡尔曼滤波器(Kalman Filte, KF)，然而由于KF是面向线性系统设计的，因此仅对线性定常系统有很好的滤波效果。为了能够实现非线性系统的滤波问题，许多学者通过雅克比矩阵将非线性的系统转化为线性系统进行滤波，从而产生了扩展卡尔曼滤波器(Extended Kalman Filter, EKF)。EKF对非线性系统有很好的滤波效果，是目前实际生产中应用较为广泛的一种滤波方法。但是由于KF、EKF在滤波过程中假设系统的状态噪声和观测噪声均为标准白噪声，所以并不完全符合实际应用中的情况。另外由于设备的硬件问题，导致每一时刻数据的采集周期有小幅不确定的情形，数据获取并不能按理想情况进行，而现有的KF、 EKF并没有考虑这种情况。发明内容
为了解决上述问题，本发明提供了一种用于WSN/INS高精度实时组合导航的H -信息融合方法，将INS(惯性导航系统)、WSN(无线传感器网络)采集到的未知节点的信息进行集成，在相对坐标系中采用H⑴滤波方法。该方法以每个时刻未知节点的在两个方向上的位置误差和速度误差作为状态向量，以每一时刻根据两种系统采集得到的数据计算出的位置误差和速度误差作为观测向量输出，由状态向量和观测向量输出重新构建一个渐近稳定的系统，即H c 滤波器。通过H c 滤波器来预估每一时刻最优的状态向量。这种方法克服传统滤波方法(如KF、EKF)对系统的噪声有特定要求的问题，更适合实际应用中的多传感器数据融合。与此同时，在构建H c 滤波器的系统方程中加入了对数据采集周期的不确定度描述，更加逼近实际中采用周期由于硬件原因导致每一时刻的采集周期有小幅不确定的情形。这种滤波器得到的状态预估比传统的滤波方法精度更高，滤波器的鲁棒性更强。
本发明为解决其技术问题采用如下技术方案
1、在有WSN信号的培训区域内，利用采用超声波与ZigBee/WIFI等短距离通信技术相组合的无线定位技术测量的相对导航信息，与MINS上得到的绝对导航信息通过扩展卡尔曼滤波器/H⑴滤波器进行数据融合，得到的导航信息，比上述任何单一导航方法得到的信息精度更高。
2、MINS利用在培训区域训练的误差模型对测量的绝对导航信息进行误差补偿，得到最优的导航信息，避免了因WSN导航无法工作导致导航误差快速下降、无法保证导航精度的问题。
3、数据融合采用的滤波器的系统(如式1所示)以每个时刻未知节点的在两个方向上的位置误差(ex，ey)和速度(evx，evy)误差作为状态向量。将同一时刻INS和WSN测量得到的位置和速度信息的差值作为系统的观测量。
权利要求
1. 一种用于WSN/INS高精度实时组合导航的H无穷信息融合方法，其特征在于包括下列步骤(1)以每个时刻未知节点的在两个方向上的位置误差(ex，ey)和速度(evx，evy)误差作为状态向量，系统方程如式(1)所示⑴ex,k+l10T0ex,keyM\010Tey,k_L^vx,k+\0010evy,k+l _0001_evy,k _(2)对采样周期T的随机不确定度描述如下所示10T000St0eyMi010T000StZZ <+00100000evy,k+\00010000即 =(A+E ·3k)xk+Bcok(2b)Λex,key,ke,vx,kevy,kωx,kω.vx,kω.' j\—Sa2/Iv(3)采用每个时刻通过的位置误差和速度误差作为观测量通过将同一时刻INS和WSN 测量得到的位置和速度信息做差得到Kk1000ex,kKk0100ey,k—+0010e , vx ’k0001_eyy,k_即 Yk = CXk+D υ(3b)\—sa 3/Iv综上所述，系统方程如式4所示，其中& = L)(k为需要估计的量与状态向量的线性关系；Yk =CXk+D^k(4)Λ = lx^(4)根据系统方程每个时刻的X和Y的输出，来对系统方程中需要预估的值进行预估 Xk+l= AfXk^ BfYkZk=LfXk,众= 0，1，2，Κ(5)首先e/t= -= Zjt _ f& ,由式(4)和式(5)得到式(6)ek+l=(KEPk)ek\—S5/Iv+ —r/o - τ p\—s 6 /Iv
全文摘要
本发明公布了一种用于WSN/INS高精度实时组合导航的H无穷信息融合方法，该方法以每个时刻未知节点的在两个方向上的位置误差和速度误差作为状态向量，以每一时刻根据两种系统采集得到的数据计算出的位置误差和速度误差作为观测向量输出，由状态向量和观测向量输出重新构建一个渐近稳定的系统，即H无穷滤波器。通过H∞滤波器来预估每一时刻最优的状态向量。与此同时，在构建H∞滤波器的系统方程中加入了对数据采集周期的不确定度描述，更加逼近实际中采用周期由于硬件原因导致每一时刻的采集周期有小幅不确定的情形。这种滤波器得到的状态预估比传统的滤波方法精度更高，滤波器的鲁棒性更强。
文档编号G01C21/20GK102494685SQ20111035909
公开日2012年6月13日 申请日期2011年11月14日 优先权日2011年11月14日
发明者徐元, 李庆华, 陈熙源 申请人:东南大学