CN110109145A - 基于多线激光雷达的行驶区域检测方法及装置 - Google Patents
基于多线激光雷达的行驶区域检测方法及装置 Download PDFInfo
- Publication number
- CN110109145A CN110109145A CN201910365161.3A CN201910365161A CN110109145A CN 110109145 A CN110109145 A CN 110109145A CN 201910365161 A CN201910365161 A CN 201910365161A CN 110109145 A CN110109145 A CN 110109145A
- Authority
- CN
- China
- Prior art keywords
- laser radar
- line laser
- slope
- pose
- circle
- 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
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- 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/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Automation & Control Theory (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明实施例公开一种基于多线激光雷达的行驶区域检测方法及装置,其中方法包括如下步骤:根据多线激光雷达的实际点云和多线激光雷达相对于参考平面的初始参考点,对多线激光雷达和IMU之间的相对位姿进行标定,基于位姿标定后的IMU和多线激光雷达检测当前行驶区域内的障碍物,计算障碍物距离同一水平线上的两边录肩的检测距离,根据检测距离确定基于当前行驶位置的有效行驶区域。采用本发明,可以在线束密集度不够时提高多线激光雷达对行驶区域检测的鲁棒性和检测精度。
Description
技术领域
本发明涉及机器人自动控制技术领域,尤其涉及一种基于多线激光雷达的行驶区域检测方法及装置。
背景技术
在无人驾驶和室外机器人领域,可通行区域检测是一个很重要的问题,该项内容决定了载体能否在复杂的环境或未知区域内正常安全的行驶。
目前已经有多种传感器和相关算法用于该领域,包括超声波雷达,毫米波雷达,激光雷达以及计算机视觉等。其中,超声波雷达最为便宜,但是其测量精度非常有限,并不能很好的用于检测路面的细节;毫米波雷达有很高的精度和鲁棒性,但是和超声雷达一样有一个缺点,就是观测的范围和角度非常有限;计算机视觉中主流的手段是利用发射的主动红外光源,观测物体的深度信息,但是受太阳光照影响,该手段不能很好的应用在室外的场景;纯计算机视觉依靠被动反射光源,在光线不足的时候,或者在遇到深色的障碍物的情况下更是毫无解决办法。
多线激光雷达由于其高精度,以及适用于绝大部分场景,目前任是检测路面的主要手段。然而,多线激光雷达的造价相对高昂,而且线束越多越密集,成本就越昂贵。但是线束稀疏的激光雷达,比如16线激光雷达,根据目前的算法并不能有效的检测路面信息。另外传统的激光雷达点云处理的算法,都是基于载体坐标系进行处理的,而载体即便轻微的倾斜也会对检测结果带来很大的影响,如下图1所示,载体在刚加速的时候由于惯性会产生角度倾斜,而激光雷达观测的点云会被误判断为在地面以下。这种情况虽然可以使用IMU实时纠正数据来缓解,但是该手段对IMU的精度要求十分高。
发明内容
本发明实施例提供一种基于多线激光雷达的行驶区域检测方法及装置,通过对多线传感器和IMU之间进行位姿标定,在标定后根据标定参考点和实际点云的斜率检测障碍物,确定有效的行驶区域,可以在线束密集度不够时提高多线激光雷达对行驶区域检测的鲁棒性和检测精度。
本发明实施例第一方面提供了一种基于多线激光雷达的行驶区域检测方法,可包括:
根据多线激光雷达的实际点云和所述多线激光雷达相对于参考平面的初始参考点,对所述多线激光雷达和IMU之间的相对位姿进行标定;
基于位姿标定后的IMU和多线激光雷达检测当前行驶区域内的障碍物;
计算所述障碍物距离同一水平线上的两边录肩的检测距离;
根据所述检测距离确定基于当前行驶位置的有效行驶区域。
进一步的,上述根据多线激光雷达的实际点云和所述多线激光雷达相对于参考平面的初始参考点,对所述多线激光雷达和IMU之间的相对位姿进行标定,包括:
根据所记录的多线激光雷达的高度和IMU读取的所述多线激光雷达的姿态角度信息,计算所述多线激光雷达相对于参考平面的初始参考点;
输出显示所述初始参考点在所述参考平面上形成的参考圆以及实际点云在实际路面上形成的实际圆;
动态显示所述参考圆与所述实际圆之间的吻合程度;
当所述参考圆与所述实际圆重合时,确定位姿标定成功。
进一步的,上述基于位姿标定后的IMU和多线激光雷达检测当前行驶区域内的障碍物,包括:
基于位姿标定后的IMU确定所述多线激光雷达相对于所述参考平面的标定参考点;
根据两目标实际点云的斜率和对应的两标定参考点的斜率,确定所述两目标实际点云指示的目标路面是否存在障碍物。
进一步的,上述根据两目标实际点云的斜率和对应的标定两参考点的斜率,确定所述两目标实际点云指示的目标路面是否存在障碍物,包括:
根据两目标实际点云的坐标计算二者之间的实际斜率;
确定所述两目标实际点云对应的两标定参考点,根据所述两标定参考点的坐标计算二者之间的参考斜率;
当所述实际斜率与所述参考斜率的差值大于预设差值阈值时,确定所述两目标实际点云对应的目标路面存在障碍物。
进一步的,上述方法还包括:
当在行驶过程中检测到满足预设高度阈值的连续固定高度的障碍物时,确定所述障碍物为当前行驶区域的路肩。
进一步的,上述计算所述障碍物距离同一水平线上的两边录肩的检测距离,包括:
确定所述障碍物的实际中心坐标点的实际水平坐标;
以所述实际水平坐标为基准,计算所述障碍物距离同一水平线上的两边录肩的检测距离。
本发明实施例第二方面提供了一种基于多线激光雷达的行驶区域检测装置,可包括:
位姿标定模块,用于根据多线激光雷达的实际点云和所述多线激光雷达相对于参考平面的初始参考点,对所述多线激光雷达和IMU之间的相对位姿进行标定;
障碍物检测模块,用于基于位姿标定后的IMU和多线激光雷达检测当前行驶区域内的障碍物;
检测距离计算模块,用于计算所述障碍物距离同一水平线上的两边录肩的检测距离;
有效区域确定模块,用于根据所述检测距离确定基于当前行驶位置的有效行驶区域。
进一步的,上述位姿标定模块包括:
初始坐标计算单元,用于根据所记录的多线激光雷达的高度和IMU读取的所述多线激光雷达的姿态角度信息,计算所述多线激光雷达相对于参考平面的初始参考点;
标定圆显示单元,用于输出显示所述初始参考点在所述参考平面上形成的参考圆以及实际点云在实际路面上形成的实际圆;
标定动态显示单元,用于动态显示所述参考圆与所述实际圆之间的吻合程度;
标定成功确认单元,用于当所述参考圆与所述实际圆重合时,确定位姿标定成功。
进一步的,上述障碍物检测模块包括:
标定坐标确定单元,用于基于位姿标定后的IMU确定所述多线激光雷达相对于所述参考平面的标定参考点;
障碍物检测单元,用于根据两目标实际点云的斜率和对应的两标定参考点的斜率,确定所述两目标实际点云指示的目标路面是否存在障碍物。
进一步的,上述障碍物检测单元包括:
实际斜率计算子单元,用于根据两目标实际点云的坐标计算二者之间的实际斜率;
参考斜率计算子单元,用于确定所述两目标实际点云对应的两标定参考点,根据所述两标定参考点的坐标计算二者之间的参考斜率;
障碍物确定子单元,用于当所述实际斜率与所述参考斜率的差值大于预设差值阈值时,确定所述两目标实际点云对应的目标路面存在障碍物。
进一步的,上述装置还包括:
路肩确定模块,用于当在行驶过程中检测到满足预设高度阈值的连续固定高度的障碍物时,确定所述障碍物为当前行驶区域的路肩。
进一步的,上述检测距离计算模块包括:
水平坐标确定单元,用于确定所述障碍物的实际中心坐标点的实际水平坐标;
检测距离计算单元,用于以所述实际水平坐标为基准,计算所述障碍物距离同一水平线上的两边录肩的检测距离。
在本发明实施例中,通过对多线传感器和IMU之间进行位姿标定,在标定后根据参考点和实际点云的斜率检测障碍物,确定有效的行驶区域,在线束密集度不够时提高了多线激光雷达对行驶区域检测的鲁棒性和检测精度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍。
图1是本发明实施例提供的一种基于多线激光雷达的行驶区域检测方法的流程示意图;
图2是本发明实施例提供的多线激光雷达激光束与设备间相对角度示意图;
图3是本发明实施例提供的参考点几何解释示意图;
图4是本发明实施例提供的位姿标定可视化效果示意图;
图5是本发明实施例提供的斜率的计算与对比效果示意图;
图6是本发明实施例提供的行驶区域确定效果示意图;
图7是本发明实施例提供的基于多线激光雷达的行驶区域检测装置的结构示意图;
图8是本发明实施例提供的位姿标定模块的结构示意图;
图9是本发明实施例提供的障碍物检测模块的结构示意图;
图10是本发明实施例提供的障碍物检测单元的结构示意图;
图11是本发明实施例提供的检测距离计算模块的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述。
本发明实施例提供的基于多线激光雷达的行驶区域检测方法可以应用于采用线束稀疏的多线激光雷达(例如,16线激光雷达)检测路面行驶区域的应用场景中。
需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
下面将结合附图1-附图6,对本发明实施例提供的基于多线激光雷达的行驶区域检测方法进行详细介绍。
请参见图1,为本发明实施例提供了一种基于多线激光雷达的行驶区域检测方法的流程示意图。如图1所示,本发明实施例的所述方法可以包括以下步骤S101-步骤S104。
S101,根据多线激光雷达的实际点云和多线激光雷达相对于参考平面的初始参考点,对多线激光雷达和IMU之间的相对位姿进行标定。
可以理解的是,多线激光雷达的每束光线相对与设备都有一个特定的角度,如图2所示。上述装置可以利用惯性测量单元(Inertial measurement unit,IMU)的姿态角度信息和已知的激光雷达高程信息,计算得出激光点云在扫到平整的路面情况下每个激光点所处的XY平面的位置,可以称为初始参考点,而实际点云为多线激光雷达扫到的实际路面时,每个激光点在路面上所处的位置。需要说明的是,在进行位姿标定前,多线激光雷达和IMU固定在一个刚性载体上,且雷达的高度为固定不变的。
具体的,上述装置可以根据上述实际点云和初始参考点对多线激光雷达和IMU之间的相对位姿进行标定,确保对行驶区域检测之前,激光雷达在地图中的定位得到的姿态角度信息要与IMU观测到的姿态信息一致。
在可选实施例中,上述装置可以获取所记录的多线激光雷达的高度h(雷达中心到水平地面的垂直距离)和当前IMU读取的姿态角度信息β(雷达中心线与铅垂线的夹角),根据如图3所示的h和β几何关系确定上述初始参考点的坐标。进一步的,上述装置可以输出显示上述初始参考点坐标在参考平面上形成的参考圆,以及实际点云在实际路面上形成的实际圆,可以理解的是,如果激光雷达水平的安装,则如图2所示的角度为负数的激光束扫到水平地面后形成的点云理论上是标准的圆形,如果激光雷达姿态发生变化,如向一侧倾斜,理论点云也会对应的发生变化,如图4所示实线圆为参考圆,虚线圆为实际圆。进一步的,通过观察上述参考圆和实际圆之间的偏差,可以调整标定参数,逐渐缩小上述两个圆之间的偏差,直至完全重合,在输入调整的标定参数的过程中,上述装置可以动态显示参考圆逐渐吻合实际圆的过程,实现一边调整标定参数一边实时显示调整的结果,将参数标定的过程可视化。可以理解的是,当上述参考圆与实际圆重合时,可以确定位姿标定成功。
S102,基于位姿标定后的IMU和多线激光雷达检测当前行驶区域内的障碍物。
具体的,上述装置可以基于位姿标定后的IMU和多线激光雷达检测当前行驶区域内的障碍物,可选的,上述装置可以基于位姿标定后的IMU确定多线激光雷达相对于参考平面的标定参考点,该标定参考点可以是位姿标定后的激光点云在扫到平整的路面情况下每个激光点所处的XY平面的位置。进一步的,上述装置可以在实际点云中选择两目标实际点云(位于待检测的目标路面的两端点)同时可以确定上述两目标实际点云对应的两标定参考点,然后根据两目标实际点云的斜率和对应的两标定参考点的斜率,确定两目标实际点云指示的目标路面是否存在障碍物。
在可选实施例中,上述装置可以根据两目标实际点云的坐标计算二者之间的实际斜率,根据两标定参考点的坐标计算二者之间的参考斜率,然后计算实际斜率和参考斜率之间的差值,当差值大于预设差值阈值时,确定上述两目标实际点云对应的目标路面存在障碍物。例如,图5所示的斜率的计算与对比,图中,实线由标定参考点组成的,虚线由实际点云组成,点a、b和c为标定参考点,点a’、b’和c’为点a、b和c对应的实际点云。由图5可看出,点a与点b在XY平面上的斜率在实线和虚线中基本一致,故判断点a点b以及中间的点都落在平整的路面上。相反点b与点c之间在XY平面上的斜率在实线和虚线中相差很大,故点b与点c之间的各个点判断为障碍物,属于不可通行区域,即以点b与点c作为两端点的目标路面存在障碍物。
S103,计算上述障碍物距离同一水平线上的两边录肩的检测距离。
可以理解的是,检测到障碍物后,上述装置可以根据检测到的障碍物与两边路肩(即方言中的马路牙子)的距离规划一有效的行驶区域。在检测上述距离之前,可以将连续检测到的具有固定高度(该高度满足预设高度阈值)的障碍物确定为路肩(即在一定时间内一直能检测到的高度不变的障碍物为路肩),上述预设高度阈值可以是根据现实中的路肩高度预先设置的路肩高度范围。
具体的,确定路肩之后,上述装置可以计算障碍物距离同一水平线上的两边录肩的检测距离,如图6所示,障碍物X与同一水平线上的左右两边录肩的交点为A和B,上述检测距离可以是X-A之间的距离和X-B之间的距离。
在可选实施例中,上述装置可以先确定障碍物的实际中心点坐标的实际水平坐标,例如,图6中障碍物X的中心点的水平方向坐标为C。进一步的,上述装置可以以上述实际水平坐标为基准,计算障碍物距离同一水平线上的两边录肩的检测距离,例如,可以将测量所得的AC和CB的长度确定为上述检测距离。
S104,根据上述检测距离确定基于当前行驶位置的有效行驶区域。
具体的,上述装置可以根据上述检测距离确定基于当前行驶位置的有效行驶区域,例如,当左侧检测距离AC大于右侧检测距离CB时,可以将除上述障碍物以及障碍物与右侧路肩之间的区域确定为有效行驶区域(即可以较大概率不碰撞障碍物的安全行驶区域)。
在本发明实施例中,通过对多线传感器和IMU之间进行位姿标定,在标定后根据参考点和实际点云的斜率检测障碍物,确定有效的行驶区域,在线束密集度不够时提高了多线激光雷达对行驶区域检测的鲁棒性和检测精度。
需要说明的是,在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行,并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
下面将结合附图7-附图11,对本发明实施例提供的基于多线激光雷达的行驶区域检测装置进行详细介绍。需要说明的是,附图7-附图11所示的基于多线激光雷达的行驶区域检测装置,用于执行本发明图1-图6所示实施例的方法,为了便于说明,仅示出了与本发明实施例相关的部分,具体技术细节未揭示的,请参照本发明图1-图6所示的实施例。
请参见图7,为本发明实施例提供了一种基于多线激光雷达的行驶区域检测装置的结构示意图。如图7所示,本发明实施例的行驶区域检测装置1可以包括:位姿标定模块11、障碍物检测模块12、检测距离计算模块13、有效区域确定模块14和路肩确定模块15。其中,位姿标定模块11如图8所示,包括初始坐标计算单元111、标定圆显示单元112、标定动态显示单元113和标定成功确认单元114;障碍物检测模块12如图9所示,包括标定坐标确定单元121和障碍物检测单元122;障碍物检测单元122如图10所示,包括实际斜率计算子单元1221、参考斜率计算子单元1222和障碍物确定子单元1223;检测距离计算模块13如图11所示,包括水平坐标确定单元131和检测距离计算单元132。
位姿标定模块11,用于根据多线激光雷达的实际点云和多线激光雷达相对于参考平面的初始参考点,对多线激光雷达和IMU之间的相对位姿进行标定。
可以理解的是,多线激光雷达的每束光线相对与设备都有一个特定的角度,如图2所示。上述装置可以利用惯性测量单元(Inertial measurement unit,IMU)的姿态角度信息和已知的激光雷达高程信息,计算得出激光点云在扫到平整的路面情况下每个激光点所处的XY平面的位置,可以称为初始参考点,而实际点云为多线激光雷达扫到的实际路面时,每个激光点在路面上所处的位置。需要说明的是,在进行位姿标定前,多线激光雷达和IMU固定在一个刚性载体上,且雷达的高度为固定不变的。
具体实现中,位姿标定模块11可以根据上述实际点云和初始参考点对多线激光雷达和IMU之间的相对位姿进行标定,确保对行驶区域检测之前,激光雷达在地图中定位得到的姿态角度信息与IMU观测到的姿态信息一致。
在可选实施例中,初始坐标计算单元111可以获取所记录的多线激光雷达的高度h(雷达中心到水平地面的垂直距离)和当前IMU读取的姿态角度信息β(雷达中心线与铅垂线的夹角),根据如图3所示的h和β几何关系确定上述初始参考点的坐标。进一步的,标定圆显示单元112可以输出显示上述初始参考点坐标在参考平面上形成的参考圆,以及实际点云在实际路面上形成的实际圆,可以理解的是,如果激光雷达水平的安装,则如图2所示的角度为负数的激光束扫到水平地面后形成的点云理论上是标准的圆形,如果激光雷达姿态发生变化,如向一侧倾斜,理论点云也会对应的发生变化,如图4所示实线圆为参考圆,虚线圆为实际圆。进一步的,通过观察上述参考圆和实际圆之间的偏差,可以调整标定参数,逐渐缩小上述两个圆之间的偏差,直至完全重合,在输入调整的标定参数的过程中,标定动态显示单元113可以动态显示参考圆逐渐吻合实际圆的过程,实现一边调整标定参数一边实时显示调整的结果,将参数标定的过程可视化。可以理解的是,当上述参考圆与实际圆重合时,标定成功确认单元114可以确定位姿标定成功。
障碍物检测模块12,用于基于位姿标定后的IMU和多线激光雷达检测当前行驶区域内的障碍物。
具体实现中,障碍物检测模块12可以基于位姿标定后的IMU和多线激光雷达检测当前行驶区域内的障碍物,可选的,标定坐标确定单元121可以基于位姿标定后的IMU确定多线激光雷达相对于参考平面的标定参考点,该标定参考点可以是位姿标定后的激光点云在扫到平整的路面情况下每个激光点所处的XY平面的位置。进一步的,上述装置可以在实际点云中选择两目标实际点云(位于待检测的目标路面的两端点)同时可以确定上述两目标实际点云对应的两标定参考点,然后障碍物检测单元122可以根据两目标实际点云的斜率和对应的两标定参考点的斜率,确定两目标实际点云指示的目标路面是否存在障碍物。
在可选实施例中,实际斜率计算子单元1221可以根据两目标实际点云的坐标计算二者之间的实际斜率,参考斜率计算子单元1222根据两标定参考点的坐标计算二者之间的参考斜率,然后计算实际斜率和参考斜率之间的差值,当差值大于预设差值阈值时,障碍物确定子单元1223可以确定上述两目标实际点云对应的目标路面存在障碍物。例如,图5所示的斜率的计算与对比,图中,实线由标定参考点组成的,虚线由实际点云组成,点a、b和c为标定参考点,点a’、b’和c’为点a、b和c对应的实际点云。由图5可看出,点a与点b在XY平面上的斜率在实线和虚线中基本一致,故判断点a点b以及中间的点都落在平整的路面上。相反点b与点c之间在XY平面上的斜率在实线和虚线中相差很大,故点b与点c之间的各个点判断为障碍物,属于不可通行区域,即以点b与点c作为两端点的目标路面存在障碍物。
检测距离计算模块13,用于计算上述障碍物距离同一水平线上的两边录肩的检测距离。
可以理解的是,检测到障碍物后,上述装置1可以根据检测到的障碍物与两边路肩(即方言中的马路牙子)的距离规划一有效的行驶区域。在检测上述距离之前,可以将连续检测到的具有固定高度(该高度满足预设高度阈值)的障碍物确定为路肩(即在一定时间内一直能检测到的高度不变的障碍物为路肩),上述预设高度阈值可以是根据现实中的路肩高度预先设置的路肩高度范围。
具体实现中,确定路肩之后,检测距离计算模块13可以计算障碍物距离同一水平线上的两边录肩的检测距离,如图6所示,障碍物X与同一水平线上的左右两边录肩的交点为A和B,上述检测距离可以是X-A之间的距离和X-B之间的距离。
在可选实施例中,水平坐标确定单元131可以先确定障碍物的实际中心点坐标的实际水平坐标,例如,图6中障碍物X的中心点的水平方向坐标为C。进一步的,检测距离计算单元132可以以上述实际水平坐标为基准,计算障碍物距离同一水平线上的两边录肩的检测距离,例如,可以将测量所得的AC和CB的长度确定为上述检测距离。
有效区域确定模块14,用于根据上述检测距离确定基于当前行驶位置的有效行驶区域。
具体实现中,有效区域确定模块14可以根据上述检测距离确定基于当前行驶位置的有效行驶区域,例如,当左侧检测距离AC大于右侧检测距离CB时,有效区域确定模块14可以将除上述障碍物以及障碍物与右侧路肩之间的区域确定为有效行驶区域(即可以较大概率不碰撞障碍物的安全行驶区域)。
在本发明实施例中,通过对多线传感器和IMU之间进行位姿标定,在标定后根据参考点和实际点云的斜率检测障碍物,确定有效的行驶区域,在线束密集度不够时提高了多线激光雷达对行驶区域检测的鲁棒性和检测精度。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random AccessMemory,RAM)等。
以上所揭露的仅为本发明较佳实施例而已,当然不能以此来限定本发明之权利范围,因此依本发明权利要求所作的等同变化,仍属本发明所涵盖的范围。
Claims (10)
1.一种基于多线激光雷达的行驶区域检测方法,其特征在于,包括:
根据多线激光雷达的实际点云和所述多线激光雷达相对于参考平面的初始参考点,对所述多线激光雷达和IMU之间的相对位姿进行标定;
基于位姿标定后的IMU和多线激光雷达检测当前行驶区域内的障碍物;
计算所述障碍物距离同一水平线上的两边录肩的检测距离;
根据所述检测距离确定基于当前行驶位置的有效行驶区域。
2.根据权利要求1所述的方法,其特征在于,所述根据多线激光雷达的实际点云和所述多线激光雷达相对于参考平面的初始参考点,对所述多线激光雷达和IMU之间的相对位姿进行标定,包括:
根据所记录的多线激光雷达的高度和IMU读取的所述多线激光雷达的姿态角度信息,计算所述多线激光雷达相对于参考平面的初始参考点;
输出显示所述初始参考点在所述参考平面上形成的参考圆以及实际点云在实际路面上形成的实际圆;
动态显示所述参考圆与所述实际圆之间的吻合程度;
当所述参考圆与所述实际圆重合时,确定位姿标定成功。
3.根据权利要求2所述的方法,其特征在于,所述基于位姿标定后的IMU和多线激光雷达检测当前行驶区域内的障碍物,包括:
基于位姿标定后的IMU确定所述多线激光雷达相对于所述参考平面的标定参考点;
根据两目标实际点云的斜率和对应的两标定参考点的斜率,确定所述两目标实际点云指示的目标路面是否存在障碍物。
4.根据权利要求1所述的方法,其特征在于,所述根据两目标实际点云的斜率和对应的标定两参考点的斜率,确定所述两目标实际点云指示的目标路面是否存在障碍物,包括:
根据两目标实际点云的坐标计算二者之间的实际斜率;
确定所述两目标实际点云对应的两标定参考点,根据所述两标定参考点的坐标计算二者之间的参考斜率;
当所述实际斜率与所述参考斜率的差值大于预设差值阈值时,确定所述两目标实际点云对应的目标路面存在障碍物。
5.根据权利要求1所述的方法,其特征在于,所述方法还包括:
当在行驶过程中检测到满足预设高度阈值的连续固定高度的障碍物时,确定所述障碍物为当前行驶区域的路肩。
6.根据权利要求1所述的方法,其特征在于,所述计算所述障碍物距离同一水平线上的两边录肩的检测距离,包括:
确定所述障碍物的实际中心坐标点的实际水平坐标;
以所述实际水平坐标为基准,计算所述障碍物距离同一水平线上的两边录肩的检测距离。
7.一种基于多线激光雷达的行驶区域检测装置,其特征在于,包括:
位姿标定模块,用于根据多线激光雷达的实际点云和所述多线激光雷达相对于参考平面的初始参考点,对所述多线激光雷达和IMU之间的相对位姿进行标定;
障碍物检测模块,用于基于位姿标定后的IMU和多线激光雷达检测当前行驶区域内的障碍物;
检测距离计算模块,用于计算所述障碍物距离同一水平线上的两边录肩的检测距离;
有效区域确定模块,用于根据所述检测距离确定基于当前行驶位置的有效行驶区域。
8.根据如权利要求7所述的装置,其特征在于,所述位姿标定模块包括:
初始坐标计算单元,用于根据所记录的多线激光雷达的高度和IMU读取的所述多线激光雷达的姿态角度信息,计算所述多线激光雷达相对于参考平面的初始参考点;
标定圆显示单元,用于输出显示所述初始参考点在所述参考平面上形成的参考圆以及实际点云在实际路面上形成的实际圆;
标定动态显示单元,用于动态显示所述参考圆与所述实际圆之间的吻合程度;
标定成功确认单元,用于当所述参考圆与所述实际圆重合时,确定位姿标定成功。
9.根据权利要求7所述的装置,其特征在于,所述障碍物检测模块包括:
标定坐标确定单元,用于基于位姿标定后的IMU确定所述多线激光雷达相对于所述参考平面的标定参考点;
障碍物检测单元,用于根据两目标实际点云的斜率和对应的两标定参考点的斜率,确定所述两目标实际点云指示的目标路面是否存在障碍物。
10.根据权利要求9所述的装置,其特征在于,所述障碍物检测单元包括:
实际斜率计算子单元,用于根据两目标实际点云的坐标计算二者之间的实际斜率;
参考斜率计算子单元,用于确定所述两目标实际点云对应的两标定参考点,根据所述两标定参考点的坐标计算二者之间的参考斜率;
障碍物确定子单元,用于当所述实际斜率与所述参考斜率的差值大于预设差值阈值时,确定所述两目标实际点云对应的目标路面存在障碍物。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910365161.3A CN110109145B (zh) | 2019-04-30 | 2019-04-30 | 基于多线激光雷达的行驶区域检测方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910365161.3A CN110109145B (zh) | 2019-04-30 | 2019-04-30 | 基于多线激光雷达的行驶区域检测方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110109145A true CN110109145A (zh) | 2019-08-09 |
CN110109145B CN110109145B (zh) | 2020-11-10 |
Family
ID=67488040
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910365161.3A Active CN110109145B (zh) | 2019-04-30 | 2019-04-30 | 基于多线激光雷达的行驶区域检测方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110109145B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110471086A (zh) * | 2019-09-06 | 2019-11-19 | 北京云迹科技有限公司 | 一种雷达测障系统及方法 |
CN113189608A (zh) * | 2021-05-20 | 2021-07-30 | 国网河南省电力公司检修公司 | 一种电力机器人固态面阵激光雷达测距装置 |
CN114089376A (zh) * | 2021-09-30 | 2022-02-25 | 江苏金陵智造研究院有限公司 | 一种基于单激光雷达的负障碍物检测方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101959738A (zh) * | 2008-09-19 | 2011-01-26 | 日立汽车系统株式会社 | 车辆控制装置 |
CN103760569A (zh) * | 2013-12-31 | 2014-04-30 | 西安交通大学 | 一种基于激光雷达的可行驶区域检测方法 |
US20160209499A1 (en) * | 2015-01-16 | 2016-07-21 | Shingo Suzuki | Object detection device, sensing device, movable body device, and object detection method |
CN105867408A (zh) * | 2014-11-07 | 2016-08-17 | 现代摩比斯株式会社 | 可行驶空间判断装置及其方法 |
CN106485233A (zh) * | 2016-10-21 | 2017-03-08 | 深圳地平线机器人科技有限公司 | 可行驶区域检测方法、装置和电子设备 |
CN107300914A (zh) * | 2016-04-15 | 2017-10-27 | 现代自动车株式会社 | 用于产生自主驾驶车辆的行驶路径的装置和方法 |
CN108604419A (zh) * | 2016-01-29 | 2018-09-28 | 日产自动车株式会社 | 车辆的行驶控制方法及车辆的行驶控制装置 |
-
2019
- 2019-04-30 CN CN201910365161.3A patent/CN110109145B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101959738A (zh) * | 2008-09-19 | 2011-01-26 | 日立汽车系统株式会社 | 车辆控制装置 |
CN103760569A (zh) * | 2013-12-31 | 2014-04-30 | 西安交通大学 | 一种基于激光雷达的可行驶区域检测方法 |
CN105867408A (zh) * | 2014-11-07 | 2016-08-17 | 现代摩比斯株式会社 | 可行驶空间判断装置及其方法 |
US20160209499A1 (en) * | 2015-01-16 | 2016-07-21 | Shingo Suzuki | Object detection device, sensing device, movable body device, and object detection method |
CN108604419A (zh) * | 2016-01-29 | 2018-09-28 | 日产自动车株式会社 | 车辆的行驶控制方法及车辆的行驶控制装置 |
CN107300914A (zh) * | 2016-04-15 | 2017-10-27 | 现代自动车株式会社 | 用于产生自主驾驶车辆的行驶路径的装置和方法 |
CN106485233A (zh) * | 2016-10-21 | 2017-03-08 | 深圳地平线机器人科技有限公司 | 可行驶区域检测方法、装置和电子设备 |
Non-Patent Citations (2)
Title |
---|
李会宾: "基于激光点云的道路边界检测和标线识别方法的研究与实现", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
段建民等: "基于车载4线激光雷达的前方道路可行驶区域检测", 《汽车电子》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110471086A (zh) * | 2019-09-06 | 2019-11-19 | 北京云迹科技有限公司 | 一种雷达测障系统及方法 |
CN110471086B (zh) * | 2019-09-06 | 2021-12-03 | 北京云迹科技有限公司 | 一种雷达测障系统及方法 |
CN113189608A (zh) * | 2021-05-20 | 2021-07-30 | 国网河南省电力公司检修公司 | 一种电力机器人固态面阵激光雷达测距装置 |
CN114089376A (zh) * | 2021-09-30 | 2022-02-25 | 江苏金陵智造研究院有限公司 | 一种基于单激光雷达的负障碍物检测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110109145B (zh) | 2020-11-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110109144A (zh) | 基于多线激光雷达的路肩检测方法及装置 | |
CN109664301B (zh) | 巡检方法、装置、设备及计算机可读存储介质 | |
CN110109145A (zh) | 基于多线激光雷达的行驶区域检测方法及装置 | |
WO2018221453A1 (ja) | 出力装置、制御方法、プログラム及び記憶媒体 | |
EP2291677B1 (en) | Improvements in lidars | |
CN107561547B (zh) | 输电线路到目标物的距离测量方法、装置及系统 | |
CN110032180A (zh) | 激光雷达定位 | |
KR101807484B1 (ko) | 객체 및 시스템 특성에 기반한 확률 분포 지도 작성 장치 및 그 방법 | |
EP2573582B1 (en) | Systems and methods for combining a priori data with sensor data | |
CN110109146A (zh) | 基于多线激光雷达的路面检测方法及装置 | |
JP7410932B2 (ja) | ライダーセンサーを取り付けられた自動車両のための道路検出の方法 | |
CN102541066A (zh) | 一种用于无人飞行器作业的自动定高的控制方法 | |
CN106872994A (zh) | 一种激光雷达扫描方法及装置 | |
CN110499727A (zh) | 一种基于多传感器的贴边清扫方法和清扫车 | |
CN109444916A (zh) | 一种无人驾驶可行驶区域确定装置及方法 | |
CN113791074A (zh) | 一种基于多传感器融合的无人机桥梁裂缝巡检系统及方法 | |
EP3605500B1 (en) | Output device, control method, program, and storage medium | |
CN112068152A (zh) | 使用3d扫描仪同时进行2d定位和2d地图创建的方法和系统 | |
WO2021168854A1 (zh) | 可行驶区域检测的方法和装置 | |
CN110645960A (zh) | 测距方法、地形跟随测距方法、避障测距方法及装置 | |
CN110109143B (zh) | 多线激光雷达与imu的位姿标定方法及装置 | |
KR101764839B1 (ko) | 차선 인식 시스템 및 방법 | |
JP2008014814A (ja) | 道路端部検出方法 | |
KR102384333B1 (ko) | 라이다 센서를 포함하는 지형 비행 장치 | |
US20150330054A1 (en) | Optical Sensing a Distance from a Range Sensing Apparatus and Method |
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 | ||
CP01 | Change in the name or title of a patent holder | ||
CP01 | Change in the name or title of a patent holder |
Address after: Room 702, 7th floor, NO.67, Beisihuan West Road, Haidian District, Beijing 100089 Patentee after: Beijing Yunji Technology Co.,Ltd. Address before: Room 702, 7th floor, NO.67, Beisihuan West Road, Haidian District, Beijing 100089 Patentee before: BEIJING YUNJI TECHNOLOGY Co.,Ltd. |