CN115223131A - 一种自适应巡航的跟随目标车辆检测方法、装置及汽车 - Google Patents
一种自适应巡航的跟随目标车辆检测方法、装置及汽车 Download PDFInfo
- Publication number
- CN115223131A CN115223131A CN202111317330.XA CN202111317330A CN115223131A CN 115223131 A CN115223131 A CN 115223131A CN 202111317330 A CN202111317330 A CN 202111317330A CN 115223131 A CN115223131 A CN 115223131A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- lane
- lane line
- target
- target vehicle
- 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
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/20—Analysis of motion
- G06T7/246—Analysis of motion using feature-based methods, e.g. the tracking of corners or segments
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/30—Subject of image; Context of image processing
- G06T2207/30248—Vehicle exterior or interior
- G06T2207/30252—Vehicle exterior; Vicinity of vehicle
- G06T2207/30256—Lane; Road marking
Landscapes
- Engineering & Computer Science (AREA)
- Multimedia (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明提供一种自适应巡航的跟随目标车辆检测方法、装置及汽车,包括,通过车载摄像头获取本车前方的车道线检测数据,并根据所述车道线检测结果确定本车车道区域;分别通过所述车载摄像头和车载雷达获取本车前方的摄像头车辆检测数据和雷达车辆检测数据,并根据所述摄像头车辆检测数据和所述雷达车辆检测数据确定目标车辆;判断所述目标车辆和所述本车车道区域的相对位置;若所述目标车辆处于所述本车车道区域内,则选择距本车距离最小的目标车辆作为当前跟随目标车辆。本发明能够在不同场景中有效检测出跟随目标车辆,提高自车跟车行驶的稳定性,进而提高行车安全和用户体验。
Description
技术领域
本发明涉及智能辅助驾驶ADAS技术领域,特别是涉及一种自适应巡航的跟随目标车辆检测方法、装置及汽车。
背景技术
自适应巡航控制(Adaptive Cruise Control,ACC)是辅助驾驶领域中一种常用的智能化自动控制系统,不仅能够保持驾驶人预先设定的车速,而且能够在检测到前方目标车辆时,根据前方车辆的位置和速度等信息以相对稳定的车速行驶或自动减速,以保持与前方目标车辆的安全距离,避免发生碰撞事故。
现有的处理方法中,有根据采集的车辆前方的视频信息和雷达信息得到前方车辆的位置和速度信息,根据本车的运动信息和车辆动力学模型计算得出本车行驶轨迹,进而基于本车行驶轨迹、车辆宽度和安全宽度计算得到本车安全行驶轨迹。当前方车辆的当前车速小于本车的当前车速,且前方车辆的当前位置处于本车的当前安全行驶轨迹内时,将前方车辆作为自适应巡航模式的跟随目标车辆;只使用了本车的运动信息,由于运动噪声的影响,会存在本车的行驶轨迹预测不准的情况,无法有效识别出跟随目标车辆。还有通过车辆安装有V2V(车际通信交互)模块,车辆之间通过V2V模块直接进行信息交互,跟随车辆查找预设范围内与本车存在相同行驶路线段的待定车辆,通过判断相同行驶路线段的通行里程是否达到预设通行里程,或者待定车辆在所述相同行驶路线段上的通行时长是否达到预设通行时长来寻找合适的车辆作为领航车辆,并根据领航车辆的行驶数据确定跟车时距;目前大部分车辆并没有配备V2V通信单元,因此适用性有限,对于没有配备V2V通信单元的车辆无法进行领航车辆的判断。
在自适应巡航控制系统中,前方目标车辆的检测至关重要,如果无法准确检测出前方目标车辆,会导致自适应巡航控制系统的跟随稳定性较差,更严重的,会导致不能及时制动,进而发生碰撞,降低驾乘安全性。
发明内容
本发明的目的在于,提出一种自适应巡航的跟随目标车辆检测方法、装置及汽车,实现能够在不同场景中有效检测出跟随目标车辆,提高自车跟车行驶的稳定性,进而提高行车安全和用户体验。
一方面,提供一种自适应巡航的跟随目标车辆检测方法,包括:
通过车载摄像头获取本车前方的车道线检测数据,并根据所述车道线检测结果确定本车车道区域;
分别通过所述车载摄像头和车载雷达获取本车前方的摄像头车辆检测数据和雷达车辆检测数据,并根据所述摄像头车辆检测数据和所述雷达车辆检测数据确定目标车辆;
判断所述目标车辆和所述本车车道区域的相对位置;若所述目标车辆处于所述本车车道区域内,则选择距本车距离最小的目标车辆作为当前跟随目标车辆。
优选地,所述通过车载摄像头获取本车前方的车道线检测数据具体包括:
通过车载摄像头获取本车前方的车道图像,以摄像头坐标系为基准坐标系通过像素点的形式显示所述车道图像上的车道线;
根据摄像头坐标系与本车坐标系的对应关系将所述车道图像上的车道线转换到本车坐标系下,得到车道线检测结果。
优选地,所述根据所述车道线检测结果确定本车车道区域具体包括:
判断所述车道线检测结果中每条车道线的像素点数量是否满足预设的像素阈值,若一条车道线的像素点数量满足预设的像素阈值,则判定所述该条车道线有效,若一条车道线的像素点数量不满足预设的像素阈值,则判定所述该条车道线无效;
将所述车道线检测结果中有效的车道线通过最小二乘算法进行拟合;并根据有效车道线的拟合结果和预设的车道宽度对无效的车道线进行拟合;根据拟合结果确定本车左侧车道线、本车右侧车道线、本车左侧车道线的相邻车道线及本车右侧车道线的相邻车道线;
当所述车道线检测结果中不存在有效的车道线时,获取本车的历史运动轨迹信息,根据所述历史运动轨迹信息预测本车的行驶轨迹并通过所述本车的行驶轨迹确定本车左侧车道线、本车右侧车道线、本车左侧车道线的相邻车道线及本车右侧车道线的相邻车道线;
将本车左侧车道线和本车右侧车道线作为本车所在车道,并将所述本车所在车道的中心线两侧预设范围内的区域作为本车车道区域。
优选地,所述通过所述车载摄像头和车载雷达获取本车前方的摄像头车辆检测数据和雷达车辆检测数据具体包括:
根据所述摄像头车辆检测数据获取第一车辆信息,并根据摄像头坐标系与本车坐标系的对应关系将所述第一车辆信息转换到本车坐标系下,得到对应的摄像头跟踪结果;其中,所述第一车辆信息至少包括车辆位置、车辆类型、车辆航向角、车辆跟踪ID;
根据所述雷达车辆检测数据获取第二车辆信息,并根据雷达坐标系与本车坐标系的对应关系将所述第二车辆信息转换到本车坐标系下,得到对应的雷达跟踪车辆信息;根据预设的目标跟踪算法筛选所述雷达跟踪车辆信息,得到雷达跟踪结果;其中,所述第二车辆信息至少包括车辆在雷达坐标系下的坐标、车辆的长度、车辆的宽度及车辆的高度。
优选地,所述根据所述摄像头车辆检测数据和所述雷达车辆检测数据确定目标车辆具体包括:
以第一次收到雷达跟踪结果作为第一帧融合结果,通过预设的目标融合算法根据后续收到所述摄像头跟踪结果和所述雷达跟踪结果对上一帧融合结果进行预测和更新,将最后的更新结果输出为目标车辆。
优选地,还包括:
根据所述本车车道区域确定左车道区域和右车道区域,并确定目标车辆和左车道区域、右车道区域的相对位置关系;
当所述目标车辆处于左车道区域或右车道区域内时,判断所述目标车辆是否满足预设的切入条件;若所述目标车辆满足预设的切入条件,则将当前跟随目标车辆切换为满足预设的切入条件的目标车辆。
优选地,所述根据所述本车车道区域确定左车道区域和右车道区域具体包括:
将所述本车车道区域和所述本车左侧车道线的相邻车道线之间的区域作为左车道区域;
将所述本车车道区域和所述本车右侧车道线的相邻车道线之间的区域作为右车道区域。
优选地,所述判断所述目标车辆是否满足预设的切入条件具体包括:
当所述目标车辆处于左车道区域或右车道区域内,判断所述目标车辆是否满足连续多帧与预设的警戒区域相交且连续多帧向本车所在车道的中心线靠近;其中,所述预设的警戒区域为本车左侧车道线的左侧预设范围或本车右侧车道线的右侧预设范围;
当所述目标车辆满足连续多帧与预设的警戒区域相交且连续多帧向本车所在车道的中心线靠近时,判定所述目标车辆正在向本车所在车道切入,并将所述目标车辆作为相邻切入车辆;
比较所述相邻切入车辆和当前跟随目标车辆的位置,根据比较结果确定是否满足切换条件;若所述相邻切入车辆和本车的距离小于所述当前跟随目标车辆和本车的距离,则判定满足切换条件,将距离本车最近的相邻切入车辆切换为当前跟随目标车辆;所述相邻切入车辆和本车的距离不小于所述当前跟随目标车辆和本车的距离,则判定不满足切换条件,不进行切换。
另一方面,还提供一种自适应巡航的跟随目标车辆检测装置,通过所述的自适应巡航的跟随目标车辆检测方法对自适应巡航的跟随目标车辆进行检测。
另一方面,还提供一种汽车,通过所述的自适应巡航的跟随目标车辆检测装置对自适应巡航的跟随目标车辆进行检测。
综上,实施本发明的实施例,具有如下的有益效果:
本发明提供的自适应巡航的跟随目标车辆检测方法、装置及汽车,在目标车辆检测和跟踪过程中,融合了摄像头和激光雷达的目标检测信息,可以有效解决基于车载摄像头或其他单一传感器由于受环境影响而产生的目标漏检、准确性低等问题。
在检测跟随目标车辆过程中,综合考虑了车道线能准确检测和无法准确检测的情况,当能准确检测车道线时,直接使用车道线的检测结果对跟随目标车辆进行判断,而当无法获得车道线的准确检测结果时,则基于自车的历史运动轨迹信息推断出虚拟车道线,进而检测跟随目标车辆,提高了算法的适用性和稳定性。以及,在检测跟随目标车辆过程中,对相邻车辆的切入行为进行了检测和判断,提高了自适应巡航系统的跟随稳定性和行车安全性。在自动驾驶的ADAS功能开发中,能够有效且稳定的检测出跟随目标车辆,提高了自适应巡航系统目标跟随的稳定性,从而有助于自动驾驶安全性、可靠性、舒适性的提升。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,根据这些附图获得其他的附图仍属于本发明的范畴。
图1为本发明实施例中一种自适应巡航的跟随目标车辆检测方法的主流程示意图。
图2为本发明实施例中一种车道线划分的示意图。
图3为本发明实施例中车辆坐标系示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明作进一步地详细描述。
如图1所示,为本发明提供的一种自适应巡航的跟随目标车辆检测方法的一个实施例的示意图。在该实施例中,所述方法包括以下步骤:
通过车载摄像头获取本车前方的车道线检测数据,并根据所述车道线检测结果确定本车车道区域;也就是,通过本车搭载的智能摄像头获取车道线的检测结果,以摄像头坐标系为基准坐标系,并以像素点的形式给出。为了区分不同位置的车道线,如图2所示,将4条车道线分别标记为左侧、右侧、左左侧、右右侧。
具体实施例中,车道线检测数据具体过程为,通过车载摄像头获取本车前方的车道图像,以摄像头坐标系为基准坐标系通过像素点的形式显示所述车道图像上的车道线;根据摄像头坐标系与本车坐标系的对应关系将所述车道图像上的车道线转换到本车坐标系下,得到车道线检测结果。
进一步的,判断所述车道线检测结果中每条车道线的像素点数量是否满足预设的像素阈值(本实施例中设置为50,可以根据实际情况进行设定),若一条车道线的像素点数量满足预设的像素阈值,则判定所述该条车道线有效,若一条车道线的像素点数量不满足预设的像素阈值,则判定所述该条车道线无效;
将所述车道线检测结果中有效的车道线通过最小二乘算法进行拟合;也就是,基于最小二乘法分别实现每条车道线的二次多项式(y=c2x2+c1x+c0)拟合。并根据有效车道线的拟合结果和预设的车道宽度对无效的车道线进行拟合;也就是,根据有效的车道线检测结果推断出缺失的车道线的二次多项式拟合方程;根据国家标准假定每条车道的宽度lane_width为3.5米,根据有效的车道线的拟合方程推断出无效的车道线的拟合方程,比如左侧车道线是有效的,其拟合的多项式方程为y=c2_0x2+c1_0x+c0_0,右侧车道线是无效的,那么根据左侧车道线推测出的右侧车道线方程可以表示为y=c2_1x2+c1_1x+c0_1,其中,c2_1=c2_0,c1_1=c1_0,c0_1=c0_0-lane_width。根据拟合结果确定本车左侧车道线、本车右侧车道线、本车左侧车道线的相邻车道线及本车右侧车道线的相邻车道线;
当所述车道线检测结果中不存在有效的车道线时,获取本车的历史运动轨迹信息,根据所述历史运动轨迹信息预测本车的行驶轨迹并通过所述本车的行驶轨迹确定本车左侧车道线、本车右侧车道线、本车左侧车道线的相邻车道线及本车右侧车道线的相邻车道线;也就是,通过本车的历史运动轨迹信息预测自车的行驶轨迹,通过本车的行驶轨迹进一步推断出对应的4条车道线的信息(本车左侧车道线、本车右侧车道线、本车左侧车道线的相邻车道线及本车右侧车道线的相邻车道线)。具体地,首先记录距离当前时刻最近的50帧(本实施例设置为50帧,也可以根据实际情况自行确定)本车的运动状态信息(包括速度,横摆角速度,时间戳)。然后根据自车的历史运动状态信息预测自车的移动轨迹,得到本车的历史轨迹点;接着基于本车的历史轨迹点计算本车历史轨迹的二次多项式方程。最后,基于本车沿着车道中心线行驶的假设,根据本车和车道线的相对位置关系,计算得到4条车道线的二次多项式方程,具体的,假设自车轨迹:y=c2_ex2+c1_ex+c0_e,左侧车道线:y=c2_0x2+c1_0x+c0_0,右侧车道线:y=c2_1x2+c1_1x+c0_1,左左侧车道线:y=c2_2x2+c1_2x+c0_2,右右侧车道线:y=c2_3x2+c1_3x+c0_3,其中,c2_3=c2_2=c2_1=c2_0=c2_e,c1_3=c1_2=c1_1=c1_0=c1_e,c0_3=c0_e-3/2*lane_width,c0_2=c0_e+3/2*lane_width,c0_1=c0_e-1/2*lane_width,c0_0=c0_e+1/2*lane_width。
将本车左侧车道线和本车右侧车道线作为本车所在车道,并将所述本车所在车道的中心线两侧预设范围内的区域作为本车车道区域。也就是,计算本车所在车道的中心线的二次曲线方程:y=c2_ex2+c1_ex+c0_e,其中,曲线方程的参数由左侧车道线和右侧车道线的参数取均值得到,即c2_e=(c2_0+c2_1)/2,c1_e=(c1_0+c1_1)/2,c0_e=(c0_0+c0_1)/2。将本车所在车道中心线左右一定范围内的区域作为本车车道区域。例如,假定本车的宽度为ego_width(这里设置为2米,可根据实际情况确定),那么本车车道区域即为曲线1:y=c2_ex2+c1_ex+c0_e-ego_width/2和曲线2:y=c2_ex2+c1_ex+c0_e+ego_width/2之间的区域。
分别通过车载摄像头和车载雷达(本实施例中采用的雷达至少包含激光雷达)获取本车前方的摄像头车辆检测数据和雷达车辆检测数据,并根据所述摄像头车辆检测数据和所述雷达车辆检测数据确定目标车辆;也就是,由于摄像头在识别出目标的形态和类型方面具有明显优势,而在检测位置和速度方面存在不足;而雷达虽然无法准确识别出目标的类型,但是却可以准确的检测出目标的位置和速度。因此,将摄像头和雷达的检测数据进行融合,可以实现对目标位置、速度、形态和类型的准确判断,提升目标检测的准确性和稳定性。
具体实施例中,如图3所示,在通过摄像头获取摄像头车辆检测数据时,根据所述摄像头车辆检测数据获取第一车辆信息,并根据摄像头坐标系与本车坐标系的对应关系将所述第一车辆信息转换到本车坐标系下,得到对应的摄像头跟踪结果;其中,所述第一车辆信息至少包括车辆位置、车辆类型、车辆航向角、车辆跟踪ID。可以理解的是,摄像头采集的目标车辆信息(目标位置、目标类型、目标航向角、目标跟踪ID等)由于是基于摄像头坐标系,因此需要根据摄像头标定矩阵将检测到的目标从摄像头坐标系转换到本车坐标系。
进一步的,如图3所示,在通过雷达获取雷达车辆检测数据时,根据所述雷达车辆检测数据获取第二车辆信息,并根据雷达坐标系与本车坐标系的对应关系将所述第二车辆信息转换到本车坐标系下,得到对应的雷达跟踪车辆信息;根据预设的目标跟踪算法筛选所述雷达跟踪车辆信息,得到雷达跟踪结果;其中,所述第二车辆信息至少包括车辆在雷达坐标系下的坐标、车辆的长度、车辆的宽度及车辆的高度。可以通过本车搭载的雷达采集点云信息,基于PointPillars深度学习网络得到车辆的检测结果,结果包括但不限于:车辆在雷达坐标系下的坐标,车辆的长度、宽度和高度。具体过程,首先,将车辆检测信息的各个属性由雷达坐标系转换到本车坐标系下;然后,提取感兴趣区域,去除感兴趣区域之外的所有检测目标车辆,其中,感兴趣区域的范围(xmax,xmin,ymax,ymin,zmax,zmin)设置为(100,-50,51,-51,3.8,-0.2);最后,基于匈牙利匹配算法和卡尔曼滤波算法对检测到的目标车辆进行跟踪,得到车辆的跟踪ID,车辆航向角、位置、速度等信息,需要说明的是也可以使用其他目标检测网络、目标跟踪算法,不仅限于本实施例中指定的算法或深度学习网络。
再进一步的,得到摄像头车辆检测数据和雷达车辆检测数据后,可以通过这两个检测数据的结合得到一个融合的结果,这个融合的结果就是目标车辆。具体地,以第一次收到雷达跟踪结果作为第一帧融合结果,通过预设的目标融合算法根据后续收到所述摄像头跟踪结果和所述雷达跟踪结果对上一帧融合结果进行预测和更新,将最后的更新结果输出为目标车辆。也就是,当第一次收到雷达的跟踪结果时,以雷达的结果建立一个融合序列作为第一帧融合结果,后续收到摄像头和雷达的跟踪结果时,则分别对上一帧融合结果进行预测和更新。具体的融合策略为,分别使用基于跟踪ID的匹配算法和基于匈牙利匹配算法实现传感器跟踪结果和上一帧融合结果的目标匹配,然后基于卡尔曼滤波算法对上一帧融合结果进行预测,并用传入的传感器跟踪结果对预测结果进行更新,需要说明的是也可以使用其他目标融合算法进行融合处理,可以根据具体实际需求进行替换。
判断所述目标车辆和所述本车车道区域的相对位置;若所述目标车辆处于所述本车车道区域内,则选择距本车距离最小的目标车辆作为当前跟随目标车辆。也就是,目标车辆和所述本车车道区域的相对位置存在两种情况,第一种是处于本车车道内;第二种则是处于本车车道两侧相邻的车道内,若第二种情况(两侧相邻的车道内)中,若目标车辆是直行不存在变道,即不切入本车车道,则无需进行跟踪;但是当目标车辆可能变道,即切入本车车道内,则需要作为当前跟随目标车辆对待,还需要说明的是,若切入的目标车辆在第一种情况(原有的当前跟随目标车辆)之前位置进入本车车道,则也不需要将其作为最新的当前跟随目标车辆,但是若切入的目标车辆在第一种情况(原有的当前跟随目标车辆)之后位置进入本车车道,则需要将其作为最新的当前跟随目标车辆(替换掉原有的当前跟随目标车辆),简单的说就是在本车车道内确定一个最接近于本车的目标车辆(不管是切入的目标车辆还是原就在本车车道行驶的目标车辆)作为当前跟随目标车辆。
具体实施例中,对于上述第二种情况具体过程为,根据所述本车车道区域确定左车道区域和右车道区域,并确定目标车辆和左车道区域、右车道区域的相对位置关系;当所述目标车辆处于左车道区域或右车道区域内时,判断所述目标车辆是否满足预设的切入条件;若所述目标车辆满足预设的切入条件,则将当前跟随目标车辆切换为满足预设的切入条件的目标车辆。
具体地,当所述目标车辆处于左车道区域或右车道区域内,判断所述目标车辆是否满足连续多帧与预设的警戒区域相交且连续多帧向本车所在车道的中心线靠近;其中,所述预设的警戒区域为本车左侧车道线的左侧预设范围或本车右侧车道线的右侧预设范围;
当所述目标车辆满足连续多帧与预设的警戒区域相交且连续多帧向本车所在车道的中心线靠近时,判定所述目标车辆正在向本车所在车道切入,并将所述目标车辆作为相邻切入车辆;也就是,当位于左、右车道区域内的目标车辆同时满足连续多帧与警戒区域(警戒区域为左侧和右侧车道线左右各lane_width/3范围内)相交且连续多帧向自车所在车道中心靠近的条件时,判断该目标车辆正在向自车所在车道切入,将所述目标车辆作为相邻切入车辆。
比较所述相邻切入车辆和当前跟随目标车辆的位置,根据比较结果确定是否满足切换条件;若所述相邻切入车辆和本车的距离小于所述当前跟随目标车辆和本车的距离,则判定满足切换条件,将距离本车最近的相邻切入车辆切换为当前跟随目标车辆;所述相邻切入车辆和本车的距离不小于所述当前跟随目标车辆和本车的距离,则判定不满足切换条件,不进行切换。
本实施例中,将所述本车车道区域和所述本车左侧车道线的相邻车道线之间的区域作为左车道区域;将所述本车车道区域和所述本车右侧车道线的相邻车道线之间的区域作为右车道区域。将上述确定本车车道区域中所述曲线1和左左侧车道线(本车左侧车道线的相邻车道线):y=c2_2x2+c1_2x+c0_2之间的区域作为左车道区域,将上述确定本车车道区域中所述曲线2和右右侧车道线(所述本车右侧车道线的相邻车道线):y=c2_3x2+c1_3x+c0_3之间的区域作为右车道区域。根据目标车辆和上述两个区域的相对位置关系,判断目标车辆是否位于左或右车道区域内。本发明还提供的一种自适应巡航的跟随目标车辆检测装置,通过所述的自适应巡航的跟随目标车辆检测方法对自适应巡航的跟随目标车辆进行检测。
本发明还提供的一种汽车,通过所述的自适应巡航的跟随目标车辆检测装置对自适应巡航的跟随目标车辆进行检测。
关于所述自适应巡航的跟随目标车辆检测装置以及汽车的实现过程可参考上述的自适应巡航的跟随目标车辆检测方法的具体过程,在此不再赘述。
综上,实施本发明的实施例,具有如下的有益效果:
本发明提供的自适应巡航的跟随目标车辆检测方法、装置及汽车,在目标车辆检测和跟踪过程中,融合了摄像头和激光雷达的目标检测信息,可以有效解决基于车载摄像头或其他单一传感器由于受环境影响而产生的目标漏检、准确性低等问题。
在检测跟随目标车辆过程中,综合考虑了车道线能准确检测和无法准确检测的情况,当能准确检测车道线时,直接使用车道线的检测结果对跟随目标车辆进行判断,而当无法获得车道线的准确检测结果时,则基于自车的历史运动轨迹信息推断出虚拟车道线,进而检测跟随目标车辆,提高了算法的适用性和稳定性。以及,在检测跟随目标车辆过程中,对相邻车辆的切入行为进行了检测和判断,提高了自适应巡航系统的跟随稳定性和行车安全性。在自动驾驶的ADAS功能开发中,能够有效且稳定的检测出跟随目标车辆,提高了自适应巡航系统目标跟随的稳定性,从而有助于自动驾驶安全性、可靠性、舒适性的提升。
以上所揭露的仅为本发明较佳实施例而已,当然不能以此来限定本发明之权利范围,因此依本发明权利要求所作的等同变化,仍属本发明所涵盖的范围。
Claims (10)
1.一种自适应巡航的跟随目标车辆检测方法,其特征在于,包括:
通过车载摄像头获取本车前方的车道线检测数据,并根据所述车道线检测结果确定本车车道区域;
分别通过车载摄像头和车载雷达获取本车前方的摄像头车辆检测数据和雷达车辆检测数据,并根据所述摄像头车辆检测数据和所述雷达车辆检测数据确定目标车辆;
判断所述目标车辆和所述本车车道区域的相对位置;若所述目标车辆处于所述本车车道区域内,则选择距本车距离最小的目标车辆作为当前跟随目标车辆。
2.如权利要求1所述的方法,其特征在于,所述通过车载摄像头获取本车前方的车道线检测数据具体包括:
通过车载摄像头获取本车前方的车道图像,以摄像头坐标系为基准坐标系通过像素点的形式显示所述车道图像上的车道线;
根据摄像头坐标系与本车坐标系的对应关系将所述车道图像上的车道线转换到本车坐标系下,得到车道线检测结果。
3.如权利要求2所述的方法,其特征在于,所述根据所述车道线检测结果确定本车车道区域具体包括:
判断所述车道线检测结果中每条车道线的像素点数量是否满足预设的像素阈值,若一条车道线的像素点数量满足预设的像素阈值,则判定所述该条车道线有效,若一条车道线的像素点数量不满足预设的像素阈值,则判定所述该条车道线无效;
将所述车道线检测结果中有效的车道线通过最小二乘算法进行拟合;并根据有效车道线的拟合结果和预设的车道宽度对无效的车道线进行拟合;根据拟合结果确定本车左侧车道线、本车右侧车道线、本车左侧车道线的相邻车道线及本车右侧车道线的相邻车道线;
当所述车道线检测结果中不存在有效的车道线时,获取本车的历史运动轨迹信息,根据所述历史运动轨迹信息预测本车的行驶轨迹并通过所述本车的行驶轨迹确定本车左侧车道线、本车右侧车道线、本车左侧车道线的相邻车道线及本车右侧车道线的相邻车道线;
将本车左侧车道线和本车右侧车道线作为本车所在车道,并将所述本车所在车道的中心线两侧预设范围内的区域作为本车车道区域。
4.如权利要求3所述的方法,其特征在于,所述通过所述车载摄像头和车载雷达获取本车前方的摄像头车辆检测数据和雷达车辆检测数据具体包括:
根据所述摄像头车辆检测数据获取第一车辆信息,并根据摄像头坐标系与本车坐标系的对应关系将所述第一车辆信息转换到本车坐标系下,得到对应的摄像头跟踪结果;其中,所述第一车辆信息至少包括车辆位置、车辆类型、车辆航向角、车辆跟踪ID;
根据所述雷达车辆检测数据获取第二车辆信息,并根据雷达坐标系与本车坐标系的对应关系将所述第二车辆信息转换到本车坐标系下,得到对应的雷达跟踪车辆信息;根据预设的目标跟踪算法筛选所述雷达跟踪车辆信息,得到雷达跟踪结果;其中,所述第二车辆信息至少包括车辆在雷达坐标系下的坐标、车辆的长度、车辆的宽度及车辆的高度。
5.如权利要求4所述的方法,其特征在于,所述根据所述摄像头车辆检测数据和所述雷达车辆检测数据确定目标车辆具体包括:
以第一次收到雷达跟踪结果作为第一帧融合结果,通过预设的目标融合算法根据后续收到所述摄像头跟踪结果和所述雷达跟踪结果对上一帧融合结果进行预测和更新,将最后的更新结果输出为目标车辆。
6.如权利要求5所述的方法,其特征在于,还包括:
根据所述本车车道区域确定左车道区域和右车道区域,并确定目标车辆和左车道区域、右车道区域的相对位置关系;
当所述目标车辆处于左车道区域或右车道区域内时,判断所述目标车辆是否满足预设的切入条件;若所述目标车辆满足预设的切入条件,则将当前跟随目标车辆切换为满足预设的切入条件的目标车辆。
7.如权利要求6所述的方法,其特征在于,所述根据所述本车车道区域确定左车道区域和右车道区域具体包括:
将所述本车车道区域和所述本车左侧车道线的相邻车道线之间的区域作为左车道区域;
将所述本车车道区域和所述本车右侧车道线的相邻车道线之间的区域作为右车道区域。
8.如权利要求7所述的方法,其特征在于,所述判断所述目标车辆是否满足预设的切入条件具体包括:
判断所述目标车辆是否满足连续多帧与预设的警戒区域相交且连续多帧向本车所在车道的中心线靠近;其中,所述预设的警戒区域为本车左侧车道线的左侧预设范围或本车右侧车道线的右侧预设范围;
当所述目标车辆满足连续多帧与预设的警戒区域相交且连续多帧向本车所在车道的中心线靠近时,判定所述目标车辆正在向本车所在车道切入,并将所述目标车辆作为相邻切入车辆;
比较所述相邻切入车辆和当前跟随目标车辆的位置,根据比较结果确定是否满足切换条件;若所述相邻切入车辆和本车的距离小于所述当前跟随目标车辆和本车的距离,则判定满足切换条件,将距离本车最近的相邻切入车辆切换为当前跟随目标车辆;所述相邻切入车辆和本车的距离不小于所述当前跟随目标车辆和本车的距离,则判定不满足切换条件,不进行切换。
9.一种自适应巡航的跟随目标车辆检测装置,其特征在于,通过如权利要求1-9任一项所述的自适应巡航的跟随目标车辆检测方法对自适应巡航的跟随目标车辆进行检测。
10.一种汽车,其特征在于,通过如权利要求9所述的自适应巡航的跟随目标车辆检测装置对自适应巡航的跟随目标车辆进行检测。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111317330.XA CN115223131A (zh) | 2021-11-09 | 2021-11-09 | 一种自适应巡航的跟随目标车辆检测方法、装置及汽车 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111317330.XA CN115223131A (zh) | 2021-11-09 | 2021-11-09 | 一种自适应巡航的跟随目标车辆检测方法、装置及汽车 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115223131A true CN115223131A (zh) | 2022-10-21 |
Family
ID=83606899
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111317330.XA Pending CN115223131A (zh) | 2021-11-09 | 2021-11-09 | 一种自适应巡航的跟随目标车辆检测方法、装置及汽车 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115223131A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115661797A (zh) * | 2022-12-06 | 2023-01-31 | 清华大学 | 目标跟踪方法、装置及设备 |
CN116682095A (zh) * | 2023-08-02 | 2023-09-01 | 天津所托瑞安汽车科技有限公司 | 一种关注目标的确定方法、装置、设备及存储介质 |
Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20140077536A (ko) * | 2012-12-14 | 2014-06-24 | 현대모비스 주식회사 | 차선폭 보정 장치 및 방법과 이를 이용한 차량 스마트 크루즈 컨트롤 시스템 |
CN106056100A (zh) * | 2016-06-28 | 2016-10-26 | 重庆邮电大学 | 一种基于车道检测与目标跟踪的车辆辅助定位方法 |
CN107161146A (zh) * | 2017-04-05 | 2017-09-15 | 吉利汽车研究院(宁波)有限公司 | 一种高速公路辅助系统 |
CN109649390A (zh) * | 2018-12-19 | 2019-04-19 | 清华大学苏州汽车研究院(吴江) | 一种自动驾驶汽车自主跟车系统及方法 |
CN110015297A (zh) * | 2019-04-02 | 2019-07-16 | 北京海纳川汽车部件股份有限公司 | 自适应巡航控制方法、装置及自动驾驶车辆 |
CN110458050A (zh) * | 2019-07-25 | 2019-11-15 | 清华大学苏州汽车研究院(吴江) | 基于车载视频的车辆切入检测方法及装置 |
CN110562253A (zh) * | 2018-06-05 | 2019-12-13 | 广州汽车集团股份有限公司 | 一种汽车自适应巡航弯道跟随控制装置及控制方法 |
CN111324120A (zh) * | 2020-02-26 | 2020-06-23 | 中汽研汽车检验中心(天津)有限公司 | 一种自动驾驶前车切入切出场景提取方法 |
WO2020164010A1 (zh) * | 2019-02-13 | 2020-08-20 | 深圳市大疆创新科技有限公司 | 车道线检测方法、装置、系统与车辆、存储介质 |
CN111717189A (zh) * | 2019-03-18 | 2020-09-29 | 长城汽车股份有限公司 | 车道保持控制方法、装置及系统 |
CN111959515A (zh) * | 2020-08-19 | 2020-11-20 | 无锡威孚高科技集团股份有限公司 | 一种基于视觉检测的前向目标选择方法、装置及系统 |
CN112498367A (zh) * | 2020-11-25 | 2021-03-16 | 重庆长安汽车股份有限公司 | 一种行驶轨迹规划方法、装置、汽车、控制器及计算机可读存储介质 |
CN112776886A (zh) * | 2021-01-29 | 2021-05-11 | 清华大学 | 智能电动车辆视觉车道居中辅助系统失效安全控制方法 |
WO2021102957A1 (zh) * | 2019-11-29 | 2021-06-03 | 驭势(上海)汽车科技有限公司 | 一种车道保持方法、车载设备和存储介质 |
CN112949398A (zh) * | 2021-01-29 | 2021-06-11 | 成都安智杰科技有限公司 | 车道线检测方法、测距方法及对应装置 |
CN113335272A (zh) * | 2021-05-14 | 2021-09-03 | 江铃汽车股份有限公司 | 辅助驾驶方法 |
CN113487874A (zh) * | 2021-05-27 | 2021-10-08 | 中汽研(天津)汽车工程研究院有限公司 | 一种跟驰行为场景数据采集、识别、分类提取系统及方法 |
-
2021
- 2021-11-09 CN CN202111317330.XA patent/CN115223131A/zh active Pending
Patent Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20140077536A (ko) * | 2012-12-14 | 2014-06-24 | 현대모비스 주식회사 | 차선폭 보정 장치 및 방법과 이를 이용한 차량 스마트 크루즈 컨트롤 시스템 |
CN106056100A (zh) * | 2016-06-28 | 2016-10-26 | 重庆邮电大学 | 一种基于车道检测与目标跟踪的车辆辅助定位方法 |
CN107161146A (zh) * | 2017-04-05 | 2017-09-15 | 吉利汽车研究院(宁波)有限公司 | 一种高速公路辅助系统 |
CN110562253A (zh) * | 2018-06-05 | 2019-12-13 | 广州汽车集团股份有限公司 | 一种汽车自适应巡航弯道跟随控制装置及控制方法 |
CN109649390A (zh) * | 2018-12-19 | 2019-04-19 | 清华大学苏州汽车研究院(吴江) | 一种自动驾驶汽车自主跟车系统及方法 |
WO2020164010A1 (zh) * | 2019-02-13 | 2020-08-20 | 深圳市大疆创新科技有限公司 | 车道线检测方法、装置、系统与车辆、存储介质 |
CN111717189A (zh) * | 2019-03-18 | 2020-09-29 | 长城汽车股份有限公司 | 车道保持控制方法、装置及系统 |
CN110015297A (zh) * | 2019-04-02 | 2019-07-16 | 北京海纳川汽车部件股份有限公司 | 自适应巡航控制方法、装置及自动驾驶车辆 |
CN110458050A (zh) * | 2019-07-25 | 2019-11-15 | 清华大学苏州汽车研究院(吴江) | 基于车载视频的车辆切入检测方法及装置 |
WO2021102957A1 (zh) * | 2019-11-29 | 2021-06-03 | 驭势(上海)汽车科技有限公司 | 一种车道保持方法、车载设备和存储介质 |
CN111324120A (zh) * | 2020-02-26 | 2020-06-23 | 中汽研汽车检验中心(天津)有限公司 | 一种自动驾驶前车切入切出场景提取方法 |
CN111959515A (zh) * | 2020-08-19 | 2020-11-20 | 无锡威孚高科技集团股份有限公司 | 一种基于视觉检测的前向目标选择方法、装置及系统 |
CN112498367A (zh) * | 2020-11-25 | 2021-03-16 | 重庆长安汽车股份有限公司 | 一种行驶轨迹规划方法、装置、汽车、控制器及计算机可读存储介质 |
CN112776886A (zh) * | 2021-01-29 | 2021-05-11 | 清华大学 | 智能电动车辆视觉车道居中辅助系统失效安全控制方法 |
CN112949398A (zh) * | 2021-01-29 | 2021-06-11 | 成都安智杰科技有限公司 | 车道线检测方法、测距方法及对应装置 |
CN113335272A (zh) * | 2021-05-14 | 2021-09-03 | 江铃汽车股份有限公司 | 辅助驾驶方法 |
CN113487874A (zh) * | 2021-05-27 | 2021-10-08 | 中汽研(天津)汽车工程研究院有限公司 | 一种跟驰行为场景数据采集、识别、分类提取系统及方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115661797A (zh) * | 2022-12-06 | 2023-01-31 | 清华大学 | 目标跟踪方法、装置及设备 |
CN116682095A (zh) * | 2023-08-02 | 2023-09-01 | 天津所托瑞安汽车科技有限公司 | 一种关注目标的确定方法、装置、设备及存储介质 |
CN116682095B (zh) * | 2023-08-02 | 2023-11-07 | 天津所托瑞安汽车科技有限公司 | 一种关注目标的确定方法、装置、设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11703876B2 (en) | Autonomous driving system | |
EP3644294B1 (en) | Vehicle information storage method, vehicle travel control method, and vehicle information storage device | |
JP7140922B2 (ja) | マルチセンサデータ融合方法、及び装置 | |
EP3647728B1 (en) | Map information system | |
CN107451521B (zh) | 车辆车道图估算 | |
JP6714513B2 (ja) | 車両のナビゲーションモジュールに対象物の存在を知らせる車載装置 | |
US9127956B2 (en) | Technique for lane assignment in a vehicle | |
JP5938569B2 (ja) | 方位情報を考慮する高度運転者支援システム、及びその動作方法 | |
CN109841088B (zh) | 车辆驾驶辅助系统及方法 | |
EP3715204A1 (en) | Vehicle control device | |
WO2021056499A1 (zh) | 数据处理方法、设备和可移动平台 | |
EP4089659A1 (en) | Map updating method, apparatus and device | |
CN110214106B (zh) | 可操作用于确定车道的一部分的位置的装置 | |
JP2001109998A (ja) | 車両走行支援装置 | |
CN115223131A (zh) | 一种自适应巡航的跟随目标车辆检测方法、装置及汽车 | |
CN113085852A (zh) | 自动驾驶车辆的行为预警方法、装置及云端设备 | |
KR20190045308A (ko) | 차량 판정 방법, 주행 경로 보정 방법, 차량 판정 장치, 및 주행 경로 보정 장치 | |
WO2023072135A1 (zh) | 车辆安全行驶的评估方法、装置、车辆及存储介质 | |
CN113432615B (zh) | 基于多传感器融合可驾驶区域的检测方法、系统和车辆 | |
JP6609292B2 (ja) | 車外環境認識装置 | |
KR20200092462A (ko) | 주행상황 정보융합 기반 주행경로 가변화 방법 및 시스템 | |
CN110606081B (zh) | 移动体辅助系统和移动体辅助方法 | |
JP7167732B2 (ja) | 地図情報システム | |
JP7147448B2 (ja) | 地図情報システム | |
US11640173B2 (en) | Control apparatus, control method, and computer-readable storage medium storing program |
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 |