激光雷达标定方法、装置、设备和存储介质与流程

文档序号:17945004发布日期:2019-06-18 23:30阅读:527来源:国知局
激光雷达标定方法、装置、设备和存储介质与流程

本发明涉及计算机技术领域,特别是涉及了一种激光雷达标定方法、装置、设备和存储介质。



背景技术:

随着无人驾驶技术的发展,常常采用车载传感器来获取车辆周围的位置信息,进而根据传感器检测到的信息,对自动驾驶的车辆进行规划、决策或者控制。

通常,车载传感器会使用多个传感器来获取车辆周围的位置信息。但是多个传感器之间的相对位姿(包括相对位置和朝向)之间存在一定的差异,需要通过将多个传感器的相对位姿进行标定,使得多个传感器采集到的车辆周围的位置信息统一到同一个坐标系下,进而根据在同一个坐标系下位置信息,对车辆自动驾驶进行规划、决策或者控制。上述标定的过程指的是获得多个传感器之间的相对位置的过程。现有的激光雷达标定方法通常用手工物理测量获得激光雷达与其他传感器的相对位置,根据该相对位置进行标记匹配,来实现激光雷达与其他传感器之间的相对位姿。

采用上述方法,通过手工物理测量对激光雷达进行标定,特别是针对大批量激光雷达的标定,其标定效率低。



技术实现要素:

基于此,有必要针对激光雷达标定效率低的问题,提供一种激光雷达标定方法、装置、设备和存储介质。

第一方面,一种激光雷达标定方法,所述方法包括:

在预设的标定场景内,获取待标定激光雷达的点云数据及惯性导航系统数据;所述标定场景中具有目标参照物;

获取所述标定场景对应的地图数据;

根据所述待标定激光雷达的点云数据、所述惯性导航系统数据和所述地图数据,通过标定算法获取所述激光雷达和所述惯性导航系统的位置转换关系;所述标定算法用于将所述点云数据和所述地图数据进行坐标系匹配后,将匹配结果与惯性导航系统数据转换为相同坐标系下的数据;

根据所述位置转换关系,确定激光雷达的标定结果。

在其中一个实施例中,所述在预设的标定场景内,获取待标定激光雷达的点云数据及惯性导航系统数据,包括:

根据数据采集规则,在预设的标定场景内,分别获取待标定激光雷达的多帧点云数据以及惯性导航系统的多帧惯性导航系统数据。

在其中一个实施例中,所述根据所述待标定激光雷达的点云数据、所述惯性导航系统数据和所述地图数据,通过标定算法获取所述激光雷达和所述惯性导航系统的位置转换关系,包括:

将所述多帧点云数据匹配至所述地图数据对应的坐标系下,获得多帧地图点云数据;

将所述多帧地图点云数据转换为所述多帧惯性导航系统数据对应的坐标系下的点云数据,获取所述激光雷达和所述惯性导航系统的位置转换关系。

在其中一个实施例中,所述将所述多帧点云数据匹配至所述地图数据对应的坐标系下,获得多帧地图点云数据,包括:

通过点云算法将所述点云数据匹配至所述地图数据对应的坐标系下,获得地图点云数据;所述点云算法包括icp算法,和/或,ndt算法。

在其中一个实施例中,所述将所述多帧地图点云数据转换为所述多帧惯性导航系统数据对应的坐标系下的点云数据,获取所述激光雷达和所述惯性导航系统的位置转换关系,包括:

根据所述多帧惯性导航数据以及所述多帧地图点云数据列举多个相对位姿方程;其中,一帧地图点云数据与同一帧内的惯性导航系统数据构成一组数据,每组数据对应一个相对位姿方程;

根据每个相对位姿方程以及所述相对位姿方程对应的一组数据,计算所述相对位姿方程中的位置转换参数,以得到多个位置转换参数;

根据多个位置转换参数以及多个相对位姿方程确定所述位置转换关系。

在其中一个实施例中,所述根据多个位置转换参数以及多个相对位姿方程确定所述位置转换关系,包括:

将多个相对位姿方程采用最小二乘法进行累加,获得目标相对位姿方程;

通过枚举算法对多个相对位置转换参数进行归纳,获得获取目标位置转换参数;

将目标位置转换参数代入所述目标相对位姿方程,获得所述位置转换关系。

在其中一个实施例中,所述根据所述位置转换关系,确定激光雷达的标定结果,包括:

将所述位置转换关系确定为所述激光雷达的标定结果;

或者,

将所述位置转换关系进行可视化,并将可视化后的结果确定为所述激光雷达的标定结果。

在其中一个实施例中,所述目标参照物为使得所述激光雷达和惯性导航系统的信号通过所述目标参照物后,反射信号强度大于预设阈值的参照物。

