CN105204510B - 一种用于精确定位的概率地图的生成方法及装置 - Google Patents
一种用于精确定位的概率地图的生成方法及装置 Download PDFInfo
- Publication number
- CN105204510B CN105204510B CN201510648254.9A CN201510648254A CN105204510B CN 105204510 B CN105204510 B CN 105204510B CN 201510648254 A CN201510648254 A CN 201510648254A CN 105204510 B CN105204510 B CN 105204510B
- Authority
- CN
- China
- Prior art keywords
- initial data
- probability map
- data
- laser radar
- intensity
- 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
Landscapes
- Traffic Control Systems (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Navigation (AREA)
Abstract
本发明提供一种用于精确定位的概率地图的生成方法与装置,其中方法包括如下步骤:在目标行驶环境中采集原始数据;对原始数据进行后期处理;根据处理后的原始数据生成概率地图,解决了无人驾驶地图采集的问题。
Description
技术领域
本发明涉及领域,尤其涉及一种用于精确定位的概率地图的生成方法。
背景技术
无人车自动驾驶系统一般分为两种:
1、不依靠预先采集的行驶环境知识,在实时自动驾驶过程中一边感知一边决策的。这种系统比较常用于陌生环境中的行驶,如野外。
2、完全或者主要依靠预先采集的行驶环境知识,在实时自动驾驶过程中先在预先采集的信息中确定自己的位置,然后再结合预先采集的信息和实时感知到的信息,做出决策。这种方法比起前一种实现难度低、算法复杂度低、效果更好。主要因为:
a.行驶过程中的感知范围有限。预先采集可以从各种不同的角度和维度感知环境
b.车载计算机运算能力有限,比起理论上无限的预先采集预先运算处理
c.车载传感器的性能、数量和类型有限。预先采集可以动用各自类型的传感器,包括空基(如机载合成孔径雷达)、天基(如卫星)等。
本发明提出一种生成一种二维的、记录了传感器感知信号(如激光雷达的反射强度信号)的概率分布的地图(以下简称概率地图)的方法。这种概率地图属于预先采集的用于自动驾驶的辅助信息的一种,特别适用于实时自动驾驶时帮助无人车确定自身的位置。
无人车可以依靠这张概率地图,配合自身传感器的信息(如全球定位系统的坐标、激光雷达扫描后的点云),利用概率的方法估算自己当前最可能的实际位置/坐标。
发明内容
本发明要解决的技术问题,在于提供一种用于精确定位的概率地图的生成方法,解决无人驾驶地图数据采集的问题。
本发明是这样实现的:一种用于精确定位的概率地图的生成方法,包括如下步骤:
在目标行驶环境中采集原始数据;
对原始数据进行后期处理;
根据处理后的原始数据生成概率地图。
具体地,“对原始数据进行后期处理”包括:
纠正原始数据每一次扫描时的坐标值;
校正用于采集原始数据的激光雷达的反射强度值。
进一步地,所述概率地图为一张二维网格,每个单元网格由激光雷达反射数据的高斯分布表示,高斯分布包括激光雷达反射的平均强度及其强度方差。
具体地,“在目标行驶环境中采集原始数据”包括:
控制载有激光雷达的车辆在被采集环境中以预设的方式行驶;
在行驶的过程中获取激光雷达传感器记录下来的在每个目标点的激光反射强度及其对应激光束代码;
将获取到的激光反射强度及其对应激光束代码成组地被记录成原始数据。
一种用于精确定位的概率地图的生成装置,包括数据采集模块、后期处理模块、地图生成模块;
所述数据采集模块用于在目标行驶环境中采集原始数据;
所述后期处理模块用于对原始数据进行后期处理;
所述地图生成模块用于根据处理后的原始数据生成概率地图。
具体地,所述后期处理模块还用于纠正原始数据每一次扫描时的坐标值;
所述后期处理模块还用于校正用于采集原始数据的激光雷达的反射强度值。
进一步地,所述概率地图为一张二维网格,每个单元网格由激光雷达反射数据的高斯分布表示,高斯分布包括激光雷达反射的平均强度及其强度方差。
具体地,还包括行驶控制模块;
所述行驶控制模块用于控制载有激光雷达的车辆在被采集环境中以预设的方式行驶;
所述数据采集模块还用于在行驶的过程中获取激光雷达传感器记录下来的在每个目标点的激光反射强度及其对应激光束代码;
所述数据数据采集模块还用于将获取到的激光反射强度及其对应激光束代码成组地被记录成原始数据。
本发明具有如下优点:准确度高,定位精确,操作简便。
附图说明
图1为本发明具体实施方式所述方法流程图;
图2为本发明具体实施方式所述装置模块图;
图3为本发明具体实施方式所述坐标过滤矫正后原始的电子云数据;
图4为本发明具体实施方式所述红外反射强度均值地图;
图5为本发明具体实施方式所述红外反射强度方差地图。
附图标记说明:
200、数据采集模块;
202、后期处理模块;
204、地图生成模块;
206、行驶控制模块。
具体实施方式
为详细说明本发明的技术内容、构造特征、所实现目的及效果,以下结合实施方式并配合附图详予说明。
请参阅图1一种用于精确定位的概率地图的生成方法,包括如下步骤:
步骤S101,在目标行驶环境中采集原始数据;在某些具体的实施例中,“在目标行驶环境中采集原始数据”包括:
1)控制载有激光雷达的车辆在被采集环境中以预设的方式行驶;
2)在行驶的过程中获取激光雷达传感器记录下来的在每个目标点的激光反射强度及其对应激光束代码;
3)将获取到的激光反射强度及其对应激光束代码成组地被记录成原始数据。
具体的某些实施例中,可以让载车在被采集环境中携带着激光雷达传感器以预设的方式行驶,所述预设的方式可以为目标行驶环境中的一段路途,优选为某些闭合环形路途,行驶的过程中激光雷达传感器会记录下来的在每个目标点的激光反射强度及其对应激光束代码(一般的仪器可以发射并感应64束激光),这些数据成组的被记录成原始数据日志。
再进行步骤S102对原始数据进行后期处理;具体包括:
1)纠正原始数据每一次扫描时的坐标值;采集原始数据的载车在行驶过程中自身的坐标/位置非常重要,直接决定了概率地图生成后地图上的各个区域各种特征的坐标是否准确。因此,载车需要搭载一个能提供精准坐标信息的传感器(如全球定位/惯性导航融合系统)。
然而,任何传感器都存在误差,随着时间的推移,偏差会逐渐积累。当载车行驶了一大圈后又回到之前到过的一个地点时,很可能会发现对于同一个地点新测的坐标和第一次测的坐标不一样,实际上应该闭合的行驶路线按照传感器的坐标值却无法闭合。这样会使得不同位置得到扫描数据在空间上融合起来的时候出现断层/错位。
为了消除这种不一致,需要对原始数据日志中的每一条记录的坐标进行过滤,尽可能消除偏差。过滤可以用基于粒子的、基于卡尔曼过滤器的或者基于贝叶斯网格的算法,如图3所示进行坐标过滤矫正后,原始的电子云数据拼接起来就没有错位
2)校正用于采集原始数据的激光雷达的反射强度值。为了保证激光雷达(或者其它传感器)对于环境感知的一致性,进而提高概率地图的准确性,需要对原始数据日志中的反射强度值进行校正。
这里根据扫描方法可以对数据进行校准,可以构建一个校准函数进行校准工作,校准函数用于对地图网格中不同点的激光反射强度进行期望计算,例如每条观察数据z可以用一个四元数组<b,l,a,g>表示,分别对应激光束编号,测距,反射强度值和对应的地图网格编号。
若激光器有64个激光束,则:
b∈[0,…,63]
(不同型号的激光雷达可能会发出不同数量的激光束,公式可以灵活变动)而测距一定大于等于0:
l∈R+
若每束激光束可以分辨256种不同的反射强度,则:
a∈[0,...,255]
g代表单元格的编号,总的单元格数量取决于地图的维数N和M:
g∈[0,...,N·M-1]
采集过程中每一时刻都会观测到许多条观察数据,所有的观察数据的总集合为:
L={z1,…,zn}
即n个观察数据。
利用这些观察数据,我们可以计算校准函数g(j,a):
以上仅为校准函数的某个实施例,当我们通过校准函数把原始数据日志中所有的点的强度值校正过后,之后就可以进行步骤S103,根据处理后的原始数据生成概率地图。进一步地,所述概率地图为一张二维网格,每个单元网格由激光雷达反射数据的高斯分布表示,高斯分布包括激光雷达反射的平均强度及其强度方差。在某些实施例中,可以将整个行驶的区域分成若干个单元格。把所述单元格建立在一个正交x,y坐标系上,在这个坐标系里每一个单元格表示(占据)一个10*10厘米(这个单元格越小清晰度也就越高,可根据需要灵活调整)的空间。每一个单元格被赋予一个唯一的编号,或者可以直接用相应的x,y轴上的值表示。
要生成一张概率地图,在每一单元格除了储存投射在它上的激光强度的均值外,还要记录下其强度方差。也就是说,概率地图会有两条数据通道:平均强度和强度方差。由于网格地图是二维的,而激光雷达的点云输出是三维的。因此,需要将三维的点云投影到二维的网格上:每一单元格对应所有横、纵坐标与该单元格一样的数据点,不管这些点的高度坐标是多少。
每个单元都要维持一定的介值以在每次获得新测量值时更新平均强度和方差。图4及图5分别为红外反射的强度均值、红外反射的强度方差地图,这里我们可以清楚看到丰富的环境细节,比如人行道,绿化带,马路等等。充分的体现了红外反射强度能捕捉丰富的环境数据与特征的优点。而且不像一般由摄像机采集产生的图像与数据,红外反射强度能规避阴影或由自然光线产生的其他影响因素。更好地解决了无人驾驶地图采集的问题。
在图2所述的某些实施例中,为一种用于精确定位的概率地图的生成装置,包括数据采集模块200、后期处理模块202、地图生成模块204;
所述数据采集模块200用于在目标行驶环境中采集原始数据;
所述后期处理模块202用于对原始数据进行后期处理;
所述地图生成模块204用于根据处理后的原始数据生成概率地图。
具体地,所述后期处理模块202还用于纠正原始数据每一次扫描时的坐标值;
所述后期处理模块202还用于校正用于采集原始数据的激光雷达的反射强度值。
进一步地,所述概率地图为一张二维网格,每个单元网格由激光雷达反射数据的高斯分布表示,高斯分布包括激光雷达反射的平均强度及其强度方差。
具体地,还包括行驶控制模块206;
所述行驶控制模块206用于控制载有激光雷达的车辆在被采集环境中以预设的方式行驶;
所述数据采集模块200还用于在行驶的过程中获取激光雷达传感器记录下来的在每个目标点的激光反射强度及其对应激光束代码;
所述数据数据采集模块200还用于将获取到的激光反射强度及其对应激光束代码成组地被记录成原始数据。通过上述装置,达到了生成无人驾驶地图采集的效果,解决了无人驾驶地图采集的问题。
以上所述仅为本发明的实施例,并非因此限制本发明的专利保护范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。
Claims (6)
1.一种用于精确定位的概率地图的生成方法,其特征在于,包括如下步骤:
在目标行驶环境中采集原始数据;
对原始数据进行后期处理;
根据处理后的原始数据生成概率地图;
其中,“在目标行驶环境中采集原始数据”包括:
控制载有激光雷达的车辆在被采集环境中以预设的方式行驶;
在行驶的过程中获取激光雷达传感器记录下来的在每个目标点的激光反射强度及其对应激光束代码;
将获取到的激光反射强度及其对应激光束代码成组地被记录成原始数据。
2.根据权利要求1所述的一种用于精确定位的概率地图的生成方法,其特征在于:“对原始数据进行后期处理”包括:
纠正原始数据每一次扫描时的坐标值;
校正用于采集原始数据的激光雷达的反射强度值。
3.根据权利要求1所述的一种用于精确定位的概率地图的生成方法,其特征在于:所述概率地图为一张二维网格,每个单元网格由激光雷达反射数据的高斯分布表示,高斯分布包括激光雷达反射的平均强度及其强度方差。
4.一种用于精确定位的概率地图的生成装置,其特征在于,包括数据采集模块、后期处理模块、地图生成模块、行驶控制模块;
所述数据采集模块用于在目标行驶环境中采集原始数据;
所述后期处理模块用于对原始数据进行后期处理;
所述地图生成模块用于根据处理后的原始数据生成概率地图;
所述行驶控制模块用于控制载有激光雷达的车辆在被采集环境中以预设的方式行驶;
所述数据采集模块还用于在行驶的过程中获取激光雷达传感器记录下来的在每个目标点的激光反射强度及其对应激光束代码;
所述数据数据采集模块还用于将获取到的激光反射强度及其对应激光束代码成组地被记录成原始数据。
5.根据权利要求4所述的一种用于精确定位的概率地图的生成装置,其特征在于,
所述后期处理模块还用于纠正原始数据每一次扫描时的坐标值;
所述后期处理模块还用于校正用于采集原始数据的激光雷达的反射强度值。
6.根据权利要求4所述的一种用于精确定位的概率地图的生成装置,其特征在于:所述概率地图为一张二维网格,每个单元网格由激光雷达反射数据的高斯分布表示,高斯分布包括激光雷达反射的平均强度及其强度方差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510648254.9A CN105204510B (zh) | 2015-10-09 | 2015-10-09 | 一种用于精确定位的概率地图的生成方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510648254.9A CN105204510B (zh) | 2015-10-09 | 2015-10-09 | 一种用于精确定位的概率地图的生成方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105204510A CN105204510A (zh) | 2015-12-30 |
CN105204510B true CN105204510B (zh) | 2016-06-22 |
Family
ID=54952251
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510648254.9A Active CN105204510B (zh) | 2015-10-09 | 2015-10-09 | 一种用于精确定位的概率地图的生成方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105204510B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105571596B (zh) * | 2016-01-18 | 2018-09-18 | 福州华鹰重工机械有限公司 | 多车辆环境探索方法及装置 |
CN105717939B (zh) * | 2016-01-20 | 2018-10-02 | 李万鸿 | 一种支持汽车无人自动驾驶的道路路面的信息化和网络化实施方法 |
CN108732554B (zh) * | 2017-04-18 | 2020-12-11 | 百度在线网络技术(北京)有限公司 | 激光雷达标定方法和装置 |
JP2019008359A (ja) * | 2017-06-20 | 2019-01-17 | 日本電産シンポ株式会社 | 移動装置 |
WO2019040997A1 (en) * | 2017-09-04 | 2019-03-07 | Commonwealth Scientific And Industrial Research Organisation | METHOD AND SYSTEM FOR USE IN REALIZING LOCATION |
CN108319262B (zh) * | 2017-12-21 | 2021-05-14 | 合肥中导机器人科技有限公司 | 一种激光反射板反射点的滤选方法及激光导航方法 |
US10739459B2 (en) | 2018-01-12 | 2020-08-11 | Ford Global Technologies, Llc | LIDAR localization |
CN108469826B (zh) * | 2018-04-23 | 2021-06-08 | 宁波Gqy视讯股份有限公司 | 一种基于机器人的地图生成方法及系统 |
CN109064506B (zh) | 2018-07-04 | 2020-03-13 | 百度在线网络技术(北京)有限公司 | 高精度地图生成方法、装置及存储介质 |
CN111443699B (zh) * | 2018-12-28 | 2023-05-23 | 深圳市优必选科技有限公司 | 定位漂移检测方法及装置、机器人 |
CN110174892B (zh) * | 2019-04-08 | 2022-07-22 | 阿波罗智能技术(北京)有限公司 | 车辆朝向的处理方法、装置、设备及计算机可读存储介质 |
CN111990929B (zh) * | 2020-08-26 | 2022-03-22 | 北京石头世纪科技股份有限公司 | 一种障碍物探测方法、装置、自行走机器人和存储介质 |
CN112462758B (zh) * | 2020-11-06 | 2022-05-06 | 深圳市优必选科技股份有限公司 | 一种建图方法、装置、计算机可读存储介质及机器人 |
CN112762921B (zh) * | 2020-12-24 | 2022-05-20 | 杭州电子科技大学 | 一种基于仿人记忆机制的机器人概率地图更新方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8126642B2 (en) * | 2008-10-24 | 2012-02-28 | Gray & Company, Inc. | Control and systems for autonomously driven vehicles |
CN101975951B (zh) * | 2010-06-09 | 2013-03-20 | 北京理工大学 | 一种融合距离和图像信息的野外环境障碍检测方法 |
CN104002747B (zh) * | 2014-06-10 | 2016-01-06 | 北京联合大学 | 一种基于无人驾驶汽车的多激光雷达栅格地图融合系统 |
CN104636763B (zh) * | 2014-12-01 | 2018-10-09 | 北京工业大学 | 一种基于无人驾驶车的道路与障碍物检测方法 |
CN104573733B (zh) * | 2014-12-26 | 2018-05-04 | 上海交通大学 | 一种基于高清正射影像图的高精细地图生成系统及方法 |
-
2015
- 2015-10-09 CN CN201510648254.9A patent/CN105204510B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105204510A (zh) | 2015-12-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105204510B (zh) | 一种用于精确定位的概率地图的生成方法及装置 | |
CN109341706B (zh) | 一种面向无人驾驶汽车的多特征融合地图的制作方法 | |
CN108921947B (zh) | 生成电子地图的方法、装置、设备、存储介质以及采集实体 | |
Huang et al. | A high-rate, heterogeneous data set from the darpa urban challenge | |
CN102645209B (zh) | 机载LiDAR点云和高分辨率影像进行空间点的联合定位方法 | |
CN109059954A (zh) | 支持高精度地图车道线实时融合更新的方法和系统 | |
CN108961811B (zh) | 停车场车辆定位方法、系统、移动终端及存储介质 | |
Egger et al. | Posemap: Lifelong, multi-environment 3d lidar localization | |
CN109282808B (zh) | 用于桥梁三维巡航检测的无人机与多传感器融合定位方法 | |
CN106296814B (zh) | 公路养护检测与可视化交互方法和系统 | |
CN110275181A (zh) | 一种车载移动测量系统及其数据处理方法 | |
Xiao et al. | Monocular vehicle self-localization method based on compact semantic map | |
CN107036594A (zh) | 智能电站巡检智能体的定位与多粒度环境感知技术 | |
CN109839118A (zh) | 路径规划方法、系统、机器人和计算机可读存储介质 | |
CN103940434A (zh) | 基于单目视觉和惯性导航单元的实时车道线检测系统 | |
CN110211228A (zh) | 用于建图的数据处理方法及装置 | |
CN104535061A (zh) | 一种基于多传感器数据融合的导航系统 | |
Pfaff et al. | Towards mapping of cities | |
CN110308729A (zh) | 基于视觉与imu或里程计的agv组合导航定位方法 | |
CN110223386A (zh) | 一种基于多源无人机遥感数据融合的数字地形建模方法 | |
CN114485619A (zh) | 基于空地协同的多机器人定位和导航方法及装置 | |
Delobel et al. | A real-time map refinement method using a multi-sensor localization framework | |
CN112363158A (zh) | 机器人的位姿估计方法、机器人和计算机存储介质 | |
CN113238251B (zh) | 一种基于车载激光雷达的目标级语义定位方法 | |
Li et al. | Hybrid filtering framework based robust localization for industrial vehicles |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |