CN109814136A - 一种基于卡尔曼滤波的gnss双频载波跟踪环路 - Google Patents
一种基于卡尔曼滤波的gnss双频载波跟踪环路 Download PDFInfo
- Publication number
- CN109814136A CN109814136A CN201910212041.XA CN201910212041A CN109814136A CN 109814136 A CN109814136 A CN 109814136A CN 201910212041 A CN201910212041 A CN 201910212041A CN 109814136 A CN109814136 A CN 109814136A
- Authority
- CN
- China
- Prior art keywords
- carrier
- phase discriminator
- ring phase
- phase
- carrier wave
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000001914 filtration Methods 0.000 title claims abstract description 13
- 230000001186 cumulative effect Effects 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 11
- 238000000034 method Methods 0.000 claims description 8
- 238000005259 measurement Methods 0.000 claims description 7
- 230000008569 process Effects 0.000 claims description 4
- 230000008859 change Effects 0.000 claims description 3
- 230000009897 systematic effect Effects 0.000 claims description 3
- 230000035945 sensitivity Effects 0.000 abstract description 3
- 238000005516 engineering process Methods 0.000 abstract description 2
- 238000012545 processing Methods 0.000 abstract description 2
- 230000006872 improvement Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 239000005433 ionosphere Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000010363 phase shift Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000032258 transport Effects 0.000 description 1
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及一种基于卡尔曼滤波的GNSS双频载波跟踪环路,属于卫星导航信号处理技术领域。所述双频载波跟踪环路包括4个积分清除器,第一载波环鉴相器,第二载波环鉴相器,卡尔曼滤波器,第一载波环路滤波器,第二载波环路滤波器,第一NCO载波发生器和第二NCO载波发生器。本发明通过卡尔曼滤波器对两个鉴相器输出的载波相位误差进行平滑,能够同时减小两个载波环路滤波器的噪声带宽,从而减小环路的动态,提高跟踪灵敏度,将其应用于双频接收机中,能够有效改善双频接收机对双频信号的跟踪性能。
Description
技术领域:
本发明涉及一种基于卡尔曼滤波的GNSS(全球导航卫星***)双频载波跟踪环路,属于卫星导航信号处理技术领域。
背景技术:
相对于单频接收机而言,双频接收机因其能够消除电离层延迟和快速解算整周模糊度的优势,被广泛应用于各种精密导航定位***中。然而传统双频接收机没有考虑L1、L2信号的关联性,而是将他们看作独立的两路信号,分别采用两个独立的跟踪环路来实现L1和L2信号的跟踪,因而对跟踪环路没有起到任何改善作用。
目前,针对双频接收机跟踪环路的改进主要有两种:一种是根据L1和L2信号之间的关联性,利用L1载波环路输出的载波多普勒值辅助L2载波跟踪的方法。该方法有效缩短L2信号的跟踪时间,提高L2信号的跟踪灵敏度,并且能够有效减小L2信号载波跟踪环路的动态,但该方法存在以下问题:L2信号的跟踪环路能够从L1环路信号跟踪中获得辅助信息,而L1信号跟踪环路却无法获得L2信号跟踪环路中的任何辅助信息,因此一旦L1信号失锁,L2信号也必将失锁。另一种则是双频和差联合跟踪算法,该算法将L1与L2双频信号跟踪放在同等地位,实现了双频信号的相互辅助,有效克服L1辅助L2算法中的固有缺点,并且能够提高双频信号的跟踪稳健性和灵敏度。但若双频信号中某一路信号太差,该算法由于其耦合作用,将会对另外一路信号跟踪产生干扰,严重时甚至会导致整个环路失锁。
因此设计一种适用于双频接收机的,能够同时提高双频信号的跟踪稳健性和灵敏度的新型GNSS双频载波跟踪环路尤为重要。
发明内容:
针对上述问题,本发明提出一种基于卡尔曼滤波的GNSS双频载波跟踪环路,将其应用于双频接收机中,能够极大地改善双频接收机对双频信号的跟踪性能。
本发明为解决其技术问题采用如下技术方案:
一种基于卡尔曼滤波的GNSS双频载波跟踪环路,包括4个积分清除器,第一载波环鉴相器,第二载波环鉴相器,卡尔曼滤波器,第一载波环路滤波器,第二载波环路滤波器,第一NCO载波发生器和第二NCO载波发生器,其中:第一积分清除器和第二积分清除器分别与第一载波环鉴相器连接,第三积分清除器和第四积分清除器分别与第二载波环鉴相器连接,第一载波环鉴相器和第二载波环鉴相器分别与卡尔曼滤波器连接,第一NCO载波发生器、第一载波环鉴相器和卡尔曼滤波器顺序连接,第二NCO载波发生器、第二载波环鉴相器和卡尔曼滤波器顺序连接。
所述第一载波环鉴相器和第二载波环鉴相器均采用二相限反正切算法。
所述第一载波环鉴相器的算法如下:
其中,为第一载波环鉴相器的载波相位误差,IP1为L1支路同相支路累加数据,QP1为L1支路正交支路累加数据。
所述第二载波环鉴相器的算法如下:
其中,为第二载波环鉴相器输出的载波相位误差,IP2为L2支路同相支路累加数据,QP2为L2支路正交支路累加数据。
所述卡尔曼滤波器模型的构建如下所示:
***状态量其中,为第一载波环鉴相器输出的载波相位误差、为第二载波环鉴相器输出的载波相位误差、fd为多普勒频移、为多普勒频移变化率;
***状态方程为:
其中,表示k+1时刻的状态量,表示k时刻的状态量,t表示两次计算间隔的时间,u=f2/f1,wk表示k时刻的过程噪声,为一个4×1阶的矩阵向量;
***观测量观测量依次为第一载波环鉴相器和第二载波环鉴相器输出的载波相位误差;
***量测方程为:
其中,表示k+1时刻的观测量,u=f2/f1,vk+1表示k+1时刻的观测噪声,为一个4×1阶的矩阵向量。
本发明的有益效果如下:
本发明对传统双频接收机的载波跟踪环路进行改进,根据L1和L2双频信号之间的关联性设计卡尔曼滤波器,通过卡尔曼滤波器对两个鉴相器输出的载波相位误差进行平滑,能够同时减小两个载波环路滤波器的噪声带宽,从而减小环路的动态,提高跟踪灵敏度,将其应用于双频接收机中,能够有效改善双频接收机对双频信号的跟踪性能。
附图说明:
图1是基于卡尔曼滤波的GNSS双频载波跟踪环路结构示意图。
具体实施方式:
下面结合附图对本发明技术方案作进一步说明。
如图1所示,一种基于卡尔曼滤波的GNSS双频载波跟踪环路,包括4个积分清除器,第一载波环鉴相器,第二载波环鉴相器,卡尔曼滤波器,第一载波环路滤波器,第二载波环路滤波器,第一NCO载波发生器,第二NCO载波发生器。
输入的L1中频信号经码剥离后,与第一NCO(数控振荡器)载波发生器生成的一路载波信号与进行相关,得到同相支路数据I,与第一NCO载波发生器生成的另一路载波信号经过90°相移后进行相关,得到正交支路数据Q,再分别通过第一积分清除器和第二积分清除器进行积分累加得到L1支路同相支路累加数据IP1和L1支路正交支路累加数据QP1,将结果输入第一载波环鉴相器进行鉴相,得到载波相位误差。
同样,输入的L2中频信号经码剥离后,与第二NCO载波发生器生成的一路载波信号与进行相关,得到同相支路数据I,与第二NCO载波发生器生成的另一路载波信号经过90°相移后进行相关,得到正交支路数据Q,再分别通过第三积分清除器和第四积分清除器进行积分累加得到L2支路同相支路累加数据IP2和L2支路正交支路累加数据QP2,将结果输入第二载波环鉴相器进行鉴相,得到载波相位误差。
第一载波环鉴相器和第二载波环鉴相器均采用二相限反正切算法,具体公式如下:
其中,分别为第一载波环鉴相器和第二载波环鉴相器输出的载波相位误差。
将第一载波环鉴相器和第二载波环鉴相器的输出载波相位误差作为卡尔曼滤波器的观测值输入到卡尔曼滤波器。卡尔曼滤波器递推出载波相位误差的估计值分别输出至第一载波环路滤波器和第二载波环路滤波器,经第一载波环路滤波器和第二载波环路滤波器输出的控制信号分别控制第一NCO载波发生器和第二NCO载波发生器进行实时调整,从而形成两个闭环回路。
对于GNSS卫星导航***,同一颗卫星发射的L1信号和L2信号经历了相同的星地视距变化,故两信号载波频率和多普勒频移存在一定关系,具体关系为:
fd1/f1=fd2/f2
其中,f1和f2分别L1和L2信号的载波频率,fd1和fd2分别L1和L2信号的多普勒频移。故卡尔曼滤波器模型的构建建立在两信号载波频率和多普勒频移之间关系的基础之上。
所述卡尔曼滤波器模型的构建如下所示:
***状态量***状态方程为:其中,为第一载波环鉴相器输出的载波相位误差、为第二载波环鉴相器输出的载波相位误差、fd为多普勒频移、为多普勒频移变化率。
其中,表示k+1时刻的状态量,表示k时刻的状态量,t表示两次计算间隔的时间,u=f2/f1,wk表示k时刻的过程噪声,为一个4×1阶的矩阵向量。
***观测量观测量依次为第一载波环鉴相器和第二载波环鉴相器输出的载波相位误差。
***量测方程为:
其中,表示k+1时刻的观测量,u=f2/f1,vk+1表示k+1时刻的观测噪声,为一个4×1阶的矩阵向量。
卡尔曼滤波器工作步骤如下:
步骤一:参数初始化,初始化和P0,其中,为状态量初始值,P0为后验估计误差方差阵的初始值;
步骤二:根据上一时刻后验估计状态量对本时刻状态量进行先验估计得到根据上一时刻后验估计误差的方差阵Pk-1对本时刻误差的方差阵进行先验估计得到公式如下:
其中,为状态转移矩阵,为过程噪声方差阵,E[·]表示求解协方差矩阵,wk-1为k-1时刻的过程噪声;
步骤三:根据本时刻先验估计误差的方差阵Pk -计算卡尔曼增益阵Kk,公式如下:
其中,为量测矩阵,为量测噪声方差阵,E[·]表示求解协方差矩阵,vk为k时刻的观测噪声;
步骤四:根据根据卡尔曼增益阵Kk和本时刻观测值Zk,即第一载波环鉴相器和即第二载波环鉴相器的输出值,对本时刻先验估计状态量进行修正,得到本时刻状态量的后验估计同时根据卡尔曼增益阵Kk和本时刻先验估计误差的方差阵得到本时刻后验估计误差的方差阵Pk,具体公式如下:
其中,I表示4×4阶的单位矩阵;
步骤五:利用公式得到本时刻的卡尔曼滤波器的输出值,分别输至第一载波环路滤波器和第二载波环路滤波器;
步骤六:返回步骤二,依次进行递推。
除上述实施例外,本发明还可以有其他实施方式。凡本技术领域的普通技术人员在不脱离本发明原理的前提下,通过改进和润饰所形成的等同替换或等效变换,均落在本发明要求的保护范围。
Claims (5)
1.一种基于卡尔曼滤波的GNSS双频载波跟踪环路,其特征在于包括4个积分清除器,第一载波环鉴相器,第二载波环鉴相器,卡尔曼滤波器,第一载波环路滤波器,第二载波环路滤波器,第一NCO载波发生器和第二NCO载波发生器,其中:第一积分清除器和第二积分清除器分别与第一载波环鉴相器连接,第三积分清除器和第四积分清除器分别与第二载波环鉴相器连接,第一载波环鉴相器和第二载波环鉴相器分别与卡尔曼滤波器连接,第一NCO载波发生器、第一载波环鉴相器和卡尔曼滤波器顺序连接,第二NCO载波发生器、第二载波环鉴相器和卡尔曼滤波器顺序连接。
2.根据权利要求1所述的一种基于卡尔曼滤波的GNSS双频载波跟踪环路,其特征在于所述第一载波环鉴相器和第二载波环鉴相器均采用二相限反正切算法。
3.根据权利要求2所述的一种基于卡尔曼滤波的GNSS双频载波跟踪环路,其特征在于所述第一载波环鉴相器的算法如下:
其中,为第一载波环鉴相器的载波相位误差,IP1为L1支路同相支路累加数据,QP1为L1支路正交支路累加数据。
4.根据权利要求2所述的一种基于卡尔曼滤波的GNSS双频载波跟踪环路,其特征在于所述第二载波环鉴相器的算法如下:
其中,为第二载波环鉴相器输出的载波相位误差,IP2为L2支路同相支路累加数据,QP2为L2支路正交支路累加数据。
5.根据权利要求1所述的一种基于卡尔曼滤波的GNSS双频载波跟踪环路,其特征在于所述卡尔曼滤波器模型的构建如下所示:
***状态量其中,为第一载波环鉴相器输出的载波相位误差、为第二载波环鉴相器输出的载波相位误差、fd为多普勒频移、为多普勒频移变化率;
***状态方程为:
其中,表示k+1时刻的状态量,表示k时刻的状态量,t表示两次计算间隔的时间,u=f2/f1,wk表示k时刻的过程噪声,为一个4×1阶的矩阵向量;
***观测量观测量依次为第一载波环鉴相器和第二载波环鉴相器输出的载波相位误差;
***量测方程为:
其中,表示k+1时刻的观测量,u=f2/f1,vk+1表示k+1时刻的观测噪声,为一个4×1阶的矩阵向量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910212041.XA CN109814136A (zh) | 2019-03-20 | 2019-03-20 | 一种基于卡尔曼滤波的gnss双频载波跟踪环路 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910212041.XA CN109814136A (zh) | 2019-03-20 | 2019-03-20 | 一种基于卡尔曼滤波的gnss双频载波跟踪环路 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109814136A true CN109814136A (zh) | 2019-05-28 |
Family
ID=66609673
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910212041.XA Pending CN109814136A (zh) | 2019-03-20 | 2019-03-20 | 一种基于卡尔曼滤波的gnss双频载波跟踪环路 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109814136A (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101539619A (zh) * | 2009-03-19 | 2009-09-23 | 北京理工大学 | 一种用于高动态的双频gps载波辅助跟踪方法 |
US20120326926A1 (en) * | 2011-06-24 | 2012-12-27 | Mayflower Communications Company, Inc. | High sensitivity gps/gnss receiver |
CN103116169A (zh) * | 2013-01-20 | 2013-05-22 | 哈尔滨工程大学 | 一种基于矢量跟踪环路的抗干扰方法 |
CN103592662A (zh) * | 2013-11-29 | 2014-02-19 | 中国航天科工信息技术研究院 | 一种gps信号接收机的载波跟踪方法及环路 |
CN104407362A (zh) * | 2014-11-03 | 2015-03-11 | 中国人民解放军63961部队 | 一种四路信号处理的载波锁相环 |
CN106338748A (zh) * | 2016-08-30 | 2017-01-18 | 电子科技大学 | 基于卡尔曼滤波的gps接收机跟踪环路 |
-
2019
- 2019-03-20 CN CN201910212041.XA patent/CN109814136A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101539619A (zh) * | 2009-03-19 | 2009-09-23 | 北京理工大学 | 一种用于高动态的双频gps载波辅助跟踪方法 |
US20120326926A1 (en) * | 2011-06-24 | 2012-12-27 | Mayflower Communications Company, Inc. | High sensitivity gps/gnss receiver |
CN103116169A (zh) * | 2013-01-20 | 2013-05-22 | 哈尔滨工程大学 | 一种基于矢量跟踪环路的抗干扰方法 |
CN103592662A (zh) * | 2013-11-29 | 2014-02-19 | 中国航天科工信息技术研究院 | 一种gps信号接收机的载波跟踪方法及环路 |
CN104407362A (zh) * | 2014-11-03 | 2015-03-11 | 中国人民解放军63961部队 | 一种四路信号处理的载波锁相环 |
CN106338748A (zh) * | 2016-08-30 | 2017-01-18 | 电子科技大学 | 基于卡尔曼滤波的gps接收机跟踪环路 |
Non-Patent Citations (2)
Title |
---|
徐飞雄: "卫星导航接收机矢量跟踪环路设计与实现", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
杨玉龙: "矢量型GNSS信号跟踪算法研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102087362B (zh) | 信号跟踪的方法和装置 | |
US4646096A (en) | Enhanced global positioning system Delta-Range processing | |
CN110018506A (zh) | 基于和差组合卡尔曼滤波器的gnss双频联合跟踪算法 | |
WON et al. | Performance comparison of different forms of Kalman filter approaches for a vector‐based GNSS signal tracking loop | |
CN104316941B (zh) | 一种基于载波频率辅助相位矢量跟踪方法 | |
CN105911575B (zh) | 一种级联式惯性/卫星深组合导航滤波器观测量提取方法 | |
CN106291614B (zh) | 用于在多路径环境中跟踪卫星无线电导航信号的装置 | |
CN106980130B (zh) | 一种sins/gnss深组合自适应导航方法 | |
CN107515414B (zh) | 一种电离层闪烁下基于矢量跟踪的自适应卡尔曼滤波方法 | |
CN105607076A (zh) | 一种北斗二代b1和b3双频接收机 | |
Zhodzishsky et al. | Co-op tracking for carrier phase | |
CN106842263A (zh) | 基于导航信号空时处理与矢量跟踪相结合的卫星导航方法 | |
Tang et al. | Practical implementation and performance assessment of an Extended Kalman Filter-based signal tracking loop | |
Lian et al. | Improving tracking performance of PLL in high dynamics applications | |
CN106597492A (zh) | 卫星导航接收机及其抗远近效应的方法和室内定位方法 | |
JP6272786B2 (ja) | 低電力の非同期型gpsベースバンドプロセッサ | |
CN109471137A (zh) | 一种自适应矢量跟踪环路的实现方法 | |
Kiesel et al. | GNSS receiver with vector based FLL-assisted PLL carrier tracking loop | |
CN113900127A (zh) | 基于强跟踪平方根容积卡尔曼滤波的卫星信号跟踪环路 | |
CN108027442A (zh) | 具有定点西格玛罗滤波器的卫星导航接收机 | |
CN109814136A (zh) | 一种基于卡尔曼滤波的gnss双频载波跟踪环路 | |
CN201751861U (zh) | 一种惯性辅助卫星导航***的接收机 | |
CN115808700B (zh) | 一种应对电离层闪烁的载波跟踪方法 | |
CN110794440B (zh) | 一种高耦合gnss接收机跟踪环路*** | |
CN202583467U (zh) | 一种基于fpga的gps软件接收机信号跟踪*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190528 |