本科生学习GNSS算法(五)- rtklib多系统多频单点定位算法 - bug修复、无电离层组合定位以及kalman滤波

上一节提到的bug

问题定位到pntpos.c->660行,发现是valsol计算dop有问题,具体原因是我们使用了多频数据,对后续的一些gdop计算没有进行兼容,导致报错,然后定位结果丢失。在以下commit中对该问题进行了修复,具体请自行查看。

2ade8fea5d70998d6e868993c939c324bd249dab

在配置文件中配置使用的频率以及电离层改正方法,即可实现不同频率的单点定位模式

单频

pos1-frequency     =l1
pos1-ionoopt       =brdc

三频

pos1-frequency     =l1+2+3
pos1-ionoopt       =brdc

一二频点无电离层组合单点定位

pos1-frequency     =l1+2
pos1-ionoopt       =dual-freq

修改的增加无电离层组合的定位模式比较简单,在以下commit

d7bfefed0637ee1a3910af89334a5d95f6b414e3

主要是以下改动

通过对不同频率组合的定位结果分析,无电离层组合的定位精度还是明显优于其他原始频点组合。虽然无电离层组合会带来观测值噪声的放大,但相对于经验模型修正残留的电离层影响,无电离层组合还是拥有明显的优势。

但是仅单历元定位进行定位,并未考虑载体自身的运动特性,这其实就有相当一部分的信息未利用,载体的自身运动信息是损失掉的。所以增加了单点定位的kalman滤波算法逻辑。

无电离层组合的kalman滤波结果

两个结果均是kalman滤波的结果,其中噪声较大的是使用类似rtklib中rtk算法的PVA模型,很平滑的结果,则是人为给了一个速度为0的约束的结果。下一系列教程会详细介绍。

GNSS高级教程介绍

正如上面介绍的,高级教程计划如下:

  1. 实现kalman滤波的单点定位算法
  2. 针对静态模式,增加零速约束以及doppler观测值对速度更新。

本文首发于个人公众号 GNSS和自动驾驶,欢迎关注。

  • 3
    点赞
  • 5
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
### 回答1: GNSS(全球导航卫星系统单点定位算法是一种利用卫星信号进行定位的方法,主要通过接收多颗卫星的信号进行测量和计算来确定用户的位置。下面是一个示例的GNSS单点定位算法代码: ```python import numpy as np def gnss_single_point_positioning(satellite_data, receiver_data): # 卫星数据:卫星的位置和伪距 satellite_positions = satellite_data['positions'] pseudo_ranges = satellite_data['pseudo_ranges'] # 接收机数据:接收机的位置 receiver_position = receiver_data['position'] # 预设接收机位置 estimated_position = np.array([0, 0, 0]) # 对每个可见卫星进行迭代 for i in range(len(satellite_positions)): # 计算接收机到卫星的几何距离 geometric_distance = np.linalg.norm(receiver_position - satellite_positions[i]) # 通过几何距离和卫星传输的伪距计算估计的接收机位置 estimated_position += (receiver_position - satellite_positions[i]) * (pseudo_ranges[i] - geometric_distance) / geometric_distance return estimated_position # 示例数据 satellite_data = { 'positions': np.array([[1000, 2000, 3000], [4000, 5000, 6000], [7000, 8000, 9000]]), 'pseudo_ranges': np.array([900, 1200, 1500]) } receiver_data = {'position': np.array([10000, 20000, 30000])} # 调用单点定位算法 estimated_position = gnss_single_point_positioning(satellite_data, receiver_data) print("Estimated Receiver Position:", estimated_position) ``` 以上是一个简单的GNSS单点定位算法代码示例,其中通过迭代计算,使用卫星信号的位置和伪距来估计接收机的位置。这只是一个简单的示例,实际中还需要考虑更多的误差源如钟差、大气延迟等,以及更复杂的算法和数据处理。 ### 回答2: GNSS单点定位算法代码是用于实现全球导航卫星系统GNSS)接收机的定位功能。该算法代码通过接收多颗卫星发射的信号,利用接收机内部的时钟和测量值,计算出接收机在地球上的位置。 代码实现的基本步骤如下: 1. 初始化接收机参数,包括接收机的位置、时钟误差、卫星的轨道信息等。 2. 接收卫星信号,测量接收机与卫星之间的距离。这可以通过计算信号传播时间或者测量信号的相位差来实现。 3. 根据接收到的卫星信号,计算接收机与每颗卫星之间的几何距离。这个距离是接收机与卫星之间的直线距离,考虑了信号在大气中传播的延迟效应。 4. 利用接收到的多颗卫星信号,计算接收机的位置。有多种方法可以实现这一步骤,其中一个常用的方法是通过解算位置的方程组,其中方程组的未知数是接收机的位置。 5. 修正接收机的时钟误差。由于接收机内部的时钟可能存在误差,需要对接收到的卫星信号进行时间校准。 6. 输出定位结果。将计算得到的接收机位置信息输出,以提供给应用程序或者用户使用。 通过以上步骤,GNSS单点定位算法代码可以实现对接收机位置的定位。这样,用户就可以根据卫星信号进行定位,从而得到精确的位置信息。该代码的应用范围广泛,包括车辆导航、精确定位等领域。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值