本科生学习GNSS算法 中级教程(二)- rtklib多系统多频单点定位算法 - tgd修正以及代码实现

本文主要是介绍本科生学习GNSS算法 中级教程(二)- rtklib多系统多频单点定位算法 - tgd修正以及代码实现,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

如何修正码偏差

上一节介绍了码偏差产生的原理,以及我们为何要修正它。

给了一篇参考论文,论文中有一节专门介绍如何对多系统多频点的码片差进行修正。下面给出论文中的截图:

从上图中的公式我们可以知道,gps的P1和P2的修正量都是Tgd乘以一个系数。而GLO和GAL系统和GPS类似一样的修正逻辑。

BDS系统由于是以B3作为卫星钟差的参考基准,所以其修正公式如下:


代码实现

rtklib中单点定位程序调用修正码偏差的函数为pntpos.c->prange(),为和原始区分,我们支持多频修正的函数取名为prange_mulfreq(),并多传入一个频率的index,用来指示计算哪个频率的修正后的伪距。

GPS系统的修正逻辑如下,注意查看我增加的注释:

if (sys == SYS_GPS || sys == SYS_QZS){gamma = SQR(FREQ1 / FREQ2);b1 = gettgd(sat, nav, 0); /* TGD (m) */switch (obs->code[k]){/*for L1C, we need to calibrate the DCB between P1 and C1. but here we ignore it*/case CODE_L1C:case CODE_L1P:tgd = b1;break;/*for L2P, calibrate tgd according the paper*/case CODE_L2P:case CODE_L2W:tgd = b1 * gamma;break;/*no L5 tgd info in broadcast nav, give the default value 0*/case CODE_L5Q:tgd = 0.0;break;}}

BDS系统修正方法与其他有区别,将BDS系统的修正逻辑粘贴如下:

else if (sys == SYS_CMP){   switch (obs->code[k]){case CODE_L2I:tgd = gettgd(sat, nav, 0);break;case CODE_L7I:tgd = gettgd(sat, nav, 1);break;/*for BDS sys, the reference frequency is 6I. that's why the correction in 6I is zeror*/case CODE_L6I:tgd = 0.0;break;case CODE_L1P:tgd = gettgd(sat, nav, 2);break;case CODE_L5P:tgd = gettgd(sat, nav, 3);break;}}

BDS2支持的信号为2I/7I/6I,一共三频,一般认为按顺序叫作北斗的第一、二、三频点。而BDS3则支持更多的频点,其播发了2I/6I,并且为了与GPS/GAL兼容互操作,播发了新的1C以及5P。所有的诸如2I/1P/5P的频点叫法,都来自于rinex的中的频率定义,详情请参考该文档。

最后贴上整个prange_mulfreq()函数。GLO修正逻辑部分未做完全考虑,可能存在错误。个人不太喜欢也不太建议使用GLO系统,现有的GPS+BDS+GAL卫星数已完全足够使用。

函数的前半部分其实保留了原函数的功能,即对无电离层组合观测值的修正。


整个函数

