[发明专利]一种无人驾驶定位测姿的载波相位整周模糊度测定方法有效
申请号: | 202010130802.X | 申请日: | 2020-02-28 |
公开(公告)号: | CN111239786B | 公开(公告)日: | 2021-04-13 |
发明(设计)人: | 张雷;沈国琛;董德存 | 申请(专利权)人: | 同济大学 |
主分类号: | G01S19/44 | 分类号: | G01S19/44;G01S19/55 |
代理公司: | 北京东方盛凡知识产权代理事务所(普通合伙) 11562 | 代理人: | 张雪 |
地址: | 200092 *** | 国省代码: | 上海;31 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 无人驾驶 定位 载波 相位 模糊 测定 方法 | ||
1.一种无人驾驶定位测姿的载波相位整周模糊度测定方法,其特征在于:包括以下步骤:
步骤一:构建宽巷模糊度的计算式
利用伪距和相位构建MW组合得到如下宽巷模糊度的计算式:
式中:和分别为不同频率上的相位观测值;ρL1和ρL2分别为不同频率上的伪距观测值;LWL为宽巷组合;λWL为宽巷波长;
所述相位观测值以周为单位,所述伪距观测值以m为单位,所述宽巷组合以m为单位;
步骤二:判断是否发生周跳
采用如下平滑算法计算宽巷模糊度及其方差:
式中:为宽巷模糊度的平均值;k和k-1分别表示当前历元和前一历元;σ2为宽巷模糊度的方差,当周跳发生时,宽巷模糊度将发生跳变,据此可判断是否发生周跳,周跳判断式如下:
当NWL(k)满足式(6.3)时,则认为历元k发生了周跳;
步骤三:判断周跳值对计算值的影响
将短时间内的电离层变化率TECR值认为是一个常数,历元k-1的电离层TEC通过下式进行计算:
式中:γ=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去整,分别得到两个频率上的整周跳变值,进而对观测值进行测定。
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。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于同济大学,未经同济大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010130802.X/1.html,转载请声明来源钻瓜专利网。
- 同类专利
- 专利分类
G01S 无线电定向;无线电导航;采用无线电波测距或测速;采用无线电波的反射或再辐射的定位或存在检测;采用其他波的类似装置
G01S19-00 卫星无线电信标定位系统;利用这种系统传输的信号确定位置、速度或姿态
G01S19-01 .传输时间戳信息的卫星无线电信标定位系统,例如,GPS [全球定位系统]、GLONASS[全球导航卫星系统]或GALILEO
G01S19-38 .利用卫星无线电信标定位系统传输的信号来确定导航方案
G01S19-39 ..传输带有时间戳信息的卫星无线电信标定位系统,例如GPS [全球定位系统], GLONASS [全球导航卫星系统]或GALILEO
G01S19-40 ...校正位置、速度或姿态
G01S19-42 ...确定位置