CN108280866A - 道路点云数据处理方法及系统 - Google Patents

道路点云数据处理方法及系统 Download PDF

Info

Publication number
CN108280866A
CN108280866A CN201611262800.6A CN201611262800A CN108280866A CN 108280866 A CN108280866 A CN 108280866A CN 201611262800 A CN201611262800 A CN 201611262800A CN 108280866 A CN108280866 A CN 108280866A
Authority
CN
China
Prior art keywords
point cloud
data
map datum
road
dimensional point
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.)
Granted
Application number
CN201611262800.6A
Other languages
English (en)
Other versions
CN108280866B (zh
Inventor
李超
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
FAFA Automobile (China) Co., Ltd.
Original Assignee
LeTV Automobile Beijing Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by LeTV Automobile Beijing Co Ltd filed Critical LeTV Automobile Beijing Co Ltd
Priority to CN201611262800.6A priority Critical patent/CN108280866B/zh
Publication of CN108280866A publication Critical patent/CN108280866A/zh
Application granted granted Critical
Publication of CN108280866B publication Critical patent/CN108280866B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T15/003D [Three Dimensional] image rendering
    • G06T15/005General purpose rendering architectures

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Graphics (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明实施例提供一种道路点云数据处理方法及系统,属于点云数据处理技术领域。所述方法包括:获取道路点云数据和与道路点云数据对应的同时刻的车辆位置数据;根据道路点云数据和车辆位置数据,通过SLAM算法得到车辆位姿;根据车辆位姿,计算得到三维点云地图数据;在三维点云地图数据中,提取与多个预设形状参数中每个预设形状参数对应的重复结构数据,得到提取后的三维点云地图数据;确定压缩后的三维点云地图数据。本发明实施例解决了现有技术中三维点云地图数据量大,难于传输和保存的问题,压缩后的三维点云地图数据在向无人车传输时,传输速度快。

Description

道路点云数据处理方法及系统
技术领域
本发明涉及点云数据处理技术领域,具体地,涉及一种道路点云数据处理方法及系统。
背景技术
在无人驾驶技术中,高精度定位是极其重要的组成部分,而在目前的技术中,精度最高的定位方法还是基于三维点云地图的定位方法。本申请发明人在实现本发明的过程中发现,现有技术具有以下缺陷:三维点云地图数据量很大,给地图的传输和保存带来了较大的困难。
发明内容
本发明实施例的目的是提供一种道路点云数据处理方法及系统,解决了现有技术中三维点云地图数据量大,难于传输的问题,降低了地图数据的大小。
为了实现上述目的,本发明实施例提供一种道路点云数据处理方法,包括:
获取道路点云数据和与所述道路点云数据对应的同时刻的车辆位置数据;
根据所述道路点云数据和所述车辆位置数据,通过SLAM算法得到车辆位姿;
根据所述车辆位姿,计算得到三维点云地图数据;
在所述三维点云地图数据中,提取与多个预设形状参数中每个预设形状参数对应的重复结构数据,得到提取后的三维点云地图数据,所述提取后的三维点云地图数据中不包含所述多个预设形状参数中每个预设形状参数对应的重复结构数据;
确定压缩后的三维点云地图数据,所述压缩后的三维点云地图数据包括所述提取后的三维点云地图数据、所述多个预设形状参数以及每个重复结构数据对应的变换矩阵。
可选的,所述根据所述道路点云数据和所述车辆位置数据,通过SLAM算法得到车辆位姿包括:
根据相邻两帧的道路点云数据,得到所述道路点云数据中的各个相邻两帧的车辆位姿变换;
根据所述车辆位置数据,获取在不同时刻同一位置的车辆位姿变换;
根据所述各个相邻两帧的车辆位姿变换和所述不同时刻同一位置的车辆位姿变换,通过位姿图优化算法得到所述车辆在所有帧的车辆位姿。
可选的,所述根据所述车辆位姿,计算得到三维点云地图数据包括:
根据计算得到三维点云地图数据,其中sum为三维点云地图数据,P_i为第i帧道路点云数据,Pose_i为第i帧车辆位姿。
可选的,所述在所述三维点云地图数据中,提取与多个预设形状参数中每个预设形状参数对应的重复结构数据,得到提取后的三维点云地图数据包括:
在所述三维点云地图数据中,选择多个领域子集,通过ransac算法对多个预设形状参数中的每一个预设形状参数进行拟合;
当拟合成功时,确定所述多个预设形状参数中的每一个预设形状参数对应的重复结构数据;
在所述三维点云地图数据中,提取所述重复结构数据对应的道路点云数据,得到提取后的三维点云地图数据。
可选的,所述重复结构为平面、线段、圆柱、圆锥或圆环面中的至少一种。
可选的,所述每个重复结构数据对应的变换矩阵为通过所述变换矩阵将所述每个重复结构数据转换为所述三维点云地图数据中的道路点云数据。
本发明实施例还提供一种道路点云数据处理系统,包括:
获取单元,用于获取道路点云数据和与所述道路点云数据对应的同时刻的车辆位置数据;
第一计算单元,用于根据所述道路点云数据和所述车辆位置数据,通过SLAM算法得到车辆位姿;
第二计算单元,用于根据所述车辆位姿,计算得到三维点云地图数据;
第三计算单元,用于在所述三维点云地图数据中,提取与多个预设形状参数中每个预设形状参数对应的重复结构数据,得到提取后的三维点云地图数据,所述提取后的三维点云地图数据中不包含所述多个预设形状参数中每个预设形状参数对应的重复结构数据;
处理单元,用于确定压缩后的三维点云地图数据,所述压缩后的三维点云地图数据包括所述提取后的三维点云地图数据、所述多个预设形状参数以及每个重复结构数据对应的变换矩阵。
可选的,所述获取单元包括GPS系统、惯性测量装置Imu和激光雷达装置,其中,所述GPS系统和Imu用于获取车辆位置数据,所述激光雷达装置用于获取道路点云数据。
可选的,所述第一计算单元包括:
第一计算模块,用于根据相邻两帧的道路点云数据,得到所述道路点云数据中的各个相邻两帧的车辆位姿变换;
第二计算模块,用于根据所述车辆位置数据,获取在不同时刻同一位置的车辆位姿变换;
第三计算模块,用于根据所述各个相邻两帧的车辆位姿变换和所述不同时刻同一位置的车辆位姿变换,通过位姿图优化算法得到所述车辆在所有帧的车辆位姿。
可选的,所述第二计算单元用于根据计算得到三维点云地图数据,其中sum为三维点云地图数据,P_i为第i帧道路点云数据,Pose_i为第i帧车辆位姿。
可选的,所述第三计算单元包括:
拟合模块,用于在所述三维点云地图数据中,选择多个领域子集,通过ransac算法对多个预设形状参数中的每一个预设形状参数进行拟合;
重复结构确定模块,用于当拟合成功时,确定所述多个预设形状参数中的每一个预设形状参数对应的重复结构数据;
提取模块,用于在所述三维点云地图数据中,提取所述重复结构数据对应的道路点云数据,得到提取后的三维点云地图数据。
通过上述技术方案,通过获取道路点云数据和与所述道路点云数据对应的同时刻的车辆位置数据,根据SLAM算法得到车辆位姿,然后根据所述车辆位姿,计算得到三维点云地图数据,在所述三维点云地图数据中,提取与多个预设形状参数中每个预设形状参数对应的重复结构数据,得到提取后的三维点云地图数据,并确定压缩后的三维点云地图数据,所述压缩后的三维点云地图数据包括所述提取后的三维点云地图数据、所述多个预设形状参数以及每个重复结构数据对应的变换矩阵。本发明实施例解决了现有技术中三维点云地图数据量大,难于传输和保存的问题,压缩后的三维点云地图数据在向无人车传输时,传输速度快。
本发明实施例的其它特征和优点将在随后的具体实施方式部分予以详细说明。
附图说明
附图是用来提供对本发明实施例的进一步理解,并且构成说明书的一部分,与下面的具体实施方式一起用于解释本发明实施例,但并不构成对本发明实施例的限制。在附图中:
图1是本发明实施例提供的一种道路点云数据处理方法的流程图;
图2是本发明实施例提供的位姿图的示例图;
图3是本发明实施例提供的openGL中的茶壶模型的示例图;
图4是本发明实施例提供的一种道路点云数据处理系统的示意图;
图5是本发明实施例提供的一种道路点云数据处理系统中第一计算单元的示意图;
图6是本发明实施例提供的一种道路点云数据处理系统中第三计算单元的示意图。
具体实施方式
以下结合附图对本发明实施例的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本发明实施例,并不用于限制本发明实施例。
三维点云地图多用于无人车的定位、感知和决策等过程中,无人车通过三维点云地图可以定位当前位置,并预先知道车道情况,当发现有与地图中不一致的地方时,判断为障碍物,从而绕行,或者在到达路口转弯之前,决定并道并限速等等,以上过程均基于三维点云地图来实现,因此对三维点云地图进行处理,对无人车至关重要,尤其在将三维点云地图进行压缩处理后,再给无人车传输时,传输数据量变小,传输速度加快。
本发明实施例提供一种道路点云数据处理方法,如图1所示,所述方法包括如下步骤:
S101、获取道路点云数据和与所述道路点云数据对应的同时刻的车辆位置数据。
将GPS系统、Imu(International Mathematical Union,惯性测量装置)和激光雷达装置安装在车辆上,并按照预设路线行进,从而可以通过所述GPS系统和Imu获取车辆位置数据,所述激光雷达装置获取道路点云数据,且所述道路点云数据与同时刻的车辆位置数据相对应。
S102、根据所述道路点云数据和所述车辆位置数据,通过SLAM算法得到车辆位姿。
利用现有技术中的SLAM算法,根据所述道路点云数据和所述车辆位置数据,通过逐帧的点云配准、回环检测和位姿图优化,最终得到车辆位姿。
具体计算如下:
1)逐帧的点云配准是根据相邻两帧的道路点云数据,得到所述道路点云数据中的各个相邻两帧的车辆位姿变换。
车辆在ti时刻得到道路点云数据Pi,在ti+1时刻得到道路点云数据Pi+1,通过迭代最近点(ICP)算法算出ti时刻和ti+1时刻的变换矩阵Ti,通过Ti就可以将Pi+1投影到ti时刻的坐标系中,又由于对所有的相邻帧都会进行配准,因此就可以将道路点云数据投到任意一个时刻的坐标系下。
例如,在道路点云数据中可通过K最近邻算法查找对应点集,并优化成本函数,即公式(1)。
其中,Np是相邻两帧的个数,分别是两相邻两帧的道路点云数据,旋转(四元数表示),代表一个3*3的旋转矩阵,是平移。
然后,更新用更新后的返回到公式(1),直到算法收敛或者达到最大迭代次数。
2)根据所述车辆位置数据,获取在不同时刻同一位置的车辆位姿变换。
其中,所述车辆位置数据包括车辆位置和朝向。
由于逐帧的点云配准会存在累计误差,因此还需要做回环检测来减小这个误差。
首先将车辆位置数据表示为一个三维点集M,每个点包含XYZ坐标以及得到该位置的时间信息,用XYZ部分构建kdtree T。
对M中每一个点Mi,用T进行搜索半径,查找半径为参数。(1)如果返回结果不为空,并且返回集合中存在结果点Mj的时间与查询点Mi的时间间隔大于一个阈值,该阈值为预设参数,则认为找到一个回环,用点对(Mi,Mj)表示。(2)若返回结果为空,或返回集合中任意一点的时间与Mi的时间间隔都不满足上述阈值,则为没有发现回环。遍历所有点,找到所有的回环,并用(Mi,Mj)对应的道路点云数据(Pi,Pj)调用逐帧的点云配准中使用的算法进行配准,得到它们之间的变换矩阵Tij,即获取在不同时刻同一位置的车辆位姿变换。
3)根据所述各个相邻两帧的车辆位姿变换和所述不同时刻同一位置的车辆位姿变换,通过位姿图优化算法得到所述车辆在所有帧的车辆位姿。
如图2所示,将车辆的位姿表示为位姿图中的顶点,即xi,每个顶点都为6维向量,[x,y,z,r,p,h](平移+旋转),而eij是图中的边,边表示了顶点间的约束。那么位姿图优化就是求解公式(2)和(3):
其中(i,j)就是图中的边。e(xi,xj,zij)是一个向量的度量函数,用来衡量待优化的参数xi和xj满足约束zij的程度。zij是点云配准出来的变换矩阵,而Ωij是zij对应的信息矩阵,通过优化就能得到x*,即得到所述车辆在所有帧的车辆位姿。
S103、根据所述车辆位姿,计算得到三维点云地图数据。
其中,根据计算得到三维点云地图数据,其中sum为三维点云地图数据,Pi为第i帧道路点云数据,Posei为第i帧车辆位姿。
S104、在所述三维点云地图数据中,提取与多个预设形状参数中每个预设形状参数对应的重复结构数据,得到提取后的三维点云地图数据,所述提取后的三维点云地图数据中不包含所述多个预设形状参数中每个预设形状参数对应的重复结构数据。
在所述三维点云地图数据中提取重复结构数据,对应的重复结构例如马路牙子、电线杆、绿化带等,可将这些重复结构设置为预设形状参数,例如平面、线段、圆柱、圆锥或圆环面等,基本思路是在所述三维点云地图数据中,选择多个领域子集,通过ransac算法对多个预设形状参数中的每一个预设形状参数进行拟合,当拟合成功时,确定所述多个预设形状参数中的每一个预设形状参数对应的重复结构数据,在所述三维点云地图数据中,提取所述重复结构数据对应的道路点云数据,得到提取后的三维点云地图数据。
例如,以平面为例,三个点可以定义一个平面,那么基于ransac算法的过程:
(1)在邻域点集中随机选择3个点pi,pj,pk,拟合一个平面。计算方法为首先计算平面的法向量n,n=(pi-pj)*(pi-pk)。然后平面就可以用点法式表示为(pi,n)。
(2)计算邻域点集中所有点到该平面的距离,如果距离小于某一阈值,则为内点,否则,为外点。内点比例为内点的个数与邻域点集的个数的比值。如果该比例大于当前最优值,则将当前的平面参数和内点比例保存,最优值初始时为零,一次迭代后将当前最优值替换为当前内点比例。
(3)重复上述过程,直到达到最大迭代次数,所述最大迭代次数为预先设置,例如为一千次。如果最优的内点比例大于某一阈值,则认为形状拟合成功。
则上述过程为以平面为例,在所述三维点云地图数据中对预设形状参数进行拟合,得到一个对应的重复结构,接着重复上面的过程,查找出所有对应的重复结构,然后在所述三维点云地图数据中将与所述重复结构数据对应的所有点云数据提取出来,得到提取后的三维点云地图数据,则所述提取后的三维点云地图数据中不包含所述多个预设形状参数中每个预设形状参数对应的重复结构数据。
之后,还需要一个逆变换把一个重构结构数据的重新转化为三维点云地图中的道路点云数据。
例如,与openGL类似,以茶壶模型为例,在openGL中通过一个变换矩阵T(R|t)对该模型进行变换,使其出现在空间中的不同位置,如图3所示。
如果在空间中检测到了3个相同的物体,但由于其位置和朝向不同,会导致拟合出来的物体参数也有所差异,那么就需要将这3个物体的参数都保存下来。而如果有变换矩阵,只需要保存一个物体参数即可。
类似的,在本发明实施例中,由于一个重复结构数据,例如一个电线杆在所述三维点云地图数据中会有上万个点云数据来表示,那么多个电线杆对应的点云数据就是十万多个,在传输三维点云地图数据时,就会是很大的数据量,因此,提取后的三维点云数据传输速度就会很快。
S105、确定压缩后的三维点云地图数据,所述压缩后的三维点云地图数据包括所述提取后的三维点云地图数据、所述多个预设形状参数以及每个重复结构数据对应的变换矩阵。
最终得到的压缩后的三维点云地图数据包括所述提取后的三维点云地图数据、所述多个预设形状参数以及每个重复结构数据对应的变换矩阵,与数万个点云数据相比,所述多个预设形状参数以及每个重复结构数据对应的变换矩阵只是占几个字节,因此传输的数据量变小,提高了传输速度。
相应地,本发明实施例还提供一种道路点云数据处理系统40,如图4所示,所述系统包括:
获取单元41,用于获取道路点云数据和与所述道路点云数据对应的同时刻的车辆位置数据;
第一计算单元42,用于根据所述道路点云数据和所述车辆位置数据,通过SLAM算法得到车辆位姿;
第二计算单元43,用于根据所述车辆位姿,计算得到三维点云地图数据;
第三计算单元44,用于在所述三维点云地图数据中,提取与多个预设形状参数中每个预设形状参数对应的重复结构数据,得到提取后的三维点云地图数据,所述提取后的三维点云地图数据中不包含所述多个预设形状参数中每个预设形状参数对应的重复结构数据;
处理单元45,用于确定压缩后的三维点云地图数据,所述压缩后的三维点云地图数据包括所述提取后的三维点云地图数据、所述多个预设形状参数以及每个重复结构数据对应的变换矩阵。
通过获取道路点云数据和与所述道路点云数据对应的同时刻的车辆位置数据,根据SLAM算法得到车辆位姿,然后根据所述车辆位姿,计算得到三维点云地图数据,在所述三维点云地图数据中,提取与多个预设形状参数中每个预设形状参数对应的重复结构数据,得到提取后的三维点云地图数据,并确定压缩后的三维点云地图数据,所述压缩后的三维点云地图数据包括所述提取后的三维点云地图数据、所述多个预设形状参数以及每个重复结构数据对应的变换矩阵。本发明实施例解决了现有技术中三维点云地图数据量大,难于传输和保存的问题,压缩后的三维点云地图数据在向无人车传输时,传输速度快。
可选的,所述获取单元41包括GPS系统、Imu和激光雷达装置,其中,所述GPS系统和Imu用于获取车辆位置数据,所述激光雷达装置用于获取道路点云数据。
可选的,如图5所示,所述第一计算单元42包括:
第一计算模块51,用于根据相邻两帧的道路点云数据,得到所述道路点云数据中的各个相邻两帧的车辆位姿变换;
第二计算模块52,用于根据所述车辆位置数据,获取在不同时刻同一位置的车辆位姿变换;
第三计算模块53,用于根据所述各个相邻两帧的车辆位姿变换和所述不同时刻同一位置的车辆位姿变换,通过位姿图优化算法得到所述车辆在所有帧的车辆位姿。
可选的,所述第二计算单元43用于根据计算得到三维点云地图数据,其中sum为三维点云地图数据,Pi为第i帧道路点云数据,Posei为第i帧车辆位姿。
可选的,如图6所示,所述第三计算单元44包括:
拟合模块61,用于在所述三维点云地图数据中,选择多个领域子集,通过ransac算法对多个预设形状参数中的每一个预设形状参数进行拟合;
重复结构确定模块62,用于当拟合成功时,确定所述多个预设形状参数中的每一个预设形状参数对应的重复结构数据;
提取模块63,用于在所述三维点云地图数据中,提取所述重复结构数据对应的道路点云数据,得到提取后的三维点云地图数据。
上述道路点云数据处理系统40中的各个单元的具体实现过程,可参加上述道路点云数据处理方法的处理过程。
以上结合附图详细描述了本发明实施例的可选实施方式,但是,本发明实施例并不限于上述实施方式中的具体细节,在本发明实施例的技术构思范围内,可以对本发明实施例的技术方案进行多种简单变型,这些简单变型均属于本发明实施例的保护范围。
另外需要说明的是,在上述具体实施方式中所描述的各个具体技术特征,在不矛盾的情况下,可以通过任何合适的方式进行组合。为了避免不必要的重复,本发明实施例对各种可能的组合方式不再另行说明。
本领域技术人员可以理解实现上述实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,该程序存储在一个存储介质中,包括若干指令用以使得一个(可以是单片机,芯片等)或处理器(processor)执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-OnlyMemory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
此外,本发明实施例的各种不同的实施方式之间也可以进行任意组合,只要其不违背本发明实施例的思想,其同样应当视为本发明实施例所公开的内容。

Claims (10)

1.一种道路点云数据处理方法,其特征在于,包括:
获取道路点云数据和与所述道路点云数据对应的同时刻的车辆位置数据;
根据所述道路点云数据和所述车辆位置数据,通过SLAM算法得到车辆位姿;
根据所述车辆位姿,计算得到三维点云地图数据;
在所述三维点云地图数据中,提取与多个预设形状参数中每个预设形状参数对应的重复结构数据,得到提取后的三维点云地图数据,所述提取后的三维点云地图数据中不包含所述多个预设形状参数中每个预设形状参数对应的重复结构数据;
确定压缩后的三维点云地图数据,所述压缩后的三维点云地图数据包括所述提取后的三维点云地图数据、所述多个预设形状参数以及每个重复结构数据对应的变换矩阵。
2.根据权利要求1所述的道路点云数据处理方法,其特征在于,所述根据所述道路点云数据和所述车辆位置数据,通过SLAM算法得到车辆位姿包括:
根据相邻两帧的道路点云数据,得到所述道路点云数据中的各个相邻两帧的车辆位姿变换;
根据所述车辆位置数据,获取在不同时刻同一位置的车辆位姿变换;
根据所述各个相邻两帧的车辆位姿变换和所述不同时刻同一位置的车辆位姿变换,通过位姿图优化算法得到所述车辆在所有帧的车辆位姿。
3.根据权利要求2所述的道路点云数据处理方法,其特征在于,所述根据所述车辆位姿,计算得到三维点云地图数据包括:
根据计算得到三维点云地图数据,其中sum为三维点云地图数据,Pi为第i帧道路点云数据,Posei为第i帧车辆位姿。
4.根据权利要求1所述的道路点云数据处理方法,其特征在于,所述在所述三维点云地图数据中,提取与多个预设形状参数中每个预设形状参数对应的重复结构数据,得到提取后的三维点云地图数据包括:
在所述三维点云地图数据中,选择多个领域子集,通过ransac算法对多个预设形状参数中的每一个预设形状参数进行拟合;
当拟合成功时,确定所述多个预设形状参数中的每一个预设形状参数对应的重复结构数据;
在所述三维点云地图数据中,提取所述重复结构数据对应的道路点云数据,得到提取后的三维点云地图数据。
5.根据权利要求4所述的道路点云数据处理方法,其特征在于,所述重复结构为平面、线段、圆柱、圆锥或圆环面中的至少一种。
6.根据权利要求1所述的道路点云数据处理方法,其特征在于,所述每个重复结构数据对应的变换矩阵为通过所述变换矩阵将所述每个重复结构数据转换为所述三维点云地图数据中的道路点云数据。
7.一种道路点云数据处理系统,其特征在于,包括:
获取单元,用于获取道路点云数据和与所述道路点云数据对应的同时刻的车辆位置数据;
第一计算单元,用于根据所述道路点云数据和所述车辆位置数据,通过SLAM算法得到车辆位姿;
第二计算单元,用于根据所述车辆位姿,计算得到三维点云地图数据;
第三计算单元,用于在所述三维点云地图数据中,提取与多个预设形状参数中每个预设形状参数对应的重复结构数据,得到提取后的三维点云地图数据,所述提取后的三维点云地图数据中不包含所述多个预设形状参数中每个预设形状参数对应的重复结构数据;
处理单元,用于确定压缩后的三维点云地图数据,所述压缩后的三维点云地图数据包括所述提取后的三维点云地图数据、所述多个预设形状参数以及每个重复结构数据对应的变换矩阵。
8.根据权利要求7所述的道路点云数据处理系统,其特征在于,所述获取单元包括GPS系统、惯性测量装置Imu和激光雷达装置,其中,所述GPS系统和Imu用于获取车辆位置数据,所述激光雷达装置用于获取道路点云数据。
9.根据权利要求7所述的道路点云数据处理系统,其特征在于,所述第一计算单元包括:
第一计算模块,用于根据相邻两帧的道路点云数据,得到所述道路点云数据中的各个相邻两帧的车辆位姿变换;
第二计算模块,用于根据所述车辆位置数据,获取在不同时刻同一位置的车辆位姿变换;
第三计算模块,用于根据所述各个相邻两帧的车辆位姿变换和所述不同时刻同一位置的车辆位姿变换,通过位姿图优化算法得到所述车辆在所有帧的车辆位姿。
10.根据权利要求9所述的道路点云数据处理系统,其特征在于,所述第二计算单元用于根据计算得到三维点云地图数据,其中sum为三维点云地图数据,Pi为第i帧道路点云数据,Posei为第i帧车辆位姿。
CN201611262800.6A 2016-12-30 2016-12-30 道路点云数据处理方法及系统 Active CN108280866B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201611262800.6A CN108280866B (zh) 2016-12-30 2016-12-30 道路点云数据处理方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611262800.6A CN108280866B (zh) 2016-12-30 2016-12-30 道路点云数据处理方法及系统

