点云数据处理方法及其装置、激光雷达、可移动平台与流程

文档序号:23476004发布日期:2020-12-29 13:32阅读:188来源:国知局
点云数据处理方法及其装置、激光雷达、可移动平台与流程

本公开涉及点云数据处理技术领域,尤其涉及一种点云数据处理方法及其装置、激光雷达、可移动平台。



背景技术:

在自动驾驶领域,目前应用最多的传感器是激光雷达,激光雷达一般用于动态障碍物检测以及建立环境地图。当前激光雷达存在的主要问题是生成的点云数据不够稠密,这对距激光雷达较远的物体尤其明显。该问题会影响动态障碍物检测的效果,也会导致激光雷达建立的环境地图不够精确。



技术实现要素:

本公开提供了一种点云数据处理方法,包括:

获取当前帧,确定所述当前帧中的障碍物;

获取所述当前帧之前的历史帧,确定所述障碍物在所述历史帧中的位置和速度;

根据所述障碍物在所述历史帧中的位置和速度,将所述历史帧中的所述障碍物的点云数据累积至所述当前帧。

本公开还提供了一种点云数据处理装置,包括:

存储器,用于存储可执行指令;

处理器,用于执行所述存储器中存储的所述可执行指令,以执行如下操作:

获取当前帧,确定所述当前帧中的障碍物;

获取所述当前帧之前的历史帧,确定所述障碍物在所述历史帧中的位置和速度;

根据所述障碍物在所述历史帧中的位置和速度,将所述历史帧中的所述障碍物的点云数据累积至所述当前帧。

本公开还提供了一种激光雷达,包括:

发射器,用于发射激光束;

接收器,用于接收发射回来的激光束;

上述点云数据处理装置,对所述接收器接收到激光束进行处理生成点云数据。

本公开还提供了一种可移动平台,包括

机体;

动力系统,设于所述机体,所述动力系统用于为所述可移动平台提供动力;

上述激光雷达,设于所述机体,用于感知所述可移动平台的环境信息。

本公开还提供了一种计算机可读存储介质,其存储有可执行指令,所述可执行指令在由一个或多个处理器执行时,可以使所述一个或多个处理器执行上述点云数据处理方法。

从上述技术方案可以看出,本公开至少具有以下有益效果:

通过本实施例的点云数据处理方法,将历史帧的点云数据累积至当前帧,实现点云数据增强,使点云数据变得稠密,克服了点云数据稀疏的缺陷,有利于生成高精度的环境地图。并且在累积的过程中考虑到障碍物移动的因素,根据障碍物的速度将历史帧的点云数据累积至当前帧,通过这种速度补偿的方法,抑制甚至消除了点云拖尾的问题,进一步提高了点云质量,有利于进一步提高环境地图的精度。

附图说明

附图是用来提供对本公开的进一步理解,并且构成说明书的一部分,与下面的具体实施方式一起用于解释本公开,但并不构成对本公开的限制。在附图中:

图1为本公开实施例点云数据处理方法的流程图。

图2为环境地图的一个示意图。

图3显示了t帧的障碍物的点云数据。

图4显示了t帧的加框后的障碍物的点云数据。

图5显示了t-1帧的加框后的障碍物的点云数据。

图6显示了t-2帧的加框后的障碍物的点云数据。

图7显示了t-1帧的障碍物的位置及其在t帧的预测位置之间的关系。

图8显示了t-2帧的障碍物的位置及其在t帧的预测位置之间的关系。

图9为根据本公开实施例点云数据处理方法处理后的t帧的障碍物的点云数据。

图10为本公开实施例点云数据处理装置的示意图。

图11为本公开实施例激光雷达的示意图。

图12为本公开实施例的可移动平台的示意图。

具体实施方式

下面将结合实施例和实施例中的附图,对本公开技术方案进行清楚、完整的描述。显然,所描述的实施例仅仅是本公开一部分实施例,而不是全部的实施例。基于本公开中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本公开保护的范围。

