[发明专利]一种自动驾驶定位系统相对精度的自动化评估方法及系统

说明书

本发明公开了一种自动驾驶定位系统相对精度的自动化评估方法及系统，该方法包括：以当前时刻为中心，获取定位轨迹及其对应的GPS轨迹前后预设时间区间的曲线；将获取的定位轨迹预设时间区间的曲线向获取的GPS轨迹预设时间区间的曲线做相似变化，使该两条曲线的两端重合；以当前时刻为中心，截取所述两端重合的定位轨迹预设时间区间的曲线及GPS轨迹预设时间区间的曲线前后预置时间区间的曲线；在所述截取预置时间区间的曲线中，计算每个时刻定位曲线到GPS曲线的距离，得到最大值M，若M小于预设距离值，则当前时刻的定位质量合格。该方法完全自动对定位结果的质量进行评估，节约了人力，评估结果更加可靠。

技术领域

本发明属于汽车自动驾驶技术领域，更具体地，涉及一种自动驾驶定位系统相对精度的自动化评估方法及系统。

背景技术

自动驾驶中，获得汽车在车道中的位置是非常重要的需求之一。为了实现这个需求，一般的做法是对车道线进行建模，这个模型也叫做地图，里面存有车道线的位置。自动驾驶的时候，在计算出汽车的坐标后，与地图中车道线的位置进行比较，就可以得出汽车当前在哪个车道中的什么位置上。

实现这个需求的方法之一是使用视觉定位。视觉定位的原理是通过把当前时刻的图像与地图中的特征点进行匹配，然后的得到相对于地图的当前位置。通过视觉定位后，需要再通过人力来判定定位质量，这样便需要消耗大量人力，且有很强的主观性，无法定量，其评估的结果不够可靠。

公开号CN108121346A的发明公开了一种基于高精导航定位系统的自动驾驶方向控制系统及方法。它包括：高精导航定位系统用于自身的定位数据获取车辆的粗定位坐标；自动驾驶控制系统用于接收高精导航定位系统的信息，并结合车辆探测系统采集的数据及车辆的高精地图，获取车辆的精确定位坐标、车辆行驶方向上的弯道曲率、交通标识信息及车辆与弯道的距离数据，根据当前车速及获取的数据确定车辆需要控制的速度和行驶方向；车辆控制系统用于控制降低车速及行驶方向变化。该发明能对车辆进行定位，提前获取车辆的控制信息，控制车辆控制系统采取措施，进行车速调整，行驶方向变化，但该发明采用GPS定位，但对定位的质量未进行评估，不能保证定位结果的准确性。

与现有技术相比，本发明将定位轨迹分段后与GPS轨迹做相似变化，得到与GPS轨迹对齐的定位轨迹，基于两条轨迹的最大距离来判断定位质量的好坏，完全自动对定位结果的质量进行评估，节约了人力，评估结果更加可靠。

发明内容

针对现有技术的以上缺陷及改进需求，本发明提供了一种自动驾驶定位系统相对精度的自动化评估方法及系统，其目的在于提供一种自动化的、准确度高的自动驾驶定位系统相对精度的评估方法及系统，由此解决现有技术存在的耗费大量人力、评估结果不可靠的技术问题。

为实现上述目的，本发明提供一种自动驾驶定位系统相对精度的自动化评估方法，包括步骤：

S1.以当前时刻为中心，获取定位轨迹及其对应的GPS轨迹前后预设时间区间的曲线；

S2.将获取的定位轨迹预设时间区间的曲线向获取的GPS轨迹预设时间区间的曲线做相似变化，使该两条曲线的两端重合；

S3.以当前时刻为中心，截取所述两端重合的定位轨迹预设时间区间的曲线及GPS轨迹预设时间区间的曲线前后预置时间区间的曲线；

S4.在所述截取的预置时间区间曲线中，计算每个时刻定位曲线到GPS曲线的距离，得到最大值M，若M小于预设距离值，则当前时刻的定位质量合格。

进一步的，在步骤S1之前，还包括步骤：

获取一段时间内自动驾驶的定位轨迹及其对应的GPS轨迹。

进一步的，在步骤S4之后，还包括步骤：

判断所述定位轨迹中所有时刻对应的定位质量是否合格，并计算定位质量合格的时刻所累积的时间。