CN111208495A - 一种基于激光雷达点云特征线与平面校准的地面提取方法 - Google Patents
一种基于激光雷达点云特征线与平面校准的地面提取方法 Download PDFInfo
- Publication number
- CN111208495A CN111208495A CN202010130256.XA CN202010130256A CN111208495A CN 111208495 A CN111208495 A CN 111208495A CN 202010130256 A CN202010130256 A CN 202010130256A CN 111208495 A CN111208495 A CN 111208495A
- Authority
- CN
- China
- Prior art keywords
- point
- ground
- point cloud
- information
- laser radar
- 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.)
- Pending
Links
- 238000000605 extraction Methods 0.000 title claims abstract description 43
- 238000000034 method Methods 0.000 claims abstract description 21
- 238000007781 pre-processing Methods 0.000 claims abstract description 4
- 239000013598 vector Substances 0.000 claims description 37
- 238000004364 calculation method Methods 0.000 claims description 13
- 238000005259 measurement Methods 0.000 claims description 10
- 239000011159 matrix material Substances 0.000 claims description 9
- 235000014594 pastries Nutrition 0.000 claims 1
- 238000010276 construction Methods 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 8
- 238000009434 installation Methods 0.000 description 4
- 230000011218 segmentation Effects 0.000 description 4
- 230000004888 barrier function Effects 0.000 description 3
- 238000005070 sampling Methods 0.000 description 2
- 238000012163 sequencing technique Methods 0.000 description 2
- 150000001875 compounds Chemical class 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 238000007499 fusion processing Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/497—Means for monitoring or calibrating
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/497—Means for monitoring or calibrating
- G01S7/4972—Alignment of sensor
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Electromagnetism (AREA)
- Radar Systems Or Details Thereof (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明公开了一种基于激光雷达点云特征线与平面校准的地面提取方法,属于车载激光扫描技术领域,该方法包括以下步骤:对雷达采集的点云信息进行预处理;根据雷达的水平扫描分辨率对预处理后的点云信息,以射线形式按照到雷达中心的距离由近到远进行排序;通过多线激光雷达的扫描线分布特征,结合扫描物体的高度信息,对地面点信息进行初步提取;对初步提取的地面点进行平面模型构建,再根据平面模型构建旋转模型,通过该旋转模型对初步提取的地面点进行水平校准,即完成地面点信息再次提取;该方法能够在提高实时性和校正点云的水平误差的同时提取地面与非地面点,在不改变点云特征的情况下通过压缩点云数据的方法减少了所要计算的点云数据量,缩短了耗时,提高了实时性。
Description
技术领域
本发明涉及车载激光扫描技术领域,尤其涉及一种基于激光雷达点云特征线与平面校准的地面提取方法。
背景技术
三维激光雷达以其较远的扫描距离,能获得精确的三维信息,稳定性以及鲁棒性好的优势正逐步应用于车载地图的构建当中。目前在该领域中,在激光雷达点云地面分割算法方面存在着两点不足之处:
(1)处理的数据量巨大耗时较长,目前市面上用于地形扫描的多线雷达为16线、32线、64线,其内部安装多对激光发射与激光接收装置,进行360度的全景扫描,每秒的数据量最少为32万,最多为130万左右。若直接使用如此庞大的数据计算,会非常缓慢,达不到车前地形在线高速实时测量的基本要求。
(2)获取的点云数据在雷达坐标系中具有水平误差,已知的地面分割算法均未考虑传感器本身误差,传感器安装误差以及车辆颠簸带来的影响。激光雷达传感器采集的数据会由于车辆的震动和颠簸,硬件安装以及数据融合过程中的系统误差,导致其在雷达坐标系中有一定的倾斜误差,而惯性测量单元本身也是有误差的,因此当倾斜度较小时性测量单元也无法进行正确的雷达点云姿态校正。当前的地面分割算法中并未考虑地面点云在雷达坐标系中发生小角度倾斜的情况,这种情况会直接影响到后续的全局地图的构建,正负障碍物的正确分类以及障碍物高度和位置等定量信息提取的精度等等。
发明内容
针对当前激光雷达点云地面分割算法中数据量巨大耗时较长和获取的点云数据在雷达坐标系中具有水平误差两个问题,本发明公开了一种基于激光雷达点云特征线与平面校准的地面提取方法,包括以下步骤:
S1:对雷达采集的点云信息进行预处理;
S2:根据雷达的水平扫描分辨率对预处理后的点云信息,以射线形式按照到雷达中心的距离由近到远进行排序;
S3:通过多线激光雷达的扫描线分布特征,结合扫描物体的高度信息,对地面点信息进行初步提取;
S4:对初步提取的地面点进行平面模型构建,再根据平面模型构建旋转模型,通过该旋转模型对初步提取的地面点进行水平校准,即完成地面点信息再次提取。
进一步地,所述对地面点信息进行初步提取的方式如下:
S3-1:通过多线激光雷达的扫描线分布特征,获得扫描物体的高度信息;
S3-2:通过当前点和前一点的高度之间的关系,判断当前点是否为地面点。
进一步地,所述扫描物体的高度信息包括相对高度阈值信息、整体高度阈值信息和地面某点的高度信息;
其中设定射线上某点与其同条射线上前一点的相对高度阈值信息△H1i计算公式如下:
ΔH1i=tanθS×ΔLi (2)
射线上某点的整体高度阈值△H2i计算公式如下:
△H2i=tanθG×Li (3)
ΔLi=Li-Li-1,(i=1,2,3,…32) (4)
式中,θS为同条射线上当前点与前一点的相对坡度阈值,θG为整个地面的坡度阈值,△Li为同条射线上当前点与前一点之间的水平距离,i为激光雷达第i条扫描线上的点;
地面某点的高度Hi的计算公式为:
Hi=|zi-zLidar| (5)
zLiadr为激光雷达的安装高度,zi为雷达坐标系中点的z坐标值。
进一步地,通过当前点i和前一点i-1的高度之间的关系,判断当前点是否为地面点的过程如下:
若前一点(i-1)点是地面点时:
(1)如果|Hi-Hi-1|<△H1i,即可确定当前点为地面点;
(2)如果|Hi-Hi-1|≥△H1i:若Hi<△H2i,当前点为地面点,若Hi≥△H2i,当前点为障碍点;
若前一点(i-1点)是非地面点时:
(1)如果|Hi-Hi-1|<△H1i:若Hi<△H2i,当前点为地面点,若Hi≥△H2i,当前点为非地面点;
(2)如果|Hi-Hi-1|≥△H1i:若Hi<△H2i,当前点为地面点,若Hi≥△H2i,当前点为非地面点。
进一步地,地面某点的提取过程出现过分割与欠分割情况,通过下列公式对地面高度阈值做出相应调整:
式中,△H,△Lmin,△Lmax均为预设值。
进一步地,所述通过旋转模型对初步提取的地面点进行水平校准的方法,包括以下步骤:
S4-1:求取初步粗提取的地面点的单位法向量,定义其为旋转前单位向量,向量(0,0,1)为旋转后单位向量;
S4-2:计算出地面点云的单位法向量到竖直向量(0,0,1)的旋转矩阵,将此矩阵运用到全局点云,即可完成全局点云的水平校准。
一种基于激光雷达点云特征线与平面校准的地面提取系统,包括:环境感知单元、地面提取单元和平面校准单元;
所述环境感知单元包括激光雷达传感器和惯性测量模块;
所述激光雷达传感器采集点云信息,所述惯性测量模块采集激光雷达的姿态信息;
所述地面提取单元根据环境感知单元采集的点云信息和姿态信息进行地面点的初步提取;
平面校准单元对所述地面提取单元初步提取的地面点进行水平校准。
由于采用了上述技术方案,本发明提供的一种基于激光雷达点云特征线与平面校准的地面提取方法,尤其针对提高算法的实时性和地面的水平校准进行了深入研究,该方法能够在提高实时性和校正点云的水平误差的同时提取地面与非地面点,在不改变点云特征的情况下通过压缩点云数据的方法减少了所要计算的点云数据量,缩短了耗时,提高了实时性;通过地面点云提取后利用校准模型校准全局点云的方法,降低了提取的地面点和非地面点在激光雷达坐标系中的水平误差,有益于提高后续的障碍物信息提取,高精度地图的重建等的精度;本发明提供了一种基于激光雷达点云特征线与平面校准的地面提取系统,用于在提高实时性和校正点云的水平误差的同时提取地面与非地面点。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请中记载的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明方法的步骤图;
图2是雷达的水平角度分辨率示意图;
图3是当前一点是地面点时,|Hi-Hi-1|<△H1i时示意图;
图4是当前一点是地面点时,|Hi-Hi-1|≥△H1i,Hi<△H2i时示意图;
图5是当前一点是地面点时,|Hi-Hi-1|≥△H1i,Hi≥△H2i时示意图;
图6是当前一点不是地面点时,|Hi-Hi-1|<△H1i,Hi<△H2i时示意图;
图7是当前一点不是地面点时,|Hi-Hi-1|<△H1i,Hi≥△H2i时示意图;
图8是当前一点不是地面点时,|Hi-Hi-1|≥△H1i,Hi<△H2i时示意图;
图9是当前一点不是地面点时,|Hi-Hi-1|≥△H1i,Hi≥△H2i时示意图;
图10是物体与雷达距离适中和距离较近时示意图;
图11是物体与雷达距离适中和距离较远时示意图;
图12是地面点云在雷达坐标系中的状态示意图;
图13是基于激光雷达点云特征线与平面校准的地面提取方法的详细流程;
图14是本发明地面提取系统安装位置图。
具体实施方式
为使本发明的技术方案和优点更加清楚,下面结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚完整的描述:
图1是本发明方法的步骤图;本发明提出了一种基于激光雷达点云特征线与平面校准的地面提取方法,包括以下步骤:
S1:对雷达采集的点云信息进行预处理,采用点云下采样方法压缩点云,降低计算时间和算法复杂度;
S2:根据雷达的水平扫描分辨率对预处理后的点云信息,以射线形式按照到雷达中心的距离由近到远进行排序,给每个点分配方位角信息;
S3:通过多线激光雷达的扫描线分布特征,结合扫描物体的高度信息,对地面点信息进行初步提取;
S4:对初步提取的地面点进行平面模型构建,再根据平面模型构建旋转模型,通过该旋转模型对初步提取的地面点进行水平校准,即完成地面点信息再次提取。
进一步地,采用点云下采样方法压缩点云的过程如下:
具体的,使用体素化栅格方法,将所有点云输入之后建立一个包含所有点云的三维体素栅格,其模型为:
式中Dx,Dy,Dz分别为三维体素栅格三边边长,xmax,xmin,ymax,ymin,zmax,zmin分别为点云中x,y,z三个坐标值最大和最小的点,η为三维体素栅格边长的余量,确保边界点在网格内。该三维体素栅格由很多微小的三维立方体的集合构成,每个小的三维立方体中包含着不同数量的点云,在每个小的三维立方体中用其包含的所有点的重心来表示该三维立方体中包含的所有点,其模型为:
式中,g表示三维小立方体包含的点数,(Xct,Yct,Zct)为三维小立方体的重心,(xi,yi,zi)为数据点在雷达坐标系中的坐标,设定的三维小立方体的边长为10厘米;
进一步地,所述以射线形式按照到雷达中心的距离由近到远进行排序的具体方法如下:
计算点云中的点到雷达中心点的水平距离Li,然后计算点云中的点相对于车头正方向(即x方向)的夹角θ:
x,y分别为点云中的点在激光雷达坐标系中的横纵坐标值,Li为点云中的点到雷达中心的水平距离。
按照激光雷达的水平分辨率对点云进行水平角度微分,一共可以分为多条射线,将每条射线中的点按照到雷达中心的距离的远近(半径从小到大)进行排序,并将其按照由内向外的顺序重新存储。当前使用的激光雷达扫描频率为20Hz,雷达的水平角度分辨率为0.36°,射线的条数为360°÷0.36°=1000,图2是雷达的水平角度分辨率示意图。
进一步地:所述对地面点信息进行初步提取的方式如下:
S3-1:通过多线激光雷达的扫描线分布特征,获得扫描物体的高度信息;
S3-2:通过当前点和前一点的高度之间的关系,判断当前点是否为地面点。
进一步地,所述扫描物体的高度信息包括如下相对高度阈值信息、整体高度阈值信息和地面某点的高度信息;
其中设定射线上某点与其同条射线上前一点的相对高度阈值信息△H1i计算公式如下:
ΔH1i=tanθS×ΔLi (5)
射线上某点的整体高度阈值△H2i计算公式如下:
△H2i=tanθG×Li (6)
ΔLi=Li-Li-1,(i=1,2,3,…32) (7)
式中,θS为同条射线上当前点与前一点的相对坡度阈值,θG为整个地面的坡度阈值,△Li为同条射线上当前点与前一点之间的水平距离,i为激光雷达第i条扫描线上的点;
地面某点的高度Hi的计算公式如下:
Hi=|zi-zLidar| (8)
其中,zLiadr为激光雷达的安装高度,zi为雷达坐标系中点的z坐标值。在这里,雷达的安装高度zLiadr=0.55米,水平安装。
进一步地:通过当前点(i)和前一点(i-1)的高度之间的关系,判断当前点是否为地面点的过程如下:
若前一点(i-1)点是地面点时:
(1)如果|Hi-Hi-1|<△H1i,即可确定当前点为地面点;图3是当前一点是地面点时,|Hi-Hi-1|<△H1i时示意图;
(2)如果|Hi-Hi-1|≥△H1i:若Hi<△H2i,当前点为地面点,图4是当前一点是地面点时,|Hi-Hi-1|≥△H1i,Hi<△H2i时示意图,若Hi≥△H2i,当前点为障碍点,图5是当前一点是地面点时,|Hi-Hi-1|≥△H1i,Hi≥△H2i时示意图;
若前一点(i-1点)不是地面点时:
(1)如果|Hi-Hi-1|<△H1i:若Hi<△H2i,当前点为地面点,图6是当前一点不是地面点时,|Hi-Hi-1|<△H1i,Hi<△H2i时示意图;
,若Hi≥△H2i,当前点为非地面点,图7是当前一点不是地面点时,|Hi-Hi-1|<△H1i,Hi≥△H2i时示意图;
(2)如果|Hi-Hi-1|≥△H1i:若Hi<△H2i,当前点为地面点,图8是当前一点不是地面点时,|Hi-Hi-1|≥△H1i,Hi<△H2i时示意图;若Hi≥△H2i,当前点为非地面点,图9是当前一点不是地面点时,|Hi-Hi-1|≥△H1i,Hi≥△H2i时示意图;
进一步地,所述地面某点的提取过程出现过分割和欠分割两种情况:
(1)假如地面坡度阈值是固定的,当物体距离雷达较近时,那么在相距较近的两条雷达扫描线之间容易将前景分割为背景,出现欠分割的情况,图10是物体与雷达距离适中和距离较近时示意图;B点在地面点的范围之内,障碍物在②处时B点划分为地面点是正确的,障碍物在①处时距离雷达较近,△H2i较小,B点被划分为障碍点是错误的;
(2)当物体距离雷达较远时,在相距较远的两条雷达扫描线之间将背景分割为前景,出现过分割的情况,图11是物体与雷达距离适中和距离较远时示意图;B点不在地面点的范围之内,障碍物在①处时B点划分为障碍点是正确的,障碍物在②处时距离雷达较远,△H2i过大,B点被划分为地面点是错误的;。
进一步地,地面某点的提取过程出现过分割与欠分割情况,通过下列公式对地面高度阈值做出相应调整:
式中,△H,△Lmin,△Lmax均为预设值,这样能有效解决物体和雷达由于距离不同出现的过分割和欠分割情况。
进一步地,所述通过旋转模型对初步提取的地面点进行水平校准的方法,包括以下步骤:
S4-1:求取初步粗提取的地面点的单位法向量,定义其为旋转前单位向量,向量(0,0,1)为旋转后单位向量;
S4-2:计算出地面点云的单位法向量到竖直向量(0,0,1)的旋转矩阵,将此矩阵运用到全局点云,即可完成全局点云的水平校准。
具体计算过程如下:
具体的,平面模型为:
ax+by+cz+d=0 (10)
该单位法向量向雷达坐标系中的(0,0,1)向量进行旋转,其旋转矩阵作为点云的旋转标准,即可将所有点云进行校准。图12是地面点云在雷达坐标系中的状态示意图,其在雷达坐标系中不是水平的。
已知旋转前向量为M,旋转后变为N,则
M·N=|M||N|cosθ (11)
两向量之间的夹角θ为:
向量M和向量N构成了一个平面,夹角θ即在此平面内,由几何关系可知,向量M向向量N旋转时所绕的旋转轴必然垂直于向量M和向量N构成的平面,设旋转前向量为M(m1,m2,m3),旋转后向量为N(n1,n2,n3),旋转轴为G(g1,g2,g3),则M和N之间的关系为:
由式(13)可知G(g1,g2,g3)为:
将单位向量M(m1,m2,m3)旋转θ角,由罗德里格斯旋转公式可得旋转矩阵RM(θ)为:
通过以上步骤便完成了对激光雷达点云数据的基于激光雷达点云特征线与平面校准的地面提取,图13是基于激光雷达点云特征线与平面校准的地面提取方法的详细流程。
一种基于激光雷达点云特征线与平面校准的地面提取系统,图14是本发明地面提取系统安装位置图;
所述系统包括:环境感知单元、地面提取单元和平面校准单元;
所述环境感知单元包括激光雷达传感器、惯性测量模块和地面移动平台组成;
所述激光雷达传感器采集点云信息,所述惯性测量模块采集激光雷达的姿态信息;
所述地面提取单元根据环境感知单元采集的点云信息和姿态信息进行地面点的初步提取;
平面校准单元对所述地面提取单元初步提取的地面点进行水平校准;
该系统的环境感知单元还包括地面移动平台,所述地面移动平台用于搭载激光雷达传感器和惯性测量模块。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,根据本发明的技术方案及其发明构思加以等同替换或改变,都应涵盖在本发明的保护范围之内。
Claims (7)
1.一种基于激光雷达点云特征线与平面校准的地面提取方法,其特征在于:包括以下步骤:
S1:对雷达采集的点云信息进行预处理;
S2:根据雷达的水平扫描分辨率对预处理后的点云信息,以射线形式按照到雷达中心的距离由近到远进行排序;
S3:通过多线激光雷达的扫描线分布特征,结合扫描物体的高度信息,对地面点信息进行初步提取;
S4:对初步提取的地面点进行平面模型构建,再根据平面模型构建旋转模型,通过该旋转模型对初步提取的地面点进行水平校准,即完成地面点信息再次提取。
2.根据权利要求1所述的一种基于激光雷达点云特征线与平面校准的地面提取方法,其特征在于:所述对地面点信息进行初步提取的方式如下:
S3-1:通过多线激光雷达的扫描线分布特征,获得扫描物体的高度信息;
S3-2:通过当前点和前一点的高度之间的关系,判断当前点是否为地面点。
3.根据权利要求2所述的一种基于激光雷达点云特征线与平面校准的地面提取方法,其特征在于:所述扫描物体的高度信息包括相对高度阈值信息、整体高度阈值信息和地面某点的高度信息;
其中设定射线上某点与其同条射线上前一点的相对高度阈值信息△H1i计算公式如下:
ΔH1i=tanθS×ΔLi (2)
射线上某点的整体高度阈值△H2i计算公式如下:
△H2i=tanθG×Li (3)
ΔLi=Li-Li-1,(i=1,2,3,…32) (4)
式中,θS为同条射线上当前点与前一点的相对坡度阈值,θG为整个地面的坡度阈值,△Li为同条射线上当前点与前一点之间的水平距离,i为激光雷达第i条扫描线上的点;
地面某点的高度Hi的计算公式为:
Hi=|zi-zLidar| (5)
zLiadr为激光雷达的安装高度,zi为雷达坐标系中点的z坐标值。
4.根据权利要求2所述的一种基于激光雷达点云特征线与平面校准的地面提取方法,其特征在于:通过当前点(i)和前一点(i-1)的高度之间的关系,判断当前点是否为地面点的过程如下:
若前一点(i-1)点是地面点时:
(1)如果|Hi-Hi-1|<△H1i,即可确定当前点为地面点;
(2)如果|Hi-Hi-1|≥△H1i:若Hi<△H2i,当前点为地面点,若Hi≥△H2i,当前点为障碍点;
若前一点(i-1点)是非地面点时:
(1)如果|Hi-Hi-1|<△H1i:若Hi<△H2i,当前点为地面点,若Hi≥△H2i,当前点为非地面点;
(2)如果|Hi-Hi-1|≥△H1i:若Hi<△H2i,当前点为地面点,若Hi≥△H2i,当前点为非地面点。
6.根据权利要求1所述的一种基于激光雷达点云特征线与平面校准的地面提取方法,其特征在于,所述通过旋转模型对初步提取的地面点进行水平校准的方法,包括以下步骤:
S4-1:求取初步粗提取的地面点的单位法向量,定义其为旋转前单位向量,向量(0,0,1)为旋转后单位向量;
S4-2:计算出地面点云的单位法向量到竖直向量(0,0,1)的旋转矩阵,将此矩阵运用到全局点云,即可完成全局点云的水平校准。
7.一种基于激光雷达点云特征线与平面校准的地面提取系统,其特征在于:所述系统包括:环境感知单元、地面提取单元和平面校准单元;
所述环境感知单元包括激光雷达传感器和惯性测量模块;
所述激光雷达传感器采集点云信息,所述惯性测量模块采集激光雷达的姿态信息;
所述地面提取单元根据环境感知单元采集的点云信息和姿态信息进行地面点的初步提取;
平面校准单元对所述地面提取单元初步提取的地面点进行水平校准。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010130256.XA CN111208495A (zh) | 2020-02-28 | 2020-02-28 | 一种基于激光雷达点云特征线与平面校准的地面提取方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010130256.XA CN111208495A (zh) | 2020-02-28 | 2020-02-28 | 一种基于激光雷达点云特征线与平面校准的地面提取方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111208495A true CN111208495A (zh) | 2020-05-29 |
Family
ID=70789819
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010130256.XA Pending CN111208495A (zh) | 2020-02-28 | 2020-02-28 | 一种基于激光雷达点云特征线与平面校准的地面提取方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111208495A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111709432A (zh) * | 2020-06-19 | 2020-09-25 | 天津市滨海新区水务局 | 复杂城市环境下InSAR地面点提取方法、装置、服务器及存储介质 |
CN112200171A (zh) * | 2020-12-07 | 2021-01-08 | 速度时空信息科技股份有限公司 | 一种基于扫描线的道路点云的提取方法 |
CN112729109A (zh) * | 2020-12-21 | 2021-04-30 | 福建汇川物联网技术科技股份有限公司 | 一种点云数据的校正方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107167788A (zh) * | 2017-03-21 | 2017-09-15 | 深圳市速腾聚创科技有限公司 | 获取激光雷达校准参数、激光雷达校准的方法及系统 |
CN107766405A (zh) * | 2016-08-23 | 2018-03-06 | 德尔福技术有限公司 | 自动车辆道路模型定义系统 |
CN110163871A (zh) * | 2019-05-07 | 2019-08-23 | 北京易控智驾科技有限公司 | 一种多线激光雷达的地面分割方法 |
CN110490812A (zh) * | 2019-07-05 | 2019-11-22 | 哈尔滨理工大学 | 基于高斯过程回归算法的地面滤波方法 |
CN110781827A (zh) * | 2019-10-25 | 2020-02-11 | 中山大学 | 一种基于激光雷达与扇状空间分割的路沿检测系统及其方法 |
-
2020
- 2020-02-28 CN CN202010130256.XA patent/CN111208495A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107766405A (zh) * | 2016-08-23 | 2018-03-06 | 德尔福技术有限公司 | 自动车辆道路模型定义系统 |
CN107167788A (zh) * | 2017-03-21 | 2017-09-15 | 深圳市速腾聚创科技有限公司 | 获取激光雷达校准参数、激光雷达校准的方法及系统 |
CN110163871A (zh) * | 2019-05-07 | 2019-08-23 | 北京易控智驾科技有限公司 | 一种多线激光雷达的地面分割方法 |
CN110490812A (zh) * | 2019-07-05 | 2019-11-22 | 哈尔滨理工大学 | 基于高斯过程回归算法的地面滤波方法 |
CN110781827A (zh) * | 2019-10-25 | 2020-02-11 | 中山大学 | 一种基于激光雷达与扇状空间分割的路沿检测系统及其方法 |
Non-Patent Citations (1)
Title |
---|
李炯 等: "基于射线坡度阈值的城市地面分割算法" * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111709432A (zh) * | 2020-06-19 | 2020-09-25 | 天津市滨海新区水务局 | 复杂城市环境下InSAR地面点提取方法、装置、服务器及存储介质 |
CN111709432B (zh) * | 2020-06-19 | 2023-04-25 | 天津市滨海新区水务局 | 复杂城市环境下InSAR地面点提取方法、装置、服务器及存储介质 |
CN112200171A (zh) * | 2020-12-07 | 2021-01-08 | 速度时空信息科技股份有限公司 | 一种基于扫描线的道路点云的提取方法 |
CN112200171B (zh) * | 2020-12-07 | 2021-03-23 | 速度时空信息科技股份有限公司 | 一种基于扫描线的道路点云的提取方法 |
CN112729109A (zh) * | 2020-12-21 | 2021-04-30 | 福建汇川物联网技术科技股份有限公司 | 一种点云数据的校正方法及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111457902B (zh) | 基于激光slam定位的水域测量方法及系统 | |
CN110969624B (zh) | 一种激光雷达三维点云分割方法 | |
CN109752701B (zh) | 一种基于激光点云的道路边沿检测方法 | |
CN111208495A (zh) | 一种基于激光雷达点云特征线与平面校准的地面提取方法 | |
CN106997049A (zh) | 一种基于激光点云数据的检测障碍物的方法和装置 | |
CN111340875B (zh) | 一种基于三维激光雷达的空间移动目标检测方法 | |
CN101008571A (zh) | 一种移动机器人三维环境感知方法 | |
CN110673107B (zh) | 基于多线激光雷达的路沿检测方法及装置 | |
CN115372989A (zh) | 基于激光雷达的越野自动小车长距离实时定位系统及方法 | |
CN112987065A (zh) | 一种融合多传感器的手持式slam装置及其控制方法 | |
CN110927762B (zh) | 一种定位修正方法、装置及系统 | |
CN114419130A (zh) | 一种基于图像特征和三维点云技术的散料体积测量方法 | |
CN111553292A (zh) | 一种基于点云数据的岩体结构面识别与产状分类方法 | |
CN110864696A (zh) | 一种基于车载激光惯导数据的三维高精地图绘制方法 | |
CN114877838B (zh) | 一种基于车载激光扫描系统的道路几何特征检测方法 | |
CN114004869A (zh) | 一种基于3d点云配准的定位方法 | |
CN114581619A (zh) | 一种基于三维定位和二维建图的煤仓建模方法 | |
CN114325634A (zh) | 一种基于激光雷达的高鲁棒性野外环境下可通行区域提取方法 | |
CN115718305A (zh) | 一种激光点云公路断面处理方法、装置、设备及存储介质 | |
CN111476798B (zh) | 一种基于轮廓约束的车辆空间形态识别方法及系统 | |
CN114612665A (zh) | 基于法向量直方图特征的位姿估计及动态车辆检测方法 | |
CN115131514A (zh) | 一种同时定位建图的方法、装置、系统及存储介质 | |
CN117572451A (zh) | 一种基于多线激光雷达的交通信息采集方法、设备及介质 | |
CN114631124A (zh) | 三维点云分割方法和装置、可移动平台 | |
CN111521996A (zh) | 一种激光雷达的安装标定方法 |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200529 |
|
RJ01 | Rejection of invention patent application after publication |