在其中一个实施例中,所述预设的标定场景为根据所述激光雷达、所述惯性导航系统的类型和所述目标参照物的类型确定的场景。

第二方面,一种激光雷达标定装置,所述装置包括:

第一获取模块,用于在预设的标定场景内,获取待标定激光雷达的点云数据及惯性导航系统数据;所述标定场景中具有目标参照物;

第二获取模块,用于获取所述标定场景对应的地图数据;

转换模块,用于根据所述待标定激光雷达的点云数据、所述惯性导航系统数据和所述地图数据,通过第一标定算法获取所述激光雷达和所述惯性导航系统的位置转换关系;所述第一标定算法用于将所述点云数据和所述地图数据进行坐标系匹配后,将匹配结果与惯性导航系统数据转换为相同坐标系下的数据;

标定模块,用于根据所述位置转换关系,确定激光雷达的标定结果。

第三方面,一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行上述激光雷达标定方法所述的方法步骤。

第四方面,一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现上述激光雷达标定方法所述的方法步骤。

上述激光雷达标定方法、装置、设备和存储介质,终端在预设的标定场景内,获取待标定激光雷达的点云数据及惯性导航系统数据,其中标定场景中具有目标参照物;并获取标定场景对应的地图数据;进而根据待标定激光雷达的点云数据、惯性导航系统数据和地图数据,通过标定算法获取激光雷达和惯性导航系统的位置转换关系,上述标定算法用于将点云数据和地图数据进行坐标系匹配后,将匹配结果与惯性导航系统数据转换为相同坐标系下的数据;进而根据位置转换关系,确定激光雷达的标定结果。本申请中,终端根据待标定激光雷达的点云数据、惯性导航系统数据和地图数据,通过标定算法自动获取激光雷达和惯性导航系统的位置转换关系,进而根据位置转换关系自动确定激光雷达的标定结果,避免了手工测量获得激光雷达的标定结果的过程,进而提高了激光雷达的标定效率。

附图说明

图1为一个实施例提供的激光雷达标定应用环境的示意图;

图2为一个实施例中激光雷达标定方法的流程示意图;

图3为另一个实施例中激光雷达标定方法的流程示意图;

图4为另一个实施例中激光雷达标定方法的流程示意图;

图5为另一个实施例中激光雷达标定方法的流程示意图;

图6为另一个实施例中激光雷达标定方法的流程示意图;

图7为一个实施例提供的激光雷达标定装置的结构示意图;

图8为另一个实施例提供的激光雷达标定装置的结构示意图;

图9为另一个实施例提供的激光雷达标定装置的结构示意图;

图10为一个实施例提供的计算结设备的内部结构图。

具体实施方式

随着无人驾驶技术的发展,常常采用车载传感器来获取车辆周围的位置信息,进而根据传感器检测到的信息,对自动驾驶车辆进行规划、决策或者控制。通常,车载传感器会使用多个传感器来获取车辆周围的位置信息。但是多个传感器之间的相对位姿(包括相对位置和朝向)之间存在一定的差异,需要通过将多个传感器的相对位姿进行标定,使得多个传感器采集到的车辆周围的位置信息统一到同一个坐标系下,进而根据在同一个坐标系下位置信息,对自动驾驶的车辆进行规划、决策或者控制。上述标定的过程指的是获得多个传感器之间的相对位置的过程。本申请提供的激光雷达标定方法、装置、设备和存储介质,旨在解决标定效率低的问题。

需要说明的是,本申请实施例提供的激光雷达标定的方法,不仅可以应用于无人驾驶的场景中,还可以应用于机器人导航的场景中,本申请实施例对具体的应用场景不做限制。

本实施例提供的激光雷达标定方法,可以适用于如图1所示的应用环境中。如图1所示,激光雷达10和惯性导航系统20可以安装在车辆的任意位置,通过标定算法通过获取激光雷达10与惯性导航系统20之间的相对位置信息,来确定激光雷达的标定结果。

需要说明的是,本申请实施例提供的激光雷达标定方法,其执行主体可以是激光雷达标定的装置,该装置可以通过软件、硬件或者软硬件结合的方式实现成为激光雷达标定的计算机设备的部分或者全部。

为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。

图2为一个实施例中激光雷达标定方法的流程示意图。本实施例涉及的是通过标定算法自动获取激光雷达与惯性导航系统的位置转换关系,进而根据该位置转换关系自动确定激光雷达的标定结果的具体过程。如图2所示,该方法包括以下步骤:

s101、在预设的标定场景内,获取待标定激光雷达的点云数据及惯性导航系统数据;标定场景中具有目标参照物。

