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

2023-11-01 22:20
文章标签 算法 代码 实现 系统 学习 教程 定位 单点 rtklib 中级 gnss 多频 本科生 修正 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。

相关文章

HarmonyOS学习(七)——UI（五）常用布局总结

HarmonyOS学习(七)——UI（五）常用布局总结

自适应布局 1.1、线性布局（LinearLayout） 通过线性容器Row和Column实现线性布局。Column容器内的子组件按照垂直方向排列，Row组件中的子组件按照水平方向排列。 属性说明space通过space参数设置主轴上子组件的间距，达到各子组件在排列上的等间距效果alignItems设置子组件在交叉轴上的对齐方式，且在各类尺寸屏幕上表现一致，其中交叉轴为垂直时，取值为Vert
阅读更多...
Ilya-AI分享的他在OpenAI学习到的15个提示工程技巧

Ilya-AI分享的他在OpenAI学习到的15个提示工程技巧

Ilya（不是本人，claude AI）在社交媒体上分享了他在OpenAI学习到的15个Prompt撰写技巧。 以下是详细的内容： 提示精确化:在编写提示时,力求表达清晰准确。清楚地阐述任务需求和概念定义至关重要。例:不用"分析文本",而用"判断这段话的情感倾向:积极、消极还是中性"。 快速迭代:善于快速连续调整提示。熟练的提示工程师能够灵活地进行多轮优化。例:从"总结文章"到"用
阅读更多...
Security OAuth2 单点登录流程

Security OAuth2 单点登录流程

单点登录（英语：Single sign-on，缩写为 SSO），又译为单一签入，一种对于许多相互关连，但是又是各自独立的软件系统，提供访问控制的属性。当拥有这项属性时，当用户登录时，就可以获取所有系统的访问权限，不用对每个单一系统都逐一登录。这项功能通常是以轻型目录访问协议（LDAP）来实现，在服务器上会将用户信息存储到LDAP数据库中。相同的，单一注销（single sign-off）就是指
阅读更多...
Spring Security 从入门到进阶系列教程

Spring Security 从入门到进阶系列教程

Spring Security 入门系列 《保护 Web 应用的安全》 《Spring-Security-入门（一）：登录与退出》 《Spring-Security-入门（二）：基于数据库验证》 《Spring-Security-入门（三）：密码加密》 《Spring-Security-入门（四）：自定义-Filter》 《Spring-Security-入门（五）：在 Sprin
阅读更多...
不懂推荐算法也能设计推荐系统

不懂推荐算法也能设计推荐系统

本文以商业化应用推荐为例，告诉我们不懂推荐算法的产品，也能从产品侧出发， 设计出一款不错的推荐系统。 相信很多新手产品，看到算法二字，多是懵圈的。 什么排序算法、最短路径等都是相对传统的算法（注：传统是指科班出身的产品都会接触过）。但对于推荐算法，多数产品对着网上搜到的资源，都会无从下手。特别当某些推荐算法 和 “AI”扯上关系后，更是加大了理解的难度。 但，不了解推荐算法，就无法做推荐系
阅读更多...
基于人工智能的图像分类系统

基于人工智能的图像分类系统

目录 引言项目背景环境准备 硬件要求软件安装与配置系统设计 系统架构关键技术代码示例 数据预处理模型训练模型预测应用场景结论 1. 引言 图像分类是计算机视觉中的一个重要任务，目标是自动识别图像中的对象类别。通过卷积神经网络（CNN）等深度学习技术，我们可以构建高效的图像分类系统，广泛应用于自动驾驶、医疗影像诊断、监控分析等领域。本文将介绍如何构建一个基于人工智能的图像分类系统，包括环境
阅读更多...
水位雨量在线监测系统概述及应用介绍

水位雨量在线监测系统概述及应用介绍

在当今社会，随着科技的飞速发展，各种智能监测系统已成为保障公共安全、促进资源管理和环境保护的重要工具。其中，水位雨量在线监测系统作为自然灾害预警、水资源管理及水利工程运行的关键技术，其重要性不言而喻。 一、水位雨量在线监测系统的基本原理 水位雨量在线监测系统主要由数据采集单元、数据传输网络、数据处理中心及用户终端四大部分构成，形成了一个完整的闭环系统。 数据采集单元：这是系统的“眼睛”，
阅读更多...
无人叉车3d激光slam多房间建图定位异常处理方案-墙体画线地图切分方案

无人叉车3d激光slam多房间建图定位异常处理方案-墙体画线地图切分方案

墙体画线地图切分方案 针对问题：墙体两侧特征混淆误匹配，导致建图和定位偏差，表现为过门跳变、外月台走歪等 ·解决思路：预期的根治方案IGICP需要较长时间完成上线，先使用切分地图的工程化方案，即墙体两侧切分为不同地图，在某一侧只使用该侧地图进行定位 方案思路 切分原理：切分地图基于关键帧位置，而非点云。 理论基础：光照是直线的，一帧点云必定只能照射到墙的一侧，无法同时照到两侧实践考虑：关
阅读更多...
【前端学习】AntV G6-08 深入图形与图形分组、自定义节点、节点动画（下）

【前端学习】AntV G6-08 深入图形与图形分组、自定义节点、节点动画（下）

【课程链接】 AntV G6：深入图形与图形分组、自定义节点、节点动画（下）_哔哩哔哩_bilibili 本章十吾老师讲解了一个复杂的自定义节点中，应该怎样去计算和绘制图形，如何给一个图形制作不间断的动画，以及在鼠标事件之后产生动画。（有点难，需要好好理解） <!DOCTYPE html><html><head><meta charset="UTF-8"><title>06
阅读更多...
Makefile简明使用教程

Makefile简明使用教程

文章目录 规则makefile文件的基本语法：加在命令前的特殊符号：.PHONY伪目标: Makefilev1 直观写法v2 加上中间过程v3 伪目标v4 变量 make 选项-f-n-C Make 是一种流行的构建工具，常用于将源代码转换成可执行文件或者其他形式的输出文件(如库文件、文档等)。Make 可以自动化地执行编译、链接等一系列操作。 规则 makefile文件
阅读更多...

Copyright China编程 23002807@qq.com

沪ICP备2023033072号-2