Publications (2)

Publication Number Publication Date
CN108280866A true CN108280866A (zh) 2018-07-13
CN108280866B CN108280866B (zh) 2021-07-27

Family

ID=62800400

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611262800.6A Active CN108280866B (zh) 2016-12-30 2016-12-30 道路点云数据处理方法及系统

Country Status (1)

Country Link
CN (1) CN108280866B (zh)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108801276A (zh) * 2018-07-23 2018-11-13 奇瑞汽车股份有限公司 高精度地图生成方法及装置
CN108985230A (zh) * 2018-07-17 2018-12-11 深圳市易成自动驾驶技术有限公司 车道线检测方法、装置及计算机可读存储介质
CN109407115A (zh) * 2018-12-25 2019-03-01 中山大学 一种基于激光雷达的路面提取系统及其提取方法
CN109754468A (zh) * 2018-12-25 2019-05-14 网易(杭州)网络有限公司 一种地图压缩方法和装置
WO2020063878A1 (zh) * 2018-09-30 2020-04-02 华为技术有限公司 一种处理数据的方法和装置
CN111098850A (zh) * 2018-10-25 2020-05-05 北京初速度科技有限公司 一种自动停车辅助系统及自动泊车方法
CN111169468A (zh) * 2018-11-12 2020-05-19 北京初速度科技有限公司 一种自动泊车的系统及方法
CN111736114A (zh) * 2020-08-21 2020-10-02 武汉煜炜光学科技有限公司 一种提高激光雷达数据传输速度的方法和激光雷达
CN112307810A (zh) * 2019-07-26 2021-02-02 北京初速度科技有限公司 一种视觉定位效果自检方法及车载终端
CN112424568A (zh) * 2018-12-04 2021-02-26 北京嘀嘀无限科技发展有限公司 构建高清地图的系统和方法
WO2021128297A1 (zh) * 2019-12-27 2021-07-01 深圳市大疆创新科技有限公司 三维点云地图构建方法、系统和设备

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104764457A (zh) * 2015-04-21 2015-07-08 北京理工大学 一种用于无人车的城市环境构图方法
CN105261060A (zh) * 2015-07-23 2016-01-20 东华大学 基于点云压缩和惯性导航的移动场景实时三维重构方法
EP3073443A1 (en) * 2015-03-23 2016-09-28 Université de Mons 3D Saliency map
CN108267141A (zh) * 2016-12-30 2018-07-10 乐视汽车(北京)有限公司 道路点云数据处理系统

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3073443A1 (en) * 2015-03-23 2016-09-28 Université de Mons 3D Saliency map
CN104764457A (zh) * 2015-04-21 2015-07-08 北京理工大学 一种用于无人车的城市环境构图方法
CN105261060A (zh) * 2015-07-23 2016-01-20 东华大学 基于点云压缩和惯性导航的移动场景实时三维重构方法
CN108267141A (zh) * 2016-12-30 2018-07-10 乐视汽车(北京)有限公司 道路点云数据处理系统

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
HAHYOUNG JUNG 等: "3D Map Building Using the Kinect Mounted on a Mobile Robot", 《2014 IEEE INTERNATIONAL CONFERENCE ON INDUSTRIAL TECHNOLOGY (ICIT)》 *
于宁波 等: "一种基于RGB-D SLAM的移动机器人定位和运动规划与控制方法", 《系统科学与数学》 *

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108985230A (zh) * 2018-07-17 2018-12-11 深圳市易成自动驾驶技术有限公司 车道线检测方法、装置及计算机可读存储介质
CN108801276A (zh) * 2018-07-23 2018-11-13 奇瑞汽车股份有限公司 高精度地图生成方法及装置
CN108801276B (zh) * 2018-07-23 2022-03-15 奇瑞汽车股份有限公司 高精度地图生成方法及装置
WO2020063878A1 (zh) * 2018-09-30 2020-04-02 华为技术有限公司 一种处理数据的方法和装置
CN111098850A (zh) * 2018-10-25 2020-05-05 北京初速度科技有限公司 一种自动停车辅助系统及自动泊车方法
CN111169468A (zh) * 2018-11-12 2020-05-19 北京初速度科技有限公司 一种自动泊车的系统及方法
CN111169468B (zh) * 2018-11-12 2023-10-27 北京魔门塔科技有限公司 一种自动泊车的系统及方法
CN112424568A (zh) * 2018-12-04 2021-02-26 北京嘀嘀无限科技发展有限公司 构建高清地图的系统和方法
CN109407115B (zh) * 2018-12-25 2022-12-27 中山大学 一种基于激光雷达的路面提取系统及其提取方法
CN109754468A (zh) * 2018-12-25 2019-05-14 网易(杭州)网络有限公司 一种地图压缩方法和装置
CN109407115A (zh) * 2018-12-25 2019-03-01 中山大学 一种基于激光雷达的路面提取系统及其提取方法
CN112307810A (zh) * 2019-07-26 2021-02-02 北京初速度科技有限公司 一种视觉定位效果自检方法及车载终端
CN112307810B (zh) * 2019-07-26 2023-08-04 北京魔门塔科技有限公司 一种视觉定位效果自检方法及车载终端
WO2021128297A1 (zh) * 2019-12-27 2021-07-01 深圳市大疆创新科技有限公司 三维点云地图构建方法、系统和设备
CN113424232A (zh) * 2019-12-27 2021-09-21 深圳市大疆创新科技有限公司 三维点云地图构建方法、系统和设备
CN113424232B (zh) * 2019-12-27 2024-03-15 深圳市大疆创新科技有限公司 三维点云地图构建方法、系统和设备
CN111736114A (zh) * 2020-08-21 2020-10-02 武汉煜炜光学科技有限公司 一种提高激光雷达数据传输速度的方法和激光雷达