具体地,目标参照物可以是使激光雷达形成良好点云成像特性的参照物,目标参照物可以是一个参照物,也可以是多个参照物,本申请实施例对此不做限制。例如,目标参照物可以是一条平直、连续的墙壁或路牙。预设的标定场景可以是包含目标参照物,又能使得惯性导航系统正常定位的场景,其可以是路边带有连续、平直墙面的室外十字路口;路边带有连续、平直墙面的l形路线;路边有整齐建筑的室外十字路口;路边有整齐建筑的l形路线;路边有符合要求典型目标的非垂直路口或l形路线;路边有符合要求典型目标的停车场或空地中的任一种,或是多种场景形成的组合场景。例如,预设的标定场景可以包括是一条平直、连续的路牙,且惯性导航系统能正常的连接全球定位系统(globalpositioningsystem,gps),使得惯性导航系统能够正常定位的场景。点云数据可以是激光雷达信号照射到物体表面时,所反射的携带方位、距离等信息的反射信号,点云数据中可以包括多个点的位置信息和与其对应的反射激光雷达信号的强度信息。

在具体的在预设的标定场景中,获取激光雷达的点云数据的过程,可以是通过激光雷达向目标参照物发送雷达信号,获得的点云数据;也可以是通过激光雷达向目标参照物发送激光雷达信号,获得的反射信号后,对该反射信号先进行点云聚类操作,获得空间平均的点云数据,进而对空间平均的点云数据进行降噪处理,获得的点云数据;本申请实施例对此不做限制。

s102、获取标定场景对应的地图数据。

具体地,标定场景对应的地图数据可以是高精地图数据,该地图数据可以包括多个点的位置信息和与其对应的图像信息。在具体获取标定场景对应的地图数据时,可以是通过服务器下载服务器中存储的该标定场景对应的地图数据,也可以是通过摄像头或其他装置实时获取该标定场景对应的地图数据,本申请实施例对此不做限制。

s103、根据待标定激光雷达的点云数据、惯性导航系统数据和地图数据,通过标定算法获取激光雷达和惯性导航系统的位置转换关系;标定算法用于将点云数据和地图数据进行坐标系匹配后,将匹配结果与惯性导航系统数据转换为相同坐标系下的数据。

具体地,标定算法可以用于将点云数据和地图数据进行坐标系匹配后,将匹配结果与惯性导航系统数据转换为相同坐标系下的数据,其可以是将待标定激光雷达的点云数据转换为惯性导航系统数据对应的坐标系下的数据的算法,也可是将惯性导航系统数据转化为待标定的激光雷达的点云数据对应的坐标系下的数据的算法,还可以是将待标定激光雷达的点云数据及惯性导航系统数据转换到第三方坐标系下的数据的算法,本申请实施例对此不做限制。位置转换关系可以是待标定激光雷达对应的坐标系,与惯性导航系统对应的坐标系之间的转换关系。

在上述实施例的基础上,可以通过建立待标定激光雷达的点云数据中的目标参照物的位置信息,和惯性导航系统数据中的目标参照物的位置信息之间的转换关系,确定该位置转换关系。在具体的建立待标定的激光雷达的点云数据中的目标参照物的位置信息,和惯性导航系统数据中的目标参照物的位置信息之间的转换关系时,可以是列举坐标系转换方程,确定位置转换关系;也可以是通过列举多个坐标转换方程,选取目标坐标转换方程,确定位置转换关系;本申请实施例对此不做限制。

s104、根据位置转换关系,确定激光雷达的标定结果。

具体地,激光雷达的标定结果可以是激光雷达与惯性导航系统之间相对位置。上述实施例的基础上,在具体的根据位置转换关系,确定激光雷达的标定结果的过程中,在确定了位置转换关系后,可选地,可以将位置转换关系确定为激光雷达的标定结果;或者,将位置转换关系进行可视化,并将可视化后的结果确定为激光雷达的标定结果;本申请实施例对此不做限制。

上述激光雷达标定方法,终端在预设的标定场景内,获取待标定激光雷达的点云数据及惯性导航系统数据,其中标定场景中具有目标参照物;并获取标定场景对应的地图数据;进而根据待标定激光雷达的点云数据、惯性导航系统数据和地图数据,通过标定算法获取激光雷达和惯性导航系统的位置转换关系,上述标定算法用于将点云数据和地图数据进行坐标系匹配后,将匹配结果与惯性导航系统数据转换为相同坐标系下的数据;进而根据位置转换关系,确定激光雷达的标定结果。本实施例中,终端根据待标定激光雷达的点云数据、惯性导航系统数据和地图数据,通过标定算法自动获取激光雷达和惯性导航系统的位置转换关系,进而根据位置转换关系自动确定激光雷达的标定结果,避免了手工测量获得激光雷达的标定结果的过程,进而提高了激光雷达的标定效率。

可选地,目标参照物为使得激光雷达发射的信号通过目标参照物后,反射信号强度大于预设阈值的参照物。

具体地,目标参照物为使得激光雷达发射的信号通过目标参照物后,反射信号强度大于预设阈值的参照物。预设阈值可以是使得激光雷达发射的信号通过目标参照物后,反射的激光雷达信号的信号强度大于激光雷达能够识别的最小雷达信号强度;预设阈值还可以是当目标参照物为多个参照物时,使得激光雷达通过多个参照物获取的多个反射信号之间不相互干扰的多个参照物的位置设置。

可选地,预设的标定场景为根据激光雷达、惯性导航系统和目标参照物的类型确定的场景。

具体地,预设的标定场景可以是周围环境不对目标参照物造成显著的信号干扰的场景。在预设的标定场景中,激光雷达通过目标参照物反射回的信号获取待标定激光雷达的点云数据。惯性导航系统通过与gps连接,实时获取gps信号中的周围环境的位置信息,即时多个点对应的位置信息。例如,根据激光雷达是通过激光信号获取待标定激光雷达的点云数据,由于角散射器对激光信号具有良好的散射特性,因此激光雷达对应的目标参照物可以是角散射器;惯性导航系统是根据接收gps信号获得惯性导航系统数据的,因此惯性导航系统需要空旷的场地,使得gps信号不受外界环境干扰。进而,可以根据待标定激光雷达、惯性导航系统及目标参照物的类型,确定预设的标定场景为是不对激光雷达通过角散射器返回的信号造成显著的电磁干扰,且使得惯性导航系统能够准确接收gps信号的室外场地。

在上述实施例的基础上,上述s101“在预设的标定场景内,获取待标定激光雷达的点云数据及惯性导航系统数据;标定场景中具有目标参照物”,可以通过数据采集规则来分别获取待标定激光雷达的多帧点云数据以及惯性导航系统的多帧惯性导航系统数据,上述s101“在预设的标定场景内,获取待标定激光雷达的点云数据及惯性导航系统数据;标定场景中具有目标参照物”,一种可能的实现方式包括:根据数据采集规则,在预设的标定场景内,分别获取待标定激光雷达的多帧点云数据以及惯性导航系统的多帧惯性导航系统数据。

具体地,数据采集规则可以是表示通过目标参照物,获取待标定激光雷达的点云数据,其可以静止的获取多帧待标定激光雷达的点云数据,也可以是运动的获取多帧待标定激光雷达的点云数据,本申请实施例对此不做限制。在具体在根据数据采集规则,通过目标参照物分别获取多帧待标定激光雷达的点云数据时,可以是将激光雷达所在的载体,处于停止状态时,获得多帧待标定激光雷达的点云数据;也可以是上述载体在缓慢行驶状态时,获得多帧待标定激光雷达的点云数据;本申请实施例对此不做限制。上述载体可以是自动驾驶车辆、辅助驾驶车辆或机器人,本申请实施例对此不做限制。

图3为另一个实施例中激光雷达标定方法的流程示意图。本实施例涉及的是根据待标定激光雷达的点云数据与地图数据获得地图点云数据,进而根据地图点云数据和惯性导航系统数据得到位置转换关系的具体过程。如图3所示,上述s103“根据待标定激光雷达的点云数据、惯性导航系统数据和地图数据,通过标定算法获取激光雷达和惯性导航系统的位置转换关系”一种可能的实现方式包括以下步骤:

s201、将多帧点云数据匹配至地图数据对应的坐标系下,获得多帧地图点云数据。

具体地,地图点云数据可以是将待标定激光雷达的点云数据投影至地图数据对应的坐标系下获得的点云数据。具体将多帧点云数据匹配至地图数据对应的坐标系下,获得多帧地图点云数据的过程中,可以将每帧待标定激光雷达的点云数据分别匹配至地图数据中,获得多帧地图点云数据;也可以是将在同一时刻获得的多帧待标定激光雷达的点云数据进行累加平均,使得每个位置的信号强度进行累加,并根据该同一时刻下点云数据的帧数,获取平均后的点云数据;同样的,获取多个其他时刻下的平均后的点云数据,进而将多帧平均后的点云数据匹配至地图数据对应的坐标系下,获得多帧地图点云数据。

可选地,通过点云算法将点云数据匹配至地图数据对应的坐标系下,获得地图点云数据;点云算法包括icp算法,和/或,ndt算法。