本公开一实施例提供了一种点云数据处理方法,如图1所示,点云数据处理方法包括以下步骤:

步骤s101:获取当前帧,确定所述当前帧中的障碍物;

步骤s102:获取所述当前帧之前的历史帧,确定所述障碍物在所述历史帧中的位置和速度;

步骤s103:根据所述障碍物在所述历史帧中的位置和速度,将所述历史帧中的所述障碍物的点云数据累积至所述当前帧。

本实施例的点云数据处理方法由一点云数据处理装置执行。所述点云数据处理装置作为传感器的部件,传感器一般安装于可移动平台。本文中的可移动平台包括:车辆、无人飞行器、有人飞行器、船舶等可移动载体。本文中的无人飞行器可以是无人机旋翼航空器,诸如由多个螺旋桨推动以在空中移动的多旋翼航空器。本文中的车辆可以是各种机动车辆和非机动车辆。机动车辆可以是无人驾驶车辆、有人驾驶车辆。

本文中的可移动平台可携带用于收集环境数据的一个或多个传感器。由所述一个或多个传感器获取的数据可以组合以生成表示周围环境的环境地图。本文中的环境地图可以是二维地图、三维地图。环境可以是城市、郊区或乡村或者任何其他环境。如图2所示,环境地图可以包括关于环境中物体位置的信息,环境中的物体例如是一个或多个障碍物。障碍物可以包括可阻碍可移动平台移动的任何物体或实体。一些障碍物可能位于地面上,诸如图2中的建筑物、机动车(例如,图2中的道路上的轿车、卡车)、人类、动物、植物(例如,如图2中的树木)和其他人造或自然构造物。一些障碍物可能完全位于空中,包括飞行器(例如,飞机、直升机、热气球、其他uav)或鸟类。

可移动平台可以使用所生成的环境地图来执行各种操作,其中一些可以是半自动化的或全自动化的。例如,环境地图可以用于自动为无人飞行器确定一个飞行路径,以从其当前位置航行至目标位置。例如,环境地图可以用于自动为车辆确定一个行驶路径,以从其当前位置行驶至目标位置。又例如,环境地图可以用于确定一个或多个障碍物的空间排列,并从而使得可移动平台能够执行避障机动。有利地,本文中用于收集环境数据的传感器可以提高环境地图构建的准确度和精度,即使是在多样化的环境和操作条件下也如此,从而增强诸如导航和避障等功能的稳健性和灵活性。

本实施例中,所述点云数据处理装置作为传感器的部件,可以单独或与可移动平台的其他传感器组合来生成环境地图。传感器可以是激光雷达,点云数据处理装置是激光雷达的数据处理部件。可移动平台的其他传感器可以是gps传感器、惯性传感器、视觉传感器、超声传感器等。激光雷达与其他传感器的融合可以用于补偿与单个传感器类型相关联的局限性或误差,从而提高环境地图的准确度和可靠性。

为构建环境地图,激光雷达在可移动平台的移动过程中,可不断探测周围环境。在探测过程中,激光雷达向周围环境发射激光束,激光束被环境中的物体反射,反射信号由激光雷达接收,得到数据帧。在探测周围环境的过程中,激光雷达在各个时刻对周围环境成像,得到各个时刻的数据帧。每一时刻的数据帧由点云数据组成。点云数据是指反映环境中的物体的表面形状的数据集合。

在步骤s101中,激光雷达在当前时刻向周围环境发射激光束,激光束被环境中的物体反射,反射信号由激光雷达接收,得到当前时刻的数据帧,以下简称当前帧。通过对当前帧的点云数据的处理,识别出当前帧中的障碍物。环境中的有些障碍物是静止的,有些障碍物是移动的,移动的障碍物称为动态障碍物。由于本实施例的目的是累积动态障碍物的点云数据,所以本步骤的障碍物识别是指动态障碍物的识别。在本实施例之后的步骤中,也是针对动态障碍物进行处理。如无专门的说明,下文中的障碍物均指动态障碍物。

可通过多种方法识别当前帧的中的障碍物。在一个示例中,该方法可以包括以下步骤:有效点云筛选、点云聚类、障碍物加框。以下分别对这些步骤进行介绍。

有效点筛选:

由于环境中的有些物体与障碍物识别不相关,例如,路面、树木、墙体、楼宇等静态障碍物,这些不相关的物体会影响对障碍物的识别。因此首先对当前帧的点云数据进行筛选。

选取感兴趣的空间区域,并将感兴趣的空间区域之外的点云数据排除。通过该步骤可将不相关物体的点云数据剔除,如图3所示,剔除了树木、建筑物,只保留与障碍物有关的点云数据。

点云聚类:

筛选出与障碍物有关的点云数据后,还不能确定这些点云数据分别属于哪个障碍物。通过点云聚类可将分离出属于同一障碍物的点云数据。在一个示例中,可采用基于密度的空间聚类算法(dbscan,density-basedspatialclusteringofapplicationwithnoise)对当前帧进行点云聚类。dbscan算法计算速度快,能够有效处理噪声点,并发现任意形状的空间聚类,同时可将易被误认为同一障碍物的不同障碍物分开,聚类准确性高。如图3所示,通过点云聚类,可将分别属于轿车和卡车的点云数据分开。

障碍物加框:

经过点云聚类可初步将障碍物识别出来。障碍物在点云数据处理装置的数据帧中一般用三维立方体的形式表示,这个三维立方体称为“框”。通过障碍物加框可将障碍物的轮廓用框圈出来,以便进行后续的障碍物跟踪。

首先可提取障碍物的特征。在一个示例中,这些特征可以包括:跟踪点位置,障碍物运动方向、长度和宽度等。然后根据上述障碍物的特征提取障碍物的框。可利用各种方法提出提取障碍物的框,在一个示例中,采用最小凸包法结合模糊线段的方法提取障碍物的框。如图4所示,可提取出轿车和卡车的框。

通过上述步骤即可识别出当前帧中的障碍物,取决于实际环境,当前帧中的障碍物可以是一个,也可以是多个。

确定出当前帧中的障碍物后,步骤s102获取当前帧之前的历史帧,并确定所述障碍物在历史帧中的位置和速度。

所述历史帧是指当前帧之前的各个历史时刻得到的数据帧。在各个历史时刻如何得到数据帧,可参见步骤s101中获取当前帧的描述。也就是说,激光雷达在各个历史时刻向周围环境发射激光束,激光束被环境中的物体反射,反射信号由激光雷达接收,得到历史时刻的数据帧。例如,如果当前帧时刻为t,那么历史帧时刻是指t-n、...、t-2、t-1这些时刻。对于t时刻的当前帧、历史帧包括t-n、...、t-2、t-1时刻的数据帧。

由于激光雷达是在各个时刻不断对周围环境成像,所以同一个障碍物会在多个时刻的数据帧中出现,即步骤s101确定出的当前帧中的障碍物,这些障碍物的部分或全部在历史帧中也同样会出现。在本步骤中,首先在历史帧中识别出所述障碍物,即在历史帧中找出当前帧中的障碍物。本实施例可采用障碍物跟踪法在历史帧中识别出当前帧中的所述障碍物。

具体来说,采用障碍物跟踪法时,分别获取当前帧的特征点和历史帧的特征点,根据当前帧的特征点和历史帧的特征点,通过光流算法确定当前帧的障碍物是否为历史帧的障碍物。

例如,对于t时刻的当前帧(为方便描述,以下简称t帧),获取其前一帧,即t-1时刻的数据帧(以下简称t-1帧)。然后分别获取t帧的特征点和t-1帧的特征点,通过光流算法对t帧的特征点和t-1帧的特征进行处理,在t-1帧中识别出t帧中的所述障碍物,,如图5所示。然后,获取t-2时刻的数据帧(以下简称t-2帧),然后分别获取t-2帧的特征点,通过光流算法对t-1帧的特征点和t-2帧的特征进行处理,在t-2帧中识别出t-1帧中的障碍物,如图6所示。以此类推,对t-3时刻的数据至t-n时刻的数据帧的相邻两帧均执行上述步骤,即可将该障碍物关联至t-n帧,实现对障碍物的跟踪。