Also Published As

Publication number Publication date
CN108280866B (zh) 2021-07-27

Similar Documents

Publication Publication Date Title
CN108280866A (zh) 道路点云数据处理方法及系统
CN108267141A (zh) 道路点云数据处理系统
KR102145109B1 (ko) 지도 생성 및 운동 객체 위치 결정 방법 및 장치
EP3629052A1 (en) Data collecting method and system
CN104778720B (zh) 一种基于空间不变特性的快速体积测量方法
KR20180079428A (ko) 자동 로컬리제이션을 위한 장치 및 방법
CN110674705B (zh) 基于多线激光雷达的小型障碍物检测方法及装置
WO2018018994A1 (zh) 室内定位方法及定位系统
CN103959308B (zh) 以参考特征匹配图像特征的方法
CN107504972A (zh) 一种基于鸽群算法的飞行器航迹规划方法及装置
CN108872991A (zh) 目标物检测与识别方法、装置、电子设备、存储介质
CN110386142A (zh) 用于自动驾驶车辆的俯仰角校准方法
CN109059906A (zh) 车辆定位方法、装置、电子设备、存储介质
EP3505868A1 (en) Method and apparatus for adjusting point cloud data acquisition trajectory, and computer readable medium
CN111650598A (zh) 一种车载激光扫描系统外参标定方法和装置
KR20200091331A (ko) 다중 카메라 혹은 서라운드 뷰 모니터링에 이용되기 위해, 타겟 객체 통합 네트워크 및 타겟 영역 예측 네트워크를 이용하여 핵심성과지표와 같은 사용자 요구 사항에 적응 가능한 cnn 기반 객체 검출기를 학습하는 방법 및 학습 장치, 그리고 이를 이용한 테스팅 방법 및 테스팅 장치
EP3686791A1 (en) Learning method and learning device for object detector based on cnn to be used for multi-camera or surround view monitoring using image concatenation and target object merging network, and testing method and testing device using the same
CN103542868A (zh) 基于角度和强度的车载激光点云噪点自动去除方法
WO2022179094A1 (zh) 车载激光雷达外参数联合标定方法、系统、介质及设备
CN109708643B (zh) 小行星表面光学导航路标评价选取方法
KR20140094211A (ko) 입체 위성 영상 RPCs 정보를 이용한 단영상에서의 3차원 위치결정 방법
CN109709977A (zh) 移动轨迹规划的方法、装置及移动物体
CN106080397A (zh) 自适应巡航系统及车载设备
CN113378693A (zh) 生成目标检测系统和检测目标的方法及装置
CN116740668A (zh) 三维目标检测方法、装置、计算机设备和存储介质

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20180711

Address after: 511458 9, Nansha District Beach Road, Guangzhou, Guangdong, 9

Applicant after: Rui Chi intelligent automobile (Guangzhou) Co., Ltd.

Address before: 100026 8 floor 909, 105 building 3, Yao Yuan Road, Chaoyang District, Beijing.

Applicant before: Music Automotive (Beijing) Co., Ltd.

SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
CB02 Change of applicant information
CB02 Change of applicant information

Address after: 511458 9, Nansha District Beach Road, Guangzhou, Guangdong, 9

Applicant after: Hengda Faraday future intelligent vehicle (Guangdong) Co., Ltd.

Address before: 511458 9, Nansha District Beach Road, Guangzhou, Guangdong, 9

Applicant before: Rui Chi intelligent automobile (Guangzhou) Co., Ltd.

TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20190320

Address after: 100015 Building No. 7, 74, Jiuxianqiao North Road, Chaoyang District, Beijing, 001

Applicant after: FAFA Automobile (China) Co., Ltd.

Address before: 511458 9, Nansha District Beach Road, Guangzhou, Guangdong, 9

Applicant before: Hengda Faraday future intelligent vehicle (Guangdong) Co., Ltd.

GR01 Patent grant
GR01 Patent grant