具体地,迭代最近点(iterativeclosestpoint,icp)算法可以是一种曲面拟合算法,该算法是基于四元数的点集到点集配准方法。从测量点集中确定其对应的就近点的点集后,计算新的就近点的点集。用该方法进行迭代计算,直到残差平方和所构成的目标函数值不变,结束迭代过程。正态分布变换(normaldistributiontransform,ndt)算法可以应用于三维点的统计模型,其可以使用标准最优化技术来确定两个点云之间的最优的匹配,其在配准过程中不利用对应点的特征计算和匹配,其匹配时间短。例如,可以将点云数据集中确定其在地图数据中对应的就近点点集合后,计算新的就近点云数据点集,并对上述过程进行迭代计算,直至残差平方和所构成的目标函数值不变,结束迭代过程,获取地图点云数据。

s202、将多帧地图点云数据转换为多帧惯性导航系统数据对应的坐标系下的点云数据,获取激光雷达和惯性导航系统的位置转换关系。

具体地,在上述实施例的基础上,获取多帧地图点云数据后,可以将同一时刻同一位置获取的地图点云数据转换到对应的惯性导航系统数据对应的坐标系下。在具体的将多帧地图点云数据转换为多帧惯性导航系统数据对应的坐标系下的点云数据,获取激光雷达和惯性导航系统的位置转换关系,可以是通过列举坐标系转换方程,确定位置转换关系;也可以是通过列举多个坐标转换方程,选取目标坐标转换方程,确定位置转换关系;本申请实施例对此不做限制。

上述激光雷达标定方法,终端将多帧点云数据匹配至地图数据对应的坐标系下,获得多帧地图点云数据,并将多帧地图点云数据转换为多帧惯性导航系统数据对应的坐标系下的点云数据,获取激光雷达和惯性导航系统的位置转换关系。本实施例中,终端通过将多帧点云数据匹配至地图数据对应的坐标系下,获得多帧地图点云数据,并将该多帧地图点云数据转换为多帧惯性导航系统数据对应的坐标系下的点云数据,使得终端可以自动获取激光雷达和惯性导航系统的位置转换关系,进而根据该位置转换关系,进而根据位置转换关系确定激光雷达的标定结果,使得获取激光雷达的标定结果是自动获得的,避免了手工测量获得激光雷达的标定结果的过程,进而提高了激光雷达的标定效率。

在上述实施例的基础上,终端可以根据待标定激光雷达的点云数据、惯性导航系统数据和地图数据,通过标定算法获取激光雷达和惯性导航系统的位置转换关系。下面通过图4来详细说明终端如何根据标定算法自动获取位置转换关系的具体过程。上述s202“将多帧地图点云数据转换为多帧惯性导航系统数据对应的坐标系下的点云数据,获取激光雷达和惯性导航系统的位置转换关系”一种可能的实现方式包括以下步骤:

s301、根据多帧惯性导航系统数据以及多帧地图点云数据列举多个相对位姿方程;其中,一帧地图点云数据与同一帧内的惯性导航系统数据构成一组数据,每组数据对应一个相对位姿方程。

具体地,相对位姿方程可以是根据一帧地图点云数据与同一帧内惯性导航系统数据获得坐标转换方程。一帧地图点云数据与同一帧内惯性导航系统数据构成一组数据,该一组数据可以是在同一时刻同一位置获取的一帧地图点云数据和一帧惯性导航系统数据,构成同一帧内的一组数据。在具体的根据多帧惯性导航系统数据以及多帧地图点云数据列举多个相对位姿方程的过程中,每一帧地图点云数据均对应一个惯性导航系统数据。其中地图点云数据与惯性导航系统数据中坐标信息的表达方式不同,可以列举相对位姿方程,将激光雷达数据与其他传感器数据统一为一种表达方式。

s302、根据每个相对位姿方程以及相对位姿方程对应的一组数据,计算相对位姿方程中的位置转换参数,以得到多个位置转换参数。

具体地,每个相对位姿方程对应了一组地图点云数据和惯性导航系统数据,将该组地图点云数据和惯性导航系统数据代入其对应的相对位姿方程,计算得到该相对位姿方程中的位置转换参数。其中地图点云数据包括多帧地图点云数据,惯性导航系统数据包括多帧惯性导航系统数据,多帧地图点云数据分别与其对应的多帧惯性导航系统形成多组数据,分别将多组数据代入其对应的相对位姿方程,通过计算获得多个位置转换参数。

s303、根据多个位置转换参数以及多个相对位姿方程确定位置转换关系。

具体地,在上述实施例的基础上,获得多个位置转换参数后,可以根据多个位置参数以其对应的多个相对位姿方程确定位置转换关系,其可以是先确定一个目标相对位姿方程,再获取目标位置转换参数,进而根据目标相对位置方程和目标位置转换参数确定位置转换关系。

可选地,上述s303“根据多个位置转换参数以及多个相对位姿方程确定位置转换关系”的一种可能实现方法,包括如图5所示实施例中的步骤:

s401、将多个相对位姿方程采用最小二乘法进行累加,获得目标相对位姿方程。

具体地,可以采用最小二乘法的思路,将多个相对位姿方程进行累加,以获得减小相对位方程的误差,其可以通过最小化误差的平方和寻找数据的最佳函数匹配。本实施例中,可以将多个相对位姿方程进行累加,以获得误差最小化的最佳相对位姿方程,即为目标相对位姿方程。

s402、通过枚举算法对多个相对位置转换参数进行归纳,获得获取目标位置转换参数。

具体地,位置转换参数可以包括多个参数,可以通过枚举算法,先确定多个参数中的部分参数,再根据部分参数,对其他参数进行归纳,获得目标位置转换参数。例如,位置转换参数可以包括a,b,c,d,e,f六个参数,首先确定a,b,c三个参数的具体数值,进而根据a,b,c三个参数值,穷举多个d,e,f的数值,选取穷举的多个d,e,f的数值满足预设要求的数值为d,e,f的参数值。进而根据a,b,c,d,e,f六个参数值,确定位置转换参数。

s403、将目标位置转换参数代入所述目标相对位姿方程,获得所述位置转换关系。

上述激光雷达标定方法,终端根据多帧惯性导航系统数据以及多帧地图点云数据列举多个相对位姿方程,并根据每个相对位姿方程以及相对位姿方程对应的一组数据,计算相对位姿方程中的位置转换参数,以得到多个位置转换参数,进而根据多个位置转换参数以及多个相对位姿方程确定位置转换关系。本实施例中,终端通过列举多个相对位姿方程,获得多个位置转换参数,进而根据多个相对位姿方程和多个位置转换参数确定位置转换关系,使得获取激光雷达的标定结果是通过标定算法自动获得的,避免了手工测量获得激光雷达的标定结果的过程,进而提高了标定效率。

图6为另一个实施例中激光雷达标定方法的流程图,如图6所示,在上述实施例的基础上,一种激光雷达标定方法包括:

s501、根据数据采集规则,在预设的标定场景内,分别获取待标定激光雷达的多帧点云数据以及惯性导航系统的多帧惯性导航系统数据。

s502、通过点云算法将点云数据匹配至地图数据对应的坐标系下,获得地图点云数据;点云算法包括icp算法,和/或,ndt算法。

s503、根据多帧惯性导航数据以及多帧地图点云数据列举多个相对位姿方程;其中,一帧地图点云数据与同一帧内的惯性导航系统数据构成一组数据,每组数据对应一个相对位姿方程。

s504、根据每个相对位姿方程以及相对位姿方程对应的一组数据,计算相对位姿方程中的位置转换参数,以得到多个位置转换参数。

s505、将多个相对位姿方程采用最小二乘法进行累加,获得目标相对位姿方程。

s506、通过枚举算法对多个相对位置转换参数进行归纳,获得获取目标位置转换参数。

s507、将目标位置转换参数代入目标相对位姿方程,获得位置转换关系。

本实施例中激光雷达标定方法的技术效果与上述实施例所对应的实施例的技术效果相似,在此不再赘述。

应该理解的是,虽然图2-6的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图2-6中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。

图7为一个实施例提供的激光雷达标定装置的结构示意图。如图7所示,激光雷达标定装置,包括:第一获取模块10、第二获取模块20、转换模块30和标定模块40,其中:

第一获取模块10,用于在预设的标定场景内,获取待标定激光雷达的点云数据及惯性导航系统数据;所述标定场景中具有目标参照物;

第二获取模块20,用于获取所述标定场景对应的地图数据;

转换模块30,用于根据所述待标定激光雷达的点云数据、所述惯性导航系统数据和所述地图数据,通过第一标定算法获取所述激光雷达和所述惯性导航系统的位置转换关系;所述第一标定算法用于将所述点云数据和所述地图数据进行坐标系匹配后,将匹配结果与惯性导航系统数据转换为相同坐标系下的数据;

标定模块40,用于根据所述位置转换关系,确定激光雷达的标定结果。

在一个实施例中,第一获取模块10具体用于根据数据采集规则,在预设的标定场景内,分别获取待标定激光雷达的多帧点云数据以及惯性导航系统的多帧惯性导航系统数据。

本申请实施例提供的激光雷达标定装置,可以执行上述方法实施例,其实现原理和技术效果类似,在此不再赘述。

图8为另一个实施例提供的激光雷达标定装置的结构示意图,在图7所示实施例的基础上,转换模块30包括:匹配单元301和转换单元302,其中:

匹配单元301,用于将所述多帧点云数据匹配至所述地图数据对应的坐标系下,获得多帧地图点云数据;

