CN109556615B - 基于自动驾驶的多传感器融合认知的驾驶地图生成方法 - Google Patents
基于自动驾驶的多传感器融合认知的驾驶地图生成方法 Download PDFInfo
- Publication number
- CN109556615B CN109556615B CN201811175699.XA CN201811175699A CN109556615B CN 109556615 B CN109556615 B CN 109556615B CN 201811175699 A CN201811175699 A CN 201811175699A CN 109556615 B CN109556615 B CN 109556615B
- Authority
- CN
- China
- Prior art keywords
- target
- vehicle
- information
- driving
- map
- 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
Images
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/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
- G01C21/32—Structuring or formatting of map data
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法,面向智能车建立复杂道路环境下的环境模型,即驾驶地图。其结合车辆的运动能力、当前车路信息向智能车提供当前环境下的车道信息、障碍物信息等环境信息,包括车载传感器、车载环境感知设备、车载工控机等装置,车载环境感知设备包括智能摄像头、激光雷达、GPS及惯性导航装置,工控机负责基于路网数据库与高精地图的车辆局部路径定位算法、基于摄像头的车辆偏离预警算法、基于摄像头与激光雷达数据融合的障碍物识别与跟踪算法以及基于多传感器信息特征级融合的实时驾驶地图生成算法。此方法最终输出物为驾驶地图,即结合路面几何形态及交通参与者的秒级的基于本车视角的局域地图。
Description
技术领域
本发明涉及一种自动驾驶车辆环境感知模型的生成方法,具体涉及一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法。
背景技术
目前,错综复杂的交通线路情况对自动驾驶车辆环境感知能力的精度和鲁棒性提出了更高的要求。为了提高自动驾驶系统的稳定性与安全性,提供更精准的环境状态信息帮助车辆有效提前的避免危险发生,各类传感器融合方法开始在自动驾驶车辆控制模型上应用。现有的驾驶辅助产品大多通过增加传感器数量来增加检测的可靠性,扩大视野以及获取更多的周围环境信息,如将雷达用于自适应巡航控制、摄像头用于车道偏离预警。随着自动驾驶的难度不断升级,现有的传感器处理架构渐露疲态,需要将各类传感器所获取的数据进行融合,借助各传感器的置信度区间形成一个应对周围环境的统一描述。因此,设计一套精准的稳定的应对复杂道路环境的车辆环境感知模型是非常必要的。
发明内容
本发明的目的就在于针对上述现有技术的不足,提供一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法,其可以辅助主动驾驶车辆更稳定地行驶在复杂道路环境、避免潜在的各类交通危险,该方法在准确定位当前车辆行驶路段的同时,对当前车道线及障碍物信息进行融合处理,结合车辆动力学模型及路面几何形状生成秒级的实时包含对本车状态动态预测的驾驶地图。
本发明的发明目的是通过以下技术方案实现的:
一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法,是利用高度计获取车辆高度信息,配合GPS获取平面定位信息,获得车辆的三维定位信息;将上述三维定位信息与路网数据库相结合,确定初始投影点,进一步实现智能汽车行驶路段的定位,并将确定行驶路段地图通过网线传输给工控机;通过车载智能摄像头及激光雷达分别采集车道线及障碍物特征级信息,并对上述信息进行基于置信区间的整合和处理,其中传感器及摄像头通过汽车CAN总线、激光雷达通过网线将数据传输到车载工控机;工控机将获取的各类特征级信息进行进一步的融合处理,并基于车辆动力学模型对局部天级的地图进行整合,增加实时的障碍物信息及车道线信息,进而输出秒级的驾驶地图,进而将上述驾驶地图通过CAN总线传输给自动驾驶车辆的决策层,辅助决策层更好更安全地控制车辆。
具体地,上述基于自动驾驶的多传感器融合认知的驾驶地图生成方法,包括以下步骤:
A、通过全局的高精度地图和路网数据库获得天级的全局地图;
B、车辆信息提取:利用高度计获取车辆高度信息,配合GPS获取平面定位信息,获得车辆的三维定位信息;
C、行驶路段定位:将上述三维定位信息与路网数据库相结合,确定初始投影点,进一步实现智能汽车行驶路段的定位信息,确定行驶路段地图,并通过网线传输给车载工控机;
D、车载工控机将定位信息与路网数据库匹配,进而获得天级的局部地图;
E、驾驶地图生成:利用智能摄像头及激光雷达获取车辆周围环境信息、车道线信息及障碍物信息,将其与天级局部地图叠加,进而获得针对当前时刻的融合认知的驾驶地图。
步骤C,确定初始投影点,进一步实现智能汽车行驶路段的定位信息,具体为:利用基于DS证据推理的地图匹配算法确定智能汽车在路网数据库中的当前行驶路段和初始投影位置点;再通过智能汽车定位模块前后两个时刻输出的定位信息获得三维定位坐标增量;接着,基于车辆初始的投影点坐标和三维定位坐标增量对定位模块的定位数据进一步修正;最后,将修正后的定位数据垂直投影到路网数据库中的道路中心线上获得汽车在路网数据中的投影位置。
步骤C,确定行驶路段地图,并通过网线传输给车载工控机,具体为:通过传感器、车载智能摄像头及激光雷达分别采集车辆运行信息、车道线及障碍物特征级信息,并对上述信息进行基于置信区间的整合和处理,其中传感器及车载智能摄像头通过汽车CAN总线、激光雷达通过网线将数据传输到车载工控机。
所述传感器包括轮速传感器和转矩传感器,其中,轮速传感器用于获得的车辆纵向车速信息,转矩传感器用于获得车辆横向转向角速度信息。
对车辆运行信息、车道线及障碍物特征级信息进行基于置信区间的整合和处理包括以下步骤:
C1可行驶区域提取:
C11、对于无车道线道路,根据雷达返回数据的特征结合数据区间密度分布获得路沿点集,并利用基于加权欧氏距离KNN改进的OPTICS算法对得到的路沿点聚类;
C12、使用最小二乘法拟合出两侧路沿;对于有车道线的道路,利用智能摄像头直接读取两侧车道线信息;
C13、通过改进的OPTICS算法将路面上的障碍物点云进行聚类,并提取出每类障碍物的距离、角度以及障碍物中心点x、y、z坐标值等几何特征;
C2、障碍物识别与跟踪:工控机将获取的各类特征级信息进行进一步的融合处理。
步骤C2,融合处理是指:计算目标几何相似度,根据相似度进行目标匹配,采用基于距离加权融合的方法对目标几何特征进行融合;采用基于多特征的目标跟踪方法对目标进行跟踪,提取目标相对于车辆坐标系中的运动速度;利用卫星定位系统采集的车辆的运动速度,通过计算,获得目标相对于地面坐标系中的运动速度;根据目标的几何特征和运动特征,建立目标特征模型对目标类别判定;栅格化目标特征,并进行栅格表示,获得当前环境下的障碍物及车道线地图。
在对两目标是否匹配进行判断时,根据相似度阈值D_θ而定:当相似度值大于D_θ时,则可视为同一目标,应进行融合;若小于阈值D_θ时,则认为其为两个不同的目标,不进行融合;对于已经进行目标相似度匹配的目标,利用置信度加权的方法对目标几何特征进行融合。
对目标几何特征进行融合包括以下步骤:计算目标中心到各激光雷达的距离;进而计算出每个雷达该目标的综合可信度;最后,由综合可信度对目标中心的坐标、目标长度、目标宽度三种几何特征进行融合。
所述目标相似度匹配为对两个四线激光雷达同时扫描到的目标进行匹配,其中,目标相似度的衡量标准具体为距离相似度和面积相似度,它们的计算公式如下:
Ⅰ、距离相似度
距离的度量采用欧氏距离,即衡量二维平面上两目标中心a点(x1,y1)与b点(x2,y2)的欧氏距离为:
Ⅱ、面积相似度
面积相似度只是两目标面积之间的差值,对于目标a的面积为Sa,目标b的面积为Sb。
Sab=|Sa-Sb|
S=length*width(ε)
其中,S为代表目标的面积,length代表目标长度,width代表宽度,ε为线段数;
即目标几何相似度的计算式如下:
其中,θ_1、θ_2分别两种标准的权重;D_ab为目标相似程度,取值在0~1之间;
假设a雷达扫描的目标集为{a1,a2,a3,a4…},b雷达扫描的目标集为{b1,b2,b3,b4…},可得到目标相似度的矩阵,如下所示:
其中,Daibj代表目标ai与目标bj的相似度。
与现有技术相比,本发明的有益效果在于:本发明基于多传感器特征级信息及高精地图、路网数据库的数据融合,可以实现自动驾驶车辆对于周围环境的实时采集与识别,准确的车辆三维定位与地图匹配又能在此过程中极大的优化环境感知模型及方法,提高可靠性及鲁棒性。同时,考虑车辆动力学模型的车辆动态预测更能增强车辆对于危险状况的预警能力,以及驾驶地图的可读性,提高车辆行驶平顺性与安全性,为自动驾驶车辆提供更为安全的行驶策略,保障公共交通安全。具体为:
(1)、现有的环境感知方法并未综合考虑车辆动力学模型及其运动能力,也并未将高精地图信息与环境传感信息有效融合,只是简单的传感信息的堆砌与融合,且信息未经过整合处理,对于自动驾驶车辆决策层来说可读性不高,鲁棒性不好。本发明引入驾驶地图概念,将路网数据库与高精地图的信息相融合进行车辆行驶路段的定位,再结合环境传感信息确定路面几何形态及具体交通参与者类型及属性,从而建立融合人车路的实时驾驶地图,辅助决策层更好地驾驶汽车,进而提高自动驾驶的安全性和稳定性;
(2)、本发明考虑到了车辆自身运动模型对环境感知方法的影响,借助车辆动力学模型对车辆运动进行动态预测,更有效地对环境信息进行动态的整合处理,以提高地图信息的可读性及准确性,避免自动驾驶车辆因环境信息的冗余或不足而发生交通事故,借助秒级驾驶地图辅助车辆决策层的控制,更有效地保障了车辆的驾驶安全。
附图说明
图1为各装置通讯示意图;
图2为具体设备安装示意图;
图3为自动驾驶车辆行驶路段定位方案示意图;
图4为基于摄像头与激光雷达的可行驶区域提取算法流程图;
图5为障碍物识别与跟踪算法流程图;
图6为驾驶地图生成算法流程图。
具体实施方式
以下结合附图进一步说明本发明的技术方案。
一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法,其包括以下步骤:车辆信息提取、行驶路段定位、可行驶区域提取、障碍物识别与跟踪和驾驶地图生成。
1、在车辆信息提取部分中,借助如图1所示的通讯方法生成自动驾驶车辆驾驶地图,由轮速传感器获得的车辆纵向车速信息、由转矩传感器获得的车辆横向转向角速度信息等车辆运行信息,由智能摄像头获取的车道线及障碍物信息,通过汽车CAN总线传输到车载工控机并进行分析处理,而由激光雷达IBEO Lux获取的障碍物信息、以及GPS和惯导装置获得的车辆三维定位信息则通过以太网传输给车载工控机。处理后生成的驾驶地图信息通过CAN总线传输给自动驾驶车辆的控制决策层。
关于具体设备的安装,如图2所示示意图,四个Ibeo Lux激光雷达分别布置于车辆的前后两侧,用来检测与识别道路上的障碍物;智能摄像头布置车辆前挡风玻璃中轴线上侧,以便于摄像头识别车道线及障碍物信息,并将其传输给工控机进行逻辑运算处理;GPS及惯导装置布置于车辆中心线上,如图2所示的位置,用于获取车辆的平面定位信息,包括经纬度等;图中两条颜色的线分别为数据传输线及供电线。
2、在行驶路段定位部分中,如图3所示自动驾驶车辆行驶路段定位方案示意图,根据由高度计及GPS获取的车辆三维定位信息,利用基于DS证据推理的地图匹配算法确定智能汽车在路网数据库中的当前行驶路段和初始投影位置点;然后,通过智能汽车定位模块前后两个时刻输出的定位信息获得三维定位坐标增量;接着,基于车辆初始的投影点坐标和三维定位坐标增量对定位模块的定位数据进一步修正;最后,将修正后的定位数据垂直投影到路网数据库中的道路中心线上,获得汽车在路网数据中的投影位置。
3、在可行驶区域提取部分中,如图4所示为基于摄像头与激光雷达的可行驶区域提取算法流程图,主要流程如下:
31、对于无车道线道路,根据雷达返回数据的特征结合数据区间密度分布获得路沿点集,并利用基于加权欧氏距离KNN改进的OPTICS算法对得到的路沿点聚类。
32、使用最小二乘法拟合出两侧路沿;对于有车道线的道路,利用智能摄像头直接读取两侧车道线信息。
33、通过改进的OPTICS算法将路面上的障碍物点云进行聚类,并通过计算得到障碍物的位置、距离、尺寸等信息。
利用改进的OPTICS算法将可行驶区域内的障碍物进行聚类,并提取出每类障碍物的距离、角度以及障碍物中心点x、y、z坐标值等几何特征,计算目标几何相似度,根据相似度进行目标匹配;采用基于距离加权融合的方法对目标几何特征进行融合;采用基于多特征的目标跟踪方法对目标进行跟踪,提取目标相对于车辆坐标系中的运动速度;利用卫星定位系统采集的车辆的运动速度,通过计算,获得目标相对于地面坐标系中的运动速度;根据目标的几何特征和运动特征,建立目标特征模型对目标类别判定;栅格化目标特征,并进行栅格表示,获得当前环境下的障碍物及车道线地图。
同时,引入PLK摄像头对前方环境识别的信息,通过多假设跟踪模型实现对于障碍物的检测与跟踪,避免单个传感器所带来的不稳定因素,提高系统的检测精度。
4、在障碍物识别与跟踪部分中,如图5所示为障碍物识别与跟踪算法流程图,以两个前方激光雷达为例,由于前后方均通过两个激光雷达来检测,它们对环境中的同一个目标会有两个不同的检测结果,这两个结果不能直接用于目标的判断,必须将它们进行融合。而对于两个检测结果进行融合的关键,是判断它们是否为同一目标,如果是同一目标才能进行融合。利用的目标相似度匹配方法就是对两个四线激光雷达同时扫描到的目标进行匹配。其中,目标相似度的衡量标准具体为距离相似度和面积相似度,它们的计算公式如下:
1.距离相似度
距离的度量采用欧氏距离,即衡量二维平面上两目标中心a点(x1,y1)与b点(x2,y2)的欧氏距离为:
2.面积相似度
面积相似度只是两目标面积之间的差值,对于目标a的面积为Sa,目标b的面积为Sb。
Sab=|Sa-Sb|
S=length*width(ε)
其中,S为代表目标的面积,length代表目标长度,width代表宽度,ε为线段数。
综上所述,目标几何相似度的计算式如下:
其中,θ_1、θ_2分别两种标准的权重;D_ab为目标相似程度,取值在0~1之间。
假设a雷达扫描的目标集为{a1,a2,a3,a4…},b雷达扫描的目标集为{b1,b2,b3,b4…},可得到目标相似度的矩阵,如下所示:
其中,Daibj代表目标ai与目标bj的相似度。
在对两目标是否匹配进行判断时,应该根据相似度阈值D_θ而定:当相似度值大于D_θ时,则可视为同一目标,应进行融合;若小于阈值D_θ时,则认为其为两个不同的目标,不进行融合。
对于已经进行目标相似度匹配的目标,利用一种置信度加权的方法对目标几何特征进行融合。该方法是通过计算目标中心到各激光雷达的距离,从而计算出每个雷达该目标的综合可信度,最后由综合可信度对目标进行融合。在融合时只对目标中心的坐标、目标长度、目标宽度三种几何特征进行融合。
本方法利用目标相似度进行数据关联,然后采用Kalman滤波进行状态估计。
在上述目标跟踪部分引入摄像头数据,基于MHT(多假设跟踪模型)对两帧数剧组合关系提出最优假设,从而通过滤波器的更新和预测,实现更准确稳定的障碍物跟踪算法。
5、在驾驶地图生成部分中,如图6所示为驾驶地图生成算法流程图,首先通过全局的高精度地图和路网数据库获得天级的全局地图;在此基础上借助高度计和GPS获得车辆的三维定位信息,并利用图3所示的算法获得智能车行驶路段的定位信息,将其与路网数据库匹配,进而获得天级的局部地图;最后,利用智能摄像头及激光雷达获取车辆周围环境信息,车道线信息及障碍物信息等,将其与之前的天级局部地图叠加,进而获得针对当前时刻的融合认知的驾驶地图。
本发明涉用来面向智能车建立复杂道路环境下的环境模型,即驾驶地图。结合车辆的运动能力、当前车路信息向智能车提供当前环境下的车道信息、障碍物信息等环境信息,包括车载传感器、车载环境感知设备、车载工控机等装置,车载工控机通过CAN线实现通讯,车载环境感知设备包括智能摄像头、激光雷达、GPS及惯性导航装置,车载传感器、智能摄像头、激光雷达、GPS及惯导等与工控机均通过CAN总线通讯,车载传感器包括轮速传感器、转矩传感器、陀螺仪等,工控机负责基于路网数据库与高精地图的车辆局部路径定位算法、基于摄像头的车辆偏离预警算法、基于摄像头与激光雷达数据融合的障碍物识别与跟踪算法以及基于多传感器信息特征级融合的实时驾驶地图生成算法。此方法的最终输出物为驾驶地图,即结合路面几何形态及交通参与者的秒级的基于本车视角的局域地图。
本发明通过车载环境感知模块各类传感器信息的特征级融合实现对车辆行驶路段的定位、车道线信息的读取及车辆周围障碍物的识别与跟踪,并结合车辆运动能力及具体交通共同参与者类型建立秒级的车辆局部驾驶地图。实时将环境感知装置获得的特征级信息(包括车辆所处局部路段高精地图信息、车道线信息、车辆周围障碍物信息)进行融合形成驾驶地图,并将其整合传输给智能车控制决策层进行具体的车辆控制操作。更精准更实时的车辆驾驶地图信息可以提供给自动驾驶车辆决策层更符合车辆动力学模型的环境传感信息,并对车辆未来一段时间内所处的环境进行动态预测,有效提高自动驾驶车辆的环境感知能力及动态避障能力,保障自动驾驶车辆在运行状态下的行驶交通安全。
Claims (7)
1.一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法,包括以下步骤:
A、通过全局的高精度地图和路网数据库获得天级的全局地图;
B、利用高度计获取车辆高度信息,配合GPS获取平面定位信息,获得车辆的三维定位信息;
C、将上述三维定位信息与路网数据库相结合,确定初始投影点,进一步实现智能汽车行驶路段的定位信息,确定行驶路段地图,并通过网线传输给车载工控机;
所述确定行驶路段地图,并通过网线传输给车载工控机,具体为:
通过传感器、车载智能摄像头及激光雷达分别采集车辆运行信息、车道线及障碍物特征级信息,并对上述信息进行基于置信区间的整合和处理,其中传感器及车载智能摄像头通过汽车CAN总线、激光雷达通过网线将数据传输到车载工控机;
所述对车辆运行信息、车道线及障碍物特征级信息进行基于置信区间的整合和处理包括以下步骤:
C1可行驶区域提取:
C11、对于无车道线道路,根据雷达返回数据的特征结合数据区间密度分布获得路沿点集,并利用基于加权欧氏距离KNN改进的OPTICS算法对得到的路沿点聚类;
C12、使用最小二乘法拟合出两侧路沿;对于有车道线的道路,利用智能摄像头直接读取两侧车道线信息;
C13、通过改进的OPTICS算法将路面上的障碍物点云进行聚类,并提取出每类障碍物的距离、角度以及障碍物中心点x、y、z坐标值几何特征;
C2、障碍物识别与跟踪:工控机将获取的各类特征级信息进行进一步的融合处理;
D、车载工控机将定位信息与路网数据库匹配,进而获得天级的局部地图;
E、利用智能摄像头及激光雷达获取车辆周围环境信息、车道线信息及障碍物信息,将其与天级局部地图叠加,进而获得针对当前时刻的融合认知的驾驶地图。
2.根据权利要求1所述的一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法,其特征在于,步骤C,确定初始投影点,进一步实现智能汽车行驶路段的定位信息,具体为:利用基于DS证据推理的地图匹配算法确定智能汽车在路网数据库中的当前行驶路段和初始投影位置点;再通过智能汽车定位模块前后两个时刻输出的定位信息获得三维定位坐标增量;接着,基于车辆初始的投影点坐标和三维定位坐标增量对定位模块的定位数据进一步修正;最后,将修正后的定位数据垂直投影到路网数据库中的道路中心线上获得汽车在路网数据中的投影位置。
3.根据权利要求1所述的一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法,其特征在于:所述传感器包括轮速传感器和转矩传感器,其中,轮速传感器用于获得的车辆纵向车速信息,转矩传感器用于获得车辆横向转向角速度信息。
4.根据权利要求1所述的一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法,其特征在于:步骤C2,融合处理是指:计算目标几何相似度,根据相似度进行目标匹配,采用基于距离加权融合的方法对目标几何特征进行融合;采用基于多特征的目标跟踪方法对目标进行跟踪,提取目标相对于车辆坐标系中的运动速度;利用卫星定位系统采集的车辆的运动速度,通过计算,获得目标相对于地面坐标系中的运动速度;根据目标的几何特征和运动特征,建立目标特征模型对目标类别判定;栅格化目标特征,并进行栅格表示,获得当前环境下的障碍物及车道线地图。
5.根据权利要求4所述的一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法,其特征在于:在对两目标是否匹配进行判断时,根据相似度阈值D_θ而定:当相似度值大于D_θ时,则视为同一目标,应进行融合;若小于阈值D_θ时,则认为其为两个不同的目标,不进行融合;对于已经进行目标相似度匹配的目标,利用置信度加权的方法对目标几何特征进行融合。
6.根据权利要求5所述的一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法,其特征在于,对目标几何特征进行融合包括以下步骤:计算目标中心到各激光雷达的距离;进而计算出每个雷达该目标的综合可信度;最后,由综合可信度对目标中心的坐标、目标长度、目标宽度三种几何特征进行融合。
7.根据权利要求4所述的一种基于自动驾驶的多传感器融合认知的驾驶地图生成方法,其特征在于:所述目标相似度匹配为对两个四线激光雷达同时扫描到的目标进行匹配,其中,目标相似度的衡量标准具体为距离相似度和面积相似度,它们的计算公式如下:
Ⅰ、距离相似度
距离的度量采用欧氏距离,即衡量二维平面上两目标中心a点(x1,y1)与b点(x2,y2)的欧氏距离为:
Ⅱ、面积相似度
面积相似度只是两目标面积之间的差值,对于目标a的面积为Sa,目标b的面积为Sb;
Sab=|Sa-Sb|
S=length*width(ε)
其中,S为代表目标的面积,length代表目标长度,width代表宽度,ε为线段数;
即目标几何相似度的计算式如下:
其中,θ1、θ2分别两种标准的权重;Dab为目标相似程度,取值在0~1之间;
假设a雷达扫描的目标集为{a1,a2,a3,a4…},b雷达扫描的目标集为{b1,b2,b3,b4…},可得到目标相似度的矩阵,如下所示:
其中,Daibj代表目标ai与目标bj的相似度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811175699.XA CN109556615B (zh) | 2018-10-10 | 2018-10-10 | 基于自动驾驶的多传感器融合认知的驾驶地图生成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811175699.XA CN109556615B (zh) | 2018-10-10 | 2018-10-10 | 基于自动驾驶的多传感器融合认知的驾驶地图生成方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109556615A CN109556615A (zh) | 2019-04-02 |
CN109556615B true CN109556615B (zh) | 2022-10-04 |
Family
ID=65864738
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811175699.XA Active CN109556615B (zh) | 2018-10-10 | 2018-10-10 | 基于自动驾驶的多传感器融合认知的驾驶地图生成方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109556615B (zh) |
Families Citing this family (68)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109766958B (zh) * | 2019-04-12 | 2019-07-05 | 江苏量动信息科技有限公司 | 一种用于数据融合的数据预处理方法及装置 |
CN110070712A (zh) * | 2019-04-12 | 2019-07-30 | 同济大学 | 一种低速清扫车全局定位系统及方法 |
CN110045402A (zh) * | 2019-04-16 | 2019-07-23 | 北京四维图新科技股份有限公司 | Gnss定位质量信息推送方法、装置、设备及存储介质 |
CN110057373B (zh) * | 2019-04-22 | 2023-11-03 | 上海蔚来汽车有限公司 | 用于生成高精细语义地图的方法、装置和计算机存储介质 |
CN111316328A (zh) * | 2019-04-24 | 2020-06-19 | 深圳市大疆创新科技有限公司 | 车道线地图的维护方法、电子设备与存储介质 |
CN111742326A (zh) * | 2019-05-22 | 2020-10-02 | 深圳市大疆创新科技有限公司 | 车道线的检测方法、电子设备与存储介质 |
CN111982133B (zh) * | 2019-05-23 | 2023-01-31 | 北京地平线机器人技术研发有限公司 | 基于高精地图对车辆进行定位的方法、装置及电子设备 |
CN110186469A (zh) * | 2019-05-31 | 2019-08-30 | 北京主线科技有限公司 | 测试无人驾驶系统的测试用数据生成方法和系统 |
CN110174115B (zh) * | 2019-06-05 | 2021-03-16 | 武汉中海庭数据技术有限公司 | 一种基于感知数据自动生成高精度定位地图的方法及装置 |
CN110058597A (zh) * | 2019-06-19 | 2019-07-26 | 奥特酷智能科技(南京)有限公司 | 一种自动驾驶异构系统及实现方法 |
CN110285817B (zh) * | 2019-07-12 | 2023-03-21 | 东北电力大学 | 基于自适应d-s证据理论的复杂路网地图匹配方法 |
CN112154429B (zh) * | 2019-07-29 | 2024-03-19 | 深圳市大疆创新科技有限公司 | 高精度地图定位方法、系统、平台及计算机可读存储介质 |
CN110481635B (zh) * | 2019-08-13 | 2021-12-10 | 中山大学 | 基于卷积神经网络和传统几何控制器的拟人化转向系统及其方法 |
GB201912145D0 (en) * | 2019-08-23 | 2019-10-09 | Five Ai Ltd | Performance testing for robotic systems |
CN110543850B (zh) * | 2019-08-30 | 2022-07-22 | 上海商汤临港智能科技有限公司 | 目标检测方法及装置、神经网络训练方法及装置 |
CN110781730B (zh) * | 2019-09-16 | 2022-09-27 | 北京踏歌智行科技有限公司 | 智能驾驶感知方法及感知装置 |
CN110641390A (zh) * | 2019-09-19 | 2020-01-03 | 杨柏青 | 一种智能汽车驾驶辅助装置 |
CN110631593B (zh) * | 2019-11-25 | 2020-02-21 | 奥特酷智能科技(南京)有限公司 | 一种用于自动驾驶场景的多传感器融合定位方法 |
CN110853393B (zh) * | 2019-11-26 | 2020-12-11 | 清华大学 | 智能网联车辆测试场数据采集与融合方法及系统 |
CN112923931A (zh) * | 2019-12-06 | 2021-06-08 | 北理慧动(常熟)科技有限公司 | 一种基于固定路线下的特征地图匹配与gps定位信息融合方法 |
CN111137236A (zh) * | 2019-12-29 | 2020-05-12 | 的卢技术有限公司 | 一种基于汽车前挡风非透明液晶显示方法及系统 |
CN113383283B (zh) * | 2019-12-30 | 2024-06-18 | 深圳元戎启行科技有限公司 | 感知信息处理方法、装置、计算机设备和存储介质 |
CN111192341A (zh) * | 2019-12-31 | 2020-05-22 | 北京三快在线科技有限公司 | 生成高精地图的方法、装置、自动驾驶设备及存储介质 |
CN111220154A (zh) * | 2020-01-22 | 2020-06-02 | 北京百度网讯科技有限公司 | 车辆定位方法、装置、设备和介质 |
JP7330911B2 (ja) * | 2020-02-05 | 2023-08-22 | マツダ株式会社 | 車両用制御装置 |
CN112241167A (zh) * | 2020-03-05 | 2021-01-19 | 北京新能源汽车技术创新中心有限公司 | 自动驾驶中的信息处理方法、装置及存储介质 |
CN111508256A (zh) * | 2020-03-17 | 2020-08-07 | 重庆大学 | 一种基于区域时空域的交通信息重构方法及智能交通系统 |
CN111356083A (zh) * | 2020-04-03 | 2020-06-30 | 许昌泛网信通科技有限公司 | 一种自动驾驶车辆的地图数据过滤及传输方法 |
DE102020205549A1 (de) * | 2020-04-30 | 2021-11-04 | Volkswagen Aktiengesellschaft | Verfahren zum Betrieb eines Transportmittel-Assistenz- oder Steuerungssystems |
CN111561923B (zh) * | 2020-05-19 | 2022-04-15 | 北京数字绿土科技股份有限公司 | 基于多传感器融合的slam制图方法、系统 |
CN111752825B (zh) * | 2020-05-26 | 2024-03-19 | 江苏大学 | 一种面向智能电动汽车的即插即用软件平台及其检测方法 |
CN111797701B (zh) * | 2020-06-10 | 2024-05-24 | 广东正扬传感科技股份有限公司 | 用于车辆多传感器融合系统的道路障碍物感知方法及系统 |
CN111880191B (zh) * | 2020-06-16 | 2023-03-28 | 北京大学 | 基于多智能体激光雷达和视觉信息融合的地图生成方法 |
CN111664860B (zh) * | 2020-07-01 | 2022-03-11 | 北京三快在线科技有限公司 | 定位方法、装置、智能设备及存储介质 |
CN111814286B (zh) * | 2020-07-07 | 2021-03-12 | 吉林大学 | 一种面向自动驾驶的车道级地图几何模型建立方法 |
WO2022027159A1 (en) * | 2020-08-03 | 2022-02-10 | Beijing Voyager Technology Co., Ltd. | Systems and methods for constructing high-definition map with its confidence determined based on crowdsourcing |
CN112101120B (zh) * | 2020-08-18 | 2024-01-05 | 沃行科技(南京)有限公司 | 基于自动驾驶应用场景的地图模型及其应用方法 |
CN112033429B (zh) * | 2020-09-14 | 2022-07-19 | 吉林大学 | 一种智能汽车的目标级多传感器融合方法 |
CN112307594B (zh) * | 2020-09-22 | 2023-03-28 | 中国汽车技术研究中心有限公司 | 道路数据采集和模拟场景建立一体化系统及方法 |
CN112113578A (zh) * | 2020-09-23 | 2020-12-22 | 安徽工业大学 | 一种用于自动驾驶车辆的障碍物运动预测方法 |
CN112147632A (zh) * | 2020-09-23 | 2020-12-29 | 中国第一汽车股份有限公司 | 车载激光雷达感知算法的测试方法、装置、设备和介质 |
CN112639910B (zh) * | 2020-09-25 | 2022-05-17 | 华为技术有限公司 | 交通元素的观测方法和装置 |
CN112257522B (zh) * | 2020-09-30 | 2024-02-20 | 南京航空航天大学 | 基于环境特征的多传感器融合环境感知方法 |
CN112212872B (zh) * | 2020-10-19 | 2022-03-11 | 合肥工业大学 | 基于激光雷达和导航地图的端到端自动驾驶方法及系统 |
CN112414416A (zh) * | 2020-10-26 | 2021-02-26 | 高深智图(广州)科技有限公司 | 一种基于四级自动驾驶高精度的adas地图数据系统 |
CN112364561B (zh) * | 2020-10-26 | 2022-07-26 | 上海感探号信息科技有限公司 | 控车动作修正方法、装置、电子设备和存储介质 |
CN112466147B (zh) * | 2020-11-18 | 2022-08-30 | 上海汽车集团股份有限公司 | 一种基于多传感器的库位检测方法及相关装置 |
CN112572430A (zh) * | 2020-12-14 | 2021-03-30 | 深兰人工智能(深圳)有限公司 | 碰撞风险确定方法和装置 |
CN112908034A (zh) * | 2021-01-15 | 2021-06-04 | 中山大学南方学院 | 一种智能公交安全驾驶行为辅助督导系统及控制方法 |
CN112887903B (zh) * | 2021-01-26 | 2022-12-09 | 东南大学 | 一种基于软信息融合的通信定位感知一体化方法 |
CN113155144B (zh) * | 2021-02-03 | 2023-05-16 | 东风汽车集团股份有限公司 | 一种基于高精地图实时路况建模的自动驾驶方法 |
CN113064193B (zh) * | 2021-03-25 | 2022-12-16 | 上海智能新能源汽车科创功能平台有限公司 | 一种基于车路云协同的组合定位系统 |
CN113085896B (zh) * | 2021-04-19 | 2022-10-04 | 暨南大学 | 一种现代有轨清洁车辅助自动驾驶系统及方法 |
CN113298141B (zh) * | 2021-05-24 | 2023-09-15 | 北京环境特性研究所 | 基于多源信息融合的探测方法、装置及存储介质 |
CN113311452B (zh) * | 2021-05-26 | 2022-12-30 | 上海新纪元机器人有限公司 | 一种基于多传感器的定位方法及其系统 |
CN114035570A (zh) * | 2021-09-24 | 2022-02-11 | 山西省交通科技研发有限公司 | 基于脑机接口与激光雷达融合感知的防撞控制方法 |
CN114084129A (zh) * | 2021-10-13 | 2022-02-25 | 武汉光庭信息技术股份有限公司 | 一种基于融合的车辆自动驾驶控制方法及系统 |
CN113985463A (zh) * | 2021-10-29 | 2022-01-28 | 江铃汽车股份有限公司 | 一种基于5g智能车载终端的l3级及以上自动驾驶定位系统 |
CN114394089B (zh) * | 2021-12-13 | 2023-09-01 | 暨南大学 | 一种轨道清洁车辅助驾驶方法及系统 |
CN114312842B (zh) * | 2021-12-30 | 2023-12-05 | 东风悦享科技有限公司 | 一种无人清扫车信号灯融合感知识别和控制方法 |
CN114383598B (zh) * | 2022-01-17 | 2023-06-20 | 中国铁建重工集团股份有限公司 | 一种隧道施工作业车及其自动驾驶系统 |
CN114076595B (zh) * | 2022-01-19 | 2022-04-29 | 浙江吉利控股集团有限公司 | 道路高精度地图生成方法、装置、设备及存储介质 |
CN114572102B (zh) * | 2022-01-28 | 2023-07-14 | 上海康耐司信号设备有限公司 | 一种适用于车灯的智能调节系统及方法 |
CN115205803A (zh) * | 2022-07-14 | 2022-10-18 | 安徽蔚来智驾科技有限公司 | 自动驾驶环境感知方法、介质及车辆 |
CN115827925A (zh) * | 2023-02-21 | 2023-03-21 | 中国第一汽车股份有限公司 | 一种目标关联方法、装置、电子设备及存储介质 |
CN116674540A (zh) * | 2023-07-27 | 2023-09-01 | 苏州鉴智机器人科技有限公司 | 车辆通过控制方法、装置、电子设备及可读存储介质 |
CN116680656B (zh) * | 2023-07-31 | 2023-11-07 | 合肥海普微电子有限公司 | 基于生成型预训练变换器的自动驾驶运动规划方法及系统 |
CN117470254B (zh) * | 2023-12-28 | 2024-03-08 | 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) | 一种基于雷达服务的车载导航系统和方法 |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080033645A1 (en) * | 2006-08-03 | 2008-02-07 | Jesse Sol Levinson | Pobabilistic methods for mapping and localization in arbitrary outdoor environments |
CN103177041A (zh) * | 2011-12-26 | 2013-06-26 | 北京四维图新科技股份有限公司 | 电子地图生成方法、信息发布方法、路径规划方法及装置 |
WO2013149149A1 (en) * | 2012-03-29 | 2013-10-03 | Honda Motor Co., Ltd | Method to identify driven lane on map and improve vehicle position estimate |
CN104943684B (zh) * | 2014-03-31 | 2017-09-29 | 比亚迪股份有限公司 | 无人驾驶汽车控制系统和具有其的汽车 |
CN104318768B (zh) * | 2014-10-27 | 2017-06-06 | 杭州智诚惠通科技有限公司 | 基于Hadoop的自适应交通信息瓦片地图生成系统及方法 |
CN104636763B (zh) * | 2014-12-01 | 2018-10-09 | 北京工业大学 | 一种基于无人驾驶车的道路与障碍物检测方法 |
CN106325275B (zh) * | 2016-09-14 | 2019-08-20 | 广州今甲智能科技有限公司 | 一种机器人导航的系统、方法及装置 |
CN106441319B (zh) * | 2016-09-23 | 2019-07-16 | 中国科学院合肥物质科学研究院 | 一种无人驾驶车辆车道级导航地图的生成系统及方法 |
CN106855411A (zh) * | 2017-01-10 | 2017-06-16 | 深圳市极思维智能科技有限公司 | 一种机器人及其以深度摄像头和避障系统构建地图的方法 |
CN107193278B (zh) * | 2017-05-08 | 2021-06-18 | 江苏大学 | 基于定位的图像和地图匹配的可行驶区域识别方法 |
CN108303721B (zh) * | 2018-02-12 | 2020-04-03 | 北京经纬恒润科技有限公司 | 一种车辆定位方法及系统 |
-
2018
- 2018-10-10 CN CN201811175699.XA patent/CN109556615B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109556615A (zh) | 2019-04-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109556615B (zh) | 基于自动驾驶的多传感器融合认知的驾驶地图生成方法 | |
CN109829386B (zh) | 基于多源信息融合的智能车辆可通行区域检测方法 | |
EP3644294B1 (en) | Vehicle information storage method, vehicle travel control method, and vehicle information storage device | |
CN109624974B (zh) | 车辆控制装置、车辆控制方法以及存储介质 | |
CN115552200A (zh) | 用于生成重要性占据栅格地图的方法和系统 | |
EP3525192B1 (en) | Vehicle assessment method, travel route correction method, vehicle assessment device, and travel route correction device | |
CN114442101B (zh) | 基于成像毫米波雷达的车辆导航方法、装置、设备及介质 | |
CN113071518B (zh) | 一种自动无人驾驶方法、小巴、电子设备以及存储介质 | |
US11042759B2 (en) | Roadside object recognition apparatus | |
CN111824141B (zh) | 显示控制装置、显示控制方法及存储介质 | |
CN113460080B (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
US11814082B2 (en) | Mobile object control method, mobile object control device, and storage medium | |
US20210300419A1 (en) | Mobile object control method, mobile object control device, and storage medium | |
US12033403B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
RU2721436C1 (ru) | Способ помощи вождению и устройство помощи вождению | |
CN113432615B (zh) | 基于多传感器融合可驾驶区域的检测方法、系统和车辆 | |
EP4285083A1 (en) | Methods and system for generating a lane-level map for an area of interest for navigation of an autonomous vehicle | |
US20230177846A1 (en) | Mobile object control device, mobile object control method, and storage medium | |
CN116242375A (zh) | 一种基于多传感器的高精度电子地图生成方法和系统 | |
US20220306150A1 (en) | Control device, control method, and storage medium | |
CN113479204B (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
CN113492844B (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
Lai et al. | Sensor fusion of camera and MMW radar based on machine learning for vehicles | |
KR20150041895A (ko) | 차선 인식 장치 및 방법 | |
CN115147689A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |