CN105068097A - 一种用于载波平滑码伪距的自适应滤波方法 - Google Patents
一种用于载波平滑码伪距的自适应滤波方法 Download PDFInfo
- Publication number
- CN105068097A CN105068097A CN201510551263.6A CN201510551263A CN105068097A CN 105068097 A CN105068097 A CN 105068097A CN 201510551263 A CN201510551263 A CN 201510551263A CN 105068097 A CN105068097 A CN 105068097A
- Authority
- CN
- China
- Prior art keywords
- error
- system noise
- pseudorange
- represent
- epoch
- 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
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/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/40—Correcting position, velocity or attitude
- G01S19/41—Differential correction, e.g. DGPS [differential GPS]
-
- 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
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)
- Navigation (AREA)
Abstract
本发明提供了一种用于载波平滑码伪距的自适应滤波方法,首先构建卡尔曼滤波基本方程,然后利用极大似然准则对系统噪声误差进行估计和自适应调整,最后进行载波平滑码伪距卡尔曼滤波,迭代后得到估计系统噪声误差。本发明在滤波前不需要统计分析载波平滑码伪距系统得到系统噪声,给出一个系统噪声经验值作为初值,后续过程对系统噪声误差进行自适应调整;可以避免周跳导致的伪距平滑结果误差过大,在存在周跳情况下滤波效果优于传统卡尔曼滤波。
Description
技术领域
本发明属于卫星导航领域,涉及在卫星导航地基增强系统中一种用于载波平滑码伪距的系统噪声误差自适应卡尔曼滤波方法。
背景技术
目前,卫星导航技术以其全天候、广覆盖和低成本等特点展示出强大的竞争力,被广泛的使用。卫星导航技术在定位精度等方面仍然需要不断改进,以GPS为例,GPS单点定位精度大致在10m这个数量级,难以满足飞机降落和船舶进出港口等应用对于定位精度的需求。
地基增强技术利用伪距差分修正原理提高伪距测量精度,从而提高定位精度,可以达到定位精度≤2m。伪距观测量和载波相位观测量是卫星导航接收机输出的重要观测量,伪距观测量测量误差较大,但是不会出现跳变;载波相位观测量测量误差较小,但是可能出现跳变。在地基增强系统地面基准站,采用载波相位观测量对伪距观测量进行平滑,融合载波相位和伪距观测量的优点得到测量精度更高的平滑后伪距,使得用户端差分定位结果实现更高精度。
目前通常采用的载波平滑码伪距滤波器为“α-β滤波器滤波器”,其表达式如下:
上式中:
:表示第k个历元,平滑后的伪距;
ρk:表示第k个历元,伪距测量值;
τ:表示平滑窗口宽度(或平滑时间);
:表示第k-1个历元,平滑后的伪距;
c:表示第k个历元的载波相位观测量;
φk-1:表示第k-1个历元的载波相位观测量;
常见的“α-β滤波器”在平滑滤波时,具有两点不足:
(1)“α-β滤波器”中关键参数为平滑窗口宽度,在滤波器设计时该参数唯一确定,所以该滤波器只能反映参与平滑的历元数量,但是无法反映参与平滑的原始观测量(伪距和载波相位观测量)的优劣。所以,“α-β滤波器”无法根据原始观测量实现自适应,导致同一参数的滤波器在不同原始观测量情况下得到优劣不同的平滑结果,当载波相位存在周跳变化时会导致伪距出现较大偏差。
(2)采用“α-β滤波器”进行平滑滤波,只能获取平滑滤波的结果,无法得到反映平滑效果的参数。所以,使用“α-β滤波器”无法对平滑滤波效果进行评估。
针对采用“α-β滤波器”进行载波平滑码伪距时存在的问题,考虑采用卡尔曼滤波器作为载波平滑码伪距工具。但是传统的卡尔曼滤波器系统噪声作为先验信息,如果得到的系统噪声无法真实反映系统特性则会导致滤波过程存在有偏估计或无法收敛。
发明内容
为了克服现有技术的不足,本发明提供一种用于载波平滑码伪距的系统噪声误差自适应卡尔曼滤波方法,解决了在载波平滑码伪距卡尔曼滤波过程中无法准确估计系统噪声误差的问题。
本发明解决其技术问题所采用的技术方案包括以下步骤:
(1)构建卡尔曼滤波基本方程
其中,表示第k个历元平滑后的伪距,ρk表示第k个历元的伪距测量值,τ表示平滑窗口宽度,表示第k-1个历元平滑后的伪距,φk表示第k个历元的载波相位观测量,φk-1表示第k-1个历元的载波相位观测量;
(2)利用极大似然准则对系统噪声误差进行估计和自适应调整,系统噪声误差估计
(3)载波平滑码伪距卡尔曼滤波,包括以下迭代过程:
a)状态一步预测
b)计算更新卡尔曼滤波增益Pk,k-1表示平滑后均方误差一步预测值,
R表示量测误差;
c)状态估计
d)一步预测均方误差其中,Pk-1表示平滑后均方误差估计,下标k-1表示第k-1历元,Qk-1表示系统噪声误差估计;
e)估计均方误差Pk=(1-Kk)Pk,k-1;
f)估计系统噪声误差
本发明的有益效果是:滤波前不需要统计分析载波平滑码伪距系统得到系统噪声,给出一个系统噪声经验值作为初值,后续过程对系统噪声误差进行自适应调整;可以避免周跳导致的伪距平滑结果误差过大,在存在周跳情况下滤波效果优于传统卡尔曼滤波。
附图说明
图1是系统噪声误差自适应估计算法流程框图;
图2是滤波算法更新和递推过程示意图;
图3是平滑的结果示意图;
图4是估计误差均方根示意图。
具体实施方式
下面结合附图和实施例对本发明进一步说明,本发明包括但不仅限于下述实施例。
本发明提供的方法包括以下步骤:
(1)构建卡尔曼滤波基本方程
将“α-β滤波器”载波平滑码伪距的表达式,如公式(1),进行等价变化,使之结构与卡尔曼滤波器中状态估计方程结构相类似,如公式(2)。
从而确定卡尔曼滤波器中状态估计值、状态估计预测值、滤波增益、量测值和量测矩阵的表达式,为后续卡尔曼滤波器设计提供基础。
(2)系统噪声误差的自适应估计
在此利用极大似然准则对系统噪声误差进行估计和自适应调整,系统噪声误差估计表达式如公式(3)
(3)载波平滑码伪距卡尔曼滤波递推公式
整个卡尔曼滤波过程包括以下几个步骤,并通过迭代过程实现。
a)状态一步预测
a)滤波增益计算更新
b)状态估计
公式(6)中:
Kk表示卡尔曼滤波增益。
公式(7)中:
Pk,k-1表示平滑后均方误差一步预测值;
R表示量测误差。
c)一步预测均方误差
公式(8)中:
Pk-1表示平滑后均方误差估计,下标k-1表示第k-1历元
Qk-1表示系统噪声误差估计
d)估计均方误差
Pk=(1-Kk)Pk,k-1(8)
e)估计系统噪声误差
下面通过对用于载波平滑码伪距的系统噪声误差自适应卡尔曼滤波方法中三个主要步骤中各个算法细节进行描述,对该算法具体实施方式进行说明。用于载波平滑码伪距的系统噪声误差自适应卡尔曼滤波方法中的原始量测量主要包括伪距和载波相位。该原始量来源于利用卫星导航基准接收机经过24小时对GPS系统西安地区可见卫星L1频点伪距和载波持续进行测量记录得到,算法实施过程中选择了GPS第8号卫星的伪距和载波相位并且截取了721历元的伪距和载波相位。为了更好的体现算法性能,对伪距和载波相位加入了热噪声,并且对载波相位随机的引入了周跳,在质量较差的量测量情况下体现载波平滑码伪距的性能。
(1)构建卡尔曼滤波基本方程
由公式(1)进行等价变化后得到:
卡尔曼滤波中状态估计方程为:
由公式(10)可以等效为卡尔曼滤波中状态估计方程,如下:
状态估计值:为为平滑伪距
状态估计预测值:为φk为载波相位量测量
滤波增益:Kk为τ为滤波器步长
量测值:Zk为ρk,ρk为伪距量测量
量测矩阵:Hk为1
(2)系统噪声误差的自适应估计
在卡尔曼滤波过程中系统噪声(Q)和量测噪声(R)是重要的先验信息,系统噪声和量测噪声误差的选取对滤波效果会有较大的影响,但是无法通过统计获取的这两个重要参数。在滤波过程中对两个参数同时进行估计和自适应调整会导致整个滤波过程稳定性较差,所以选择对变化更为复杂的且影响更大的系统噪声进行估计和自适应调整。
在此利用极大似然准则对系统噪声误差进行估计和自适应调整。具体步骤如下:
a)获取极大似然准则下的系统噪声误差的后验概率密度函数;
b)在a)的基础上得到极大似然准则下系统噪声误差的目标函数;
在a)和b)的基础上得到系统噪声误差估计的表达式,并可以利用该表达式对系统噪声误差进行自适应调整。
具体算法流程框图如图1所示。
a)极大似然准则下后验概率密度函数为:
公式(12)中:
Z为量测量
Q为系统噪声误差
k为历元编号
N为历元总数
|·|表示行列式
vk为新息,如下所示:
公式(13)中Zk为第k历元的量测量,为量测量一步预测值。
Cvk为新息方差,如下所示:
b)系统噪声误差的目标函数
c)系统噪声误差估计表达式
(3)载波平滑码伪距卡尔曼滤波递推公式
a)状态一步预测
b)状态估计
公式(18)中:
Kk表示卡尔曼滤波增益。
c)滤波增益计算更新
公式(19)中:
Pk,k-1表示平滑后均方误差一步预测值;
R表示量测误差。
d)一步预测均方误差
公式(20)中:
Pk-1表示平滑后均方误差估计,下标k-1表示第k-1历元
Qk-1表示系统噪声误差估计
e)估计均方误差
Pk=(1-Kk)Pk,k-1(21)
f)估计系统噪声误差
基于上述过程的卡尔曼滤波的计算和更新过程如图2所示。
通过上述具体实施方式,对一组原始伪距和载波相位观测量进行离线处理。该原始观测量来源于利用卫星导航基准接收机经过24小时对GPS系统西安地区可见卫星L1频点伪距和载波持续进行测量记录得到,算法实施过程中选择了GPS第8号卫星的伪距和载波相位并且截取了721个历元的伪距和载波相位。为了更好的体现算法性能,对伪距和载波相位加入了热噪声,并且对载波相位随机的引入了周跳,在质量较差的量测量情况下体现载波平滑码伪距的性能。利用载波平滑码伪距系统噪声误差自适应卡尔曼滤波方法进行平滑的结果如图3所示。
其中空心实线为载波测量距离,实心虚线为平滑前伪距,实心实线为平滑后伪距,由图3可以看出平滑后的伪距方差明显小于平滑前伪距方差,同时当载波测量距离出现周跳后对伪距平滑结果又一定影响,但是影响较小。平滑过程的估计误差均方根如图4所示。
由图4可以看出,由于载波周跳引起的伪距平滑结果误差增大,但是在经过15个历元后伪距平滑结果误差恢复为正常水平。综合图3和图4可以得到利用载波平滑码伪距系统噪声误差自适应卡尔曼滤波方法进行伪距平滑是一种有效的方法滤波误差均方根较小通常情况下不超过300m,并且可以克服周跳对于平滑过程的影响,当由于周跳导致滤波误差均方根过大时在较短时间内可以恢复到正常水平。
Claims (1)
1.一种用于载波平滑码伪距的自适应滤波方法,其特征在于包括下述步骤:
(1)构建卡尔曼滤波基本方程
其中,表示第k个历元平滑后的伪距,ρk表示第k个历元的伪距测量值,τ表示平滑窗口宽度,表示第k-1个历元平滑后的伪距,φk表示第k个历元的载波相位观测量,φk-1表示第k-1个历元的载波相位观测量;
(2)利用极大似然准则对系统噪声误差进行估计和自适应调整,系统噪声误差估计
(3)载波平滑码伪距卡尔曼滤波,包括以下迭代过程:
a)状态一步预测
b)计算更新卡尔曼滤波增益Pk,k-1表示平滑后均方误差一步预测值,
R表示量测误差;
c)状态估计
d)一步预测均方误差其中,Pk-1表示平滑后均方误差估计,下标k-1表示第k-1历元,Qk-1表示系统噪声误差估计;
e)估计均方误差Pk=(1-Kk)Pk,k-1;
f)估计系统噪声误差
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510551263.6A CN105068097A (zh) | 2015-09-01 | 2015-09-01 | 一种用于载波平滑码伪距的自适应滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510551263.6A CN105068097A (zh) | 2015-09-01 | 2015-09-01 | 一种用于载波平滑码伪距的自适应滤波方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105068097A true CN105068097A (zh) | 2015-11-18 |
Family
ID=54497512
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510551263.6A Pending CN105068097A (zh) | 2015-09-01 | 2015-09-01 | 一种用于载波平滑码伪距的自适应滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105068097A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106525081A (zh) * | 2015-12-22 | 2017-03-22 | 中国电子科技集团公司第二十研究所 | 用于卫星导航着陆系统的便携式检测标定装置及方法 |
CN106526634A (zh) * | 2016-10-19 | 2017-03-22 | 闽江学院 | 一种基于自调整卡尔曼滤波的多普勒辅助载波相位平滑伪距方法 |
CN107193026A (zh) * | 2017-05-06 | 2017-09-22 | 千寻位置网络有限公司 | 伪距定位平滑方法及系统、定位终端 |
CN111352140A (zh) * | 2020-03-13 | 2020-06-30 | 东南大学 | 一种评价gnss周跳修复结果可靠性的方法 |
CN111399018A (zh) * | 2020-03-02 | 2020-07-10 | 和芯星通科技(北京)有限公司 | Gnss中载波相位的平滑处理方法和装置 |
CN115980803A (zh) * | 2023-03-17 | 2023-04-18 | 北京航空航天大学 | 基于双频码伪距和载波相位观测量进行伪距平滑的方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2339377B1 (fr) * | 2009-12-18 | 2012-06-06 | Thales | Récepteur de positionnement par satellites |
CN102565813A (zh) * | 2010-12-31 | 2012-07-11 | 和芯星通科技(北京)有限公司 | 一种通过载波平滑进行伪距观测量估计的方法和装置 |
CN103995268A (zh) * | 2014-05-23 | 2014-08-20 | 北京理工大学 | 一种卫星导航接收机本地时修正方法及定位方法 |
CN104516006A (zh) * | 2014-11-07 | 2015-04-15 | 中国电子科技集团公司第二十研究所 | 一种基于改进型卡尔曼滤波的载波相位平滑伪距算法 |
-
2015
- 2015-09-01 CN CN201510551263.6A patent/CN105068097A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2339377B1 (fr) * | 2009-12-18 | 2012-06-06 | Thales | Récepteur de positionnement par satellites |
CN102565813A (zh) * | 2010-12-31 | 2012-07-11 | 和芯星通科技(北京)有限公司 | 一种通过载波平滑进行伪距观测量估计的方法和装置 |
CN103995268A (zh) * | 2014-05-23 | 2014-08-20 | 北京理工大学 | 一种卫星导航接收机本地时修正方法及定位方法 |
CN104516006A (zh) * | 2014-11-07 | 2015-04-15 | 中国电子科技集团公司第二十研究所 | 一种基于改进型卡尔曼滤波的载波相位平滑伪距算法 |
Non-Patent Citations (1)
Title |
---|
赵琳等: "自适应卡尔曼滤波在载波相位平滑伪距中的应用", 《哈尔滨工程大学学报》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106525081A (zh) * | 2015-12-22 | 2017-03-22 | 中国电子科技集团公司第二十研究所 | 用于卫星导航着陆系统的便携式检测标定装置及方法 |
CN106526634A (zh) * | 2016-10-19 | 2017-03-22 | 闽江学院 | 一种基于自调整卡尔曼滤波的多普勒辅助载波相位平滑伪距方法 |
CN106526634B (zh) * | 2016-10-19 | 2019-02-26 | 闽江学院 | 一种基于自调整卡尔曼滤波的多普勒辅助载波相位平滑伪距方法 |
CN107193026A (zh) * | 2017-05-06 | 2017-09-22 | 千寻位置网络有限公司 | 伪距定位平滑方法及系统、定位终端 |
CN111399018A (zh) * | 2020-03-02 | 2020-07-10 | 和芯星通科技(北京)有限公司 | Gnss中载波相位的平滑处理方法和装置 |
CN111399018B (zh) * | 2020-03-02 | 2022-04-01 | 和芯星通科技(北京)有限公司 | Gnss中载波相位的平滑处理方法和装置 |
CN111352140A (zh) * | 2020-03-13 | 2020-06-30 | 东南大学 | 一种评价gnss周跳修复结果可靠性的方法 |
CN111352140B (zh) * | 2020-03-13 | 2022-03-11 | 东南大学 | 一种评价gnss周跳修复结果可靠性的方法 |
CN115980803A (zh) * | 2023-03-17 | 2023-04-18 | 北京航空航天大学 | 基于双频码伪距和载波相位观测量进行伪距平滑的方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105068097A (zh) | 一种用于载波平滑码伪距的自适应滤波方法 | |
CN105629263B (zh) | 一种对流层大气延迟误差估计改正方法和改正系统 | |
CN105676250B (zh) | 一种基于gnss的单历元三频模糊度解算方法 | |
CN110109162B (zh) | 一种gnss接收机自适应的卡尔曼滤波定位解算方法 | |
CN108828640B (zh) | 一种卫星导航定位观测值定权方法及装置 | |
CN107193029A (zh) | 北斗三频信号的网络rtk基准站间模糊度快速确定方法 | |
CN104614741B (zh) | 一种不受glonass码频间偏差影响的实时精密卫星钟差估计方法 | |
CN105301617B (zh) | 一种卫星导航系统中的整周模糊度有效性检验方法 | |
CN109001781B (zh) | 一种顾及电离层约束的bds三频模糊度解算方法 | |
CN105842720B (zh) | 一种基于载波相位的广域精密实时定位方法 | |
CN102608631B (zh) | 基于模糊逻辑的自适应强跟踪ukf定位滤波算法 | |
CN110780323B (zh) | 一种长距离下基于北斗三频信号的实时分米级定位方法 | |
CN110208836B (zh) | 基于卡尔曼滤波的gnss高适应性周跳探测与修复方法 | |
CN105891860A (zh) | 一种基于误差分离模式的gnss区域伪距差分增强定位方法 | |
CN110059361B (zh) | 一种基于抗差卡尔曼滤波算法的实时区域对流层建模方法 | |
CN104503223B (zh) | Gnss 三频高精度卫星钟差估计与服务方法 | |
CN111352137B (zh) | 一种顾及广播星历误差的多模gnss异步rtk定位方法 | |
CN107861131A (zh) | 一种斜路径电离层延迟的获取方法及系统 | |
CN111077550A (zh) | 一种应用于智能终端rtd定位的粗差探测方法及系统 | |
CN107544081A (zh) | 顾及电离层约束的rtk定位方法 | |
CN110286396A (zh) | 一种基于电离层延迟先验信息和时空变化信息双约束的非差非组合ppp方法 | |
CN109212563A (zh) | 北斗/gps三频周跳探测与修复方法 | |
NGOC et al. | Evaluating process and measurement noise in extended Kalman filter for GNSS position accuracy | |
CN104199054A (zh) | 一种用于北斗卫星导航系统共视数据的预处理方法 | |
CN112880633A (zh) | 基于伯格算法的海面高度测量方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20151118 |