转换单元302,用于将所述多帧地图点云数据转换为所述多帧惯性导航系统数据对应的坐标系下的点云数据,获取所述激光雷达和所述惯性导航系统的位置转换关系。

在一个实施例中,匹配单元301具体用于通过点云算法将所述点云数据匹配至所述地图数据对应的坐标系下,获得地图点云数据;所述点云算法包括icp算法,和/或,ndt算法。

图9为另一个实施例提供的激光雷达标定装置的结构示意图,在图7或图8所示实施例的基础上,转换单元302,包括:列举子单元3021、转换子单元3022和确定子单元3023,其中:

列举子单元3021,用于根据所述多帧惯性导航数据以及所述多帧地图点云数据列举多个相对位姿方程;其中,一帧地图点云数据与同一帧内的惯性导航系统数据构成一组数据,每组数据对应一个相对位姿方程;

转换子单元3022,用于根据每个相对位姿方程以及所述相对位姿方程对应的一组数据,计算所述相对位姿方程中的位置转换参数,以得到多个位置转换参数;

确定子单元3023,用于根据多个位置转换参数以及多个相对位姿方程确定所述位置转换关系。

在一个实施例中,确定子单元3023具体用于将多个相对位姿方程采用最小二乘法进行累加,获得目标相对位姿方程;通过枚举算法对多个相对位置转换参数进行归纳,获得获取目标位置转换参数;将目标位置转换参数代入所述目标相对位姿方程,获得所述位置转换关系。

在一个实施例中,将所述位置转换关系确定为所述激光雷达的标定结果;或者,将所述位置转换关系进行可视化,并将可视化后的结果确定为所述激光雷达的标定结果。

在一个实施例中,所述目标参照物为使得所述激光雷达发射的信号通过所述目标参照物后,反射信号强度大于预设阈值的参照物。

在一个实施例中,所述预设的标定场景为根据所述激光雷达、所述惯性导航系统的类型和所述目标参照物的类型确定的场景。

本申请实施例提供的激光雷达标定装置,可以执行上述方法实施例,其实现原理和技术效果类似,在此不再赘述。

关于一种激光雷达标定装置的具体限定可以参见上文中对于激光雷达标定方法的限定,在此不再赘述。上述激光雷达标定装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。

在一个实施例中,提供了一种计算机设备,该计算机设备可以是终端,其内部结构图可以如图10所示。该计算机设备包括通过系统总线连接的处理器、存储器、网络接口、显示屏和输入装置。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统和计算机程序。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机设备被处理器执行时以实现一种激光雷达标定方法。该计算机设备的显示屏可以是液晶显示屏或者电子墨水显示屏,该计算机设备的输入装置可以是显示屏上覆盖的触摸层,也可以是计算机设备外壳上设置的按键、轨迹球或触控板,还可以是外接的键盘、触控板或鼠标等。

本领域技术人员可以理解,图10中示出的结构,仅仅是与本公开方案相关的部分结构的框图,并不构成对本公开方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。

在一个实施例中,提供了一种计算机设备,包括存储器和处理器,存储器中存储有计算机程序,该处理器执行计算机程序时实现以下步骤:

在预设的标定场景内,获取待标定激光雷达的点云数据及惯性导航系统数据;所述标定场景中具有目标参照物;

获取所述标定场景对应的地图数据;

根据所述待标定激光雷达的点云数据、所述惯性导航系统数据和所述地图数据,通过标定算法获取所述激光雷达和所述惯性导航系统的位置转换关系;所述标定算法用于将所述点云数据和所述地图数据进行坐标系匹配后,将匹配结果与惯性导航系统数据转换为相同坐标系下的数据;

根据所述位置转换关系,确定激光雷达的标定结果。

在一个实施例中,处理器执行计算机程序时还实现以下步骤:根据数据采集规则,在预设的标定场景内,分别获取待标定激光雷达的多帧点云数据以及惯性导航系统的多帧惯性导航系统数据。

在一个实施例中,处理器执行计算机程序时还实现以下步骤:将所述多帧点云数据匹配至所述地图数据对应的坐标系下,获得多帧地图点云数据;将所述多帧地图点云数据转换为所述多帧惯性导航系统数据对应的坐标系下的点云数据,获取所述激光雷达和所述惯性导航系统的位置转换关系。

在一个实施例中,处理器执行计算机程序时还实现以下步骤:通过点云算法将所述点云数据匹配至所述地图数据对应的坐标系下,获得地图点云数据;所述点云算法包括icp算法,和/或,ndt算法。

