CN111239786B - 一种无人驾驶定位测姿的载波相位整周模糊度测定方法 - Google Patents
一种无人驾驶定位测姿的载波相位整周模糊度测定方法 Download PDFInfo
- Publication number
- CN111239786B CN111239786B CN202010130802.XA CN202010130802A CN111239786B CN 111239786 B CN111239786 B CN 111239786B CN 202010130802 A CN202010130802 A CN 202010130802A CN 111239786 B CN111239786 B CN 111239786B
- Authority
- CN
- China
- Prior art keywords
- tecr
- value
- cycle slip
- epoch
- formula
- 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/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/53—Determining attitude
- G01S19/54—Determining attitude using carrier phase measurements; using long or short baseline interferometry
- G01S19/55—Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
-
- 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
本发明公开一种无人驾驶定位测姿的载波相位整周模糊度测定方法,包括以下步骤:构建宽巷模糊度的计算式、判断是否发生周跳、判断周跳值对计算值的影响、利用相位观测值平滑计算、根据TECR值得到历元周跳和计算原始载波相位观测值的周跳;本发明采用MW组合方法消除了大气电离层和对流层延迟误差、站星几何距离、卫星和接收机钟差,并具有较长的波长,非常适合于处理动态环境下的周跳问题,并采用未发生周跳的连续相位观测值计算电离层变化率,来探测周跳,消除站星几何距离的影响,并顾及电离层变化影响,适合于动态环境的周跳探测,从而方便整周模糊度的解算。
Description
技术领域
本发明涉及无人驾驶技术领域,尤其涉及一种无人驾驶定位测姿的载波相位整周模糊度测定方法。
背景技术
近年来,随着智能汽车领域的不断发展以及自动控制领域技术的不断成熟,汽车的自动控制技术研究越来越受到人们的关注,在实际行驶中,无人驾驶车辆应当具备在不同道路及气象条件下进行定位行驶的能力,在无人驾驶GNSS相对定位中,要使用载波相位观测值实现厘米级的高精度定位,需要解决好整周模糊度确定这个关键问题,整周模糊度确定的前提是模糊度有效时段中没有周跳,如果在该时段上存在未能探测到的周跳,则将导致模糊度解算错误,所以,载波相位观测值中周跳的探测是高精度定位数据处理的关键环节;
载体处于运动状态时,整周模糊度确定及周跳探测的复杂性表现在以下几个方面:GNSS观测环境多变、信噪比低、多路径影响复杂、周跳的发生更加频繁;载体运动状态的复杂多变将导致相位观测值的变化规律不明显,致使基于站星几何变化规律的周跳探测方法将不再适用;随着动态条件下测站之间基线长度的增加,具有强空间相关性的电离层延迟将难以通过双差得到很好的消除;高动态条件下,观测值受到的电离层延迟误差变化快,使得周跳的探测更为困难,采用传统的周跳探测和修复方法容易出现周跳漏判和误判问题,因此,本发明提出一种无人驾驶定位测姿的载波相位整周模糊度测定方法以解决现有技术中存在的问题。
发明内容
针对上述问题,本发明的目的在于提出一种无人驾驶定位测姿的载波相位整周模糊度测定方法,该方法采用MW组合方法消除了大气电离层和对流层延迟误差、站星几何距离、卫星和接收机钟差,并具有较长的波长,非常适合于处理动态环境下的周跳问题,并采用未发生周跳的连续相位观测值计算电离层变化率,从而方便整周模糊度的解算。
为实现本发明的目的,本发明通过以下技术方案实现:一种无人驾驶定位测姿的载波相位整周模糊度测定方法,包括以下步骤:
步骤一:构建宽巷模糊度的计算式
利用伪距和相位构建MW组合得到如下宽巷模糊度的计算式:
步骤二:判断是否发生周跳
采用如下平滑算法计算宽巷模糊度及其方差:
当NWL(k)满足式(6.3)时,则认为历元k发生了周跳;
步骤三:判断周跳值对计算值的影响
将短时间内的电离层变化率(TECR)值认为是一个常数,历元k-1的电离层TEC通过下式进行计算:
TECR(k)=(TEC(k)-TEC(k-1))/Δt (6.5)
式(6.5)中模糊度参数和频率间偏差参数被消去,当历元k发生周跳时,该计算值将受到周跳值的影响;
步骤四:利用相位观测值平滑计算
假定历元k前相位观测值并未发生周跳,利用式(6.5)计算历元k之前所有历元的TECR,利用前面历元计算的TECR信息预测当前历元的TECR,假定计算了k-2和k-1历元的TECR,则历元k的TECR预测值TECR(k)通过以下两式计算:
实际计算时,TECR(k-1)、TECR(k-2)用前面历元的相位观测值逐步进行平滑计算,进而得到精度更高的TECR(k-1)和TECR(k-2);
步骤五:根据TECR值得到历元周跳
将TECR计算值和TECR预测值差值的阈值取为0.15TECU/s,根据计算的TECR(k)值得到历元k的周跳,计算式为:
步骤六:计算原始载波相位观测值的周跳
假定由MW组合探测得到的宽巷组合的周跳值为a,利用TECR探测得到的周跳值λ1ΔN1(k)-λ2ΔN2(k)为b,则原始观测值的周跳计算公式为:
式中:a为整数,b为实数,式(6.9)求得的实数值ΔN1,ΔN2去整,分别得到两个频率上的整周跳变值,进而对观测值进行测定。
进一步改进在于:所述步骤二中,采用平滑算法计算宽巷模糊度及其方差的目的是:削弱噪声的影响。
进一步改进在于:所述步骤四中,利用前面历元计算的TECR信息预测当前历元的TECR的依据是:在短时间内电离层TECR的变化是平缓的。
进一步改进在于:所述步骤四中,TECR(k-1)、TECR(k-2)用前面历元的相位观测值逐步进行平滑计算是为了减小其测量噪声。
进一步改进在于:所述步骤五中,根据短时间内TECR的变化较为平缓、理论上不发生周跳的情况,当前历元的TECR计算值和TECR预测值之间的差异值很小,因此,当二者差异值超过一定的阈值时,则认为该历元发生了周跳,通常,电离层平静期时,电离层TEC变化率约为0.01TECU/s;电离层活跃期时则达到0.03TECU/s以上,顾及测站的动态特性与数据采样间隔,将TECR计算值和TECR预测值差值的阈值取为0.15TECU/s。
本发明的有益效果为:本发明采用MW组合方法消除了大气电离层和对流层延迟误差、站星几何距离、卫星和接收机钟差,并具有较长的波长,非常适合于处理动态环境下的周跳问题,并采用未发生周跳的连续相位观测值计算电离层变化率(TECR),由于TECR在短时间内是平缓变化的,周跳的发生将使计算的电离层TECR的平缓性受到破坏,因此可以根据这一特点来探测周跳,且利用此方法同样可消除站星几何距离的影响,并可顾及电离层变化影响,适合于动态环境的周跳探测,从而方便整周模糊度的解算。
附图说明
图1为本发明的TECR和MW宽巷组合观测值周跳探测流程图。
具体实施方式
为了加深对本发明的理解,下面将结合实施例对本发明做进一步详述,本实施例仅用于解释本发明,并不构成对本发明保护范围的限定。
根据图1所示,本实施例提供了一种无人驾驶定位测姿的载波相位整周模糊度测定方法,包括以下步骤:
步骤一:构建宽巷模糊度的计算式
利用伪距和相位构建MW组合得到如下宽巷模糊度的计算式:
步骤二:判断是否发生周跳
削弱噪声的影响,采用如下平滑算法计算宽巷模糊度及其方差:
当NWL(k)满足式(6.3)时,则认为历元k发生了周跳;
步骤三:判断周跳值对计算值的影响
将短时间内的电离层变化率(TECR)值认为是一个常数,历元k-1的电离层TEC通过下式进行计算:
TECR(k)=(TEC(k)-TEC(k-1))/Δt (6.5)
式(6.5)中模糊度参数和频率间偏差参数被消去,当历元k发生周跳时,该计算值将受到周跳值的影响;
步骤四:利用相位观测值平滑计算
假定历元k前相位观测值并未发生周跳,利用式(6.5)计算历元k之前所有历元的TECR,由于在短时间内电离层TECR的变化是平缓的,因此利用前面历元计算的TECR信息预测当前历元的TECR,假定计算了k-2和k-1历元的TECR,则历元k的TECR预测值TECR(k)通过以下两式计算:
实际计算时,TECR(k-1)、TECR(k-2)用前面历元的相位观测值逐步进行平滑计算,以减小其测量噪声,进而得到精度更高的TECR(k-1)和TECR(k-2);
步骤五:根据TECR值得到历元周跳
根据短时间内TECR的变化较为平缓、理论上不发生周跳的情况,当前历元的TECR计算值和TECR预测值之间的差异值很小,因此,当二者差异值超过一定的阈值时,则认为该历元发生了周跳,通常,电离层平静期时,电离层TEC变化率约为0.01TECU/s;电离层活跃期时则达到0.03TECU/s以上,顾及测站的动态特性与数据采样间隔,TECR计算值和TECR预测值差值的阈值取为0.15TECU/s,根据计算的TECR(k)值得到历元k的周跳,计算式为
步骤六:计算原始载波相位观测值的周跳
假定由MW组合探测得到的宽巷组合的周跳值为a,利用TECR探测得到的周跳值λ1ΔN1(k)-λ2ΔN2(k)为b,则原始观测值的周跳计算公式为:
式中:a为整数,b为实数,式(6.9)求得的实数值ΔN1,ΔN2去整,分别得到两个频率上的整周跳变值,进而对观测值进行测定。
该无人驾驶定位测姿的载波相位整周模糊度测定方法采用MW组合方法消除了大气电离层和对流层延迟误差、站星几何距离、卫星和接收机钟差,并具有较长的波长,非常适合于处理动态环境下的周跳问题,并采用未发生周跳的连续相位观测值计算电离层变化率(TECR),由于TECR在短时间内是平缓变化的,周跳的发生将使计算的电离层TECR的平缓性受到破坏,因此可以根据这一特点来探测周跳,且利用此方法同样可消除站星几何距离的影响,并可顾及电离层变化影响,适合于动态环境的周跳探测,从而方便整周模糊度的解算。
以上显示和描述了本发明的基本原理、主要特征和优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。
Claims (5)
1.一种无人驾驶定位测姿的载波相位整周模糊度测定方法,其特征在于:包括以下步骤:
步骤一:构建宽巷模糊度的计算式
利用伪距和相位构建MW组合得到如下宽巷模糊度的计算式:
所述相位观测值以周为单位,所述伪距观测值以m为单位,所述宽巷组合以m为单位;
步骤二:判断是否发生周跳
采用如下平滑算法计算宽巷模糊度及其方差:
当NWL(k)满足式(6.3)时,则认为历元k发生了周跳;
步骤三:判断周跳值对计算值的影响
将短时间内的电离层变化率TECR值认为是一个常数,历元k-1的电离层TEC通过下式进行计算:
式中:γ=f1 2/f2 2,f1和f2为对应的载波频率;bi和Bp分别为接收机端和卫星端的信号频率间偏差,在一段时间内认为是常量,历元k的TECR计算值为:
TECR(k)=(TEC(k)-TEC(k-1))/Δt (6.5)
式(6.5)中模糊度参数和频率间偏差参数被消去,当历元k发生周跳时,该计算值将受到周跳值的影响;
步骤四:利用相位观测值平滑计算
假定历元k前相位观测值并未发生周跳,利用式(6.5)计算历元k之前所有历元的TECR,利用前面历元计算的TECR信息预测当前历元的TECR,假定计算了k-2和k-1历元的TECR,则历元k的TECR预测值TECR(k)通过以下两式计算:
实际计算时,TECR(k-1)、TECR(k-2)用前面历元的相位观测值逐步进行平滑计算,进而得到精度更高的TECR(k-1)和TECR(k-2);
步骤五:根据TECR值得到历元周跳
将TECR计算值和TECR预测值差值的阈值取为0.15TECU/s,根据计算的TECR(k)值得到历元k的周跳,计算式为:
步骤六:计算原始载波相位观测值的周跳
假定由MW组合探测得到的宽巷组合的周跳值为a,利用TECR探测得到的周跳值λ1ΔN1(k)-λ2ΔN2(k)为b,则原始观测值的周跳计算公式为:
式中:a为整数,b为实数,式(6.9)求得的实数值ΔN1,ΔN2去整,分别得到两个频率上的整周跳变值,进而对观测值进行测定。
2.根据权利要求1所述的一种无人驾驶定位测姿的载波相位整周模糊度测定方法,其特征在于:所述步骤二中,采用平滑算法计算宽巷模糊度及其方差的目的是:削弱噪声的影响。
3.根据权利要求1所述的一种无人驾驶定位测姿的载波相位整周模糊度测定方法,其特征在于:所述步骤四中,利用前面历元计算的TECR信息预测当前历元的TECR的依据是:在短时间内电离层TECR的变化是平缓的。
4.根据权利要求1所述的一种无人驾驶定位测姿的载波相位整周模糊度测定方法,其特征在于:所述步骤四中,TECR(k-1)、TECR(k-2)用前面历元的相位观测值逐步进行平滑计算是为了减小其测量噪声。
5.根据权利要求1所述的一种无人驾驶定位测姿的载波相位整周模糊度测定方法,其特征在于:所述步骤五中,根据短时间内TECR的变化较为平缓、理论上不发生周跳的情况,当前历元的TECR计算值和TECR预测值之间的差异值很小,因此,当二者差异值超过一定的阈值时,则认为该历元发生了周跳,通常,电离层平静期时,电离层TEC变化率约为0.01TECU/s;电离层活跃期时则达到0.03TECU/s以上,顾及测站的动态特性与数据采样间隔,将TECR计算值和TECR预测值差值的阈值取为0.15TECU/s。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010130802.XA CN111239786B (zh) | 2020-02-28 | 2020-02-28 | 一种无人驾驶定位测姿的载波相位整周模糊度测定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010130802.XA CN111239786B (zh) | 2020-02-28 | 2020-02-28 | 一种无人驾驶定位测姿的载波相位整周模糊度测定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111239786A CN111239786A (zh) | 2020-06-05 |
CN111239786B true CN111239786B (zh) | 2021-04-13 |
Family
ID=70864529
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010130802.XA Active CN111239786B (zh) | 2020-02-28 | 2020-02-28 | 一种无人驾驶定位测姿的载波相位整周模糊度测定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111239786B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114527492B (zh) * | 2022-02-18 | 2022-09-16 | 中国科学院上海天文台 | 一种电离层异常环境下的周跳实时探测方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6166683A (en) * | 1998-02-19 | 2000-12-26 | Rockwell International Corporation | System and method for high-integrity detection and correction of cycle slip in a carrier phase-related system |
CN107153208A (zh) * | 2017-06-20 | 2017-09-12 | 北京工业大学 | 一种gps载波相位周跳探测与修复的方法 |
CN108572377A (zh) * | 2018-04-13 | 2018-09-25 | 桂林电子科技大学 | 基于多普勒辅助的mw组合法探测与修复周跳改进的方法 |
CN109581452A (zh) * | 2018-12-18 | 2019-04-05 | 辽宁工程技术大学 | 一种gnss参考站载波相位整周模糊度解算方法 |
CN110095796A (zh) * | 2019-05-10 | 2019-08-06 | 哈尔滨工程大学 | 一种跨系统mw紧组合实时动态精密导航定位方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6832155B2 (en) * | 2002-09-23 | 2004-12-14 | Itt Manufacturing Enterprises, Inc. | Methods and apparatus for determining phase ambiguities in ranging and navigation systems |
-
2020
- 2020-02-28 CN CN202010130802.XA patent/CN111239786B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6166683A (en) * | 1998-02-19 | 2000-12-26 | Rockwell International Corporation | System and method for high-integrity detection and correction of cycle slip in a carrier phase-related system |
CN107153208A (zh) * | 2017-06-20 | 2017-09-12 | 北京工业大学 | 一种gps载波相位周跳探测与修复的方法 |
CN108572377A (zh) * | 2018-04-13 | 2018-09-25 | 桂林电子科技大学 | 基于多普勒辅助的mw组合法探测与修复周跳改进的方法 |
CN109581452A (zh) * | 2018-12-18 | 2019-04-05 | 辽宁工程技术大学 | 一种gnss参考站载波相位整周模糊度解算方法 |
CN110095796A (zh) * | 2019-05-10 | 2019-08-06 | 哈尔滨工程大学 | 一种跨系统mw紧组合实时动态精密导航定位方法 |
Non-Patent Citations (1)
Title |
---|
"整周模糊度的在航解算——GNSS动态载波相位测量的数据处理方法之五";刘基余等;《数字通信世界》;20180831(第5期);第1-4、9页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111239786A (zh) | 2020-06-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110823217B (zh) | 一种基于自适应联邦强跟踪滤波的组合导航容错方法 | |
EP3430429B1 (en) | Satellite navigation receiver with improved ambiguity resolution | |
CN109219732B (zh) | 具有改进的模糊度解算的卫星导航接收器 | |
CN111427068B (zh) | 一种动对动平台局域增强卫星a类星历故障完好性监测方法 | |
JP2010528320A (ja) | リアルタイムキネマティック(rtk)測位における距離依存性誤差の軽減 | |
AU2005226022A1 (en) | Method for back-up dual-frequency navigation during brief periods when measurement data is unavailable on one of two frequencies | |
CN111323793B (zh) | 一种gnss伪距单点定位状态域完好性监测方法 | |
US11300689B2 (en) | System and method for reconverging GNSS position estimates | |
KR20130024181A (ko) | Gps 수신기 및 항법해 산출 방법 | |
CN111239786B (zh) | 一种无人驾驶定位测姿的载波相位整周模糊度测定方法 | |
CN116009042A (zh) | 一种单站载波历元间差分实时探测相对形变的方法及系统 | |
US6704650B1 (en) | Technique for accurate distance and velocity calculations using the global positioning system (GPS) | |
CN115267848A (zh) | 一种双频周跳探测及修复方法、系统、设备及介质 | |
CN115902963A (zh) | 一种单点定位数据处理方法、装置、电子设备及存储介质 | |
CN111830535A (zh) | 一种基于软件接收机的观测噪声完好性监测方法 | |
CN115373007A (zh) | 基于手机gnss模糊度相对变化估计的里程计定位方法 | |
CN111239785B (zh) | 一种无人驾驶定位测姿的载波相位周跳探测及修复方法 | |
CN116150565A (zh) | 一种用于单频gnss/mems-imu/里程计低功耗实时组合导航的改进自适应抗差卡尔曼滤波算法及系统 | |
CN114355410B (zh) | 基于并行计算的卫星导航实时精密单点定位系统及方法 | |
CN113821766B (zh) | 一种海洋声学导航系统误差改正方法 | |
CN113671551B (zh) | Rtk定位解算方法 | |
Wang et al. | Research on Android-odometry based on the estimation of GNSS temporal ambiguity variation with Xiaomi MI8 | |
CN111538041A (zh) | 一种基于动对动平台电离层梯度完好性监测方法 | |
Li et al. | An ambiguity-free smoothing algorithm for multipath mitigation in INS/RTK tightly-coupled integration | |
US20230413224A1 (en) | Method and system for locating a mobile node by radio measurements using a visibility map |
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 |