System.ArgumentOutOfRangeException: 索引和长度必须引用该字符串内的位置。 参数名: length 在 System.String.Substring(Int32 startIndex, Int32 length) 在 zhuanliShow.Bind()
【技术实现步骤摘要】
本申请涉及地图处理,具体而言,涉及一种基于激光雷达的路面生成方法、装置、介质、设备及车辆。
技术介绍
1、电子地图,也称即数字地图,是利用计算机技术,以数字方式存储和查阅的地图。生成电子地图的关键步骤之一是生成路面。目前生成路面的主要方法包括:先获取包括多个相机位姿和多个车道线的矢量语义地图,再将相机位姿对应的对地参数向量与地面的交点和对车道线的采样点生成路面点云,最后通过对路面点云进行拟合生成路面。其中,相机位姿为对应视频帧图像被采集时相机的位姿,相机位姿的获取方法主要包括:从各视频帧图像中提取多个特征,并通过对图像间进行特征匹配的方式求解相机位姿。然而,当因为天气等原因导致视频帧图像质量较低时,会大大影响特征匹配的精度,从而导致获取的相机位姿精度较低,进而使得最终生成的路面精度较低。
技术实现思路
1、本申请提供了一种基于激光雷达的路面生成方法、装置、介质、设备及车辆,能够提高路面生成的精度。
2、具体的技术方案如下:
3、第一方面,本申请实施例提供了一种基于激光雷达的路面生成方法,所述方法包括:
4、在确定转换到站心坐标系下的原始雷达点云所覆盖的平面范围之后,将所述平面范围划分为多个网格;
5、基于目标距离范围和目标数量阈值,加载每个所述网格对应的第一雷达点云,其中,所述第一雷达点云包括至少一帧所述原始雷达点云;
6、针对每个所述网格,过滤所述第一雷达点云中的无效雷达点云,获得第二雷达点云,其中,所述无效雷达点云包括
7、根据第一距离阈值和/或第二距离阈值对所述网格对应的第二雷达点云进行聚类,获得至少一个第三雷达点云,其中,所述第一距离阈值为所述站心坐标系中x轴和y轴组成的平面对应的距离阈值,所述第二距离阈值为所述站心坐标系中z轴对应的距离阈值;
8、通过对每个所述第三雷达点云进行曲面拟合以及最小包围框计算,生成路面的曲面信息。
9、通过上述方案可知,本申请实施例可以先将站心坐标系下的原始雷达点云所覆盖的平面范围划分为多个网格,加载每个网格对应的第一雷达点云,再过滤每个网格对应的第一雷达点云中的无效雷达点云获得第二雷达点云,通过对第二雷达点云进行聚类获得至少一个第三雷达点云,最后对第三雷达点云进行曲面拟合和最小包围框计算,生成路面的曲面信息,而不再依赖相机位姿,从而不会存在因特征匹配不准而导致相机位姿不准,进而影响路面生成精度的问题,即本申请实施例可以通过直接对激光雷达生成的原始雷达点云进行处理生成路面的曲面信息,由此提高了路面生成的精度。
10、在第一方面的第一种可能的实现方式中,在时间戳、激光雷达原点的位置与一帧原始雷达点云三者之间具有一一对应关系的情况下,所述基于目标距离范围和目标数量阈值,加载每个所述网格对应的第一雷达点云,包括:
11、针对每个所述网格,从每个所述时间戳对应的激光雷达原点的位置中,查找位于所述网格对应的所述目标距离范围内的所述激光雷达原点的位置,其中,所述时间戳为所述激光雷达生成每帧原始雷达点云时的时间点;
12、在查找到的位置的数量大于或者等于所述目标数量阈值的情况下,将距离所述网格的中心点最近的所述目标数量阈值个所述位置,所对应的所述原始雷达点云确定为所述网格对应的所述第一雷达点云;
13、在查找到的位置的数量小于所述目标数量阈值的情况下,将查找到的位置所对应的原始雷达点云确定为所述网格对应的所述第一雷达点云;
14、加载每个所述网格对应的所述第一雷达点云。
15、通过上述方案可知,本申请实施例可以预先确定时间戳、激光雷达原点的位置与一帧原始雷达点云三者之间的映射关系,再基于该映射关系,针对每个网格,从每个时间戳对应的激光雷达原点的位置中,查找位于该网格对应的目标距离范围内的激光雷达原点的位置,并根据位置的数量确定并加载每个网格对应的第一雷达点云,从而可以全面地获得每个网格所包含的所有雷达点云,避免产生遗漏。
16、在第一方面的第二种可能的实现方式中,在所述通过对每个所述第三雷达点云进行曲面拟合以及最小包围框计算,生成路面的曲面信息之前,所述方法还包括:
17、在所述第三雷达点云的数量大于或者等于第一点数阈值的情况下,针对每个所述第三雷达点云,将所述站心坐标系的原点平移到所述第三雷达点云的中心;
18、随机抽取坐标原点平移后的所述第三雷达点云中预设数量的点作为第一点集,并将所述第一点集拟合成第一平面;
19、计算所述坐标原点平移后的所述第三雷达点云中除所述第一点集外的每个点到所述第一平面的距离;
20、将所述距离小于或者等于第三距离阈值的点添加到所述第一点集后,获得第二点集,并将所述第二点集拟合成第二平面;
21、继续计算所述坐标原点平移后的所述第三雷达点云中除所述第二点集外的每个点到所述第二平面的距离,直至达到目标迭代次数后,获得目标平面;
22、过滤所述坐标原点平移后的所述第三雷达点云中,与所述目标平面的距离大于所述第三距离阈值的点,获得过滤后的所述第三雷达点云。
23、通过上述方案可知,本申请实施例可以通过随机抽取拟合加迭代的方式获得最终的目标平面,并过滤掉距离该目标平面距离较远的点,从而使得足够多的第三雷达点云中的点均在一个平面上,进而可以提高基于第三雷达点云进行曲面拟合所生成路面的精度和平滑度。
24、在第一方面的第三种可能的实现方式中,所述通过对每个所述第三雷达点云进行曲面拟合以及最小包围框计算,生成路面的曲面信息,包括:
25、在过滤后的所述第三雷达点云的点数与过滤前的所述第三雷达点云的点数的比例大于或者等于目标比例阈值,且所述目标平面的水平度大于或者等于目标水平度阈值的情况下,通过对所述第三雷达点云进行曲面拟合以及最小包围框计算,生成路面的曲面信息。
26、通过上述方案可知,在对第三雷达点云过滤后,本申请实施例只有在过滤后的第三雷达点云的点数与过滤前的第三雷达点云的点数的比例大于或者等于目标比例阈值,且目标平面的水平度大于或者等于目标水平度阈值的情况下,才对第三雷达点云进行曲面拟合以及最小包围框计算,从而可以保证足够多的第三雷达点云可以用于曲面拟合,而避免因第三雷达点云点数太少,导致最终拟合出的曲面平滑度和准确较低。
27、在第一方面的第四种可能的实现方式中,所述根据第一距离阈值和/或第二距离阈值对所述网格对应的第二雷达点云进行聚类,获得至少一个第三雷达点云,包括:
28、在所述网格对应的所述第二雷达点云中点数大于或者等于第二点数阈值的情况下,根据所述第一距离阈值和/或所述第二距离阈值对所述网格对应的所述第二雷达点云进行聚类,获得至少一个第三雷达点云。
29、通过上述方案可知,本申请实施例只有在第二雷达点云中点数足够多时,才本文档来自技高网...
【技术保护点】
1.一种基于激光雷达的路面生成方法,其特征在于,所述方法包括:
2.根据权利要求1所述的方法,其特征在于,在时间戳、激光雷达原点的位置与一帧原始雷达点云三者之间具有一一对应关系的情况下,所述基于目标距离范围和目标数量阈值,加载每个所述网格对应的第一雷达点云,包括:
3.根据权利要求1所述的方法,其特征在于,在所述通过对每个所述第三雷达点云进行曲面拟合以及最小包围框计算,生成路面的曲面信息之前,所述方法还包括:
4.根据权利要求3所述的方法,其特征在于,所述通过对每个所述第三雷达点云进行曲面拟合以及最小包围框计算,生成路面的曲面信息,包括:
5.根据权利要求1所述的方法,其特征在于,所述根据第一距离阈值和/或第二距离阈值对所述网格对应的第二雷达点云进行聚类,获得至少一个第三雷达点云,包括:
6.根据权利要求1-5中任一项所述的方法,其特征在于,在通过对每个所述第三雷达点云进行曲面拟合以及最小包围框计算,生成路面的曲面信息之后,所述方法还包括:
7.一种基于激光雷达的路面生成装置,其特征在于,所述装置包括:
>8.根据权利要求7所述的装置,其特征在于,所述加载单元,包括:
9.根据权利要求7所述的装置,其特征在于,所述装置还包括:
10.根据权利要求9所述的装置,其特征在于,所述生成单元,用于在过滤后的所述第三雷达点云的点数与过滤前的所述第三雷达点云的点数的比例大于或者等于目标比例阈值,且所述目标平面的水平度大于或者等于目标水平度阈值的情况下,通过对所述过滤后的所述第三雷达点云进行曲面拟合以及最小包围框计算,生成路面的曲面信息。
11.根据权利要求7所述的装置,其特征在于,所述聚类单元,用于在所述网格对应的所述第二雷达点云中点数大于或者等于第二点数阈值的情况下,根据所述第一距离阈值和/或所述第二距离阈值对所述网格对应的所述第二雷达点云进行聚类,获得至少一个第三雷达点云。
12.根据权利要求7-11中任一项所述的装置,其特征在于,所述装置还包括:
13.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述程序被处理器执行时实现如权利要求1-6中任一项所述的方法。
14.一种电子设备,其特征在于,所述电子设备包括:
15.一种车辆,其特征在于,所述车辆包含如权利要求7-12中任一项所述的装置,或者包含如权利要求14所述的电子设备。
...【技术特征摘要】
1.一种基于激光雷达的路面生成方法,其特征在于,所述方法包括:
2.根据权利要求1所述的方法,其特征在于,在时间戳、激光雷达原点的位置与一帧原始雷达点云三者之间具有一一对应关系的情况下,所述基于目标距离范围和目标数量阈值,加载每个所述网格对应的第一雷达点云,包括:
3.根据权利要求1所述的方法,其特征在于,在所述通过对每个所述第三雷达点云进行曲面拟合以及最小包围框计算,生成路面的曲面信息之前,所述方法还包括:
4.根据权利要求3所述的方法,其特征在于,所述通过对每个所述第三雷达点云进行曲面拟合以及最小包围框计算,生成路面的曲面信息,包括:
5.根据权利要求1所述的方法,其特征在于,所述根据第一距离阈值和/或第二距离阈值对所述网格对应的第二雷达点云进行聚类,获得至少一个第三雷达点云,包括:
6.根据权利要求1-5中任一项所述的方法,其特征在于,在通过对每个所述第三雷达点云进行曲面拟合以及最小包围框计算,生成路面的曲面信息之后,所述方法还包括:
7.一种基于激光雷达的路面生成装置,其特征在于,所述装置包括:
8.根据权利要求7所述的装置,其特征在于,所述加载单元,包括:<...
【专利技术属性】
技术研发人员:赵旭,罗金辉,
申请(专利权)人:北京初速度科技有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。