爱玩科技网
您的当前位置:首页基于卡尔曼滤波的多径估计延迟锁定环算法

基于卡尔曼滤波的多径估计延迟锁定环算法

来源:爱玩科技网
第37卷第1期 2015年2月 探测与控制学报 Journal of Detection&Control Vo1.37 NO.1 Feb.2015 基于卡尔曼滤波的多径估计延迟锁定环算法 胡 辉 ,张雪丽 ,方 玲 ,杨德进。,欧敏辉 (1.华东交通大学信息工程学院,江西南昌330013;2.中移(杭州)信息技术有限公司,浙江杭州311121; 3.中国科学院国家授时中心。陕西西安710600) 摘 要:针对多径估计延迟锁定环(MEDLL-Multipath Estimating Delay Lock Loop)算法所需相关器数量大, 并在低信噪比时难以保证多径抑制效果的问题,提出了基于卡尔曼滤波(KF)的多径估计延迟锁定环算法。该 算法首先用KF对相关器输出进行噪声抑制,然后用MEDLL来估计多径信号的幅度、相位和码延迟等参数, 通过消除多径信号来得到直达信号。仿真结果表明:当采用41路相关器时,K-MEDLL算法比MEDLL算法 的伪码误差减小了0.16 chip,这比采用了201路相关器的MEDLL算法的伪码误差还少0.08 chip;当信噪比 为一30 dB时,MEDLL算法的多径误差包络变化剧烈,最大误差为0.48 chip,K—MEDLL的多径包络误差比较 平缓,最大误差为0.08 chip。 关键词:GPS;多径抑制;卡尔曼滤波;多径估计延迟锁定环 中图分类号:1]P 92 文献标志码:A 文章编号:1008—1194(2015)O1—0058—06 A Multipath Estimating Delay Lock Loop Based on Kalman Filter HU Hui ,ZHANG Xueli ,FANG Ling ,YANG Dej in。,OU Minhui (1.School of Information Engineering,East China Jiaotong University,Nanchang 330013,China; 2.China Mobile Information Technology Corporation,Hangzhou 311121,China; 3.National Time Service Center,Chinese Academy of Sciences,Xfan,710600,China) Abstract:The multipath estimating delay lock loop needs massive correlators,and it is difficult to guarantee the multipath mitigation performance in the case of low SNR.Aiming at the problems,a multipath estimating delay lock loop based on Kalman filter(K-MEDLL)was presented in this paper.The algorithm utilized Kalman Filter to filter the correlators output SO as to suppress the noise;then,estimatied the parameters of multipath signal by utilizing MEDLL to separate the direct signal from the received signa1.Simulation results showed that the code error of K—MEDLL was 0.16 chips less than MEDLI when using 41 correlators,and 0.08 chips less than MEDLL in the case of 201 correlators.Meanwhile,when the SNR was一30dB,the code error varied significant— ly,the maximum code error of MEDLL was up to 0.48 chips,whereas the code error of K-MEDLL did not vary obviously,the maximum code error was up to 0.08 chips. Key words:GPS;multipath mitigation;Kalman filter;multipath estimating delay Lock loop 0 引言 多径干扰是GPS系统的主要误差来源之一,并 且无法通过差分GPS技术去除。目前GPS多径抑 可以分为以下两大类:1)通过改进接收机的相关器 和码环鉴别器的性能来抑制多径,主要包括窄相关 技术l_1]、Strobe Correlator技术l2]、早迟斜率多径 抑制技术ELS(Early Late Slope)[3]等,这类技术 是通过减少早迟相关器间隔来提高多径抑制性能。 由于相关间隔无法做到无限小、预相关带宽也是有 限的,而较宽的预相关带宽又会导致环路的噪声性 制的方法除了基于天线的空域处理方法之外,大致 *收稿日期:2014-09—04 基金项目 江西省自然科学基金项目资助(20142BAB207001) 江西省教育厅科学技术研究项目资助(JJ14369) 作者简介:胡辉(197O一),男,江西南昌人,博士,教授,研究方向:卫星导航定位,并行算法与并行处理,机器视觉。E mail:948393783@99.corn。 胡辉等:基于卡尔曼滤波的多径估计延迟锁定环算法 59 能下降,所以采用这类算法进行多径抑制必须折衷 的幅度a ===0.5、多径延迟r 一0.3 chip时,多径信 考虑相关间隔和预相关带宽。2)基于信号估计理论 来估计多径信号幅度、延迟和相位等参数,通过从输 入信号中消除多径信号来恢复直达信号,如最大似 然估计_4j、MEDLL[5-6 3、扩展卡尔曼滤波算法 号的影响使伪码自相关函数形状发生畸变,相关峰 曲线过零点发生偏移。 (EKF)【 ]等。其中MEDLL算法将多径信号估计 与跟踪环路结合在一起,采用多相关器结构得到本 地伪码与输入信号的相关值。要使MEDLL算法 具有优越的性能,必须采用尽可能多的相关器,一般 要大于10路相关器,这样硬件或计算量非常大;而 且在低信噪比条件下,由不同延迟的相关器组抽样 得到的相关峰形状受到严重畸变,难以估计多径信 号参数并恢复直达信号。本文针对此问题,提出了 基于KF的多径估计延迟锁定环算法。 1 GPS多径信号模型与MEDLL算法 1.1 GPS多径信号模型 GPS信号传输到达地面时,因受到地形地貌以 及周围建筑物的影响产生散射和反射,从而引起了 多径效应。直达信号、反射信号和散射信号由于各 自传输路径不同,信号之间存在相对相位和相对延 迟,幅度特性亦存在差异。进入接收机的信号由各 路信号叠加而成,不考虑导航电文,假设输入信号中 含有1条直达信号和M一1条多径信号,则GPS中 频信号的数学模型可表示为: ^平1 r(£)一 ajc(f一.cj)cos(似+ )+,z(£)(1) J一0 式(1)中,r( )为接收信号,c(£)为伪随机码序列, ( )为高斯白噪声,M为信号的路数,a 、 、oj分别 为第J( 一0,1,…,M一1)路信号的幅值、码相位和 载波相位,J一0表示直达信号。 假设接收信号r(f)中只包含一路直达信号和 一路多径信号,即M一2,并假设信号中载波完全被 剥离,然后与本地伪码进行相关积分运算,得到接收 信号的自相关函数可表示为: 1 Ct R(r)一寺l』J r r(t)c(t—r)COS(以+ )dt一 T 倪oR (r一"Co)+a1R (r—r1) (2) 式(2)中: 1 Ct R (r)一 l C(£)c( 一r)dt (3) 』J rT 其中,R (・)为伪码的自相关函数。 如图1所示,当直达信号幅度Ct。一1、多径信号 图1 受多径影响的相关函数 Fig.1 Correlation function with the presence ofin-phase and out-phase multipath 1.2 MEDLL算法 由于多径信号的存在,相关峰畸变,传统的伪码 延迟跟踪环不能够准确跟踪码相位。MEDLL算 法 基于最大似然估计的原理,从接收到的复合信 号中分离出直达信号,从而达到消除多径信号的目 的。MEDLL原理具体如下: 接收信号r(£)的复数形式为: r( )一∑ f( 一 )  ̄w(t-rj + ( )(4) 对r( )构造最大似然函数进行估计,使式(5) 的最大似然函数取得最小值: L( , , )===I』r( )一s(£)]dt (5) 式中: ( )一∑ c( 一 ) ej”‘ (6) 其中,s(£)为接收信号的估计。 为了解出最大似然函数,得到各参数的估计,用 最大似然函数分别对三个参数求偏导差, 3L, 3L, 并令它们等于0。可以得到三个参数的估计: 1 一m—ax(Re{[-R (r)一∑air (r一≠ ) ] 睁 (7) 1 . 一arg[-R ( )一∑云 ( 一 ) t](9) 60 探测与控制学报 式中: R ( )一亍』t ( )c( 一 ) d£ (10) 其中,R(・)为实际相关函数。 由于式(6)一式(8)中各参数是相互耦合的,难 以解算,所以一般采用迭代法对公式进行处理l8]。 MEDLL算法将多径信号估计与跟踪环路结合 在一起,采用多相关器结构得到本地伪码与输入信 号的多组相关值,用以恢复得到信号的相关函数 R (r),通过迭代估计的方式得到新估计的直达信 号相关函数,再利用传统的跟踪环进行信号的跟踪, 以达到多径抑制的目的。 要使MEDLL算法达到更优越的性能,必须采 用尽可能多的相关器(一般要大于10路相关器),并 且在低信噪比的条件下,由于相关峰会受到噪声的 影响,跟踪环中的多径抑制性能将下降。 图2(a),(b)分别表示的是无噪声和有噪声影响 的情况下,MEDLL算法所估计相关峰的结果图。可看 出,由于噪声的影响,MEDLL估计的直达信号相关峰 也受到很大的影响,也就降低了跟踪环的性能。 码偏/chip (a】无噪声影响的相关峰 码偏/chip (b)有噪声影响的相关峰 图2 MEDLL估计的相关峰 Fig.2 The correlation peak estimated by MEDLL 2 K-MEDLL算法 首先采用多相关器的结构对基带信号进行采 样,基于采样值恢复相关峰,因为相关峰受到多径和 噪声的影响,会产生畸变,首先采用KF对畸变的相 关峰进行滤波得到消除噪声影响后的相关峰,然后 利用MEDLL消除多径对相关峰的影响得到修正的 直达信号相关峰。K—MEDLL算法的跟踪环框图如 图3所示。 图3 K-MEDLL算法跟踪环框图 Fig.3 The block diagramof K—MEDLL 2.1 系统模型的建立 接收信号的相关函数近似为不同振幅、时延参 数的直达和多径信号波形的叠加,通过从相关函数 中减去多径信号波形来消除多径干扰[ 。因此,首 先建立多相关器输出的模型,然后针对该模型利用 KF消除噪声对相关峰的影响。 2.1.1 多相关器输出观测模型 对于GPS C/A码,采用N组相关器,本地伪码 相位分别为 ( 一0,1,…,N一1),假设载波完全 被剥离,与本地伪码进行相关积分运算,接收信号的 相关函数可表示为: ~1^垂1 R===∑∑ni=0 j=o  ( 一rj)+V (11) 其中, 为相关运算后的噪声。 用Ero r1…r 1]时刻幅度为[以。al… 口 ]的参考相关峰来拟合观测相关峰,令x一 [no a …n ] ’,则多相关器输出模型如下式 所示: R—HX+V (12) 其中,观测矩阵H是由伪码自相关函数R (・)组成 的N行M列矩阵: H 一  一胡; 辉等:基于卡尔曼滤波的多径估计延迟锁定环算法 61 …~ R (rN_1一 …R _一 ] 1)_J (13) 此外,相关器输出的噪声之间也存在互相关,第 i个相关器和第 个相关器之间噪声的互相关如下 式所示: R , (r)===EEV ( )V (£一r)]=== E{[ ( )*h( )][ ( 一r)*h( 一r)]}・ E[c(t一≠ )c(£一r一 )]=== R (r)R [r+( 一z-  )] (21) 2.1.2 相关器输出噪声的分析 接收机中噪声的双边带功率谱与接收信号的带 宽有关,而接收信号的带宽与接收机的每个基带处 理过程有关,所以每个基带处理过程的信噪比 (SNR)可由下式计算得到: SNR一 gK( 4) 』 。 式(14)中,P是接收信号的功率,B 是接收信号的 带宽。 高斯白噪声,z( )通过积分累加器,可近似为通 过低通滤波器的过程,所以噪声的相关输出可认为 是双边带功率谱为 ,带宽为[一B ,B ]高斯噪声, 其中B 一1/T,是积分累加器的带宽,丁为相关积 分时间。其中在码相位≠ 处的相关器输出噪声可表 示为: V ( )一n( )c(£一 )*h( ) (15) 式(15)中, ( )是相关积分器的冲激响应,也是低 通滤波器。相关器输出噪声的自相关函数R (r)为: R (r)一EEv ( )V (£——r)]一 E{En(£)*h( )][ ( ——r)*h( ——r)])・ EEc(£一 )c(£一r一 )] (16) 由于GPS系统的伪码C( )具有强自相关性,所 以r≠o时,有: E[c(£一 )f(f—r一 )]一0 (17) 则式(16)可化为: R (r)一E{En(t)* ( )]En(t—r)*h(t—r)]}・ EEc( 一 )f( 一 )]一 E{En(£)*^( )][ ( --r)* (t--z")])一 (r) (18) 由相关器输出噪声的自相关函数R (r)可知, 通过相关器后的噪声方差为: 0-2一 B (19) 综合式(14)和式(19),可得噪声方差与信噪比 的关系如下: 一 P /2 (2O) 则相关器输出噪声的互相关函数的一般表达 式为: R , (0)一R (0 Rc(r』一r )一 (22) R (r,一r ) 综上可得,噪声向量V 的协方差矩阵为: ===0- Pv (23) 『_足( 一矗) 足(矗一 ) … 足( 一 H) :f足( 一£) 足(a一 )…足( 一 ) ( H一 )足( H一矗)…足( 一 H)  I1 ( 。一 ) …尼(r o—fN_1)  lR(f1一r 0) l …R(rl—fⅣ-1) (fN_1一r o) 尼(  ̄_ 一 ) (24) 2.2 K-MEDLL算法的基本原理 由2.1可知,第志时刻相关器输出的相关矩阵 R 组成系统模型中的观测向量,系统模型中的第k 时刻状态向量为 ===(口∽a1^,…,a( 1)^),则系 统的线性观测模型和状态模型如下所示: Rk—HX + (25) X 一 卜1+,l 1 (26) 其中, 是观测噪声, ~N(O, ),Ck是观测噪 声V 的方差阵;F是状态转移矩阵,一般取对角阵; ,l 是过程噪声,,l ~N(0,Q ),Q}一 是过程噪 声 卜 的方差阵,取对角阵。 根据以上建立的系统模型,构建KF的预测过 程和更新过程,在预测过程中,KF给出当前状态的 预测以及当前预测估计的协方差矩阵: I 1=== 1 (27) 62 探测与控制学报 P I卜1一J P 1F 4-Q 1 (28) 其中, I 为误差的相关矩阵。在更新过程中,KF 根据当前预测值,计算K ,然后用其修正当前预测 值 I 从而得到更精确的估计值,同时更新协方 差矩阵 : K 一 I 1H (HP I 1H + ) (29) 一 I}_1 4-K (R 一HX l 1) (30) 一(1一K H)P I卜1 (31) 受噪声影响的相关峰利用KF建模并滤除噪声 对含多径的相关峰的影响,得到基于KF估计的多 径相关峰,如图4所示,实线是经过KF建模后的相 关峰,然后通过MEDLL估计得到直达信号的相关 峰,达到抑制多径信号的影响的目的。 趔 馨 1 图4 KF估计的多径相关峰 Fig.4 The multipath correlation peak estimated by KF 3 实验验证 假设中频信号的载波已经完全跟踪,相关积分 时间为1 ms,多径信号相对直达信号的幅度比为 0.5,多径延迟为0.2 chip,图5所示为采用101路 相关器,不同信噪比条件下的伪码跟踪误差。 . 毖 喏 留 图5不同信噪比条件下多径抑制算法的性能比较 Fig.5 The perfcIrmance comparison of muhipath mitigation under different SNR 从图5可看出,当信噪比从一33 dB增加到一 13 dB时,MEDLL算法的伪码跟踪误差随着信噪比 的减小而不断增大,并且误差都大于0.08 chip;而 K—MEDI I 算法随着信噪比的减小,其伪码跟踪误 差变化趋势不明显,且都小于0.05 chip,所以在低 信噪比的环境下,利用K—MEDLL算法具有比一般 MEDLL算法更优越的性能。 信噪比为一30 dB时,K—MEDI I MEDI I 算 法性能与相关器个数的关系如图6所示。 . 专 凿 离 相关器个数 图6多径抑制算法性能与相关器个数的关系 Fig.6 The relationship between the performance of muhipath mitigation and the number of correlation 由图6可以看出,取41路相关器时,MEDI I 算法的误差是0.26 chip,而K—MEDLL算法误差为 :2 ¨ 0.1 chip,误差减小了0.16 chip,且比MEDI I 算法 用201路相关器的伪码误差还减少了0.08 chip。 随着相关器个数的增加,两种算法的伪码跟踪误差 都是减小的趋势;在相关器个数小于4l时,K— MEDI I 算法的误差减小趋势大于MEDI L算法; 在41路相关器之后,二者趋势平行,K MEDI I 算 法的伪码跟踪误差比MEDLL算法小0.16 chip。 图7为信噪比为一30 dB时,MEDLL算法和 K—MEDLL算法的伪码跟踪误差包络比较图。 图7两种多径抑制算法的伪码跟踪误差包络比较 Fig.7 The code tracking error envelope comparison of two muhipath mitigation algorithm 由图7明显可以看出,MEDLL算法的多径误 差包络变化剧烈,而且最大伪码跟踪误差达到了 0.48 chip,而K—MEDLI 算法的包络平缓,且其伪 码多径误差都小于0.08 chip。 d1I{ 胡 辉等:基于卡尔曼滤波的多径估计延迟锁定环算法 63 Meeting of the Satellite Division of The Institute of Navi— 4结论 本文提出了K—MEDLL算法,该算法首先利用 KF对相关器输出的建模,滤除噪声对相关值的影 gation(ION GPS 1994),1994:143-148. [4]刘亚欢,田宇,李国通.基于最大似然估计的GPS多径估 计口].宇航学报,2009,30(4):1466—1471. [-5]Nee van,Richard D J,Siereveld Jaap.The multipath as— timating delay lock loop:approaching theoretical accura— 响;然后利用MEDLL估计多径信号的幅度、相位 和码延迟各参数,从而分离得到直达信号。仿真实 验结果表明,提出的K—MEDLL算法对噪声抑制效 果更好;在相关器个数较少时,K—MEDLL算法比 cy limits[C]//Position Location and Navigation Sympo— siurn.US:IEEE,1994:246—251. [6]Townsend B R,Fenton P C,Van Dierendonck K J,et a1. Performance evaluation of the multipath estimating delay MEDLL算法的性能更优越。 参考文献: [1]Van Dierendonck A J,Fenton Pat,Ford Torn.Theory and performance of narrow correlator spacing in a GPS lock loop[J].NAVIGATION—L0S ANGELES AND— WASHINGT0N,1995,42:503—514. [-7]Jee G I,Kim H S,Lee Y J.A GPS C/A code tracking loop based on extended Kalman filter with multipath mit— igation[C]//M Proceedings of ION conference GPS 2002.Portland,USA:The Institute of Navigation,2002: 446—451. receiver[J].Navigation,1992,39(3):265—283. r2]Lionel Garin,Diggelen Frank van,Rousseau Jean-Miche1. Strobe&edge correlator multipath mitigation for code [-8]Nee Van.Methord of Estimating A Line of Sight Signal Propagation Time Using A Reduced Multipath Correla— [c]//Proceedings of 9th International Technical Meet— ing of the Satellite Division of the Institute of Naviga— tion,ION GPS-96,1996:657—664. tion Functionl P j.United States patent:5615232,1997. [9]Lohan E S,Renfors M Feedforward approach for esti— mating the muhipath delays in CDMA systems[c]// Proceeding of Nordic Signal Processing Symposium.Kol— marden,Sweden:2000:125—128. [3]Bryan T,Patrick F.A practical approach to the reduction of pseudorange multipath errors in all GPS receiver, [C]//Proceedings of the 7th International Technical 欢迎订阅《探测与控制学报》 《探测与控制学报》是由西安机电信息技术研究所、机电动态控制重点实验室、中国兵工学会联合主办的 国内外公开发行的学术期刊。1979年创刊,被中文核心期刊要目总览、中国科技核心期刊收录,也是中国科 学引文数据库来源刊。本刊是综合性的学术技术刊物,旨在为引信及相关探测与控制技术领域内的科研、生 产和教学服务,重点刊载:机、电接触探测,无线电、红外、激光和磁近程探测,信号处理,超小型电源,安全与 解除保险装置,测试仿真等方面的学术论文。 《探测与控制学报》为双月刊,每册15元,全年90元。刊号:ISSN 1O08—1194;CN 61—1316/TJ,欢迎各单 位及读者订阅。 

因篇幅问题不能全部显示,请点此查看更多更全内容