本实施例可采用其他方法实现障碍物跟踪,这些方法包括:多目标假设跟踪法、最近邻域法、联合概率数据关联法等等。

如果判断前一帧的一个障碍物与后一帧的一个障碍物为同一障碍物,可将该障碍物附上相同的编号。其中,提取数据帧的障碍物的特征信息的方法有多种,在一个示例中,可采用人工神经网络算法提取障碍物的特征信息。

本领域技术人员可以理解,以上针对的是当前帧中确定出的所有障碍物。也就是说,当步骤s101在当前帧中确定出一个障碍物时(例如,当图4中只有轿车或卡车时),通过上述步骤可将该障碍物关联至历史帧,从而在各个历史帧中识别出该障碍物。当步骤s101在当前帧中确定出多个障碍物时(例如,图4中同时出现轿车和卡车),对每一障碍物执行上述操作,可将每一个障碍物都关联至历史帧,从而在各个历史帧中识别出每一个障碍物。

在历史帧中识别出当前帧中的障碍物后,可从历史帧中的所述障碍物的点云数据中提取出所述障碍物在历史帧中的位置。

如表1所示,障碍物的点云数据包括有位置信息和属性信息。属性信息一般是指障碍物回波信号的强度信息。位置信息是指障碍物的位置坐标,该位置坐标可以是以激光雷达为原点的三维坐标系下的三轴坐标x/y/z。因此,将障碍物的点云数据的位置坐标提取出来,即可得到障碍物在历史帧中的位置。

表1点云数据的格式

例如,对于t-1帧的障碍物,将t-1帧的该障碍物的点云数据中的三轴坐标作为该障碍物在t-1帧中的位置;对于t-2帧的障碍物,将t-2帧的该障碍物的点云数据中的三轴坐标作为该障碍物在t-2帧中的位置;以此类推,对于t-n帧的障碍物,将t-n帧的该障碍物的点云数据中的三轴坐标作为该障碍物在t-n帧中的位置。通过上述步骤,即可得到轿车和卡车的在图5所示的t-1帧中的位置、以及在图6所示的t-2帧中的位置。

为了将累积障碍物的点云数据,需要知道障碍物在历史帧的速度。可通过多种方法确定障碍物在历史帧的速度。这些方法至少包括:根据预设传感器的测量值确定障碍物在历史帧中的速度。作为一个示例,本实施例采用卡尔曼滤波器来估计障碍物在历史帧的速度。根据状态方程和测量方程进行迭代运算确定障碍物在历史帧中的速度;所述测量方程包括预设传感器的速度测量值。

卡尔曼滤波器的状态方程为

vw(t)=a*vw(t-1)+w(t)

卡尔曼滤波器的测量方程为

vz(t)=z(t)+y(t)

其中,vw(t)为状态方程在t帧的速度预测值,a为状态方程的系数,vw(t-1)为状态方程在t-1帧的速度预测值,w(t)为t帧的状态噪声;vz(t)为测量方程在t帧的速度预测值,z(t)为点云数据处理装置在t帧的速度测量值,y(t)为t帧的预测噪声。

障碍物的速度计算公式为

v(t)=a*vw(t-1)+w(t)*(vz(t)-z(t-1))

其中,v(t)为障碍物在t帧的速度,z(t-1)为点云数据处理装置在t-1帧的速度测量值。

可为状态方程的速度预测值设定一个初始值,该初始值可以是一经验值,例如80km/h。通过对卡尔曼滤波器的状态方程和测量方程进行迭代运算,得到障碍物在t-n帧、...、t-2帧、t-1帧的速度。

其中,点云数据处理装置数据帧的采样与预设传感器的采样可同步进行,也可以异步进行。当二者同步采样时,点云数据处理装置在t帧的速度测量值z(t)与t帧在同一采样时刻t得到。当二者异步采样时,点云数据处理装置在t帧的速度测量值z(t)可以是在t帧的采样时刻t之前或之后得到的。

通过上述步骤可分别对图3所示的各个历史帧中的轿车和卡车的速度进行估计,从而得到各个历史帧中的轿车和卡车的速度。

如前文所述,激光雷达安装于可移动平台上,所以点云数据处理装置的速度测量值实际也是可移动平台的速度测量值。该速度测量值通常是由激光雷达或可移动平台的至少一个预设传感器提供。这些预设传感器至少包括:惯性测量单元、轮速计、卫星定位单元。

本实施例中,可以利用惯性测量单元、轮速计、卫星定位单元的其中一个的测量值得到速度测量值。也可以对惯性测量单元、轮速计、卫星定位单元在内的两个或两个以上传感器的测量值进行数据融合,以得到所述速度测量值。通过数据融合得到的速度测量值精度更高,有利于进一步提高点云数据累积的精度,进一步改善点云质量。

获得障碍物在历史帧中的位置以及速度后,步骤s103即可将历史帧中的障碍物的点云数据累积至当前帧,从而使当前帧的点云数据更加稠密,提高点云数据的质量。

首先,根据障碍物在历史帧的速度,确定所述障碍物从所述历史帧至所述当前帧的移动距离。所述移动距离可通过以下步骤确定:

确定所述历史帧与所述当前帧的时间差;

根据所述历史帧的所述速度、以及所述时间差,得到所述移动距离。

首先计算历史帧与当前帧的时间差。对于当前帧的t帧,t-1帧与t帧时刻相差一个时刻,t-2帧与t帧相差两个时刻,同理,t-n帧与t帧相差n个时刻。相邻帧之间时间长度取决于激光雷达的帧率,帧率越高,则这个时间长度越短,帧率越低,则这个时间长度越长。举例来说,如果激光雷达的帧率为20fps,即每秒20帧,那么相邻两帧的之间的时间长度就是0.05秒。t-1帧与tzhen的时间差就是0.05秒,t-2帧与t帧的时间差就是0.1秒,同理,t-n帧与t帧的时间差就是0.05*n秒。

接着根据历史帧的所述速度、以及所述时间差,得到所述移动距离。具体来说,对于每一个障碍物,将其历史帧的速度乘以各个历史帧与当前帧的时间差,即可得到这个障碍物从各个历史帧到当前帧的移动距离。

例如,参见图7所示,为了更加清楚地显示障碍物的移动距离和位置,在图7中省去了轿车和卡车的点云数据,以二者的框来分别代表轿车和卡车。对于当前帧t帧的轿车,将轿车在t-1帧时刻的速度乘以一个时刻的时间长度,得到轿车从t-1帧到t帧的移动距离d1;对于当前帧t的卡车,将卡车在t-1帧的速度乘以一个时刻的时间长度,得到卡车从t-1帧到t帧的移动距离d1’。参见图8所示,将轿车在t-2帧的速度乘以两个时刻的时间长度,得到轿车从t-2帧到当前帧t的移动距离d2。同理,将卡车在t-2帧的速度乘以两个时刻的时间长度,得到卡车从t-2帧到t帧的移动距离d2’。以此类推,即可得到轿车和卡车从t-n帧到t帧的移动距离dn和dn’。

接着根据所述障碍物在所述历史帧中的位置、以及所述移动距离,确定所述历史帧中的所述障碍物在所述当前帧中的预测位置。

对于每一个障碍物,将其在各个历史帧的位置移动至历史帧与当前帧的移动距离,即可得到各个历史帧中的该障碍物在当前帧的预测位置。

例如,如图7所示,将轿车在t-1帧的三维坐标移动一个距离d1,即可得到t-1帧的轿车在t帧中的预测位置p1及其三维坐标;将卡车在t-1帧的三维坐标移动一个距离d1’,即可得到t-1帧的卡车在t帧中的预测位置p1’及其三维坐标。将轿车在t-2帧的三维坐标移动一个距离d2,即可得到t-2帧的轿车在t帧中的预测位置p2及其三维坐标;将卡车在t-2帧的三维坐标移动一个距离d2’,即可得到t-2帧的卡车在t帧中的预测位置p2’及其三维坐标。以此类推,即可得到t-n帧的轿车和卡车在t帧中的预测位置及其三维坐标。

然后,根据所述预测位置更新所述历史帧中的所述障碍物的点云数据,将更新后的所述点云数据补充至所述当前帧。更新历史帧中的障碍物的点云数据是指,将历史帧中的障碍物的点云数据的位置坐标替换为预测位置的位置坐标。

通过上述步骤,可将历史帧中的障碍物的点云数据累积至当前帧中。对于每一个障碍物,对其在各个历史帧中的点云数据进行更新,即将历史帧中的点云数据的三维坐标替换为该历史帧在当前帧的预测位置的三维坐标,并将更新后的点云数据也作为当前帧的点云数据。

例如,将t-1帧中轿车的点云数据的三维坐标替换为t-1帧的轿车在t帧中的预测位置的三维坐标,将t-2帧中轿车的点云数据的三维坐标替换为t-2帧的轿车在t帧中的预测位置的三维坐标,从而将t-1帧和t-2帧中轿车的点云数据累积至t帧。将t-1帧中卡车的点云数据的三维坐标替换为t-1帧的卡车在t帧中的预测位置的三维坐标,将t-2帧中卡车的点云数据的三维坐标替换为t-2帧的卡车在t帧中的预测位置的三维坐标,从而将t-1帧和t-2帧中卡车的点云数据累积至t帧。以此类推,可将t-1帧至t-n帧中的轿车和卡车的点云数据全部累积至t帧。如图9所示,经过累积后,当前帧中的轿车和卡车的点云数据明显比图3所示的累积前的点云数据更加稠密,从而提高了点云数据的密度,改善了点云质量,有利于提高环境地图的精度。

需要说明的是,历史帧的数量n可根据实际需求来确定。一般来说,n的数值越大,即累积的历史帧越多,当前帧就越稠密。但同时也会带来噪声,累积的点云数据可能有一部分是噪点,超出了激光雷达的探测范围,对改善点云质量不利。因此,本实施例可在步骤s103之后,进行去噪操作。

首先确定获取一个预设位置范围。这个预设位置范围可以是点云数据处理装置为原点的三维坐标系下的一个、两个或三维维度的范围。例如三维坐标系下x轴的一个位置范围,或x轴和y轴共同形成的位置范围,或x轴、y轴和z轴共同形成的位置范围。

可将位于预设位置范围之外的预测位置作为噪点位置,即将累积至当前帧的、且位于预设位置范围之外的点云数据作为噪点,并将噪点对应的点云数据从当前帧中去除。通过上述去噪操作,可消除噪点,进一步提高点云质量,有利于进一步提高环境地图的精度。

通过本实施例的点云数据处理方法,将历史帧的点云数据累积至当前帧,实现点云数据增强,使点云数据变得稠密,克服了点云数据稀疏的缺陷,有利于生成高精度的环境地图。并且在累积的过程中考虑到障碍物移动的因素,根据障碍物的速度将历史帧的点云数据累积至当前帧,通过这种速度补偿的方法,累积后的当前帧抑制甚至消除了点云拖尾的问题,进一步提高了点云质量,有利于进一步提高环境地图的精度。

本公开另一实施例提供了一种点云数据处理装置,所述点云数据处理装置作为可移动平台的传感器的部件。传感器可安装于可移动平台,传感器可以是激光雷达。所述点云数据处理装置可以单独或与可移动平台的其他传感器组合来生成环境地图。

如图10所示,该点云数据处理装置包括:存储器和处理器。处理器和存储器可以通过总线相连。

存储器可以存储供处理器执行的指令和/或要处理或已处理的数据。存储器的数量也可以是一个或多个。供处理器执行的指令和/或要处理或已处理的数据可以存储在一个存储器中,也可以分布存储于各个存储器中。存储器可以是易失性存储器或非易失性存储器。例如,作为易失性存储器,存储器可以包括:随机存取存储器(ram)、动态ram(dram)、静态ram(sram)、同步dram(sdram)、高速缓存、寄存器等。例如,作为非易失性存储器,存储器还可以包括:一次性可编程只读存储器(otprom)、可擦除可编程rom(eprom)、电可擦除可编程rom(eeprom)、掩膜rom、闪存rom、闪存、硬盘驱动器、固态驱动器等等。

处理器的数量可以是一个或多个。处理器可以为中央处理器(centralprocessingunit,cpu)、现场可编程门阵列(field-programmablegatearray,fpga),数字信号处理器(digitalsignalprocessor,dsp),或其他数据处理芯片。当处理器的数量是一个时,存储器存储的供处理器执行的指令可由该一个处理器执行。当处理器的数量是多个时,存储器存储的供处理器执行的指令可由多个处理器中的一个,或在多个处理器的至少部分处理器中分布执行。

本实施例的点云数据处理装置,

存储器,用于存储可执行指令;

处理器,用于执行所述存储器中存储的所述可执行指令,以执行如下操作:

获取当前帧,确定所述当前帧中的障碍物;

获取所述当前帧之前的历史帧,确定所述障碍物在所述历史帧中的位置和速度;

根据所述障碍物在所述历史帧中的位置和速度,将所述历史帧中的所述障碍物的点云数据累积至所述当前帧。

所述确定所述障碍物在所述历史帧中的位置的操作,包括:

在所述历史帧中识别出所述障碍物;

从所述历史帧中的所述障碍物的点云数据,提取出所述障碍物在所述历史帧中的位置。

所述在所述历史帧中识别出所述障碍物的操作,包括:

分别获取所述当前帧的特征点和所述历史帧的特征点;

根据所述当前帧的特征点和所述历史帧的特征点,通过光流算法确定所述当前帧的障碍物是否为所述历史帧的障碍物。

根据预设传感器的测量值确定所述障碍物在所述历史帧中的速度。

根据预设传感器的测量值,利用卡尔曼滤波器确定所述障碍物在所述历史帧中的速度。

所述卡尔曼滤波器包括:状态方程、测量方程;

所述利用卡尔曼滤波器确定所述障碍物在所述历史帧中的速度,包括:

根据所述状态方程和所述测量方程进行迭代运算确定所述障碍物在所述历史帧中的速度;所述测量方程包括所述预设传感器的测量值。

所述预设传感器为多个,所述测量值通过多个所述预设传感器的测量结果的融合得到。

所述预设传感器至少包括以下其中一种:惯性测量单元、轮速计、卫星定位单元。

所述将所述历史帧中的所述障碍物的点云数据累积至所述当前帧的操作,包括:

根据所述障碍物在所述历史帧中的速度,确定所述障碍物从所述历史帧至所述当前帧的移动距离;

根据所述障碍物在所述历史帧中的位置、以及所述移动距离,确定所述历史帧中的所述障碍物在所述当前帧中的预测位置;

根据所述预测位置更新所述历史帧中的所述障碍物的点云数据,将更新后的所述点云数据补充至所述当前帧。

所述确定所述障碍物从所述历史帧至所述当前帧的移动距离的操作,包括:

确定所述历史帧与所述当前帧的时间差;

根据所述障碍物在所述历史帧中的速度、以及所述时间差,得到所述移动距离。

所述更新所述历史帧中的所述障碍物的点云数据的操作,包括:

将所述历史帧中的所述障碍物的点云数据的位置坐标替换为所述预测位置的位置坐标。

所述处理器还执行如下操作:

将位于预设位置范围之外的预测位置作为噪点位置;