在一个实施例中,处理器执行计算机程序时还实现以下步骤:根据所述多帧惯性导航数据以及所述多帧地图点云数据列举多个相对位姿方程;其中,一帧地图点云数据与同一帧内的惯性导航系统数据构成一组数据,每组数据对应一个相对位姿方程;根据每个相对位姿方程以及所述相对位姿方程对应的一组数据,计算所述相对位姿方程中的位置转换参数,以得到多个位置转换参数;根据多个位置转换参数以及多个相对位姿方程确定所述位置转换关系。

在一个实施例中,处理器执行计算机程序时还实现以下步骤:将多个相对位姿方程采用最小二乘法进行累加,获得目标相对位姿方程;通过枚举算法对多个相对位置转换参数进行归纳,获得获取目标位置转换参数;将目标位置转换参数代入所述目标相对位姿方程,获得所述位置转换关系。

在一个实施例中,处理器执行计算机程序时还实现以下步骤:将所述位置转换关系确定为所述激光雷达的标定结果;或者,将所述位置转换关系进行可视化,并将可视化后的结果确定为所述激光雷达的标定结果。

在一个实施例中,所述目标参照物为使得所述激光雷达发射的信号通过所述目标参照物后,反射信号强度大于预设阈值的参照物。

在一个实施例中,所述预设的标定场景为根据所述激光雷达、所述惯性导航系统的类型和所述目标参照物的类型确定的场景。

本实施例提供的计算机设备,其实现原理和技术效果与上述方法实施例类似,在此不再赘述。

在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现以下步骤:

在预设的标定场景内,获取待标定激光雷达的点云数据及惯性导航系统数据;所述标定场景中具有目标参照物;

获取所述标定场景对应的地图数据;

根据所述待标定激光雷达的点云数据、所述惯性导航系统数据和所述地图数据,通过标定算法获取所述激光雷达和所述惯性导航系统的位置转换关系;所述标定算法用于将所述点云数据和所述地图数据进行坐标系匹配后,将匹配结果与惯性导航系统数据转换为相同坐标系下的数据;

根据所述位置转换关系,确定激光雷达的标定结果。

在一个实施例中,计算机程序被处理器执行时还实现以下步骤:根据数据采集规则,在预设的标定场景内,分别获取待标定激光雷达的多帧点云数据以及惯性导航系统的多帧惯性导航系统数据。

在一个实施例中,计算机程序被处理器执行时还实现以下步骤:将所述多帧点云数据匹配至所述地图数据对应的坐标系下,获得多帧地图点云数据;将所述多帧地图点云数据转换为所述多帧惯性导航系统数据对应的坐标系下的点云数据,获取所述激光雷达和所述惯性导航系统的位置转换关系。

在一个实施例中,计算机程序被处理器执行时还实现以下步骤:通过点云算法将所述点云数据匹配至所述地图数据对应的坐标系下,获得地图点云数据;所述点云算法包括icp算法,和/或,ndt算法。

在一个实施例中,计算机程序被处理器执行时还实现以下步骤:根据所述多帧惯性导航数据以及所述多帧地图点云数据列举多个相对位姿方程;其中,一帧地图点云数据与同一帧内的惯性导航系统数据构成一组数据,每组数据对应一个相对位姿方程;根据每个相对位姿方程以及所述相对位姿方程对应的一组数据,计算所述相对位姿方程中的位置转换参数,以得到多个位置转换参数;根据多个位置转换参数以及多个相对位姿方程确定所述位置转换关系。

在一个实施例中,计算机程序被处理器执行时还实现以下步骤:将多个相对位姿方程采用最小二乘法进行累加,获得目标相对位姿方程;通过枚举算法对多个相对位置转换参数进行归纳,获得获取目标位置转换参数;将目标位置转换参数代入所述目标相对位姿方程,获得所述位置转换关系。

在一个实施例中,计算机程序被处理器执行时还实现以下步骤:将所述位置转换关系确定为所述激光雷达的标定结果;或者,将所述位置转换关系进行可视化,并将可视化后的结果确定为所述激光雷达的标定结果。

在一个实施例中,所述目标参照物为使得所述激光雷达发射的信号通过所述目标参照物后,反射信号强度大于预设阈值的参照物。

在一个实施例中,所述预设的标定场景为根据所述激光雷达、所述惯性导航系统的类型和所述目标参照物的类型确定的场景。

本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本公开所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(rom)、可编程rom(prom)、电可编程rom(eprom)、电可擦除可编程rom(eeprom)或闪存。易失性存储器可包括随机存取存储器(ram)或者外部高速缓冲存储器。作为说明而非局限,ram以多种形式可得,诸如静态ram(sram)、动态ram(dram)、同步dram(sdram)、双数据率sdram(ddrsdram)、增强型sdram(esdram)、同步链路(synchlink)dram(sldram)、存储器总线(rambus)直接ram(rdram)、直接存储器总线动态ram(drdram)、以及存储器总线动态ram(rdram)等。

以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。

以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1