CN112630798B - 用于估计地面的方法和装置 - Google Patents
用于估计地面的方法和装置 Download PDFInfo
- Publication number
- CN112630798B CN112630798B CN201910903476.9A CN201910903476A CN112630798B CN 112630798 B CN112630798 B CN 112630798B CN 201910903476 A CN201910903476 A CN 201910903476A CN 112630798 B CN112630798 B CN 112630798B
- Authority
- CN
- China
- Prior art keywords
- ground
- point cloud
- plane
- sub
- estimated
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Abstract
本申请实施例公开了用于估计地面的方法和装置。该方法的一具体实施方式包括:接收激光雷达采集的当前帧点云;获取当前帧点云的前N帧点云,其中,N为正整数;将前N帧点云转换到当前帧点云的坐标系中,得到转换点云;将当前帧点云与转换点云叠加,得到叠加点云;基于叠加点云进行地面估计,得到地面。该实施方式提高了估计出的地面的准确度。
Description
技术领域
本申请实施例涉及计算机技术领域,具体涉及用于估计地面的方法和装置。
背景技术
无人驾驶汽车是一种新型的智能汽车,也称之为“轮式移动机器人”,主要通过传感器(激光雷达、摄像头等)来获取其周边环境数据,并对这些数据进行综合分析运算后,发出指令来分别控制无人驾驶汽车中的不同设备,从而实现汽车的全自动运行,达到汽车无人驾驶的目的。
然而,在激光雷达采集的点云中检测障碍物时,很容易将地面误检为障碍物。为了降低障碍物的误检率,通常会先基于单帧点云估计地面,再从点云中过滤掉属于地面的点云点,最后基于过滤后的点云进行障碍物检测。
发明内容
本申请实施例提出了用于估计地面的方法和装置。
第一方面,本申请实施例提供了一种用于估计地面的方法,包括:接收激光雷达采集的当前帧点云;获取当前帧点云的前N帧点云,其中,N为正整数;将前N帧点云转换到当前帧点云的坐标系中,得到转换点云;将当前帧点云与转换点云叠加,得到叠加点云;基于叠加点云进行地面估计,得到地面。
在一些实施例中,基于叠加点云进行地面估计,得到地面,包括:以高度区间为横坐标,以数目为纵坐标,绘制叠加点云的分布直方图;基于叠加点云中的落入分布直方图的峰值区间的叠加点云点拟合地面。
在一些实施例中,基于叠加点云进行地面估计,得到地面,包括:从叠加点云中选取预估地面点云;将预估地面点云所处的第一立体空间划分为多个第二立体空间;对多个第二立体空间内的预估地面点云点进行地面估计,得到多个地面子平面;基于多个地面子平面生成地面。
在一些实施例中,对多个第二立体空间内的预估地面点云点进行地面估计,得到多个地面子平面,包括:基于多个第二立体空间内的预估地面点云点拟合多个第一平面;对于每个第一平面,执行以下拟合步骤:从该第一平面所处的第二立体空间内选取与该第一平面的距离小于第一距离阈值的预估地面点云点,作为候选地面点云点;利用该候选地面点云点拟合第二平面;确定该第二平面是否稳定;若该第二平面稳定,将该第二平面作为地面子平面。
在一些实施例中,对多个第二立体空间内的预估地面点云点进行地面估计,得到多个地面子平面,还包括:响应于确定该第二平面不稳定,利用该第二平面替换该第一平面,并继续执行拟合步骤。
在一些实施例中,确定该第二平面是否稳定,包括:若拟合步骤的执行次数小于次数阈值,确定该第二立体空间内的预估地面点云点到该第二平面的距离之和是否小于第二距离阈值;若小于第二距离阈值,则确定该第二平面稳定;若不小于第二距离阈值,则确定该第二平面不稳定。
在一些实施例中,基于多个地面子平面生成地面,包括:对于每个地面子平面,计算该地面子平面的角度和该地面子平面相邻的地面子平面的角度的加权平均值;基于该加权平均值调整该地面子平面的角度。
第二方面,本申请实施例提供了一种用于估计地面的装置,包括:接收单元,被配置成接收激光雷达采集的当前帧点云;获取单元,被配置成获取当前帧点云的前N帧点云,其中,N为正整数;转换单元,被配置成将前N帧点云转换到当前帧点云的坐标系中,得到转换点云;叠加单元,被配置成将当前帧点云与转换点云叠加,得到叠加点云;估计单元,被配置成基于叠加点云进行地面估计,得到地面。
在一些实施例中,估计单元包括:绘制子单元,被配置成以高度区间为横坐标,以数目为纵坐标,绘制叠加点云的分布直方图;拟合子单元,被配置成基于叠加点云中的落入分布直方图的峰值区间的叠加点云点拟合地面。
在一些实施例中,估计单元包括:选取子单元,被配置成从叠加点云中选取预估地面点云;划分子单元,被配置成将预估地面点云所处的第一立体空间划分为多个第二立体空间;估计子单元,被配置成对多个第二立体空间内的预估地面点云点进行地面估计,得到多个地面子平面;生成子单元,被配置成基于多个地面子平面生成地面。
在一些实施例中,估计子单元包括:第一拟合模块,被配置成基于多个第二立体空间内的预估地面点云点拟合多个第一平面;第二拟合模块,被配置成对于每个第一平面,执行以下拟合步骤:从该第一平面所处的第二立体空间内选取与该第一平面的距离小于第一距离阈值的预估地面点云点,作为候选地面点云点;利用该候选地面点云点拟合第二平面;确定该第二平面是否稳定;若该第二平面稳定,将该第二平面作为地面子平面。
在一些实施例中,估计子单元还包括:替换模块,被配置成响应于确定该第二平面不稳定,利用该第二平面替换该第一平面,并继续执行拟合步骤。
在一些实施例中,第二拟合子单元进一步被配置成:若拟合步骤的执行次数小于次数阈值,确定该第二立体空间内的预估地面点云点到该第二平面的距离之和是否小于第二距离阈值;若小于第二距离阈值,则确定该第二平面稳定;若不小于第二距离阈值,则确定该第二平面不稳定。
在一些实施例中,生成子单元进一步被配置成:对于每个地面子平面,计算该地面子平面的角度和该地面子平面相邻的地面子平面的角度的加权平均值;基于该加权平均值调整该地面子平面的角度。
第三方面,本申请实施例提供了一种电子设备,该电子设备包括:一个或多个处理器;存储装置,其上存储有一个或多个程序;当一个或多个程序被一个或多个处理器执行,使得一个或多个处理器实现如第一方面中任一实现方式描述的方法。
第四方面,本申请实施例提供了一种计算机可读介质,其上存储有计算机程序,该计算机程序被处理器执行时实现如第一方面中任一实现方式描述的方法。
本申请实施例提供的用于估计地面的方法和装置,首先在接收到激光雷达采集的当前帧点云的情况下,获取当前帧点云的前N帧点云;之后将前N帧点云转换到当前帧点云的坐标系中,得到转换点云;然后将当前帧点云与转换点云叠加,得到叠加点云;最后基于叠加点云进行地面估计,得到地面。通过坐标转换和点云叠加使点云更加密集,消除了单帧点云的噪声,提高了估计出的地面的准确度。
附图说明
通过阅读参照以下附图所作的对非限制性实施例所作的详细描述,本申请的其它特征、目的和优点将会变得更明显:
图1是本申请可以应用于其中的示例性系统架构;
图2是根据本申请的用于估计地面的方法的一个实施例的流程图;
图3是根据本申请的用于估计地面的方法的又一个实施例的流程图;
图4是根据本申请的用于估计地面的方法的另一个实施例的流程图;
图5是根据本申请的用于估计地面的装置的一个实施例的结构示意图;
图6是适于用来实现本申请实施例的电子设备的计算机系统的结构示意图。
具体实施方式
下面结合附图和实施例对本申请作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释相关发明,而非对该发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与有关发明相关的部分。
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本申请。
图1示出了可以应用本申请的用于估计地面的方法或用于估计地面的装置的实施例的示例性系统架构100。
如图1所示,系统架构100中可以包括无人驾驶汽车101。无人驾驶汽车101上可以安装有激光雷达1011、1012、1013,网络1014和驾驶控制设备1015。网络1014用以在激光雷达1011、1012、1013和驾驶控制设备1015之间提供通信链路的介质。网络1014可以包括各种连接类型,例如有线、无线通信链路或者光纤电缆等等。
激光雷达1011、1012、1013可以通过网络1014与驾驶控制设备1015交互,以接收或发送消息等。
激光雷达1011、1012、1013可以是以发射激光束探测目标的位置、速度等特征量的雷达系统。具体地,当激光雷达1011、1012、1013发射的激光束照射到目标表面时,所反射的激光会携带方位、距离等信息。若激光雷达1011、1012、1013发射的激光束按照某种轨迹进行扫描,便会边扫描边记录到反射的激光点信息,由于扫描极为精细,则能够得到大量的激光点,因而就可形成点云。
驾驶控制设备1015,又称为车载大脑,负责无人驾驶汽车101的智能控制。驾驶控制设备1015可以是单独设置的控制器,例如可编程逻辑控制器、单片机、工业控制机等;也可以是由其他具有输入/输出端口,并具有运算控制功能的电子器件组成的设备;还可以是安装有车辆驾驶控制类应用的计算机设备。
需要说明的是,本申请实施例所提供的用于估计地面的方法一般由驾驶控制设备1015执行,相应地,用于估计地面的装置一般设置于驾驶控制设备1015中。
应该理解,图1中的驾驶控制设备、网络和激光雷达的数目仅仅是示意性的。根据实现需要,可以具有任意数目的驾驶控制设备、网络和激光雷达。
继续参考图2,其示出了根据本申请的用于估计地面的方法的一个实施例的流程200。该用于估计地面的方法包括以下步骤:
步骤201,接收激光雷达采集的当前帧点云。
在本实施例中,用于估计地面的方法的执行主体(例如图1所示的驾驶控制设备1015)可以接收激光雷达(例如图1所示的激光雷达1011、1012、1013)采集的当前帧点云。
实践中,激光雷达可以安装在无人驾驶汽车(例如图1所示的无人驾驶汽车101)的车顶,用于采集无人驾驶汽车周围的物体的点云。当采集到每帧点云时,激光雷达会将采集到的该帧点云实时发送至上述执行主体。其中,激光雷达采集的点云可以由大量点云点(激光点)组成,每个点云点可以包括三维坐标和激光反射强度。这里,通常会预先选定坐标系,而激光雷达采集的点云中的点云点的三维坐标均是在预先选定的坐标系中的坐标。预先选定坐标系可以随着无人驾驶汽车的运动而运动,例如车辆坐标系、IMU(Inertialmeasurement unit,惯性测量单元)坐标系等。因此,在无人驾驶汽车的运动过程中,激光雷达采集的每帧点云的坐标系均不相同。
步骤202,获取当前帧点云的前N帧点云。
在本实施例中,上述执行主体可以获取当前帧点云的前N帧点云。其中,N为正整数。在实际应用中,N通常不超过2。
对于N等于2的情况,当上述执行主体接收到前两帧点云时,通常会对前两帧点云进行保存。从接收到第三帧及之后的每一帧点云开始,上述执行主体可以获取其之前的两帧点云并执行后续步骤。
步骤203,将前N帧点云转换到当前帧点云的坐标系中,得到转换点云。
在本实施例中,上述执行主体可以将前N帧点云转换到当前帧点云的坐标系中,以得到转换点云。
通常,对于前N帧点云中的每一帧点云,该帧点云的坐标系中的点与当前帧点云的坐标系中的点之间存在一一对应的关系。由于该帧点云的坐标系和当前帧点云的坐标系是同类型的坐标系,因此上述执行主体可以通过坐标轴的平移和旋转,实现该帧点云的每个点云点在该帧点云的坐标系中的坐标,到当前帧点云的坐标系中的坐标的转换。
步骤204,将当前帧点云与转换点云叠加,得到叠加点云。
在本实施例中,上述执行主体可以将当前帧点云与转换点云叠加,以得到叠加点云。
实践中,不管点云是多少线束的激光雷达采集的,由于线束之间存在一定的距离,都会导致点云中的点云点存在稀疏性。例如,对于安装在距离地面0.7米高的16线激光雷达,其相邻线束照射到地面上的点云点之间的距离是0.4米。这里,将转换点云叠加到当前帧点云中,转换点云的点云点会均匀插入到当前帧点云中,以使得到的叠加点云更加密集。
步骤205,基于叠加点云进行地面估计,得到地面。
在本实施例中,上述执行主体可以基于叠加点云进行地面估计,以得到地面。由于叠加点云更加密集,消除了单帧点云的噪声,提高了估计出的地面的准确度
在本实施例的一些可选的实现方式中,上述执行主体可以首先以高度区间为横坐标,以数目为纵坐标,绘制叠加点云的分布直方图;然后基于叠加点云中的落入分布直方图的峰值区间的叠加点云点拟合地面。其中,叠加点云中的叠加点云点的高度可以等于该叠加点云点的三维坐标中的Z坐标的值。这里,上述执行主体可以将高度划分为多个细粒度区间,例如,高度区间可以包括0-0.1米、0.1-0.2米、0.2-0.3米等等。随后,上述执行主体可以统计落入到每个高度区间的叠加点云点的数目,并绘制出叠加点云的分布直方图。最后,上述执行主体可以确定分布直方图的峰值区间,并利用落入峰值区间的至少部分叠加点云点拟合出平面作为地面。通常,落入分布直方图的峰值区间的叠加点云点的数目明显高于落入其相邻区间的叠加点云点的数目。需要说明的是,分布直方图可以同时存在多个峰值区间。通常,峰值区间的数目与叠加的点云的帧数相同。
应当理解的是,激光雷达的线束越多,其采集到的点云越密集。因此,点云叠加通常应用在40线及以下的激光雷达采集的点云中。对于线束足够多的激光雷达,例如128线激光雷达,其采集到的点云已足够密集,将不再进行点云叠加。
本申请实施例提供的用于估计地面的方法,首先在接收到激光雷达采集的当前帧点云的情况下,获取当前帧点云的前N帧点云;之后将前N帧点云转换到当前帧点云的坐标系中,得到转换点云;然后将当前帧点云与转换点云叠加,得到叠加点云;最后基于叠加点云进行地面估计,得到地面。通过坐标转换和点云叠加使点云更加密集,消除了单帧点云的噪声,提高了估计出的地面的准确度。
进一步参考图3,其示出了根据本申请的用于估计地面的方法的又一个实施例的流程300。该用于估计地面的方法包括以下步骤:
步骤301,接收激光雷达采集的当前帧点云。
步骤302,获取当前帧点云的前N帧点云。
步骤303,将前N帧点云转换到当前帧点云的坐标系中,得到转换点云。
步骤304,将当前帧点云与转换点云叠加,得到叠加点云。
在本实施例中,步骤301-304的具体操作已在图2所示的实施例中步骤201-204中进行了详细的介绍,在此不再赘述。
步骤305,从叠加点云中选取预估地面点云。
在本实施例中,用于估计地面的方法的执行主体(例如图1所示的驾驶控制设备1015)可以从叠加点云中选取预估地面点云。
通常,预估地面点云可以是叠加点云的至少部分,由叠加点云中的属于地面的概率较高的叠加点云点组成。
在本实施例的一些可选的实现方式中,无人驾驶汽车上安装的激光雷达发射的激光束大都会照射到地面上。也就是说,叠加点云中会有很大部分叠加点云点属于地面。因此,上述执行主体可以将叠加点云直接作为预估地面点云,以进行后续地面估计。
在本实施例的一些可选的实现方式中,地面不是完全平整的,地面点云点也不是完全在同一个平面上的,因此选取出的预估地面点云也应当是立体的。具体地,上述执行主体可以从叠加点云中选取距离预估地面预设高度范围内的叠加点云点,得到预估地面点云。其中,预估地面可以是预估出的一个接近于地面的平面。例如,预估地面可以是无人驾驶汽车的车轮与地面的四个接触点确定的平面。具体地,上述执行主体可以首先将叠加点云中的位于预估地面上方、且与预估地面的距离不大于第一高度阈值(例如50厘米)的叠加点云点确定为预估地面点云点,同时将位于预估地面下方、且与预估地面的距离不大于第二高度阈值(例如30厘米)的叠加点云点确定为预估地面点云点;然后基于确定出的预估地面点云点形成预估地面点云。应当理解的是,在实际场景下,叠加点云中会有很大部分叠加点云点都位于预估地面的上方,因此,第二高度阈值通常不会大于第一高度阈值。
步骤306,将预估地面点云所处的第一立体空间划分为多个第二立体空间。
在本实施例中,上述执行主体可以将预估地面点云所处的第一立体空间划分为多个第二立体空间。通常,预估地面点云所处的第一立体空间是包围预估地面点云的立方体。这里,将包围预估地面点云的立方体划分为多个小立方体,每个小立方体是一个第二立体空间。
在本实施例的一些可选的实现方式中,上述执行主体可以首先将预估地面划分为多个网格(例如8×8的64个网格);然后基于多个网格对第一立体空间进行分割,得到多个第二立体空间。应当理解的是,上述执行主体仅将预估地面上属于激光雷达的探测范围的区域划分网格,然后利用网格将第一立体空间切分为多个小的立体空间,即,第二立体空间。
步骤307,对多个第二立体空间内的预估地面点云点进行地面估计,得到多个地面子平面。
在本实施例中,对于每个第二立体空间,上述执行主体可以对该第二立体空间内的预估地面点云点进行地面估计,以得到一个地面子平面。具体地,上述执行主体可以选取该第二立体空间内的至少部分预估地面点云点拟合平面,并将拟合出的平面作为地面子平面。
步骤308,基于多个地面子平面生成地面。
在本实施例中,上述执行主体可以基于多个地面子平面生成地面。例如,上述执行主体可以对多个地面子平面中的相邻地面子平面进行连接,以生成地面。
在本实施例的一些可选的实现方式中,上述执行主体可以对多个地面子平面进行平滑,生成地面。可选地,对于每个地面子平面,上述执行主体可以利用该地面子平面相邻的地面子平面对该地面子平面进行平滑。例如,上述执行主体可以首先计算该地面子平面的角度和该地面子平面相邻的地面子平面的角度的加权平均值;然后基于该加权平均值调整该地面子平面的角度。其中,对于每个地面子平面,该地面子平面的角度的权重通常大于该地面子平面相邻的地面子平面的角度的权重。此时,计算出的加权平均值通常小于该地面子平面的角度。这里,利用加权平均值调整该地面子平面的角度,可以使该地面子平面与其相邻的地面子平面之间的钝角夹角更大,即,使该地面子平面与其相邻的地面子平面之间的过渡更加平滑。此外,由于每个地面子平面是局部信息,利用该地面子平面相邻的地面子平面对该地面子平面进行平滑,可以在该地面子平面中增加全局信息,这样,能使得到的地面更加平滑、真实。
在本实施例的一些可选的实现方式中,上述执行主体可以将点云中的地面附近的点云点确定为地面点云点。例如,上述执行主体可以将点云中距离地面小于第三距离阈值(例如10厘米)的点云点确定为地面点云点。其中,第三距离阈值的数值可以与车型、传感器的安装位置等信息相关。随后,上述执行主体可以过滤点云中的地面点云点,并基于过滤后的点云进行障碍物检测。这样,就有效降低了将地面误检为障碍物的概率。
从图3中可以看出,与图2对应的实施例相比,本实施例中的用于估计地面的方法的流程300突出了估计地面的步骤。由此,本实施例描述的方案对预估地面点云进行划分后分别进行地面估计,提高了估计出的地面的真实度。
进一步参考图4,其示出了根据本申请的用于估计地面的方法的另一个实施例的流程400。该用于估计地面的方法包括以下步骤:
步骤401,接收激光雷达采集的当前帧点云。
步骤402,获取当前帧点云的前N帧点云。
步骤403,将前N帧点云转换到当前帧点云的坐标系中,得到转换点云。
步骤404,将当前帧点云与转换点云叠加,得到叠加点云。
步骤405,从叠加点云中选取预估地面点云。
步骤406,将预估地面点云所处的第一立体空间划分为多个第二立体空间。
在本实施例中,步骤401-406的具体操作已在图3所示的实施例中步骤301-306中进行了详细的介绍,在此不再赘述。
步骤407,基于多个第二立体空间内的预估地面点云点拟合多个第一平面。
在本实施例中,对于每个第二立体空间,用于估计地面的方法的执行主体(例如图1所示的驾驶控制设备1015)可以基于该第二立体空间内的预估地面点云点拟合一个第一平面。具体地,上述执行主体可以选取该第二立体空间内的至少部分预估地面点云点拟合一个第一平面。
在本实施例的一些可选的实现方式中,对于每个第二立体空间,上述执行主体可以首先对该第二立体空间内的预估地面点云点进行采样,得到采样地面点云点;然后利用该采样地面点云点拟合第一平面。可选地,上述执行主体可以对该第二立体空间内的预估地面点云点进行随机采样。这里,先采样再拟合,有效降低了拟合平面的计算量。
在本实施例的一些可选的实现方式中,上述执行主体可以首先将该第二立体空间划分为多个第三立体空间;然后对每个第三立体空间内的预估地面点云点进行采样。可选地,上述执行主体可以对每个第三立体空间内的预估地面点云点进行随机采样。这样,先划分小立体空间再对每个小立体空间采样,确保采样到的点云点均匀分布在整个第二立体空间中。
步骤408,对于每个第一平面,从该第一平面所处的第二立体空间内选取与该第一平面的距离小于第一距离阈值的预估地面点云点,作为候选地面点云点。
在本实施例中,对于每个第一平面,上述执行主体可以计算该第一平面所处的第二立体空间内的每个预估地面点云点与该第一平面的距离,并选取与该第一平面的距离小于第一距离阈值的预估地面点云点,作为候选地面点云点。其中,与该第一平面的距离小于第一距离阈值的预估地面点云点可以认为是第一平面上的点云点。与该第一平面的距离不小于第一距离阈值的预估地面点云点可以认为不是第一平面上的点云点。
步骤409,利用该候选地面点云点拟合第二平面。
在本实施例中,上述执行主体可以利用从该第一平面所处的第二立体空间内选取出的候选地面点云点拟合第二平面。
步骤410,确定该第二平面是否稳定。
在本实施例中,上述执行主体可以确定该第二平面是否稳定;若该第二平面稳定,执行步骤411;若该第二平面不稳定,执行步骤412。通常,当第二平面满足一定的条件时,确定第二平面稳定。
在本实施例的一些可选的实现方式中,若拟合步骤的执行次数小于次数阈值(例如3次),上述执行主体可以确定该第二立体空间内的预估地面点云点到该第二平面的距离之和是否小于第二距离阈值;若小于第二距离阈值,则确定该第二平面稳定;若不小于第二距离阈值,则确定该第二平面不稳定。此外,若拟合步骤的执行次数不小于次数阈值,或者拟合步骤的执行次数不小于次数阈值,且该第二平面的角度大于角度阈值(例如6度),上述执行主体可以确定该第二立体空间内不存在地面点云点。其中,拟合步骤可以包括步骤408-412。
步骤411,将该第二平面作为地面子平面。
在本实施例中,在该第二平面稳定的情况下,上述执行主体可以将该第二平面作为地面子平面。
步骤412,利用该第二平面替换该第一平面。
在本实施例中,在该第二平面不稳定的情况下,上述执行主体可以利用该第二平面替换该第一平面,并返回继续执行步骤408。
步骤413,基于多个地面子平面生成地面。
在本实施例中,步骤413的具体操作已在图3所示的实施例中步骤308中进行了详细的介绍,在此不再赘述。
从图4中可以看出,与图3对应的实施例相比,本实施例中的用于估计地面的方法的流程400突出了迭代计算平面的步骤。由此,本实施例描述的方案通过多次迭代计算第二平面,使第二平面更加趋近于真实的地面,进一步提高了估计出的地面的真实度。
进一步参考图5,作为对上述各图所示的方法的实现,本申请提供了一种用于估计地面的装置的一个实施例,该装置实施例与图2所示的方法实施例相对应,该装置具体可以应用于各种电子设备中。
如图5所示,本实施例的用于估计地面的装置500可以包括:接收单元501、获取单元502、转换单元503、叠加单元504和估计单元505。其中,接收单元501,被配置成接收激光雷达采集的当前帧点云;获取单元502,被配置成获取当前帧点云的前N帧点云,其中,N为正整数;转换单元503,被配置成将前N帧点云转换到当前帧点云的坐标系中,得到转换点云;叠加单元504,被配置成将当前帧点云与转换点云叠加,得到叠加点云;估计单元505,被配置成基于叠加点云进行地面估计,得到地面。
在本实施例中,用于估计地面的装置500中:接收单元501、获取单元502、转换单元503、叠加单元504和估计单元505的具体处理及其所带来的技术效果可分别参考图2对应实施例中的步骤201-205的相关说明,在此不再赘述。
在本实施例的一些可选的实现方式中,估计单元505包括:绘制子单元(图中未示出),被配置成以高度区间为横坐标,以数目为纵坐标,绘制叠加点云的分布直方图;拟合子单元(图中未示出),被配置成基于叠加点云中的落入分布直方图的峰值区间的叠加点云点拟合地面。
在本实施例的一些可选的实现方式中,估计单元505包括:选取子单元(图中未示出),被配置成从叠加点云中选取预估地面点云;划分子单元(图中未示出),被配置成将预估地面点云所处的第一立体空间划分为多个第二立体空间;估计子单元(图中未示出),被配置成对多个第二立体空间内的预估地面点云点进行地面估计,得到多个地面子平面;生成子单元(图中未示出),被配置成基于多个地面子平面生成地面。
在本实施例的一些可选的实现方式中,估计子单元包括:第一拟合模块(图中未示出),被配置成基于多个第二立体空间内的预估地面点云点拟合多个第一平面;第二拟合模块(图中未示出),被配置成对于每个第一平面,执行以下拟合步骤:从该第一平面所处的第二立体空间内选取与该第一平面的距离小于第一距离阈值的预估地面点云点,作为候选地面点云点;利用该候选地面点云点拟合第二平面;确定该第二平面是否稳定;若该第二平面稳定,将该第二平面作为地面子平面。
在本实施例的一些可选的实现方式中,估计子单元还包括:替换模块(图中未示出),被配置成响应于确定该第二平面不稳定,利用该第二平面替换该第一平面,并继续执行拟合步骤。
在本实施例的一些可选的实现方式中,第二拟合子单元进一步被配置成:若拟合步骤的执行次数小于次数阈值,确定该第二立体空间内的预估地面点云点到该第二平面的距离之和是否小于第二距离阈值;若小于第二距离阈值,则确定该第二平面稳定;若不小于第二距离阈值,则确定该第二平面不稳定。
在本实施例的一些可选的实现方式中,生成子单元进一步被配置成:对于每个地面子平面,计算该地面子平面的角度和该地面子平面相邻的地面子平面的角度的加权平均值;基于该加权平均值调整该地面子平面的角度。
下面参考图6,其示出了适于用来实现本申请实施例的电子设备(例如图1所示的驾驶控制设备1015)的计算机系统600的结构示意图。图6示出的电子设备仅仅是一个示例,不应对本申请实施例的功能和使用范围带来任何限制。
如图6所示,计算机系统600包括中央处理单元(CPU)601,其可以根据存储在只读存储器(ROM)602中的程序或者从存储部分608加载到随机访问存储器(RAM)603中的程序而执行各种适当的动作和处理。在RAM 603中,还存储有系统600操作所需的各种程序和数据。CPU 601、ROM 602以及RAM 603通过总线604彼此相连。输入/输出(I/O)接口605也连接至总线604。
以下部件连接至I/O接口605:包括键盘、鼠标等的输入部分606;包括诸如阴极射线管(CRT)、液晶显示器(LCD)等以及扬声器等的输出部分607;包括硬盘等的存储部分608;以及包括诸如LAN卡、调制解调器等的网络接口卡的通信部分609。通信部分609经由诸如因特网的网络执行通信处理。驱动器610也根据需要连接至I/O接口605。可拆卸介质611,诸如磁盘、光盘、磁光盘、半导体存储器等等,根据需要安装在驱动器610上,以便于从其上读出的计算机程序根据需要被安装入存储部分608。
特别地,根据本公开的实施例,上文参考流程图描述的过程可以被实现为计算机软件程序。例如,本公开的实施例包括一种计算机程序产品,其包括承载在计算机可读介质上的计算机程序,该计算机程序包含用于执行流程图所示的方法的程序代码。在这样的实施例中,该计算机程序可以通过通信部分609从网络上被下载和安装,和/或从可拆卸介质611被安装。在该计算机程序被中央处理单元(CPU)601执行时,执行本申请的方法中限定的上述功能。
需要说明的是,本申请所述的计算机可读介质可以是计算机可读信号介质或者计算机可读存储介质或者是上述两者的任意组合。计算机可读存储介质例如可以是——但不限于——电、磁、光、电磁、红外线、或半导体的系统、装置或器件,或者任意以上的组合。计算机可读存储介质的更具体的例子可以包括但不限于:具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、随机访问存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、光纤、便携式紧凑磁盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。在本申请中,计算机可读存储介质可以是任何包含或存储程序的有形介质,该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。而在本申请中,计算机可读的信号介质可以包括在基带中或者作为载波一部分传播的数据信号,其中承载了计算机可读的程序代码。这种传播的数据信号可以采用多种形式,包括但不限于电磁信号、光信号或上述的任意合适的组合。计算机可读的信号介质还可以是计算机可读存储介质以外的任何计算机可读介质,该计算机可读介质可以发送、传播或者传输用于由指令执行系统、装置或者器件使用或者与其结合使用的程序。计算机可读介质上包含的程序代码可以用任何适当的介质传输,包括但不限于:无线、电线、光缆、RF等等,或者上述的任意合适的组合。
可以以一种或多种程序设计语言或其组合来编写用于执行本申请的操作的计算机程序代码,所述程序设计语言包括面向目标的程序设计语言—诸如Java、Smalltalk、C++,还包括常规的过程式程序设计语言—诸如”C”语言或类似的程序设计语言。程序代码可以完全地在用户计算机上执行、部分地在用户计算机上执行、作为一个独立的软件包执行、部分在用户计算机上部分在远程计算机上执行、或者完全在远程计算机或电子设备上执行。在涉及远程计算机的情形中,远程计算机可以通过任意种类的网络——包括局域网(LAN)或广域网(WAN)—连接到用户计算机,或者,可以连接到外部计算机(例如利用因特网服务提供商来通过因特网连接)。
附图中的流程图和框图,图示了按照本申请各种实施例的系统、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代表一个模块、程序段、或代码的一部分,该模块、程序段、或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意,在有些作为替换的实现中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如,两个接连地表示的方框实际上可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是,框图和/或流程图中的每个方框、以及框图和/或流程图中的方框的组合,可以用执行规定的功能或操作的专用的基于硬件的系统来实现,或者可以用专用硬件与计算机指令的组合来实现。
描述于本申请实施例中所涉及到的单元可以通过软件的方式实现,也可以通过硬件的方式来实现。所描述的单元也可以设置在处理器中,例如,可以描述为:一种处理器包括接收单元、获取单元、转换单元、叠加单元和估计单元。其中,这些单元的名称在种情况下并不构成对该单元本身的限定,例如,接收单元还可以被描述为“接收激光雷达采集的当前帧点云的单元”。
作为另一方面,本申请还提供了一种计算机可读介质,该计算机可读介质可以是上述实施例中描述的电子设备中所包含的;也可以是单独存在,而未装配入该电子设备中。上述计算机可读介质承载有一个或者多个程序,当上述一个或者多个程序被该电子设备执行时,使得该电子设备:接收激光雷达采集的当前帧点云;获取当前帧点云的前N帧点云,其中,N为正整数;将前N帧点云转换到当前帧点云的坐标系中,得到转换点云;将当前帧点云与转换点云叠加,得到叠加点云;基于叠加点云进行地面估计,得到地面。
以上描述仅为本申请的较佳实施例以及对所运用技术原理的说明。本领域技术人员应当理解,本申请中所涉及的发明范围,并不限于上述技术特征的特定组合而成的技术方案,同时也应涵盖在不脱离上述发明构思的情况下,由上述技术特征或其等同特征进行任意组合而形成的其它技术方案。例如上述特征与本申请中公开的(但不限于)具有类似功能的技术特征进行互相替换而形成的技术方案。
Claims (8)
1.一种用于估计地面的方法,包括:
接收激光雷达采集的当前帧点云;
获取所述当前帧点云的前N帧点云,其中,N为正整数;
将所述前N帧点云转换到所述当前帧点云的坐标系中,得到转换点云;
将所述当前帧点云与所述转换点云叠加,得到叠加点云;
基于所述叠加点云进行地面估计,得到地面;
其中,所述基于所述叠加点云进行地面估计,得到地面,包括:
从所述叠加点云中选取预估地面点云;
将所述预估地面点云所处的第一立体空间划分为多个第二立体空间;
对所述多个第二立体空间内的预估地面点云点进行地面估计,得到多个地面子平面;
基于所述多个地面子平面生成地面;
其中,所述对所述多个第二立体空间内的预估地面点云点进行地面估计,得到多个地面子平面,包括:
基于所述多个第二立体空间内的预估地面点云点拟合多个第一平面;
对于每个第一平面,执行以下拟合步骤:从该第一平面所处的第二立体空间内选取与该第一平面的距离小于第一距离阈值的预估地面点云点,作为候选地面点云点;利用该候选地面点云点拟合第二平面;确定该第二平面是否稳定;若该第二平面稳定,将该第二平面作为地面子平面。
2.根据权利要求1所述的方法,其中,所述基于所述叠加点云进行地面估计,得到地面,包括:
以高度区间为横坐标,以数目为纵坐标,绘制所述叠加点云的分布直方图;
基于所述叠加点云中的落入所述分布直方图的峰值区间的叠加点云点拟合地面。
3.根据权利要求1所述的方法,其中,所述对所述多个第二立体空间内的预估地面点云点进行地面估计,得到多个地面子平面,还包括:
响应于确定该第二平面不稳定,利用该第二平面替换该第一平面,并继续执行所述拟合步骤。
4.根据权利要求1或3所述的方法,其中,所述确定该第二平面是否稳定,包括:
若所述拟合步骤的执行次数小于次数阈值,确定该第二立体空间内的预估地面点云点到该第二平面的距离之和是否小于第二距离阈值;
若小于所述第二距离阈值,则确定该第二平面稳定;
若不小于所述第二距离阈值,则确定该第二平面不稳定。
5.根据权利要求1或3所述的方法,其中,所述基于所述多个地面子平面生成地面,包括:
对于每个地面子平面,计算该地面子平面的角度和该地面子平面相邻的地面子平面的角度的加权平均值;
基于该加权平均值调整该地面子平面的角度。
6.一种用于估计地面的装置,包括:
接收单元,被配置成接收激光雷达采集的当前帧点云;
获取单元,被配置成获取所述当前帧点云的前N帧点云,其中,N为正整数;
转换单元,被配置成将所述前N帧点云转换到所述当前帧点云的坐标系中,得到转换点云;
叠加单元,被配置成将所述当前帧点云与所述转换点云叠加,得到叠加点云;
估计单元,被配置成基于所述叠加点云进行地面估计,得到地面;
其中,所述估计单元包括:
选取子单元,被配置成从所述叠加点云中选取预估地面点云;
划分子单元,被配置成将所述预估地面点云所处的第一立体空间划分为多个第二立体空间;
估计子单元,被配置成对所述多个第二立体空间内的预估地面点云点进行地面估计,得到多个地面子平面;
生成子单元,被配置成基于所述多个地面子平面生成地面;
其中,所述估计子单元包括:
第一拟合模块,被配置成基于所述多个第二立体空间内的预估地面点云点拟合多个第一平面;
第二拟合模块,被配置成对于每个第一平面,执行以下拟合步骤:从该第一平面所处的第二立体空间内选取与该第一平面的距离小于第一距离阈值的预估地面点云点,作为候选地面点云点;利用该候选地面点云点拟合第二平面;确定该第二平面是否稳定;若该第二平面稳定,将该第二平面作为地面子平面。
7.一种电子设备,包括:
一个或多个处理器;
存储装置,其上存储有一个或多个程序,
当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实现如权利要求1-5中任一所述的方法。
8.一种计算机可读介质,其上存储有计算机程序,其中,所述计算机程序被处理器执行时实现如权利要求1-5中任一所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910903476.9A CN112630798B (zh) | 2019-09-24 | 2019-09-24 | 用于估计地面的方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910903476.9A CN112630798B (zh) | 2019-09-24 | 2019-09-24 | 用于估计地面的方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112630798A CN112630798A (zh) | 2021-04-09 |
CN112630798B true CN112630798B (zh) | 2022-11-29 |
Family
ID=75282627
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910903476.9A Active CN112630798B (zh) | 2019-09-24 | 2019-09-24 | 用于估计地面的方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112630798B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116309199A (zh) * | 2021-12-03 | 2023-06-23 | 咪咕文化科技有限公司 | 一种点云处理方法、装置及电子设备 |
CN115375713B (zh) * | 2022-10-25 | 2023-03-24 | 杭州华橙软件技术有限公司 | 地面点云的分割方法、装置及计算机可读存储介质 |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1928921A (zh) * | 2006-09-22 | 2007-03-14 | 东南大学 | 三维扫描系统中特征点云带的自动搜索方法 |
JP2015125685A (ja) * | 2013-12-27 | 2015-07-06 | Kddi株式会社 | 空間構造推定装置、空間構造推定方法及び空間構造推定プログラム |
CN105335993A (zh) * | 2014-08-01 | 2016-02-17 | 联想(北京)有限公司 | 一种信息处理方法及电子设备 |
CN105608421A (zh) * | 2015-12-18 | 2016-05-25 | 中国科学院深圳先进技术研究院 | 一种人体动作的识别方法及装置 |
CN107167815A (zh) * | 2017-04-28 | 2017-09-15 | 上海华测导航技术股份有限公司 | 一种公路公路地面线数据的自动生成系统及方法 |
CN107798702A (zh) * | 2016-08-30 | 2018-03-13 | 成都理想境界科技有限公司 | 一种用于增强现实的实时图像叠加方法以及装置 |
CN107798721A (zh) * | 2016-08-31 | 2018-03-13 | 北京四维图新科技股份有限公司 | 一种点云数据的处理方法及装置和点云渲染方法及装置 |
CN108152831A (zh) * | 2017-12-06 | 2018-06-12 | 中国农业大学 | 一种激光雷达障碍物识别方法及系统 |
CN108647646A (zh) * | 2018-05-11 | 2018-10-12 | 北京理工大学 | 基于低线束雷达的低矮障碍物的优化检测方法及装置 |
CN109752701A (zh) * | 2019-01-18 | 2019-05-14 | 中南大学 | 一种基于激光点云的道路边沿检测方法 |
CN109870706A (zh) * | 2019-01-31 | 2019-06-11 | 深兰科技(上海)有限公司 | 一种路面标识的检测方法、装置、设备及介质 |
CN109919237A (zh) * | 2019-03-13 | 2019-06-21 | 武汉海达数云技术有限公司 | 点云处理方法及装置 |
CN110044371A (zh) * | 2018-01-16 | 2019-07-23 | 华为技术有限公司 | 一种车辆定位的方法以及车辆定位装置 |
CN110221603A (zh) * | 2019-05-13 | 2019-09-10 | 浙江大学 | 一种基于激光雷达多帧点云融合的远距离障碍物检测方法 |
-
2019
- 2019-09-24 CN CN201910903476.9A patent/CN112630798B/zh active Active
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1928921A (zh) * | 2006-09-22 | 2007-03-14 | 东南大学 | 三维扫描系统中特征点云带的自动搜索方法 |
JP2015125685A (ja) * | 2013-12-27 | 2015-07-06 | Kddi株式会社 | 空間構造推定装置、空間構造推定方法及び空間構造推定プログラム |
CN105335993A (zh) * | 2014-08-01 | 2016-02-17 | 联想(北京)有限公司 | 一种信息处理方法及电子设备 |
CN105608421A (zh) * | 2015-12-18 | 2016-05-25 | 中国科学院深圳先进技术研究院 | 一种人体动作的识别方法及装置 |
CN107798702A (zh) * | 2016-08-30 | 2018-03-13 | 成都理想境界科技有限公司 | 一种用于增强现实的实时图像叠加方法以及装置 |
CN107798721A (zh) * | 2016-08-31 | 2018-03-13 | 北京四维图新科技股份有限公司 | 一种点云数据的处理方法及装置和点云渲染方法及装置 |
CN107167815A (zh) * | 2017-04-28 | 2017-09-15 | 上海华测导航技术股份有限公司 | 一种公路公路地面线数据的自动生成系统及方法 |
CN108152831A (zh) * | 2017-12-06 | 2018-06-12 | 中国农业大学 | 一种激光雷达障碍物识别方法及系统 |
CN110044371A (zh) * | 2018-01-16 | 2019-07-23 | 华为技术有限公司 | 一种车辆定位的方法以及车辆定位装置 |
CN108647646A (zh) * | 2018-05-11 | 2018-10-12 | 北京理工大学 | 基于低线束雷达的低矮障碍物的优化检测方法及装置 |
CN109752701A (zh) * | 2019-01-18 | 2019-05-14 | 中南大学 | 一种基于激光点云的道路边沿检测方法 |
CN109870706A (zh) * | 2019-01-31 | 2019-06-11 | 深兰科技(上海)有限公司 | 一种路面标识的检测方法、装置、设备及介质 |
CN109919237A (zh) * | 2019-03-13 | 2019-06-21 | 武汉海达数云技术有限公司 | 点云处理方法及装置 |
CN110221603A (zh) * | 2019-05-13 | 2019-09-10 | 浙江大学 | 一种基于激光雷达多帧点云融合的远距离障碍物检测方法 |
Non-Patent Citations (1)
Title |
---|
基于车载激光点云数据的典型地物分类与提取;唐云龙;《中国优秀硕士学位论文全文数据库 基础科学辑》;20160315;第30-31页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112630798A (zh) | 2021-04-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110687549B (zh) | 障碍物检测方法和装置 | |
US11328429B2 (en) | Method and apparatus for detecting ground point cloud points | |
CN109521756B (zh) | 用于无人驾驶车辆的障碍物运动信息生成方法和装置 | |
CN108319655B (zh) | 用于生成栅格地图的方法和装置 | |
CN109146976B (zh) | 用于定位无人车的方法和装置 | |
CN109407073B (zh) | 反射值地图构建方法和装置 | |
EP3624055B1 (en) | Ground detection method, apparatus, electronic device, vehicle and storage medium | |
CN111461981B (zh) | 点云拼接算法的误差估计方法和装置 | |
CN110889808A (zh) | 一种定位的方法、装置、设备及存储介质 | |
CN113607185B (zh) | 车道线信息显示方法、装置、电子设备和计算机可读介质 | |
CN111353453B (zh) | 用于车辆的障碍物检测方法和装置 | |
CN112630798B (zh) | 用于估计地面的方法和装置 | |
CN112622923B (zh) | 用于控制车辆的方法和装置 | |
CN115406457A (zh) | 一种可行驶区域检测方法、系统、设备及存储介质 | |
CN115755097A (zh) | 天气情况检测方法、装置、设备及存储介质 | |
CN112558035B (zh) | 用于估计地面的方法和装置 | |
CN113177980B (zh) | 用于自动驾驶的目标对象速度确定方法、装置及电子设备 | |
CN111461980B (zh) | 点云拼接算法的性能估计方法和装置 | |
Muckenhuber et al. | Sensors for automated driving | |
CN109827610B (zh) | 用于校验传感器融合结果的方法和装置 | |
CN112630749B (zh) | 用于输出提示信息的方法和装置 | |
CN111376249B (zh) | 移动设备定位系统、方法、装置及移动设备 | |
CN112560548B (zh) | 用于输出信息的方法和装置 | |
CN115019167B (zh) | 基于移动终端的融合定位方法、系统、设备及存储介质 | |
US20230025579A1 (en) | High-definition mapping |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |