CN110531393B - 基于自适应卡尔曼滤波的弱信号跟踪方法 - Google Patents
基于自适应卡尔曼滤波的弱信号跟踪方法 Download PDFInfo
- Publication number
- CN110531393B CN110531393B CN201910685248.9A CN201910685248A CN110531393B CN 110531393 B CN110531393 B CN 110531393B CN 201910685248 A CN201910685248 A CN 201910685248A CN 110531393 B CN110531393 B CN 110531393B
- Authority
- CN
- China
- Prior art keywords
- carrier
- branch
- tracking
- updating
- phase error
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/24—Acquisition or tracking or demodulation of signals transmitted by the system
- G01S19/29—Acquisition or tracking or demodulation of signals transmitted by the system carrier including Doppler, related
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/24—Acquisition or tracking or demodulation of signals transmitted by the system
- G01S19/30—Acquisition or tracking or demodulation of signals transmitted by the system code related
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/43—Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
- G01S19/44—Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及卫星导航接收机中在微弱信号下的跟踪技术,提供了一种基于自适应卡尔曼滤波的弱信号跟踪方法。其包括以下步骤:S1、中频信号经过捕获阶段后进入到跟踪阶段;S2、将中频信号分别与正弦和余弦载波复制信号混频,分为I支路和Q支路;S3、混频后的信号与伪码相乘;S4、将解调后的信号均输入到积分清除器中,获取积分值;S5、将积分值输入到鉴相器中获取载波相位误差;S6、将载波相位误差作为测量值输入至基于自适应卡尔曼滤波器的跟踪环路中,获取载波相位误差,载波多普勒误差和载波多普勒变化率;S7、更新载波数控振荡器(NCO)中的多普勒频率和载波相位。本发明能够较佳地提高跟踪灵敏度。
Description
技术领域
本发明涉及卫星导航接收机中在微弱信号下的跟踪技术,提供了一种基于自适应卡尔曼滤波的弱信号跟踪方法。
背景技术
随着众多新的导航卫星系统的投入和运行,全球导航卫星系统(GlobalNavigation Satellite System,GNSS)接收机技术已经广泛应用于人们的日常生活中,例如车辆导航、个人手机导航、大地测量和海洋救援等。传统的GNSS接收机在开阔的环境下能够准确导航和定位,但是在室内、茂密森林和城市峡谷等复杂环境下,GNSS信号会严重衰减导致接收机无法正常定位。而接收机中的重要部分载波跟踪环路在微弱环境下非常脆弱,而且跟踪环路性能会严重影响接收机导航和定位的性能。因此,提高跟踪环路的灵敏度对于提高接收机的性能具有非常重要的作用。
传统的跟踪环路一般使用的是锁相环,为了提高灵敏度一般需要加长积分时间,但是这就需要减小环路滤波器的带宽。环路带宽的减小会严重影响跟踪环路的动态性能。因此,锁相环在提高跟踪环路的灵敏度上受到很大限制。为了进一步提高跟踪环的灵敏度,卡尔曼滤波器(KF)作为一种时变系统,已经被人们广泛应用于跟踪环路中。目前已经有很多文献指出KF跟踪相对于传统跟踪环可以提高跟踪灵敏度,这主要是因为KF跟踪根据输入的信号自适应的调节载波环路增益,从而提高跟踪环路的准确性。但是KF系统估计的准确性在很大程度上依赖于噪声的统计特性,比如测量噪声协方差和过程噪声协方差。但是这些噪声协方差一般都是根据实验的情况或者经验值预先设定好的,因此这就很难反映实际情况下的噪声统计特性,尤其是输入信号为时变的情况下,很难实时准确反应实际的噪声统计特性。
发明内容
本发明提供了一种基于自适应卡尔曼滤波的弱信号跟踪方法,其能够克服现有技术的某种或某些缺陷。
根据本发明的基于自适应卡尔曼滤波的弱信号跟踪方法,其包括以下步骤:
S1、对经过天线接收到的GPS卫星信号进行下变频及采样,将收到的高频信号转变为中频信号,该中频信号经过捕获阶段后进入到跟踪阶段,作为跟踪环路的输入信号;
S2、将输入到跟踪环路的中频信号分为两路,其中一路与正弦载波复制信号混频,该支路为同相支路,即为I支路;其中另一路与余弦载波复制信号混频,该支路为正交支路,即为Q支路;其中,通过载波数控振荡器(NCO)完成正弦载波和余弦载波的复制;
S3、I支路和Q支路混频后的信号均与伪码发生器产生的伪码相乘,解调出导航数据码;
S4、将经步骤S3处理后的I支路与Q支路的信号均输入到积分清除器中,进而获取I支路的积分值Ip(k)与Q支路的积分值Qp(k);
S5、将Ip(k)与Qp(k)输入到鉴相器中进行处理,进而获取载波相位误差;
S6、采用自适应卡尔曼滤波器对经步骤S5获取的载波相位误差进行处理,以载波相位误差作为测量值,进行卡尔曼滤波迭代计算,计算出载波相位误差载波多普勒误差ωk和载波多普勒变化率αk;在卡尔曼滤波迭代的过程,对过程噪声协方差Qk和测量噪声协方差Rk进行实时更新;
本发明中,通过采用自适应卡尔曼跟踪方法,能够实时调节测量噪声统计特性和系统噪声统计特性,故能够较佳地提高跟踪灵敏度。
作为优选,步骤S2中,载波数控振荡器(NCO)的复制过程包括如下步骤,
S21、由载波数控振荡器(NCO)输出一个阶梯形的周期信号;
S22、由正弦表和余弦表分别将阶梯信号转换为数字式正弦和余弦载波复制信号。从能够较佳地获取正弦和余弦载波复制信号。
作为优选,步骤S6中,将经步骤S5获取的载波相位误差输入到基于自适应卡尔曼的环路滤波器中作为测量值;其中,三阶自适应卡尔曼跟踪载波环的状态模型为xk+1=Φkxk+nk、测量模型为zk+1=Hkxk+vk;其中,k时刻的状态变量xk设置为其中,ωk和αk分别为载波相位误差,载波多普勒误差和载波多普勒变化率;状态转移矩阵Φk为zk+1是k+1时刻的测量矩阵,即为步骤S5中得到的载波相位误差;测量矩阵Hk为Hk=[1 T/2 T2/6],其中T为卡尔曼跟踪环的更新周期,nk和vk分别为过程噪声矩阵和测量噪声矩阵,nk和vk互不相关且均为白噪声阵列,nk和vk的协方差矩阵分别为Qk和Rk,分别称为过程噪声协方差和测量噪声协方差。从而能够较佳地对过程噪声协方差和测量噪声协方差进行实时更新。
作为优选,自适应卡尔曼跟踪的递推过程如下,
(11)更新完毕后,进入下一时刻,继续迭代更新。
通过上述(1)-(11)能够较佳地实现自适应卡尔曼跟踪的递推,从而使得整个系统具备较佳地灵敏度。另外,由于本发明中采用的是基于新息的自适应估计方法,故能够有效地降低系统的计算量。
附图说明
图1为实施例1中的基于自适应卡尔曼方法的跟踪环路的框图示意图;
图2为实施例1中的基于自适应卡尔曼方法的流程示意图。
具体实施方式
为进一步了解本发明的内容,结合附图和实施例对本发明作详细描述。应当理解的是,实施例仅仅是对本发明进行解释而并非限定。
实施例1
如图1-2所示,本实施例提供了一种基于自适应卡尔曼滤波的弱信号跟踪方法,其包括以下步骤:
S1、对经过天线接收到的GPS卫星信号进行下变频及采样,将收到的高频信号转变为中频信号,该中频信号经过捕获阶段后进入到跟踪阶段,作为跟踪环路的输入信号;
S2、将输入到跟踪环路的中频信号分为两路,其中一路与正弦载波复制信号混频,该支路为同相支路,即为I支路;其中另一路与余弦载波复制信号混频,该支路为正交支路,即为Q支路;其中,通过载波数控振荡器(NCO)完成正弦载波和余弦载波的复制;
S3、I支路和Q支路混频后的信号均与伪码发生器产生的伪码相乘,解调出导航数据码;
S4、将经步骤S3处理后的I支路与Q支路的信号均输入到积分清除器中,进而获取I支路的积分值Ip(k)与Q支路的积分值Qp(k);
步骤S4中,积分清除器相当于低通滤波器,通过保留低频信号,进而获取I支路的积分值Ip(k)与Q支路的积分值Qp(k)。
S5、将Ip(k)与Qp(k)输入到鉴相器中进行处理,进而获取载波相位误差;
S6、采用自适应卡尔曼滤波器对经步骤S5获取的载波相位误差进行处理,以载波相位误差作为测量值,进行卡尔曼滤波迭代计算,计算出载波相位误差载波多普勒误差ωk和载波多普勒变化率αk;在卡尔曼滤波迭代的过程,对过程噪声协方差Qk和测量噪声协方差Rk进行实时更新;
步骤S6中,由于卡尔曼滤波迭代的过程,过程噪声协方差Qk和测量噪声协方差Rk不再保持不变,而是进行实时更新,从而较佳地保证了自适应卡尔曼滤波器模型中噪声统计特性的准确性,这样可以使该跟踪环路更加的适应外部环境的变化;
步骤S7中,能够根据步骤S6中迭代运算所获取的载波相位误差载波多普勒误差ωk和载波多普勒变化率αk,对载波数控振荡器(NCO)中的多普勒频率和载波相位进行更新,从而较佳地实现对正弦和余弦载波复制信号的实时更新,进而能够较佳地提升对信号的跟踪灵敏度。
步骤S2中,载波数控振荡器(NCO)的复制过程包括如下步骤,
S21、由载波数控振荡器(NCO)输出一个阶梯形的周期信号;
S22、由正弦表和余弦表分别将阶梯信号转换为数字式正弦和余弦载波复制信号。
步骤S6中,将经步骤S5获取的载波相位误差输入到基于自适应卡尔曼的环路滤波器中作为测量值;其中,三阶自适应卡尔曼跟踪载波环的状态模型为xk+1=Φkxk+nk、测量模型为zk+1=Hkxk+vk;其中,k时刻的状态变量xk设置为其中,ωk和αk分别为载波相位误差,载波多普勒误差和载波多普勒变化率;状态转移矩阵Φk为zk+1是k+1时刻的测量矩阵,即为步骤S5中得到的载波相位误差;测量矩阵Hk为Hk=[1 T/2 T2/6],其中T为卡尔曼跟踪环的更新周期,nk和vk分别为过程噪声矩阵和测量噪声矩阵,nk和vk互不相关且均为白噪声阵列,nk和vk的协方差矩阵分别为Qk和Rk,分别称为过程噪声协方差和测量噪声协方差。
本实施例中,自适应卡尔曼滤波器采用线性离散卡尔曼模型。
本实施例中,nk和vk互不相关且均为白噪声阵列,其具有如下统计特性,
其中,E[·]为期望函数,Qk和Rk分别为nk和vk的协方差矩阵。
本实施例中,自适应卡尔曼跟踪的递推过程如下,
(11)更新完毕后,进入下一时刻,继续迭代更新。
本实施例中,卡尔曼滤波跟踪的递推算法包括预测过程和更新过程两部分,预测过程的递推公式为,
更新过程的递推公式为,
其中,新息序列的协方差理论上由下式计算出,
以上示意性的对本发明及其实施方式进行了描述,该描述没有限制性,附图中所示的也只是本发明的实施方式之一,实际的结构并不局限于此。所以,如果本领域的普通技术人员受其启示,在不脱离本发明创造宗旨的情况下,不经创造性的设计出与该技术方案相似的结构方式及实施例,均应属于本发明的保护范围。
Claims (4)
1.基于自适应卡尔曼滤波的弱信号跟踪方法,其包括以下步骤:
S1、对经过天线接收到的GPS卫星信号进行下变频及采样,将收到的高频信号转变为中频信号,该中频信号经过捕获阶段后进入到跟踪阶段,作为跟踪环路的输入信号;
S2、将输入到跟踪环路的中频信号分为两路,其中一路与正弦载波复制信号混频,该支路为同相支路,即为I支路;其中另一路与余弦载波复制信号混频,该支路为正交支路,即为Q支路;其中,通过载波数控振荡器(NCO)完成正弦载波和余弦载波的复制;
S3、I支路和Q支路混频后的信号均与伪码发生器产生的伪码相乘,解调出导航数据码;
S4、将经步骤S3处理后的I支路与Q支路的信号均输入到积分清除器中,进而获取I支路的积分值Ip(k)与Q支路的积分值Qp(k);
S5、将Ip(k)与Qp(k)输入到鉴相器中进行处理,进而获取载波相位误差;
S6、采用自适应卡尔曼滤波器对经步骤S5获取的载波相位误差进行处理,以载波相位误差作为测量值,进行卡尔曼滤波迭代计算,计算出载波相位误差载波多普勒误差ωk和载波多普勒变化率αk;在卡尔曼滤波迭代的过程,对过程噪声协方差Qk和测量噪声协方差Rk进行实时更新;
2.根据权利要求1所述的基于自适应卡尔曼滤波的弱信号跟踪方法,其特征在于:步骤S2中,载波数控振荡器(NCO)的复制过程包括如下步骤,
S21、由载波数控振荡器(NCO)输出一个阶梯形的周期信号;
S22、由正弦表和余弦表分别将阶梯信号转换为数字式正弦和余弦载波复制信号。
3.根据权利要求1所述的基于自适应卡尔曼滤波的弱信号跟踪方法,其特征在于:步骤S6中,将经步骤S5获取的载波相位误差输入到基于自适应卡尔曼的环路滤波器中作为测量值;其中,三阶自适应卡尔曼跟踪载波环的状态模型为xk+1=Φkxk+nk、测量模型为zk+1=Hkxk+vk;其中,k时刻的状态变量xk设置为其中,ωk和αk分别为载波相位误差,载波多普勒误差和载波多普勒变化率;状态转移矩阵Φk为zk+1是k+1时刻的测量矩阵,即为步骤S5中得到的载波相位误差;测量矩阵Hk为Hk=[1 T/2T2/6],其中T为卡尔曼跟踪环的更新周期,nk和vk分别为过程噪声矩阵和测量噪声矩阵,nk和vk互不相关且均为白噪声阵列,nk和vk的协方差矩阵分别为Qk和Rk,分别称为过程噪声协方差和测量噪声协方差。
4.根据权利要求3所述的基于自适应卡尔曼滤波的弱信号跟踪方法,其特征在于:自适应卡尔曼跟踪的递推过程如下,
(11)更新完毕后,进入下一时刻,继续迭代更新。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910685248.9A CN110531393B (zh) | 2019-07-27 | 2019-07-27 | 基于自适应卡尔曼滤波的弱信号跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910685248.9A CN110531393B (zh) | 2019-07-27 | 2019-07-27 | 基于自适应卡尔曼滤波的弱信号跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110531393A CN110531393A (zh) | 2019-12-03 |
CN110531393B true CN110531393B (zh) | 2022-12-13 |
Family
ID=68660951
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910685248.9A Active CN110531393B (zh) | 2019-07-27 | 2019-07-27 | 基于自适应卡尔曼滤波的弱信号跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110531393B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111444663B (zh) * | 2020-03-11 | 2023-05-12 | 西安电子科技大学 | 卡尔曼跟踪环路设计方法、卡尔曼跟踪环路、航天飞行器 |
CN112491431A (zh) * | 2020-11-20 | 2021-03-12 | 江苏亨通太赫兹技术有限公司 | 支持高动态的载波跟踪方法及系统 |
CN115242297B (zh) * | 2022-09-21 | 2022-11-25 | 腾讯科技(深圳)有限公司 | 移动终端的运动参数确定方法、装置、设备和存储介质 |
CN116319211B (zh) * | 2023-05-12 | 2023-08-11 | 长沙先度科技有限公司 | 一种用于qam信号的多阶卡尔曼载波跟踪方法、跟踪环路及信号接收机 |
CN117255401B (zh) * | 2023-10-16 | 2024-04-09 | 四川轻化工大学 | 一种基于fpga的多源相位自适应跟踪同步系统 |
CN117607921B (zh) * | 2024-01-18 | 2024-04-09 | 浙江赛思电子科技有限公司 | 一种基于融合滤波器的载波相位跟踪方法及装置 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107765270A (zh) * | 2016-08-17 | 2018-03-06 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种基于卡尔曼滤波的卫星导航接收机跟踪环 |
CN110018506A (zh) * | 2019-04-08 | 2019-07-16 | 南京航空航天大学 | 基于和差组合卡尔曼滤波器的gnss双频联合跟踪算法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106291645B (zh) * | 2016-07-19 | 2018-08-21 | 东南大学 | 适于高维gnss/ins深耦合的容积卡尔曼滤波方法 |
-
2019
- 2019-07-27 CN CN201910685248.9A patent/CN110531393B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107765270A (zh) * | 2016-08-17 | 2018-03-06 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种基于卡尔曼滤波的卫星导航接收机跟踪环 |
CN110018506A (zh) * | 2019-04-08 | 2019-07-16 | 南京航空航天大学 | 基于和差组合卡尔曼滤波器的gnss双频联合跟踪算法 |
Also Published As
Publication number | Publication date |
---|---|
CN110531393A (zh) | 2019-12-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110531393B (zh) | 基于自适应卡尔曼滤波的弱信号跟踪方法 | |
CN111149018B (zh) | 用于校准系统参数的方法和系统 | |
US20120326926A1 (en) | High sensitivity gps/gnss receiver | |
EP2064568A1 (en) | Highly integrated gps, galileo and inertial navigation system | |
US8063818B2 (en) | Cross-PRN phase correction for GPS processing | |
CN103592662A (zh) | 一种gps信号接收机的载波跟踪方法及环路 | |
CN113805208A (zh) | 一种适用于导航接收机的gnss-ir测高方法 | |
Del Peral-Rosado et al. | Kalman filter-based architecture for robust and high-sensitivity tracking in GNSS receivers | |
CN109946723B (zh) | 一种自适应扩展卡尔曼跟踪方法、装置及存储介质 | |
Fan et al. | A two-step stochastic hybrid estimation for GNSS carrier phase tracking in urban environments | |
CN108027442A (zh) | 具有定点西格玛罗滤波器的卫星导航接收机 | |
Vilà-Valls et al. | Multi-frequency GNSS robust carrier tracking for ionospheric scintillation mitigation | |
Jin et al. | Analysis of a federal Kalman filter-based tracking loop for GPS signals | |
CN113534210A (zh) | 一种基于混合卡尔曼滤波的模糊度固定方法 | |
CN109507696A (zh) | 一种基于自适应滤波的gnss伪距多路径消除方法 | |
CN117008159A (zh) | 一种天线抗干扰处理方法及装置 | |
Tang et al. | The explicit tuning investigation and validation of a full Kalman filter-based tracking loop in GNSS receivers | |
CN110940999A (zh) | 一种基于误差模型下的自适应无迹卡尔曼滤波方法 | |
JP4160969B2 (ja) | 衛星測位方法 | |
CN114355411B (zh) | 一种基于北斗或gps载噪比观测值的洪水探测方法 | |
CN116636151A (zh) | 用于卫星导航接收器的自适应窄频带和宽频带干扰抑制 | |
Liu et al. | A MCKF-based cascade vector tracking method designed for ship navigation | |
CN109633713B (zh) | 一种北斗导航弱信号接收的频率跟踪方法 | |
CN114609652B (zh) | 一种极端电离层异常下的多频开环接收机跟踪方法及系统 | |
Fan et al. | Monitoring and mitigation of GNSS multipath fading utilizing diversity reception |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |