第15卷第2期 2014年4月 信息工程大学学报 Journal of Information Engineering University Vo1.15 NO.2 Apr.2014 DOI:10.3969/j.issn.1671-0673.2014.02.008 一种基于改进卡尔曼滤 波的NLOS误差抑制算法 贾腾飞 ,彭 锐 ,赵 远 ,胡捍英 ,李志铭 (1.信息工程大学,河南郑州450001;2.北京理工大学,北京100081) 摘要:在蜂窝网络中,非视距(NLOS)传播是影响定位精度的主要因素。针对LOS与NLOS的 混合环境,提出了一种基于到达时间(TOA)测量值进行NLOS误差消除的算法。该算法首先 利用TOA测量值的统计特征建立新的判决机制,鉴别当前时刻的测量值是否存在NLOS误 差,然后对包含NLOS误差的测量值,通过构建测量误差模型估计NLOS误差,并以此修正卡 尔曼滤波器的新息,实现LOS重构。仿真结果表明,与已知算法相比,文章提出的算法能够更 好地抑制NLOS误差,并且适应于不同的LOS与NLOS混合环境。 关键词:到达时间;非视距误差;卡尔曼滤波;视距重构 中图分类号:TN929.5 文献标识码:A 文章编号:1671-0673(2014)02-0175-06 NLOS Error Mitigation Based on Modified Kalman Filter JIA Teng—fei ,PENG Rui ,ZHAO Yuan ,HU Han—ying ,LI Zhi—ming (1.Information Engineering University,Zhengzhou 450001,China; 2.Beijing Institute of Technology,Beijing 100081,China) Abstract:The main n’npact on location of mobile terminals in cellular network is the Non—Line-of- Sight(NLOS)propagation.Based on modiifed Kalman Filter,an algorithm of mitigating NLOS error under LOS/NLOS conditions is proposed.The NLOS error is first identiied by exploifting the statisti— cal characteristics of the time history of range measurements,and the NLOS error in current range measurements is also estimated according to the relationship between range measurements and error. Then,the Kalman Filler uses the estimated value to adjust its renewal process.Simulation results demonstrate that,compared with traditional algorithms of NLOS error mitigation,the proposed meth- ods can mitigate NLOS error in range measurements more effectively under LOS/NLOS condition. Key words:time of arrival;non—line—of-sight error;Kalman filter;LOS reconstruction 0 引言 近年来,随着基于位置服务广泛应用,蜂窝网定位技术受到了越来越多的关注。其中,基于TOA实现 对移动台位置估计的方法原理简单,且在LOS环境下能取得较好的定位精度,因而受到广泛应用。在实 际使用中,这种定位方法的误差主要来自两个方面:一方面是测量误差,主要由测量装置的热噪声、量化误 差及设备精度引起 ;另一疗面是NLOS误差,这是由于障碍物的阻隔导致移动台和基站之间产生了非视 距传播,特别是在城市环境中,由于大量建筑物的存在,非视距传播极大地影响了定位精度。文献[2]通 收稿日期:2013-10-24;修回日期:2014-01-07 基金项目:国家科技重大专项资助项目(2011ZX03003-003-02) 作者简介:贾腾飞(1990一),男,硕士生,主要研究方向为移动通信,E-mail:jtf2013@126.corn。 176 信息工程大学学报 2014正 过实测表明,在GSM网络环境中平均NLOS误差可达500m~700m,在IS-95网络环境中平均NLOS误差 可达589m,而系统测量误差对定位精度的影响相对较小。因此,在蜂窝网定位中,如何消除TOA测量值 中NLOS误差,提高定位精度成为了一个重要的课题。 目前,NLOS误差的抑制主要有两种思路:①间接法,其思路是在位置解算的过程中采用加权处理以 减轻NLOS误差对定位结果的影响 ,从而增强算法在LOS与NLOS混合环境下的实用性,这种思路虽然 不需要对测量值进行预处理,但是要求参与定位的基站数目必须大于3个;②直接法,即对测量值中包含 的NLOS误差先鉴别后消除。其中,常用的是Wylie法 ,该算法首先对一段时间内的TOA测量值进行多 项式拟合,然后利用LOS环境下测量值噪声标准差来判断测量值是否存在NLOS误差,再根据TOA测量 值的残差进行LOS重构,该鉴别法计算量较大,LOS重构方法在工程应用中不易实现,并且在LOS与 NLOS的混合环境下,TOA测量值中可能既包含有LOS误差又包含NLOS误差时,该算法性能不佳。文献 [5—8]都是基于卡尔曼滤波方法来抑制NLOS误差。文献[5 ]均利用新息大小来判断NLOS传播的存在 与否,文献[5]在新息中减掉在该环境下的NLOS误差统计均值,由于在该LOS重构方法中需要特定环境 中NLOS误差分布新息来修正新息,在实际使用中该方法性能不佳。文献[6]通过设置卡尔曼增益系数以 修正卡尔曼增益的大小,从而抑制测量值中的NLOS误差,但是该参数需要提前设置。文献[7.8]对卡尔 曼滤波器进行了改进,通过在状态向量中增加NLOS误差预测项,在一定程度上改善定位精度,然而在 LOS和NLOS的混合环境中,由于NLOS误差自身具有随机性,使得NLOS误差的预测值与真实值之间往 往存在较大的偏差,在实际使用中性能不稳定。 本文针对LOS与NLOS混合环境,考虑到移动台运动轨迹的连续性和不可突变性,根据NLOS统计特 性构建测量误差模型,利用卡尔曼滤波器对TOA值进行最小方差估计。本文提出的算法分两步:①联合 TOA测量值均值与标准差建立NLOS误差鉴别机制,判断当前时刻测量值是否存在NLOS误差;②对LOS 传播的测量值直接采用卡尔曼滤波加以平滑,对NLOS传播的测量值,则根据测量值的均值与真实距离、 NLOS误差之间的关系估计出相应时刻的NLOS误差,并修正卡尔曼滤波中的异常新息以实现LOS重构。 仿真结果表明,该算法不依赖于特定的NLOS误差分布,并且与现有算法相比,本文算法能较好地抑制 NLOS误差。 1 NLOS误差模型及统计特性 在LOS与NLOS混合的蜂窝网中,移动台与基站之间距离测量值与误差间的关系: 『d+n,LOS环境下 ,.、 【d+n+e, NLOS环境下 、 其中,r表示从移动台到基站的距离测量值,d表示移动台与基站之间的真实距离,/7,是系统测量误差,服 从均值为零,方差为or 的正态分布,e是由无线传播环境带来的NLOS误差,是一个正均值随机变量,通常 认为其服从指数分布、均匀分布或Delta分布,本文中设NLOS误差e的均值为 ,方差为 :。其中,根据 文献[9]可知NLOS误差e具有随机性和性,并且与系统测量误差n相互。本文以停靠在固定位 置或者以较低速度运动的移动台为对象,在一段时间内,可以近似认为移动台与基站之间的距离不变,即 E(d)一d,D(d) 0。对(1)式求均值: 附 = =d,L OS 嘶对(1)式求方差: for ,LOS环境下 境下 D r { I NL0s环境下 在(1)式~(3)式中,移动台与基站之间的距离d是未知量,待求。在i时刻,用r 表示此时的测量 值。计算第i时刻之前 1内测量值的方差: 酉1 ∑(r 一万1 =i- : L1rn) 。 第2期 贾腾飞等:一种基于改进卡尔曼滤波的NLOS误差抑制算法 177 利用(3)式通过比较这段时间内距离测量值的方差D(r)与噪声方差 间的关系可以求出NLOS误差均值的估计值: 1 i+L2—1 来鉴别测量值中是否包含 NLOS误差。若判断第 时刻的测量值包含NLOS误差,则根据(2)式中距离测量值的均值E(r)与d、/x 之 d+/x =E(r )=吉∑r , ≤t<i+L2。 若在第i时刻之前的L1个测量值中为LOS传播或者包含的NLOS误差已经被消除,其均值可以近似 等于第i时刻的真实距离: 1 i一1 d=E(rc) 者 : 。 ,i—L1≤ <io 则NLOS误差均值的估计值: 1 i+L2一l =1 i一1 (d+ e)一d 壶 r 一者 : n。 下面将针对LOS与NLOS混合环境下如何鉴别测量值中的NLOS误差的存在以及对包含NLOS误差 的测量值如何进行LOS重构进行讨论。 2 算法描述 为实时监测TOA测量值中是否包含NLOS误差,本文采用滑动窗口的方式,分两步进行:①通过引入 TOA测量值的均值与标准差建立新的判决机制,并利用该机制鉴别每个时刻的测量值中是否包含NLOS 误差;②对LOS传播的测量值直接采用卡尔曼滤波加以平滑,若TOA测量值中包含NLOS误差,则将 NLOS传播测量值的均值和LOS传播(或LOS重构后)测量值的均值之间的差值作为相应时刻的NLOS误 差估计值,并修正卡尔曼滤波更新过程中出现的异常新息以实现LOS重构。该流程示意图如图1所示。 改进的卡尔曼滤波器 幽1 TOA测量僵鉴别及重构流程 2.1 NLOS误差鉴别 在i时刻,滑动窗 1位于[i—L1,i一1]区间,用阴影矩形表示,如图2所示。 用 表示在第i时刻 FOA测量值,此时滑动窗口位于[i—L1,i一1]区 . 差 。: 1 .1 —一 £l E2 ... .间,利用下式计算区间[ —L1, 一1]中L1个测量数据的均值m。和标准偏 —: _ _ _一, mI 者 : , t √者 ; 。(r 一mt) 改变: (4) 图2基于滑动窗口的TOA 数据NLo 鉴别 首先,将第i时刻的测量值ri与mI进行比较,判断传播状态是否发生 若 —m,l≤6 ,其中,6,是预先设定的门限值,则判断第i时刻的测量值的传播状态未发生改变,接 下来比较 。与6 ,其中,6 ,是预先设定的门限值。当 ≤6 ,则判定当前传播状态为LOS传播;当 > 6 ,则判定当前传播状态为NLOS传播。鉴别第i时刻的测量值后进入(i+1)时刻,同时利用(4)式更新 均值m。和标准偏差or,。 若lrl—m。I>6 ,取区问[i,i+L2—1]内 2个测量值,然后利用下式计算该区间内测量值的均值m, 和标准偏差or,: 178 信息工程大学学报 m2 壶 Fn, z √壶 (r 一mz) 。 当 ≤6 ,则当前传播状态为LOS传播;当 >6 ,则当前传播状态为NLOS传播。进入(i+1)时 刻,利用(4)式更新均值m。和标准偏差6 。本文的判决门限值6 、艿 以及滑动窗长度 l、 2均与蜂窝网 环境有关,可以根据经验设定。上述算法过程表述如图3所示。 2.2 LOS重构 假设每个周期 获取一次TOA测量值,卡尔曼滤波器分 别用状态方程和观测方程描述移动台的运动状态和观测 过程。 状态方程为X(k+1)=似( )+GW(k),其中, (k)= [ ( ) ( )]T,表示状态向量; =[01 :],表示状态转移矩 阵;G:[0.5T2 斯白噪声。 ; (k)表示零均值、协方差矩阵为Q的高 观测方程为z(k)=HX(k)+V(k),其中,H=[1 0r 表示测量矩阵;V(k)是第k个时刻的观测噪声,其协方差阵 为尺。 基于卡尔曼滤波器对TOA测量值进行处理,实际上是利 用前一时刻状态的估计值以及当前时刻的观测值来计算当前 图3 NLOS误差鉴别算法流程图 状态的估计值。在LOS环境下,卡尔曼滤波器可以在一定程度上消除TOA测量值中的系统测量噪声误 差。然而,在NLOS环境中,测量噪声由于受到NLOS误差的影响,在卡尔曼滤波更新过程中产生的新息 将出现异常,造成滤波估计值偏离系统的真实状态,同时由于卡尔曼滤波器的记忆性,后续的滤波估计值 都会受到影响,故需要对卡尔曼滤波器中出现异常的新息进行修正。 为减轻NLOS误差对TOA测量值估计的影响,本文接下来根据NLOS误差鉴别的结果,在卡尔曼滤波 更新过程中,对不包含NLOS误差的测量值,直接进行经典的卡尔曼滤波处理,而对包含NLOS误差的测 量值,将(m:一m )作为NLOS误差估计值,并对卡尔曼滤波中产生的新息进行修正。故对卡尔曼滤波更 新过程修正如下: X(k/k)=X(k/k一1)+K(k)[ 一 ]。 其 — 叶 : 一 1(m; NLOS ,m 是当前时刻之前的L1个坝m{ = 日『l廿、l l/日I lH ̄l I、 百日 l7Ul0l量10l【的均1 D1日直 m—,m 是从当 从 2一m。),此时鉴别结果显示为 ’… ~ ~ ~ ’… 前时刻开始 2个测量值的均值,K(k)是卡尔曼增益系数, 表示新息。 : 时 3仿真结果及分析 为验证本文提出算法在LOS与NLOS混合环境下的性能,使用服从COST259信道模型¨。。中的城市 环境和郊区环境这两种典型环境来分析。假设服务基站的坐标为(0,0),单位为In,移动台初始位置坐标 为(200,0),单位为Ill,并以2m/s的恒定速度沿横坐标轴方向匀速运动。TOA测量值的采样时间间隔为 0.1 s,采样时间为200s。其中,TOA测量值中包含的测量误差服从均值为0、标准差为30的高斯分布; TOA测量值中包含的NLOS误差服从COST259信道模型的指数分布。 实验中,设定判决门限值6,=90,6 =36,设定滑动窗长度L1=L2:120。仿真实验分别采用三阶多 项式进行平滑与LOS重构的Wylie法,文献[8]采用的NLOS重构方法和本文提出的算法对TOA测量值 进行处理。 实验1 3种算法在郊区环境中对TOA测量值的影响 通过分析图4、图5和图6可以看出:在郊区环境中,利用本文提出的消除NLOS误差算法,重构后的 第2期 贾腾飞等:一种基于改进卡尔曼滤波的NLOS误差抑制算法 179 测量值抖动幅度最小,相对于真实值误差最小,消除NLOS误差的性能优于Wylie法和文献[8]的方法。 采样点数 采样点数 采样点数 未经过处理的测量值曲线 均方根误差曲线 采样点敦采样点数 采样点数 wyti ̄ ̄消 ̄NLOS误差的性能曲线 文献『81法消 ̄NLOS误差的性能曲线 图4消除NLOS误差性能比较 图5 TOA测量值重构均方误差比较 Wylie法在拟合曲线整体向下平移的过程中,以LOS环境下的最大偏差作为偏移量,这个偏移量属于 LOS环境下的先验知识,在LOS与NLOS混合环境下使用Wyl{单 酱} ie法时,其不能随着NLOS误差的变化有效 消除NLOS误差,抖动幅度增大,性能明显变差;文献[8]采用的NLOS重构方法,直接对NLOS误差进行 预测并进行重构,由于NLOS环境中NLOS误差的随机性,重构测量值不能动态适应NLOS误差的变化,因 而出现了较大误差,其性能在NLOS和LOS切换时出现更大的偏差,性能明显变差;本文提出的算法虽然 先经过一段延迟,并且不对这部分数据进行处理,但是在全部为NLOS的环境中,本文提出的NLOS误差 的消除性能明显要优于前两种方法,在NLOS和LOS切换时,本文提出算法也出现少量较大偏差的重构 值,但相对于前两种方法其偏差比较小。 在郊区环境下进行1000次蒙特卡罗实验,实验结果如图6所示,量 本文算法都能取得较好的测量精度, 测量值误差在30m以内的概率达到67%,在100m以内的概率达到95%,性能明显优于Wylie法和文献 [8]的方法。 实验2 3种算法在城市环境中对TOA测量值的 影响 在城市环境中,首先分析图7、图8和图9并对比3 斛 种算法的性能可知,本文提出的消除NLOS误差算法相 鞋 蛊 比较于Wylie法和文献[8]的方法来说最有效,重构后 i四 蠖 的测量值总体上相对于真实值误差较小,重构后的测量 割 颦 值抖动幅度最小。 ÷ 通过对比图4和图7以及图5和图8,分析郊区环 境和城市环境对算法性能带来的影响:随着城市环境中 NLOS传播地增多,并且NLOS误差相对幅度增大,Wylie 0 法重构后的测量值相对于郊区环境下抖动幅度明显增 大,在LOS和NLOS切换时,有较多LOS重构的测量值 图6不同重构方法对距离测量值影响 。 误差甚至超过了300m,远大于当时的真实距离值;文献[8]采用的NLOS重构方法同样受到的城市环境的 影响,其LOS重构后的测量值相对于真实值的误差仍然较大;本文提出的方法虽然受到环境的影响,重构 后测量值的误差增大,但是增大幅度较小,并且与Wylie法和文献[8]的方法相比,本文算法明显性能优于 这两种算法。 在城市环境下进行1000次蒙特卡罗实验,实验结果如图9所示,本文算法都能取得较好的测量精度, 测量值误差在60m以内的概率达到67%,在200m以内的概率达到90%,性能明显优于Wylie法和文献 [8]的方法。 180 信息工程大学学报 2014正 [ 糨采样点数 过处理的测量值曲线 实正 值后 测 量 值 采样点数 下 一0一如 一0 , l- 采样点数 采样点数 一 一采样点数 二 真惨 塑 啊一 采样点数 采样点数 采样点数 图7消除NLOS误差性能比较 值后 值 量 酒 一 一砌 一一O 图8 TOA测量值重构均方根误差比较 4 结论 针对LOS与NLOS混合的蜂窝环境,本文提出了一 种基于改进卡尔曼滤波对TOA测量值进行NLOS误差 糌 蛊 趔 竖 薹}{ 一 ¨ H●—蚕l=,q 0— 嘞m姗 抑制方法。该方法首先根据观测数据的统计特征,通过 联合TOA测量值的均值和方差建立新的判决机制,实现 ÷ j】3jj 账 NLOS误差的鉴别,然后在鉴别结果的基础上,利用不含 一0 NLOS误差测量值的均值与包含NLOS误差测量值的均 龅 鲥 值之间的差值来修正卡尔曼滤波器的新息,完成对包含 NLOS误差TOA测量值的LOS重构。在NLOS误差的鉴 。 重构测量值误差,m 图9不同重构方法对距离测量值影响 别和抑制过程中,与间接法相比,本文的方法要求的基站数可以小于完成一次TOA定位的最少基站数;与 同属直接法的Wylie方法、文献[8]的算法相比,本文提出的方法以一小段时间延迟为代价,重构后的TOA 姗 测量值与真实值之间的误差较小,并且在不同的LOS和NLOS混合环境中性能均优于这两种算法。 奠Ⅺ 一 ㈣ 删 参考文献: 龅● 一 2007,29(7):1551-1555. [1] 黄清明,刘琚.基于卡尔曼滤波的测量值重构及定位算法[J].电子与信息学报,[2] Silventoinen M,Rantalainen T.Mobile station emergency location in GSM[C]//IEEE International Conference on Personal Wireless Communications.1996:232—238. [3]Liu Dawei,Lee MoonChuen,Pun Chi—Man.Analysis of Wireless Localization in Non—line—of—SiSht Condiitons[J].IEEE Trans on Inform Theory,2013,62(4):1484—1492. [4] Wylile M P。Hohzman J.The non—line.of—sight problem in mobile location estimation[C]//IEEE International Conference on Universal Personal Communications.1996:827—831. [5]。段凯宇,张力军,高玲,等.两种NLOS误差消除及TOA定位算法[J].信号处理,2008,24(4):566—568. [6]李静,刘琚.用卡尔曼滤波器消除TOA中NLOS误差的三种方法[J].通信学报,2005,26(1):130-135. [7]Zhang Meiyang,Wang Jianhui,Ji Zhongmei.A novel algorithm of NLOS error mitigation based on Kalman filter in cellular wireless Location[c]//Wireless Communications Networking and Mobile Computing.2010:14. [8]Guan Weiguo,Deng Zhongliang,Ge Yuetao.TDOA Mobile Location Based on Kalman Filter in CDMA2000 Cellular Networks [C]//Wireless Communications Networking and Mobile Computing.2010:1-4. [9]田孝华,廖桂生.一种有效减小非视距传播影响的TOA定位方法[J].电子学报,2003,31(9):1429・1432. [10]Woo Sung・Shik,You Heung—Ryeo1.The NLOS mitigation technique for position location using IS・95 CDMA networks[C]// IEEE Vehicular Technology Conference.2000:2556—2560.