/* psendorange with code bias correction -------------------------------------*/
static double prange_mulfreq(const obsd_t *obs, const nav_t *nav, const prcopt_t *opt, const int k,double *var)
{double P1, P2, gamma, b1, b2, P, tgd;int sat, sys;sat = obs->sat;sys = satsys(sat, NULL);P1 = obs->P[0];P2 = obs->P[1];*var = 0.0;if (P1 == 0.0 || (opt->ionoopt == IONOOPT_IFLC && P2 == 0.0))return 0.0;/* P1-C1,P2-C2 DCB correction */if (sys == SYS_GPS || sys == SYS_GLO){if (obs->code[0] == CODE_L1C)P1 += nav->cbias[sat - 1][1]; /* C1->P1 */if (obs->code[1] == CODE_L2C)P2 += nav->cbias[sat - 1][2]; /* C2->P2 */}if (opt->ionoopt == IONOOPT_IFLC){ /* dual-frequency */if (sys == SYS_GPS || sys == SYS_QZS){ /* L1-L2,G1-G2 */gamma = SQR(FREQ1 / FREQ2);return (P2 - gamma * P1) / (1.0 - gamma);}else if (sys == SYS_GLO){ /* G1-G2 */gamma = SQR(FREQ1_GLO / FREQ2_GLO);return (P2 - gamma * P1) / (1.0 - gamma);}else if (sys == SYS_GAL){ /* E1-E5b */gamma = SQR(FREQ1 / FREQ7);if (getseleph(SYS_GAL)){                                                    /* F/NAV */P2 -= gettgd(sat, nav, 0) - gettgd(sat, nav, 1); /* BGD_E5aE5b */}return (P2 - gamma * P1) / (1.0 - gamma);}else if (sys == SYS_CMP){ /* B1-B2 */gamma = SQR(((obs->code[0] == CODE_L2I) ? FREQ1_CMP : FREQ1) / FREQ2_CMP);if (obs->code[0] == CODE_L2I)b1 = gettgd(sat, nav, 0); /* TGD_B1I */else if (obs->code[0] == CODE_L1P)b1 = gettgd(sat, nav, 2); /* TGD_B1Cp */elseb1 = gettgd(sat, nav, 2) + gettgd(sat, nav, 4); /* TGD_B1Cp+ISC_B1Cd */b2 = gettgd(sat, nav, 1);                           /* TGD_B2I/B2bI (m) */return ((P2 - gamma * P1) - (b2 - gamma * b1)) / (1.0 - gamma);}else if (sys == SYS_IRN){ /* L5-S */gamma = SQR(FREQ5 / FREQ9);return (P2 - gamma * P1) / (1.0 - gamma);}}else{ /* single-freq */if (k < 0 || k >= (NFREQ + NEXOBS)){return 0.0;}P = obs->P[k];*var = SQR(ERR_CBIAS);tgd = 0.0;if (sys == SYS_GPS || sys == SYS_QZS){gamma = SQR(FREQ1 / FREQ2);b1 = gettgd(sat, nav, 0); /* TGD (m) */switch (obs->code[k]){/*for L1C, we need to calibrate the DCB between P1 and C1. but here we ignore it*/case CODE_L1C:case CODE_L1P:tgd = b1;break;/*for L2P, calibrate tgd according the paper*/case CODE_L2P:case CODE_L2W:tgd = b1 * gamma;break;/*no L5 tgd info in broadcast nav, give the default value 0*/case CODE_L5Q:tgd = 0.0;break;}}else if (sys == SYS_GLO){   /*for GLO, the logic may has error*/gamma = SQR(FREQ1_GLO / FREQ2_GLO);b1 = gettgd(sat, nav, 0); /* -dtaun (m) */b1 = b1 / (gamma - 1.0);switch (obs->code[k]){case CODE_L1C:case CODE_L1P:tgd = b1;break;case CODE_L2C:case CODE_L2P:tgd = b1 * gamma;break;}}else if (sys == SYS_GAL){   /*for GAL sys, there is two ephemerises*/if (getseleph(SYS_GAL))b1 = gettgd(sat, nav, 0); /* BGD_E1E5a */elseb1 = gettgd(sat, nav, 1); /* BGD_E1E5b */switch (obs->code[k]){case CODE_L1C:tgd = b1;break;case CODE_L5Q:gamma = SQR(FREQ1 / FREQ5);tgd = b1 * gamma;break;case CODE_L7Q:gamma = SQR(FREQ1 / FREQ7);tgd = b1 * gamma;break;}}else if (sys == SYS_CMP){   switch (obs->code[k]){case CODE_L2I:tgd = gettgd(sat, nav, 0);break;case CODE_L7I:tgd = gettgd(sat, nav, 1);break;/*for BDS sys, the reference frequency is 6I. that's why the correction in 6I is zeror*/case CODE_L6I:tgd = 0.0;break;case CODE_L1P:tgd = gettgd(sat, nav, 2);break;case CODE_L5P:tgd = gettgd(sat, nav, 3);break;}}return P - tgd;}return P1;
}

代码已上传到国内版git上(gitee,主要是网速快)。代码链接 请在个人公众号回复 git 获取。在此也建议大家使用git工具clone代码,这样可以便于查看代码的更新历史,以及方便拉取最新的代码。

另外本节的代码在mulfreq-spp分支,注意分支切换。master分支是原始的rtklib代码。另外虽然mulfreq-spp分支有一些其他的改动,但暂时结果的正确性无法保证,我还在开发中。

另外一个,建议大家使用vscode来查看代码。git和vscode的使用请自行搜索博客或者bilibili。

下一节我会讲一下如何使用git查看代码的历史以及使用vscode查看每次提交的改动,这样方便大家理解代码的修改思路。

欢迎关注个人公众号

个人公众号 GNSS和自动驾驶,会持续更新GNSS的基础教程/进阶教程/GNSS在自动驾驶中的应用/自动驾驶技术进展等。

