一种GNSS跳变数据剔除算法制造技术

本发明专利技术涉及无人驾驶的建图和定位技术领域，具体是公开一种GNSS跳变数据剔除算法，1、确定起始数据，初始跳变误差记为error；2、新数据作为当前时刻数据记为now_data，now_data前未被舍弃的上一时刻数据记为old_data；3、计算now_data相对于old_data的位姿变换，并得到相对移动向量记为d,相对移动距离即为|d|；4、若|d|大于预设定的阈值A，则记录error＝error+d，否则不进行其他操作；5、若模长|error|大于预设定的阈值B，则判断当前GNSS数据now_data出现了跳变，舍弃该数据，回2；若模长|error|小于或等于预设定的阈值B，则判断当前GNSS数据now_data正常，将error清零避免产生累计误差，回2；由此，实现循环处理，通过该算法剔除因环境因素导致的GNSS跳变数据，能够更精确的帮助进行点云地图构建与定位。进行点云地图构建与定位。进行点云地图构建与定位。

【技术实现步骤摘要】
一种GNSS跳变数据剔除算法


[0001]本专利技术涉及无人驾驶的建图和定位


技术介绍

[0002]随着无人驾驶技术的快速发展，无人驾驶对人类生活的影响越来越大。建图与定位能力是无人驾驶汽车能够运行的前提条件，是自动驾驶技术的重要组成部分，建图精确与否对定位的准确度有重要影响。目前，建图主要是通过多传感器融合技术对激光雷达、IMU(惯性测量单元)和GNSS(全球导航卫星系统)等传感器数据进行融合，来建立出精确的地图，并在无人驾驶车辆运行时通过融合数据提供精确的定位。
[0003]其中，GNSS利用接收机被动地接受来自卫星的数据结算出经纬度信息，得到绝对定位数据，在差分模式下可达到厘米级定位精度，在多传感器融合建图中，GNSS的位姿数据作为点云数据进行建图的直接约束，对建图效果有着直接影响。但是GNSS数据可能收到外界环境的影响导致数据产生跳变，如容易受到树荫等遮挡的影响产生跳变，GNSS数据出现跳变时，若直接使用存在跳变的GNSS数据进行融合建图，则将导致点云地图出现错误约束，建立出错误的地图。若建图错误，则多传感器融合定位也无从谈起。

技术实现思路

