一种无人驾驶定位测姿的载波相位整周模糊度测定方法技术

本发明专利技术公开一种无人驾驶定位测姿的载波相位整周模糊度测定方法，包括以下步骤：构建宽巷模糊度的计算式、判断是否发生周跳、判断周跳值对计算值的影响、利用相位观测值平滑计算、根据TECR值得到历元周跳和计算原始载波相位观测值的周跳；本发明专利技术采用MW组合方法消除了大气电离层和对流层延迟误差、站星几何距离、卫星和接收机钟差，并具有较长的波长，非常适合于处理动态环境下的周跳问题，并采用未发生周跳的连续相位观测值计算电离层变化率，来探测周跳，消除站星几何距离的影响，并顾及电离层变化影响，适合于动态环境的周跳探测，从而方便整周模糊度的解算。

A method of carrier phase ambiguity measurement for attitude determination of unmanned driving

【技术实现步骤摘要】
一种无人驾驶定位测姿的载波相位整周模糊度测定方法
本专利技术涉及无人驾驶
，尤其涉及一种无人驾驶定位测姿的载波相位整周模糊度测定方法。
技术介绍
近年来，随着智能汽车领域的不断发展以及自动控制领域技术的不断成熟，汽车的自动控制技术研究越来越受到人们的关注，在实际行驶中，无人驾驶车辆应当具备在不同道路及气象条件下进行定位行驶的能力，在无人驾驶GNSS相对定位中，要使用载波相位观测值实现厘米级的高精度定位，需要解决好整周模糊度确定这个关键问题，整周模糊度确定的前提是模糊度有效时段中没有周跳，如果在该时段上存在未能探测到的周跳，则将导致模糊度解算错误，所以，载波相位观测值中周跳的探测是高精度定位数据处理的关键环节；载体处于运动状态时，整周模糊度确定及周跳探测的复杂性表现在以下几个方面：GNSS观测环境多变、信噪比低、多路径影响复杂、周跳的发生更加频繁；载体运动状态的复杂多变将导致相位观测值的变化规律不明显，致使基于站星几何变化规律的周跳探测方法将不再适用；随着动态条件下测站之间基线长度的增加，具有强空间相关性的电离层延迟将难以通过双差得到很好的消除；高动态条件下，观测值受到的电离层延迟误差变化快，使得周跳的探测更为困难，采用传统的周跳探测和修复方法容易出现周跳漏判和误判问题，因此，本专利技术提出一种无人驾驶定位测姿的载波相位整周模糊度测定方法以解决现有技术中存在的问题。
技术实现思路
针对上述问题，本专利技术的目的在于提出一种无人驾驶定位测姿的载波相位整周模糊度测定方法，该方法采用MW组合方法消除了大气电离层和对流层延迟误差、站星几何距离、卫星和接收机钟差，并具有较长的波长，非常适合于处理动态环境下的周跳问题，并采用未发生周跳的连续相位观测值计算电离层变化率，从而方便整周模糊度的解算。为实现本专利技术的目的，本专利技术通过以下技术方案实现：一种无人驾驶定位测姿的载波相位整周模糊度测定方法，包括以下步骤：步骤一：构建宽巷模糊度的计算式利用伪距和相位构建MW组合得到如下宽巷模糊度的计算式：式中：和分别为不同频率上的相位观测值(以周为单位)；ρL1和ρL2分别为不同频率上的伪距观测值(以m为单位)；LWL为宽巷组合(以m为单位)；λWL为宽巷波长；步骤二：判断是否发生周跳采用如下平滑算法计算宽巷模糊度及其方差：式中：为宽巷模糊度的平均值；k和k-1分别表示当前历元和前一历元；σ2为宽巷模糊度的方差，当周跳发生时，宽巷模糊度将发生跳变，据此可判断是否发生周跳，周跳判断式如下：当NWL(k)满足式(6.3)时，则认为历元k发生了周跳；步骤三：判断周跳值对计算值的影响将短时间内的电离层变化率(TECR)值认为是一个常数，历元k-1的电离层TEC通过下式进行计算：TEC(k-1)＝f12((λ1φ1(k-1)-λ2φ2(k-1))-(λ1N1-λ2N2)-bi-Bp)/(4.3×1016(γ-1))(6.4)式中：γ＝f12/f22，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去整，分别得到两个频率上的整周跳变值，进而对观测值进行测定。进一步改进在于：所述步骤二中，采用平滑算法计算宽巷模糊度及其方差的目的是：削弱噪声的影响。进一步改进在于：所述步骤四中，利用前面历元计算的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组合得到如下宽巷模糊度的计算式：式中：和分别为不同频率上的相位观测值(以周为单位)；ρL1和ρL2分别为不同频率上的伪距观测值(以m为单位)；LWL为宽巷组合(以m为单位)；λWL为宽巷波长；步骤二：判断是否发生周跳削弱噪声的影响，采用如下平滑算法计算宽巷模糊度及其方差：式中：为宽巷模糊度的平均值；k和k-1分别表示当前历元和前一历元；σ本文档来自技高网...

【技术保护点】
1.一种无人驾驶定位测姿的载波相位整周模糊度测定方法，其特征在于：包括以下步骤：/n步骤一：构建宽巷模糊度的计算式/n利用伪距和相位构建MW组合得到如下宽巷模糊度的计算式：/n

【技术特征摘要】
1.一种无人驾驶定位测姿的载波相位整周模糊度测定方法，其特征在于：包括以下步骤：
步骤一：构建宽巷模糊度的计算式
利用伪距和相位构建MW组合得到如下宽巷模糊度的计算式：



式中：和分别为不同频率上的相位观测值(以周为单位)；ρL1和ρL2分别为不同频率上的伪距观测值(以m为单位)；LWL为宽巷组合(以m为单位)；λWL为宽巷波长；
步骤二：判断是否发生周跳
采用如下平滑算法计算宽巷模糊度及其方差：



式中：为宽巷模糊度的平均值；k和k-1分别表示当前历元和前一历元；σ2为宽巷模糊度的方差，当周跳发生时，宽巷模糊度将发生跳变，据此可判断是否发生周跳，周跳判断式如下：



当NWL(k)满足式(6.3)时，则认为历元k发生了周跳；
步骤三：判断周跳值对计算值的影响
将短时间内的电离层变化率(TECR)值认为是一个常数，历元k-1的电离层TEC通过下式进行计算：
TEC(k-1)＝f12((λ1φ1(k-1)-λ2φ2(k-1))-(λ1N1-λ2N2)-bi-Bp)/(4.3×1016(γ-1))
(6.4)
式中：γ＝f12/f22，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)用前面历...

【专利技术属性】
技术研发人员：张雷，沈国琛，董德存，
申请(专利权)人：同济大学，
类型：发明
国别省市：上海;31