这篇关于本科生学习GNSS算法 中级教程(二)- rtklib多系统多频单点定位算法 - tgd修正以及代码实现的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/326169

相关文章

电脑找不到mfc90u.dll文件怎么办? 系统报错mfc90u.dll丢失修复的5种方案

《电脑找不到mfc90u.dll文件怎么办?系统报错mfc90u.dll丢失修复的5种方案》在我们日常使用电脑的过程中,可能会遇到一些软件或系统错误,其中之一就是mfc90u.dll丢失,那么,mf... 在大部分情况下出现我们运行或安装软件,游戏出现提示丢失某些DLL文件或OCX文件的原因可能是原始安装包

电脑显示mfc100u.dll丢失怎么办?系统报错mfc90u.dll丢失5种修复方案

《电脑显示mfc100u.dll丢失怎么办?系统报错mfc90u.dll丢失5种修复方案》最近有不少兄弟反映,电脑突然弹出“mfc100u.dll已加载,但找不到入口点”的错误提示,导致一些程序无法正... 在计算机使用过程中,我们经常会遇到一些错误提示,其中最常见的就是“找不到指定的模块”或“缺少某个DL

使用Python实现IP地址和端口状态检测与监控

《使用Python实现IP地址和端口状态检测与监控》在网络运维和服务器管理中,IP地址和端口的可用性监控是保障业务连续性的基础需求,本文将带你用Python从零打造一个高可用IP监控系统,感兴趣的小伙... 目录概述:为什么需要IP监控系统使用步骤说明1. 环境准备2. 系统部署3. 核心功能配置系统效果展

Python实现微信自动锁定工具

《Python实现微信自动锁定工具》在数字化办公时代,微信已成为职场沟通的重要工具,但临时离开时忘记锁屏可能导致敏感信息泄露,下面我们就来看看如何使用Python打造一个微信自动锁定工具吧... 目录引言:当微信隐私遇到自动化守护效果展示核心功能全景图技术亮点深度解析1. 无操作检测引擎2. 微信路径智能获

Python中pywin32 常用窗口操作的实现

《Python中pywin32常用窗口操作的实现》本文主要介绍了Python中pywin32常用窗口操作的实现,pywin32主要的作用是供Python开发者快速调用WindowsAPI的一个... 目录获取窗口句柄获取最前端窗口句柄获取指定坐标处的窗口根据窗口的完整标题匹配获取句柄根据窗口的类别匹配获取句

在 Spring Boot 中实现异常处理最佳实践

《在SpringBoot中实现异常处理最佳实践》本文介绍如何在SpringBoot中实现异常处理,涵盖核心概念、实现方法、与先前查询的集成、性能分析、常见问题和最佳实践,感兴趣的朋友一起看看吧... 目录一、Spring Boot 异常处理的背景与核心概念1.1 为什么需要异常处理?1.2 Spring B

Python位移操作和位运算的实现示例

《Python位移操作和位运算的实现示例》本文主要介绍了Python位移操作和位运算的实现示例,文中通过示例代码介绍的非常详细,对大家的学习或者工作具有一定的参考学习价值,需要的朋友们下面随着小编来一... 目录1. 位移操作1.1 左移操作 (<<)1.2 右移操作 (>>)注意事项:2. 位运算2.1

如何在 Spring Boot 中实现 FreeMarker 模板

《如何在SpringBoot中实现FreeMarker模板》FreeMarker是一种功能强大、轻量级的模板引擎,用于在Java应用中生成动态文本输出(如HTML、XML、邮件内容等),本文... 目录什么是 FreeMarker 模板?在 Spring Boot 中实现 FreeMarker 模板1. 环

Qt实现网络数据解析的方法总结

《Qt实现网络数据解析的方法总结》在Qt中解析网络数据通常涉及接收原始字节流,并将其转换为有意义的应用层数据,这篇文章为大家介绍了详细步骤和示例,感兴趣的小伙伴可以了解下... 目录1. 网络数据接收2. 缓冲区管理(处理粘包/拆包)3. 常见数据格式解析3.1 jsON解析3.2 XML解析3.3 自定义

SpringMVC 通过ajax 前后端数据交互的实现方法

《SpringMVC通过ajax前后端数据交互的实现方法》:本文主要介绍SpringMVC通过ajax前后端数据交互的实现方法,本文给大家介绍的非常详细,对大家的学习或工作具有一定的参考借鉴价... 在前端的开发过程中,经常在html页面通过AJAX进行前后端数据的交互,SpringMVC的controll