[0004]本专利技术的目的在于提供一种剔除因环境因素导致的GNSS跳变数据的一种GNSS跳变数据剔除算法，以应对GNSS数据跳变不可完全避免的情况下对跳变数据进行剔除处理。
[0005]为实现上述目的，本专利技术的技术方案是：一种GNSS跳变数据剔除算法，算法步骤如下：
[0006]步骤1、接收传感器传传来的GNSS数据，以不受干扰的正确的GNSS数据作为第一个GNSS数据，即起始数据，初始跳变误差记为error，error为三维向量，分别对应x、y、z三维坐标，error的模长则为|error|，初始|error|＝0；然后进入步骤2；
[0007]步骤2、继续接收传感器传来的GNSS数据，最新接收的数据作为当前时刻数据记为now_data，now_data前未被舍弃的上一时刻数据记为old_data；然后进入步骤3；
[0008]步骤3：计算now_data相对于old_data的位姿变换，并得到相对移动向量记为d,d的模长为相对移动距离即为|d|；然后进入步骤4；
[0009]步骤4：若|d|大于预设定的阈值A，则记录error＝error+d，否则不进行其他操作；然后进入步骤5；
[0010]步骤5：若模长|error|大于预设定的阈值B，则判断当前GNSS数据now_data出现了跳变，舍弃该数据，回到步骤2；
[0011]若模长|error|小于或等于预设定的阈值B，则判断当前GNSS数据now_data正常，将error清零避免产生累计误差，回到步骤2；
[0012]由此，实现循环处理。
[0013]应用于自动驾驶设备时，若自动驾驶设备运动较快，阈值A和阈值B同比增大，若自
动驾驶设备运动较慢，阈值A和阈值B同比减小。
[0014]通过采用上述技术方案，本专利技术的有益效果是：上述技术方案的一种GNSS跳变数据的剔除算法，通过判断相邻两个时刻和历史时刻的GNSS数据变化大小，判断当前的GNSS数据是否属于跳变数据并进行剔除，从而得到可靠的GNSS数据。GNSS数据可用于自动驾驶中的多传感器融合地图构建及定位，剔除跳变数据后的GNSS数据能够更精确的帮助进行点云地图构建与定位。本专利技术有利于构建自动驾驶所需的3D点地图及实时定位。
附图说明
[0015]图1是本专利技术涉及的一种GNSS跳变数据位姿示意图。
[0016]图2是实际采集的存在GNSS跳变数据的GNSS数据示意图；
[0017]图3是图2的同环境采集通过采用本专利技术的一种GNSS跳变数据剔除算法处理得到的GNSS数据示意图。
具体实施方式
[0018]为了进一步解释本专利技术的技术方案，下面通过具体实施例来对本专利技术进行详细阐述。
[0019]这里先说明一下本实施例中所述的GNSS数据均为已经经过坐标转换的数据，即对应x、y、z三维坐标的三维向量。
[0020]本专利技术一种GNSS跳变数据剔除算法，算法步骤如下：
[0021]步骤1、接收传感器传传来的GNSS数据，以不受干扰的正确的GNSS数据作为第一个GNSS数据，即起始数据，初始跳变误差记为error，error为三维向量，分别对应x、y、z三维坐标，error的模长则为|error|，初始|error|＝0；然后进入步骤2；
[0022]该步骤1中对GNSS跳变数据的剔除处理以第一个数据作为正确参照，判断后续数据是否产生跳变；
[0023]步骤2、继续接收传感器传来的GNSS数据，最新接收的数据作为当前时刻数据记为now_data，now_data前未被舍弃的上一时刻数据记为old_data；然后进入步骤3；
[0024]步骤3：计算now_data相对于old_data的位姿变换(旋转+平移变换)，并得到相对移动向量记为d(由old_data坐标点指向now_data坐标点的向量),d的模长为相对移动距离即为|d|；然后进入步骤4；
[0025]步骤4：若|d|大于预设定的阈值A，则记录error＝error+d(两向量相加)，否则不进行其他操作；然后进入步骤5；
[0026]步骤5：若模长|error|大于预设定的阈值B，则判断当前GNSS数据now_data出现了跳变，舍弃该数据，回到步骤2；
[0027]若模长|error|小于或等于预设定的阈值B，则判断当前GNSS数据now_data正常，将error清零避免产生累计误差，回到步骤2；
[0028]由此，实现循环处理。
[0029]根据上面的方法步骤下面结合具体的实施例方式描述一下本专利技术的算法应用，如图1所示，每个箭头代表一个GNSS数据位姿，其中3号和4号箭头表示产生跳变的GNSS数据位姿，是应该剔除的GNSS跳变数据，1号箭头为正常GNSS数据位姿，以1号箭头为初始位姿，也
就是第一个GNSS数据，即起始数据，进行跳变数据处理。
[0030]设连续两个位姿的相对距离在不产生跳变的情况下不大于阈值A，如1号位姿跟2号位姿；设连续两个位姿的相对距离在均产生同样跳变的情况下不大于阈值A，如3号位姿跟4号位姿；设连续两个位姿的相对距离在只有其中一个位姿跳变的情况下大于阈值B，如2号位姿跟3号位姿。
[0031]首先接收到1号位姿，此时只有一个位姿，初始误差|error|＝0，继续接收下一个位姿；然后接收到2号位姿，此时2号位姿为当前时刻数据now_data，1号位姿为上一时刻位姿old_data；接着计算2号位姿now_data相对于1号位姿old_data的位姿变换(旋转+平移变换)，并得到相对移动向量d(由old_data坐标点指向now_data坐标点的向量),d的模长为相对移动距离|d|；因为相对移动距离|d|不大于阈值A，因此视1号位姿和2号位姿均未产生跳本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种GNSS跳变数据剔除算法，其特征在于，算法步骤如下：步骤1、接收传感器传传来的GNSS数据，以不受干扰的正确的GNSS数据作为第一个GNSS数据，即起始数据，初始跳变误差记为error，error为三维向量，分别对应x、y、z三维坐标，error的模长则为|error|，初始|error|＝0；然后进入步骤2；步骤2、继续接收传感器传来的GNSS数据，最新接收的数据作为当前时刻数据记为now_data，now_data前未被舍弃的上一时刻数据记为old_data；然后进入步骤3；步骤3：计算now_data相对于old_data的位姿变换，并得到相对移动向量记为d,d的模长为相对...

【专利技术属性】
技术研发人员：吴宇雄，李瑞峰，霍光磊，温宽昌，黄小春，
申请(专利权)人：福建泉州哈工大工程技术研究院，
类型：发明
国别省市：