将与所述噪点位置对应的点云数据从所述当前帧中去除。

所述预设位置范围至少包括:

执行所述点云数据处理方法的点云处理装置的坐标系下至少一个维度的范围。

本公开又一实施例还提供了一种激光雷达,如图11所示,包括:发射器、接收器和上述实施例的点云数据处理装置。

发射器用于发射激光束,所述激光束照射环境中的物体,并被环境中的物体反射。

接收器用于接收发射回来的激光束。

所述点云数据处理装置对所述接收器接收到激光束进行处理,以生成点云数据。

本公开再一实施例还提供了一种可移动平台,如图12所示,包括:机体、动力系统、以及上述实施例的激光雷达。所述可移动平台至少可以是:车辆、飞行器。所述飞行器例如可以是无人机。

机体用于为动力系统和激光雷达提供支撑。机体内可以设置有控制部件和通信部件。机体通过控制部件可控制动力系统和激光雷达的动作,通过通信部件可与远端的控制站、控制终端或控制中心通信。

动力系统设置在机体上,动力系统用于为可移动平台提供动力,以使可移动平台行使或航行。

激光雷达设置在机体上,用于感知可移动平台的环境信息。

本公开再一实施例提供了一种计算机可读存储介质。计算机可读存储介质存储有可执行指令,所述可执行指令在由一个或多个处理器执行时,可以使所述一个或多个处理器执行如本公开实施例所述的无人机的仿真方法进行仿真。

所述计算机可读存储介质可以是计算机能够存取的任何可用介质或者是包含一个或多个可用介质集成的服务器、数据中心等数据存储设备。所述可用介质可以是磁性介质(例如,软盘、硬盘、磁带)、光介质(例如数字视频光盘(digitalvideodisc,dvd))、或者半导体介质(例如固态硬盘(solidstatedisk,ssd))等。

应理解,在本发明的各种实施例中,上述各过程的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本发明实施例的实施过程构成任何限定。

在上述实施例中,可以全部或部分地通过软件、硬件、固件或者其他任意组合来实现。当使用软件实现时,可以全部或部分地以计算机程序产品的形式实现。所述计算机程序产品包括一个或多个计算机指令。在计算机上加载和执行所述计算机程序指令时,全部或部分地产生按照本发明实施例所述的流程或功能。所述计算机可以是通用计算机、专用计算机、计算机网络、或者其他可编程系统。所述计算机指令可以存储在计算机可读存储介质中,或者从一个计算机可读存储介质向另一个计算机可读存储介质传输,例如,所述计算机指令可以从一个网站站点、计算机、服务器或数据中心通过有线(例如同轴电缆、光纤、数字用户线(digitalsubscriberline,dsl))或无线(例如红外、无线、微波等)方式向另一个网站站点、计算机、服务器或数据中心进行传输。

本领域普通技术人员可以意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、或者计算机软件和电子硬件的结合来实现。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本公开的范围。

以上所述,仅为本公开的具体实施方式,但本公开的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本公开揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本公开的保护范围之内。因此,本公开的保护范围应以所述权利要求的保护范围为准。

另外,计算机程序可被配置为具有例如包括计算机程序模块的计算机程序代码。应当注意,模块的划分方式和个数并不是固定的,本领域技术人员可以根据实际情况使用合适的程序模块或程序模块组合,当这些程序模块组合被计算机(或处理器)执行时,使得计算机可以执行本公开所述所述的无人机的仿真方法的流程及其变形。

本领域技术人员可以清楚地了解到,为描述的方便和简洁,仅以上述各功能模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能模块完成,即将装置的内部结构划分成不同的功能模块,以完成以上描述的全部或者部分功能。上述描述的装置的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。

最后应说明的是:以上各实施例仅用以说明本公开的技术方案,而非对其限制;尽管参照前述各实施例对本公开进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;在不冲突的情况下,本公开实施例中的特征可以任意组合;而这些修改或者替换,并不使相应技术方案的本质脱离本公开各实施例技术方案的范围。

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