[发明专利]激光雷达匹配定位方法及装置

说明书

本发明提供了一种激光雷达匹配定位方法，包括：获取当前激光雷达点云信息；根据位置坐标，将地面点和地面以上点映射在预设的栅格地图上；计算栅格地图中的每个栅格的地面点的分布和地面以上点的分布；根据每个栅格的地面点的分布和地面以上点的分布，计算每个栅格中各点的概率；以栅格地图中的第一栅格为中心，确定预设搜索范围内的栅格集；当车辆位于栅格集中的任一栅格时，根据与车辆高度对应的点的概率，计算不同偏航角对应的匹配概率；根据栅格集中的每个栅格中不同偏航角对应的匹配概率，确定概率矩阵；根据概率矩阵，对定位结果进行评价，生成评价结果；根据评价结果，确定车辆的定位结果。由此，排除了场景的差别，能很好适应多场景。

技术领域

本发明涉及自动驾驶领域，尤其涉及激光雷达匹配定位方法及装置。

背景技术

近年来无人驾驶关键技术的不断突破与发展，大大加快了无人驾驶技术的落地与普及。无人驾驶车辆的正常行驶离不开车辆实时高精度定位，高精度定位作为实现无人驾驶的关键技术，其方式主要包括高精度差分GNSS(Global Navigation Satellite System)定位、激光雷达匹配定位、视觉定位等。激光雷达匹配定位作为其中重要的定位手段，快速且稳定的定位以及准确的定位效果评价是其最关键的因素。

激光雷达匹配定位技术一般包括计算最优匹配定位结果和定位结果评价两部分。

目前大多数激光雷达匹配方法使用非线性优化技术，以最大化激光匹配概率为目标，计算最优的匹配结果。当评价激光匹配结果是否可用时，往往是基于最优结果的匹配概率与固定阈值比较，来评价结果的可用性，如果大于阈值认为匹配可用，小于阈值认为匹配失败。

基于优化匹配概率计算定位结果存在如下问题：该方法只提供最优解对应的概率值，不能提供搜索空间内的概率分布，损失了大量的信息，而利用这些信息却可以进行更有效的定位结果判定，甚至可以通过这些信息进行场景的识别。

用匹配概率作为匹配的评价指标存在如下问题：不同场景，评价匹配结果是否有效的概率阈值往往不同。比如，有些场景以树木植被为主，有些场景以楼宇为主，不同的场景往往有不同的匹配概率；相同场景，随着季节变化，匹配的概率也随之变化。比如多植被场景，冬季落叶，夏季繁茂，不同季节的匹配概率也相应变化。所以，匹配概率不能作为稳定、统一的手段作为判断定位是否可用的标准。

发明内容

本发明实施例的目的是提供一种激光雷达匹配定位方法及装置，以解决现有技术中的以匹配概率作为判断定位可用的标准所存在的信息损失量大及不能有效的进行定位结果的判定的问题。

为解决上述问题，第一方面，本发明提供了一种激光雷达匹配定位方法，所述方法包括：

获取当前激光雷达点云信息；其中，所述激光雷达点云信息包括地面点和地面以上点，每个点具有位置坐标；

根据所述位置坐标，将所述地面点和所述地面以上点映射在预设的栅格地图上；

计算所述栅格地图中的每个栅格的地面点的分布和地面以上点的分布；

根据每个栅格的地面点的分布和地面以上点的分布，计算每个栅格中各点的概率；

以栅格地图中的第一栅格为中心，确定预设搜索范围内的栅格集；其中，所述第一栅格为定位结果预测值所在的栅格；

当所述车辆位于所述栅格集中的任一栅格时，根据与所述车辆高度对应的点的概率，计算不同偏航角对应的匹配概率；

根据所述栅格集中的每个栅格中不同偏航角对应的匹配概率，确定概率矩阵；

根据所述概率矩阵，对定位结果进行评价，生成评价结果；

根据所述评价结果，确定车辆的定位结果。

在一种可能的实现方式中，所述获取当前激光雷达点云信息之前，所述方法还包括：