CN110940981B - 一种用于判断车辆前方目标的位置是否处于本车道内的方法 - Google Patents
一种用于判断车辆前方目标的位置是否处于本车道内的方法 Download PDFInfo
- Publication number
- CN110940981B CN110940981B CN201911198581.3A CN201911198581A CN110940981B CN 110940981 B CN110940981 B CN 110940981B CN 201911198581 A CN201911198581 A CN 201911198581A CN 110940981 B CN110940981 B CN 110940981B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- target
- running state
- speed
- coordinate system
- 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
- 238000000034 method Methods 0.000 title claims abstract description 66
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000001514 detection method Methods 0.000 description 9
- 238000005516 engineering process Methods 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 2
- 230000004927 fusion Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/89—Radar or analogous systems specially adapted for specific applications for mapping or imaging
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种用于判断车辆前方目标的位置是否处于本车道内的方法,当车辆的行驶状态为弯道低速行驶状态时,将车辆的弯道低速行驶轨迹视为圆周运动,以本车位置为原点O建立平面直角坐标系XOY,本车行驶轨迹所在虚拟圆的圆心坐标为(r,0),首先根据公式r=v/ω计算本车行驶轨迹的转弯半径r,其中,v表示本车的车速,ω表示本车的横摆角速度,然后根据公式来计算目标行驶轨迹的转弯半径r1,再根据公式w=(0.015*r*arcsin(x/γ1)+0.85)*2来计算目标所在位置的虚拟车道线的宽度w,其中,将本车行驶轨迹设定为虚拟车道线的中心线,如果目标与虚拟车道线的中心线之间的距离小于虚拟车道线宽度的一半,则判定所述目标处于本车道内,否则的话,则判定所述目标不在本车道内。
Description
技术领域
本发明涉及车辆安全驾驶领域,尤其涉及车辆前向碰撞预警领域。具体地说,本发明涉及一种车辆前方目标识别方法,所述车辆前方目标识别方法包括一种用于判断车辆前方目标的位置是否处于本车道内的方法。对本领域技术人员而言,显而易见的是,本发明亦可应用于其它领域。
背景技术
随着汽车保有量的日益增长和道路运输业的飞速发展,汽车在方便人们生活和繁荣经济的同时,也给道路安全带来了日益严峻的挑战。车辆前向碰撞预警设备作为车载监控系统的一部分广泛应用于车辆安全驾驶领域,它通过将感知、通信和控制等相关技术结合在一起,能够辅助驾驶员安全地驾驶汽车。
目前,市场上常见的车辆前向碰撞预警设备对于车辆前方目标的识别主要通过以下方式来实现:首先,通过前向视觉传感器来采集车辆前方图像,然后,使用图像处理技术检测出所述车辆前方图像中的目标车辆,再根据所述车辆前方图像中的信息估计出本车与前方车辆之间的距离以及前方车辆的行驶方向,或者进一步加装雷达来提高测距精度,从而对可能发生碰撞的目标进行识别和跟踪。但是,该现有技术不能准确估计本车在弯道行驶过程中的轨迹和前方目标车辆的轨迹,并且在本车转弯过程中也很难对本车道的前方目标车辆进行有效识别和跟踪,从而导致这种常见的车辆前向碰撞预警设备在车辆弯道行驶中非常容易产生误报警,严重影响所述车辆前向碰撞预警设备的准确性,进而影响车辆在弯道行驶中的安全性。
中国专利CN104101878B公开了一种车辆前方目标识别方法,其具体公开了使用雷达选择目标的方法,该方法由于考虑了处于弯道中的目标并且对处于弯道中目标的横向位置进行了修正,因而相对提高了雷达识别目标的准确性。然而,该方法仅仅单独使用雷达目标挑选模块而没有结合视觉采集模块,不利于候选目标识别的完整性和准确性,同时该方法没有对车辆行驶状态进行更加精细的划分和识别,也没有区分如何在不同行驶状态下识别目标,因此,由该方法识别出目标的准确性也有待进一步提高。
在此背景之下,本领域技术人员需要一种能够满足不同行驶状态、能够快速、精准和低成本地识别前方目标的车辆前方目标识别方法,所述车辆前方目标识别方法包括一种根据本发明的用于判断车辆前方目标的位置是否处于本车道内的方法。
发明内容
针对现有技术中的上述缺点,本发明提供一种车辆前方目标识别方法。所述车辆前方目标识别方法能够利用多传感器信息,结合车速、横摆角速度、目标位置信息和运动状态等信息,估算出本车行驶轨迹和车道线位置,并且识别出各种行驶状态,例如至少区分出高速状态、低速状态以及弯道状态,以便根据不同的行驶状态,采取不同的目标选择策略,从而快速、精准和低成本地识别出本车道目标。
本发明的大致思路是,构建一种车辆前方目标识别方法,它能够将视觉采集模块和雷达模块的优势结合在一起,将视觉传感器和雷达这两种技术手段所获取的信息进行融合,提供一种更全面、更准确的目标识别方式,同时区分出不同的行驶状态,以便根据不同的行驶状态采用不同的目标识别策略,从而进一步提高目标识别的准确性,尤其是主目标识别的准确性。所述车辆前方目标识别方法包括一种根据本发明的用于判断车辆前方目标的位置是否处于本车道内的方法。在根据本发明的一种实施方式中,所述车辆的行驶状态包括正常行驶状态、普通低速行驶状态和弯道低速行驶状态,当所述车辆的行驶状态为弯道低速行驶状态时,将车辆的弯道低速行驶轨迹视为圆周运动,所述用于判断车辆前方目标的位置是否处于本车道内的方法是:以本车位置为原点O建立平面直角坐标系XOY,所述平面直角坐标系XOY为SAE坐标系中的XOY平面,所述平面直角坐标系XOY的X轴正方向为本车行驶轨迹的切线方向,其中切点为原点O,所述平面直角坐标系XOY的Y轴正方向为车体平面内垂直于X轴的右侧方向,所述本车行驶轨迹所在虚拟圆的圆心坐标为(r,0),目标坐标为(y,x),目标行驶轨迹所在虚拟圆的圆心坐标亦为(r,0),其中,所述本车行驶轨迹所在虚拟圆和所述目标行驶轨迹所在虚拟圆为圆心坐标同为(r,0)的同心圆,在以本车位置和本车行驶轨迹建立平面直角坐标系XOY并且标记所述目标的坐标位置之后,首先根据公式计算所述本车行驶轨迹的转弯半径r,其中,v表示本车的车速,ω表示本车的横摆角速度,然后根据公式/>来计算所述目标行驶轨迹的转弯半径r1,再根据公式w=(0.015*r*arcsin(x/γ1)+0.85)*2来计算目标所在位置的虚拟车道线的宽度w,其中,将本车行驶轨迹设定为所述虚拟车道线的中心线,如果目标与所述虚拟车道线的中心线之间的距离小于所述虚拟车道线宽度的一半,则判定所述目标处于本车道内,否则的话,则判定所述目标不在本车道内。
在根据本发明的另一种实施方式中,当所述车辆的行驶状态为正常行驶状态或者普通低速行驶状态时,所述用于判断车辆前方目标的位置是否处于本车道内的方法是:以本车位置为原点O建立平面直角坐标系XOY,所述平面直角坐标系XOY为SAE坐标系中的XOY平面,所述平面直角坐标系XOY的X轴正方向为本车行驶轨迹的前进方向,所述平面直角坐标系XOY的Y轴正方向为车体平面内垂直于X轴的右侧方向,其中,目标的坐标标记为(y,x),根据公式w=(0.015*x+0.85)*2计算出目标所在位置的虚拟车道线的宽度w,其中,将本车行驶轨迹设定为所述虚拟车道线的中心线,如果目标与所述虚拟车道线的中心线之间的距离小于所述虚拟车道线宽度的一半,则判定所述目标处于本车道内,否则的话,则判定所述目标不在本车道内。
根据本发明的一种实施方式,所述本车的行驶状态的判定条件为:如果本车的车速大于预设的速度阈值,则判定本车的行驶状态为正常行驶状态;如果本车的车速大于等于0而小于等于所述预设的速度阈值,则进一步判断本车的横摆角速度是否大于预设的横摆角速度阈值,并且同时判断本车前方目标在SAE定义的车体坐标系中的坐标在Y方向上的绝对值是否大于上一帧图像中所述目标的坐标在Y方向上的绝对值,如果本车的横摆角速度大于所述预设的横摆角速度阈值并且同时本车前方目标在SAE坐标系中的坐标在Y方向上的绝对值也大于上一帧图像中所述目标的坐标在Y方向上的绝对值,则判定本车的行驶状态为弯道低速行驶状态;否则的话,判定本车的行驶状态为普通低速行驶状态。
根据本发明的一种实施方式,所述本车的车速通过轮速传感器来获取。所述本车的横摆角速度例如通过陀螺仪和加速度传感器来获取。根据本发明的一种实施方式,所述预设的速度阈值例如可以是35km/h、40km/h、45km/h或50km/h。所述预设的横摆角速度阈值例如可以是0.07rad/s、0.08rad/s或0.09rad/s。
根据本发明的车辆前方目标识别方法和用于判断车辆前方目标的位置是否处于本车道内的方法的多种具体实施方式中将在下文中进行详细描述。
与现有技术相比,根据本发明的车辆前方目标识别方法以及相应的系统至少具有以下优点:
(1)根据本发明的车辆前方目标识别方法以及相应的系统能够将视觉采集模块和雷达模块结合起来,从而提高了所识别的前方目标的全面性与准确性。
(2)根据本发明的车辆前方目标识别方法以及相应的系统能够区分不同的行驶状态,并且根据不同的行驶状态制定不同的目标识别策略,从而进一步提高了目标识别的准确性,尤其是主目标识别的准确性。因此,根据本发明的车辆前方目标识别方法以及相应的系统能够辅助驾驶员及时采取避碰措施,有效提高了驾驶车辆的安全性,减少了交通事故发生的概率。
附图说明
下面参考附图通过举例的方式(但并不限于此)阐述本发明,其中:
图1示例性示出一种根据本发明的车辆前方目标识别方法的流程图。
图2示例性示出一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为正常行驶状态或者普通低速行驶状态时本车与前方目标的坐标图。
图3示例性示出一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为弯道低速行驶状态时本车与前方目标的坐标图。
图4示例性示出一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为正常行驶状态时从所述目标列表中选定主目标的流程图。
图5示例性示出另一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为正常行驶状态时从所述目标列表中选定主目标的流程图。
图6示例性示出一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为普通低速行驶状态时的主目标选择策略的流程图。
图7示例性示出一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为弯道低速行驶状态时的主目标选择策略的流程图。
具体实施方式
现在参考附图中所示的实施例来详细描述本发明的实施方式。在下面的说明书中,许多具体细节都是用来提供对具体实施方式的完全理解。但是,对本领域技术人员来说,显而易见的是,所述实施方式能够以不带有一些或全部具体细节的方式实施。在其他实施例中,公知的步骤和/或结构并未进行详细阐述,以免不必要地造成具体实施方式难于理解。本领域技术人员能理解的是,本次讨论仅仅是对示例性实施方式的描述,其用意并不在于限制本发明在示例性步骤和/或结构中具体实施的较宽范围。
图1示例性示出一种根据本发明的车辆前方目标识别方法的流程图。图1中所示的车辆前方目标识别方法能够提高车辆前方目标识别的精准度,并且在保证精准度的前提下降低车辆前方目标识别的成本。
如图1所示,在根据本发明的一种实施方式中,所述车辆前方目标识别方法100包括以下步骤:
(1)采集车辆前方的目标信息和本车的车辆信息,如图1中步骤101所示。在根据本发明的一种实施例中,所述车辆前方的目标信息可以通过图像传感器或者视觉传感器来获取,例如通过图像传感器或者视觉传感器来获取车辆前方的图像或者视频,所述图像或者视频包含了目标信息。在根据本发明的另一种实施例中,所述车辆前方的目标信息也可以通过雷达(例如毫米波雷达)来获取,雷达能够利用无线电的方法发现目标并且测定它们的空间位置。在根据本发明的又一种实施例中,所述车辆前方的目标信息可以通过图像传感器和/或雷达来获取。也就是说,所述车辆前方的目标信息可以通过图像传感器和雷达相结合的方式(即通过两种传感器技术相结合的方式)来获取,然后再利用传感器融合技术来提取所述目标信息。在这里,所述目标信息至少包括目标的位置信息、目标的运动状态、目标出现在有效视界内的持续时间。在根据本发明的一种实施例中,本车的车辆信息至少包括本车的车速和横摆角速度。本车的车速可以通过轮速传感器来获取。本车的横摆角速度可以通过陀螺仪和加速度传感器来获取。
(2)根据所述目标信息生成目标列表,如图1中步骤102所示。在图像传感器或者视觉传感器获得的车辆前方图像或者视频中,可能存在多个车辆前方目标,同时,针对每个目标,可能需要探测和监控所述每个目标的多个信息项或者信息条目。根据本发明的一种实施例,为了方便所述目标信息的分类、显示、提取、计算和分析,可以根据所述目标信息生成目标列表。在根据本发明的一种实施例中,根据所述目标信息生成目标列表可以通过传感器融合技术来实现。
(3)根据本车的车辆信息判断本车的行驶状态,如图1中步骤103所示。在根据本发明的一种实施例中,本车的行驶状态包括正常行驶状态、普通低速行驶状态和弯道低速行驶状态。例如,在对车辆行驶状态进行精细划分和识别时,车辆行驶状态的区分标准是:如果本车的车速大于预设的速度阈值,例如本车的车速>35km/h(千米每小时),则判定本车的行驶状态为正常行驶状态;如果本车的车速大于等于0而小于等于所述预设的速度阈值,例如0km/h≤本车的车速≤35km/h,则进一步判断本车的横摆角速度是否大于预设的横摆角速度阈值,例如0.07rad/s(弧度每秒),并且同时判断本车前方目标在SAE(Society ofAutomotive Engineers,即汽车工程师协会)定义的车体坐标系(简称“SAE坐标系”)中的坐标在Y方向上的绝对值是否大于上一帧图像中所述目标的坐标在Y方向上的绝对值,如果本车的横摆角速度大于所述预设的横摆角速度阈值(例如0.07rad/s)并且同时本车前方目标在SAE坐标系中的坐标在Y方向上的绝对值也大于上一帧图像中所述目标的坐标在Y方向上的绝对值,则判定本车的行驶状态为弯道低速行驶状态;否则的话,判定本车的行驶状态为普通低速行驶状态。也就是说,只有当本车的车速、本车的横摆角速度以及本车前方目标在SAE坐标系中的坐标在Y方向上的绝对值这三者均满足上述要求时,才将所述本车的行驶状态判定为弯道低速行驶状态,否则的话,将本车的行驶状态判定为普通低速行驶状态。例如,在根据本发明的一种实施例中,如果本车的车速为60km/h(在此,所述预设的速度阈值为35km/h),则可以判定本车的行驶状态为正常行驶状态。因为车辆在转弯时一般都会减速行驶,所以只有在车辆速度处于低速时,才考虑车辆处于转弯行驶的情况。又例如,在根据本发明的一种实施例中,如果本车的车速为25km/h,同时本车的横摆角速度为0.08rad/s(在此,所述预设的速度阈值为35km/h并且所述预设的横摆角速度阈值为0.07rad/s)并且同时本车前方目标在SAE坐标系中的坐标在Y方向上的绝对值大于上一帧图像中所述目标的坐标在Y方向上的绝对值,则判定本车的行驶状态为弯道低速行驶状态。又例如,在根据本发明的一种实施例中,如果本车的车速为0km/h,本车的横摆角速度为0rad/s,同时本车前方目标在SAE坐标系中的坐标在Y方向上的绝对值等于上一帧图像中所述目标的坐标在Y方向上的绝对值,则判定本车的行驶状态为普通低速行驶状态。由此可见,所述普通低速行驶状态包括本车静止的状态,例如本车在等红灯时的状态,这意味着,根据本发明的车辆前方目标识别方法即使在车辆静止的情况下仍然能够持续选择目标,而不会停止工作。关于SAE车体坐标系,本领域技术人员可以参考公知的现有技术(例如网址:http://www.360doc.com/content/17/0225/08/40003352_631837542.shtml),在此不再赘述。
对本领域技术人员来说,显而易见的是,所述预设的速度阈值和所述预设的横摆角速度阈值均是可变的,本领域技术人员可以根据实际需要或者特定的要求而自由选择所述预设的速度阈值和所述预设的横摆角速度阈值的具体数值。例如,所述预设的速度阈值可以是35km/h、40km/h、45km/h、50km/h等,而所述预设的横摆角速度阈值可以是0.07rad/s、0.08rad/s、0.09rad/s等。
(4)根据本车的不同行驶状态,使用不同的目标选择策略从所述目标列表中选定主目标,如图1中步骤104所示。在图像传感器或者视觉传感器获得的车辆前方图像或者视频中,可能存在多个车辆前方目标,为了避免与前方目标发生碰撞并且对碰撞风险进行实时监控和追踪,需要优先识别最有可能与本车发生碰撞的主目标。在根据本发明的一种实施例中,从所述目标列表中选定主目标优先由以下因素决定:(1)目标与本车之间的距离;(2)目标的位置是否在本车道内;(3)目标的置信度;以及(4)目标被连续选定为本车道目标的图像帧数。在根据本发明的一种实施例中,可以根据重要性或者实际需要来设定上述四个因素的先后顺序和/或优先级。在根据本发明的一种实施例中,从所述目标列表中选定的主目标至少具备以下特征:目标与本车之间的距离最小。此外,从所述目标列表中选定主目标时,需要判断车辆前方目标的位置是否在本车道内。关于置信度,对本领域技术人员来说,易于理解的是,置信度表示某个事件有多大程度上值得可信。在检测或者判断车辆前方图像或者视频中是否出现所述目标时,需要利用置信度来给出检测结果或者判断结果的可信程度。所述置信度显示了所述检测结果或者判断结果的准确性。例如,在选定所述主目标时,需要设置一个预设的置信度阈值,所述预设的置信度阈值与车辆(即本车)的行驶状态有关。例如,在根据本发明的一种实施例中,当所述车辆的行驶状态为正常行驶状态时,从所述目标列表中选定的主目标要求:所述目标的置信度大于或等于0.8(即预设的置信度阈值为0.8)。又例如,当所述车辆的行驶状态为普通低速行驶状态时,从所述目标列表中选定的主目标要求:所述目标的置信度大于或等于0.6(即预设的置信度阈值为0.6)。目标的置信度可以通过各种图像检测方法或者其他方式获得,在此不再赘述。在根据本发明的一种实施例中,所述目标的置信度优先取决于以下因素:(1)目标是否被图像检测算法检测到;(2)目标是否被雷达检测到;(3)目标是否处于运动中;以及(4)目标存在于有效视界内的持续时间。在根据本发明的一种实施例中,可以根据重要性或者实际需要来设定上述四个因素的先后顺序和/或优先级。在根据本发明的一种实施例中,从所述目标列表中选定的主目标例如还具备以下特征:目标被连续选定为本车道目标的图像帧数大于或等于一个预设的帧数阈值,例如20帧。
只有当所述目标列表中的目标符合预设条件(预先设定的条件)时,它才被选定为所述目标列表中的主目标。通俗一点说,所述预设条件是筛选所述主目标的门槛。所述预设条件是由上文提到的四个因素中的至少两个因素按照优先级顺序和/或其他需要的顺序排列组合而成的。例如,在根据本发明的一种具体实施例中,选定为所述目标列表中的主目标需要符合以下预设条件:(1)目标与本车之间的距离最小并且(2)目标的位置处于本车道内。又例如,在根据本发明的一种具体实施例中,选定为所述目标列表中的主目标需要符合以下预设条件:(1)目标与本车之间的距离最小;(2)目标的位置处于本车道内;以及(3)目标的置信度大于或等于一个预设的置信度阈值,例如大于或等于0.8。又例如,在根据本发明的一种具体实施例中,选定为所述目标列表中的主目标需要符合以下预设条件:(1)目标与本车之间的距离最小;(2)目标的位置处于本车道内;(3)目标的置信度大于或等于一个预设的置信度阈值,例如大于或等于0.7;以及(4)目标被连续选定为本车道目标的图像帧数大于或等于一个预设的帧数阈值,例如30帧。在不同的道路场景下,可以根据不同的目标检测和追踪要求来设定不同的预设条件来筛选所述主目标。
图2示例性示出一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为正常行驶状态或者普通低速行驶状态时本车与前方目标的坐标图。根据本发明的一种实施例,当所述车辆的行驶状态为正常行驶状态或者普通低速行驶状态(例如直线行驶)时,用于判断所述车辆前方目标的位置是否在本车道内的方法是:以本车位置为原点O建立平面直角坐标系XOY,所述平面直角坐标系XOY即为SAE坐标系中的XOY平面,所述平面直角坐标系XOY的X轴正方向为本车行驶轨迹的前进方向(水平指向前方),所述平面直角坐标系XOY的Y轴正方向为车体平面内垂直于X轴的右侧方向,其中,目标的坐标标记为(y,x),如图2所示,根据公式w=(0.015*x+0.85)*2能够计算出目标所在位置的虚拟车道线的宽度w。在这里,所述虚拟车道线实际上是利用算法(例如图像识别算法)拟合出来的,而并非实际行车路面上印刷的实物车道线,因为在判断目标(例如前方车辆)是否在本车道内时使用印刷的实物车道线会带来较大误差。例如,基于毫米波雷达的特性,距离本车越远的目标,它的横向误差越大,例如前方20米处的目标的横向误差可能是正负0.5米,而前方120米处的目标横向误差可能达到正负2米了,这个误差已经超过大半个常规车道线宽度了。此外,在特定情况下或者特定地点,印刷的实物车道线不一定存在。根据本发明,借助于所述虚拟车道线能够更加准确并且方便地判断所述车辆前方目标的位置。在根据本发明的一种实施例中,将本车行驶轨迹设定为所述虚拟车道线的中心线。如果目标与所述虚拟车道线的中心线之间的距离小于所述虚拟车道线宽度的一半,则判定所述目标处于本车道内,否则的话,则判定所述目标不在本车道内。上述根据本发明的用于判断车辆前方目标的位置是否在本车道内的方法能够以低成本的简便运算实现对车辆前方目标的位置的准确判断。在实际应用中,当车辆处于正常行驶状态或者普通低速行驶状态时,上述根据本发明的用于判断车辆前方目标的位置是否在本车道内的方法能够使得对车辆前方目标的位置的判断准确率达到95%以上。
图3示例性示出一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为弯道低速行驶状态时本车与前方目标的坐标图。一般情况下,在车辆转弯时,可以将车辆行驶轨迹视为圆周运动。例如,如图3所示,将车辆的弯道低速行驶状态视为圆周运动,根据本发明的一种实施例,当所述车辆的行驶状态为弯道低速行驶状态时,用于判断所述车辆前方目标的位置是否在本车道内的方法是:以本车位置为原点O建立平面直角坐标系XOY(即为SAE坐标系中的XOY平面),弧线OA为本车行驶轨迹,所述平面直角坐标系XOY的X轴正方向为弧线OA的切线方向(切点为原点O),所述平面直角坐标系XOY的Y轴正方向为车体平面内垂直于X轴的右侧方向,所述本车行驶轨迹OA所在虚拟圆的圆心坐标为(r,0)。在图3所示的实施例中,弧线CD为目标行驶轨迹,目标坐标为(y,x),所述目标行驶轨迹CD所在虚拟圆的圆心坐标亦为(r,0)。由此可见,在图3所示的实施例中,所述本车行驶轨迹OA所在虚拟圆和所述目标行驶轨迹CD所在虚拟圆为圆心坐标同为(r,0)的同心圆。对本领域技术人员来说,易于理解的是,一般情况下r的数值较大,从而将这两个行驶轨迹的模型简化为同心圆是合理的,并且使得相关的计算变得简单。在以本车位置和本车行驶轨迹建立平面直角坐标系XOY并且标记所述目标的坐标位置之后,根据公式r=v/ω计算所述本车行驶轨迹的曲率半径r(即,本车的转弯半径r),其中,v表示本车的车速,ω表示本车的横摆角速度,然后,根据公式来计算所述目标行驶轨迹的曲率半径r1(即,目标的转弯半径r1),然后,再根据公式w=(0.015*r*arcsin(x/γ1)+0.85)*2来计算目标所在位置的虚拟车道线的宽度w。在这里,所述虚拟车道线实际上是利用算法(例如图像识别算法)拟合出来的,而并非实际行车路面上印刷的实物车道线,因为在判断目标(例如前方车辆)是否在本车道内时使用印刷的实物车道线会带来较大误差。此外,在特定情况下或者特定地点,印刷的实物车道线不一定存在。根据本发明,借助于所述虚拟车道线能够更加准确并且方便地判断所述车辆前方目标的位置。在根据本发明的一种实施例中,将本车行驶轨迹设定为所述虚拟车道线的中心线。如果目标与所述虚拟车道线的中心线之间的距离小于所述虚拟车道线宽度的一半,则判定所述目标处于本车道内,否则的话,则判定所述目标不在本车道内。上述根据本发明的用于判断车辆前方目标的位置是否在本车道内的方法能够以低成本的简便运算实现对车辆前方目标的位置的准确判断。在实际应用中,当车辆处于弯道低速行驶状态时,上述根据本发明的用于判断车辆前方目标的位置是否在本车道内的方法能够使得对车辆前方目标的位置的判断准确率达到90%以上。
图4示例性示出一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为正常行驶状态时从所述目标列表中选定主目标的流程图(即,主目标选择策略400的流程图)。根据本发明的一种具体实施例,当本车的行驶状态为正常行驶状态时,在所述目标列表中搜索主目标,判断正常行驶状态下是否成功搜索到主目标(如图4中步骤401所示),如果在所述目标列表中成功搜索到符合预设条件的主目标(即,在所述目标列表中存在符合预设条件的主目标),则进一步判断搜索到的主目标与上一帧图像中选定的主目标是否相同(如图4中步骤402所示),如果所述搜索到的主目标与上一帧图像中选定的主目标相同,则将所述搜索到的主目标选定为当前帧图像的主目标(如图4中步骤403所示),如果所述搜索到的主目标与上一帧图像中选定的主目标不相同,则进一步判断所述搜索到的主目标是否会触发报警或者具有预设的置信度(如图4中步骤406所示,在这里,所述预设的置信度是指预设的高置信度,例如置信度的值不小于0.8),如果所述搜索到的主目标会触发报警或者具有预设的置信度,则将所述搜索到的主目标选定为当前帧图像的主目标(如图4中步骤409所示),如果所述搜索到的主目标不会触发报警并且不具有预设的置信度,则进一步判断上一帧图像中是否存在选定的主目标(如图4中步骤407所示),如果上一帧图像中存在选定的主目标,则将上一帧图像中选定的主目标选定为当前帧图像的主目标(如图4中步骤410所示),如果上一帧图像中不存在选定的主目标,则将所述搜索到的主目标选定为当前帧图像主目标(如图4中步骤408所示);如果在所述目标列表中未成功搜索到符合预设条件的主目标,则进入步骤601:判断普通低速行驶状态下是否成功搜索到主目标,如图4、图5和图6中步骤601所示。
图5示例性示出另一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为正常行驶状态时的主目标选择策略500的流程图。图5中所示的主目标选择策略500与图4中所示的主目标选择策略400的区别在于,图5中所示的主目标选择策略500还包括步骤404:判断搜索到的主目标与候选目标是否相同和步骤405:将所述搜索到的主目标作为新的候选目标,其中,所述候选目标是位置处于本车道内并且与本车之间的距离最小的目标。在大多数情况下,候选目标与符合预设条件的主目标是同一目标。如图5中所示的主目标选择策略500,当本车的行驶状态为正常行驶状态时,在所述目标列表中搜索主目标,判断正常行驶状态下是否成功搜索到主目标(如图5中步骤401所示),如果在所述目标列表中成功搜索到符合预设条件的主目标(即,在所述目标列表中存在符合预设条件的主目标),则进一步判断搜索到的主目标与上一帧图像中选定的主目标是否相同(如图5中步骤402所示),如果所述搜索到的主目标与上一帧图像中选定的主目标相同,则将所述搜索到的主目标选定为当前帧图像的主目标(如图5中步骤403所示),如果所述搜索到的主目标与上一帧图像中选定的主目标不相同,则进一步将所述搜索到的主目标与候选目标进行比较,即,判断搜索到的主目标与候选目标是否相同(如图5中步骤404所示),其中,所述候选目标是位置处于本车道内并且与本车之间的距离最小的目标,如果所述搜索到的主目标与所述候选目标相同(即两者是同一目标),则将所述候选目标的置信度增加一个预设数值(例如0.05或者0.1)并且进入步骤406:判断所述搜索到的主目标是否会触发报警或者具有预设的置信度,如果所述搜索到的主目标与所述候选目标不相同(即两者不是同一目标),则将所述搜索到的主目标作为新的候选目标(如图5中步骤405所示)并且进入步骤406:进一步判断所述搜索到的主目标是否会触发报警或者具有预设的置信度(如图5中步骤406所示,在这里,所述预设的置信度是指预设的高置信度,例如置信度的值不小于0.8),如果所述搜索到的主目标会触发报警或者具有预设的置信度,则将所述搜索到的主目标选定为当前帧图像的主目标(如图5中步骤409所示),如果所述搜索到的主目标不会触发报警并且不具有预设的置信度,则进一步判断上一帧图像中是否存在选定的主目标(如图5中步骤407所示),如果上一帧图像中存在选定的主目标,则将上一帧图像中选定的主目标选定为当前帧图像的主目标(如图5中步骤410所示),如果上一帧图像中不存在选定的主目标,则将所述搜索到的主目标选定为当前帧图像主目标(如图5中步骤408所示);如果在所述目标列表中未成功搜索到符合预设条件的主目标,则进入步骤601:判断普通低速行驶状态下是否成功搜索到主目标,如图4、图5和图6中步骤601所示。通过引入候选目标并且将所述符合预设条件的主目标与候选目标进行比较,能够有效提高选定主目标的准确性和稳定性,尤其是能够有效避免选定主目标时的检测或跟踪错误。根据本发明的一种实施方式,针对图像传感器或者视觉传感器采集到的每一帧图像,都利用根据本发明的主目标选择策略去搜索图像中的主目标,其中,候选目标是当前帧图像中本车道内距离最近的目标,主目标可能是连续好几帧图像中都稳定存在于图像中的本车道内距离最近的目标,如果有一个目标在当前帧图像中它不在本车道内也不是距离最近的目标,但是它在前面连续几帧图像中都被认为是本车道内距离最近的目标,那么出现这种情况的原因有可能是因为误检测或者跟踪错误。因为发生检测错误或者跟踪错误时会出现的一种情况就是虽然事实上前方目标没有发生变化,但是当前帧图像中搜索找到的主目标与上一帧图像中选定的主目标不一样,为了避免这种检测错误或者跟踪错误的发生,可以引入所述候选目标,所述候选目标就是最有可能替换当前主目标的目标。
图6示例性示出一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为普通低速行驶状态时的主目标选择策略600的流程图。根据本发明的一种具体实施例,当本车的行驶状态为普通低速行驶状态时,在所述目标列表中搜索主目标,判断普通低速行驶状态下是否成功搜索到主目标(如图6中步骤601所示),如果在所述目标列表中成功搜索到符合预设条件主目标,则将搜索到的主目标选定为当前帧图像的主目标(如图6中步骤602所示);如果在所述目标列表中未成功搜索到符合预设条件的主目标,则进入步骤701:判断弯道低速行驶状态下是否成功搜索到主目标(如图6和图7中步骤701所示)。在一种具体实施例中,在普通低速行驶状态下搜索主目标,可以适当调整所述主目标的预设条件,例如将目标的所述预设的置信度阈值降低为0.7。
图7示例性示出一种根据本发明的车辆前方目标识别方法中车辆的行驶状态为弯道低速行驶状态时的主目标选择策略700的流程图。根据本发明的一种具体实施例,当本车的行驶状态为弯道低速行驶状态时,在所述目标列表中搜索主目标,判断弯道低速行驶状态下是否成功搜索到主目标(如图7中步骤701所示),如果在所述目标列表中成功搜索到符合预设条件的主目标,则将所述搜索到的主目标选定为当前帧图像的主目标(如图7中步骤704所示);如果在所述目标列表中未成功搜索到符合预设条件的主目标,则进一步判断上一帧图像中是否存在选定的主目标(如图7中步骤702所示),如果上一帧图像中存在选定的主目标,则将上一帧图像中选定的主目标选定为当前帧图像的主目标(如图7中步骤705所示),如果上一帧图像中不存在选定的主目标,则返回并且显示结果:本次搜索没有找到主目标,如图7中步骤703所示。
对本领域技术人员来说,显而易见的是,可以针对这里所描述的实施方式实现大量的改进方案和变形方案,而它们并未脱离要求保护的主题的实质和范围。因此,本说明书的用意在于,涵盖这里所描述的不同实施方式的改进方案和变形方案,只要所述改进方案和变形方案处于附加的权利要求和它们的等效方案的范围之内。
Claims (7)
1.一种用于判断车辆前方目标的位置是否处于本车道内的方法,其中,所述车辆的行驶状态包括正常行驶状态、普通低速行驶状态和弯道低速行驶状态,当所述车辆的行驶状态为弯道低速行驶状态时,将车辆的弯道低速行驶轨迹视为圆周运动,所述用于判断车辆前方目标的位置是否处于本车道内的方法是:以本车位置为原点O建立平面直角坐标系XOY,所述平面直角坐标系XOY为SAE坐标系中的XOY平面,所述平面直角坐标系XOY的X轴正方向为本车行驶轨迹的切线方向,其中切点为原点O,所述平面直角坐标系XOY的Y轴正方向为车体平面内垂直于X轴的右侧方向,所述本车行驶轨迹所在虚拟圆的圆心坐标为(r,0),目标坐标为(y,x),目标行驶轨迹所在虚拟圆的圆心坐标亦为(r,0),其中,所述本车行驶轨迹所在虚拟圆和所述目标行驶轨迹所在虚拟圆为圆心坐标同为(r,0)的同心圆,在以本车位置和本车行驶轨迹建立平面直角坐标系XOY并且标记所述目标的坐标位置之后,首先根据公式r=v/ω计算所述本车行驶轨迹的转弯半径r,其中,v表示本车的车速,ω表示本车的横摆角速度,然后根据公式来计算所述目标行驶轨迹的转弯半径γ1,再根据公式w=(0.015*r*arcsin(x/γ1)+0.85)*2来计算目标所在位置的虚拟车道线的宽度w,其中,将本车行驶轨迹设定为所述虚拟车道线的中心线,如果目标与所述虚拟车道线的中心线之间的距离小于所述虚拟车道线宽度的一半,则判定所述目标处于本车道内,否则的话,则判定所述目标不在本车道内。
2.根据权利要求1所述的方法,其特征在于,当所述车辆的行驶状态为正常行驶状态或者普通低速行驶状态时,所述用于判断车辆前方目标的位置是否处于本车道内的方法是:
以本车位置为原点O建立平面直角坐标系XOY,所述平面直角坐标系XOY为SAE坐标系中的XOY平面,所述平面直角坐标系XOY的X轴正方向为本车行驶轨迹的前进方向,所述平面直角坐标系XOY的Y轴正方向为车体平面内垂直于X轴的右侧方向,其中,目标的坐标标记为(y,x),根据公式w=(0.015*x+0.85)*2计算出目标所在位置的虚拟车道线的宽度w,其中,将本车行驶轨迹设定为所述虚拟车道线的中心线,如果目标与所述虚拟车道线的中心线之间的距离小于所述虚拟车道线宽度的一半,则判定所述目标处于本车道内,否则的话,则判定所述目标不在本车道内。
3.根据权利要求1或2所述的方法,其特征在于,所述本车的行驶状态的判定条件为:
如果本车的车速大于预设的速度阈值,则判定本车的行驶状态为正常行驶状态;
如果本车的车速大于等于0而小于等于所述预设的速度阈值,则进一步判断本车的横摆角速度是否大于预设的横摆角速度阈值,并且同时判断本车前方目标在SAE定义的车体坐标系中的坐标在Y方向上的绝对值是否大于上一帧图像中所述目标的坐标在Y方向上的绝对值,如果本车的横摆角速度大于所述预设的横摆角速度阈值并且同时本车前方目标在SAE坐标系中的坐标在Y方向上的绝对值也大于上一帧图像中所述目标的坐标在Y方向上的绝对值,则判定本车的行驶状态为弯道低速行驶状态;
否则的话,判定本车的行驶状态为普通低速行驶状态。
4.根据权利要求1或2所述的方法,其特征在于,所述本车的车速通过轮速传感器来获取。
5.根据权利要求1或2所述的方法,其特征在于,所述本车的横摆角速度通过陀螺仪和加速度传感器来获取。
6.根据权利要求3所述的方法,其特征在于,所述预设的速度阈值是35km/h、40km/h、45km/h或50km/h。
7.根据权利要求3所述的方法,其特征在于,所述预设的横摆角速度阈值是0.07rad/s、0.08rad/s或0.09rad/s。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911198581.3A CN110940981B (zh) | 2019-11-29 | 2019-11-29 | 一种用于判断车辆前方目标的位置是否处于本车道内的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911198581.3A CN110940981B (zh) | 2019-11-29 | 2019-11-29 | 一种用于判断车辆前方目标的位置是否处于本车道内的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110940981A CN110940981A (zh) | 2020-03-31 |
CN110940981B true CN110940981B (zh) | 2024-02-20 |
Family
ID=69908855
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911198581.3A Active CN110940981B (zh) | 2019-11-29 | 2019-11-29 | 一种用于判断车辆前方目标的位置是否处于本车道内的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110940981B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111845737A (zh) * | 2020-06-17 | 2020-10-30 | 汉腾汽车有限公司 | 一种智能车辆的弯道目标识别方法及其危险等级判断机制 |
CN115507874B (zh) * | 2022-06-09 | 2024-03-01 | 广东省智能网联汽车创新中心有限公司 | 一种基于v2x的车道匹配方法及装置 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003121543A (ja) * | 2001-10-19 | 2003-04-23 | Nissan Motor Co Ltd | 車両用走行車線判断装置 |
JP2006213073A (ja) * | 2005-02-01 | 2006-08-17 | Honda Motor Co Ltd | 先行車認識装置 |
WO2011145581A1 (ja) * | 2010-05-17 | 2011-11-24 | いすゞ自動車株式会社 | 先行車検知装置 |
CN103895646A (zh) * | 2012-12-26 | 2014-07-02 | 现代摩比斯株式会社 | Scc装置及应用于其的目标车辆车道判别方法 |
CN104101878A (zh) * | 2014-06-23 | 2014-10-15 | 北京智华驭新汽车电子技术开发有限公司 | 一种车辆前方目标识别系统及识别方法 |
CN104870293A (zh) * | 2012-12-11 | 2015-08-26 | 丰田自动车株式会社 | 驾驶辅助装置以及驾驶辅助方法 |
CN107672589A (zh) * | 2017-09-26 | 2018-02-09 | 苏州观瑞汽车技术有限公司 | 一种基于雷达探测数据的车辆轨迹实时预测方法和装置 |
CN108960183A (zh) * | 2018-07-19 | 2018-12-07 | 北京航空航天大学 | 一种基于多传感器融合的弯道目标识别系统及方法 |
-
2019
- 2019-11-29 CN CN201911198581.3A patent/CN110940981B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003121543A (ja) * | 2001-10-19 | 2003-04-23 | Nissan Motor Co Ltd | 車両用走行車線判断装置 |
JP2006213073A (ja) * | 2005-02-01 | 2006-08-17 | Honda Motor Co Ltd | 先行車認識装置 |
WO2011145581A1 (ja) * | 2010-05-17 | 2011-11-24 | いすゞ自動車株式会社 | 先行車検知装置 |
CN104870293A (zh) * | 2012-12-11 | 2015-08-26 | 丰田自动车株式会社 | 驾驶辅助装置以及驾驶辅助方法 |
CN103895646A (zh) * | 2012-12-26 | 2014-07-02 | 现代摩比斯株式会社 | Scc装置及应用于其的目标车辆车道判别方法 |
CN104101878A (zh) * | 2014-06-23 | 2014-10-15 | 北京智华驭新汽车电子技术开发有限公司 | 一种车辆前方目标识别系统及识别方法 |
CN107672589A (zh) * | 2017-09-26 | 2018-02-09 | 苏州观瑞汽车技术有限公司 | 一种基于雷达探测数据的车辆轨迹实时预测方法和装置 |
CN108960183A (zh) * | 2018-07-19 | 2018-12-07 | 北京航空航天大学 | 一种基于多传感器融合的弯道目标识别系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110940981A (zh) | 2020-03-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4906398B2 (ja) | 車載道路形状識別装置、車載システム、道路形状識別方法及び周辺監視方法 | |
US11568746B2 (en) | Vehicular environment estimation device | |
CN103303306B (zh) | 就所出现的危险状况对车辆驾驶员作出警示的方法 | |
US8711003B2 (en) | Vehicle location information-based abnormal driving determination and warning system | |
US9524643B2 (en) | Orientation sensitive traffic collision warning system | |
JP4604103B2 (ja) | 交差点見通し検出装置 | |
US8447484B2 (en) | Branch-lane entry judging system | |
CN110940982B (zh) | 一种车辆前方目标识别方法以及相应的设备 | |
US7474961B2 (en) | System to determine the path of a vehicle | |
US6226571B1 (en) | Surroundings monitoring apparatus for an automotive vehicle | |
US10691125B2 (en) | Blinker judgment device and autonomous driving system | |
KR20180092101A (ko) | Ecu, 상기 ecu를 포함하는 무인 자율 주행 차량, 및 이의 주행 차로 판단 방법 | |
Leonhardt et al. | Feature evaluation for lane change prediction based on driving situation and driver behavior | |
CN104192063B (zh) | 车辆安全行驶警示系统及相应的警示方法 | |
JP2012089114A (ja) | 障害物認識装置 | |
US11042160B2 (en) | Autonomous driving trajectory determination device | |
CN110940981B (zh) | 一种用于判断车辆前方目标的位置是否处于本车道内的方法 | |
CN113815620B (zh) | 一种车辆安全行驶的评估方法、装置、设备及存储介质 | |
Sivaraman et al. | Merge recommendations for driver assistance: A cross-modal, cost-sensitive approach | |
CN111796286A (zh) | 一种制动等级的评估方法、装置、车辆和存储介质 | |
CN111731296A (zh) | 行驶控制装置、行驶控制方法以及存储程序的存储介质 | |
CN114291116B (zh) | 周围车辆轨迹预测方法、装置、车辆及存储介质 | |
CN115195773A (zh) | 用于控制车辆驾驶的装置和方法及记录介质 | |
CN113879312B (zh) | 基于多传感器融合的前向目标选择方法、装置和存储介质 | |
JP5682302B2 (ja) | 走行道路推定装置、方法およびプログラム |
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 |