CN116373890A - 车辆自动驾驶合规性的监测方法、监测系统和存储介质 - Google Patents
车辆自动驾驶合规性的监测方法、监测系统和存储介质 Download PDFInfo
- Publication number
- CN116373890A CN116373890A CN202310446883.8A CN202310446883A CN116373890A CN 116373890 A CN116373890 A CN 116373890A CN 202310446883 A CN202310446883 A CN 202310446883A CN 116373890 A CN116373890 A CN 116373890A
- Authority
- CN
- China
- Prior art keywords
- target vehicle
- vehicle
- lane
- compliance
- speed
- 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
- 238000012544 monitoring process Methods 0.000 title claims abstract description 302
- 238000000034 method Methods 0.000 title claims abstract description 70
- 230000008569 process Effects 0.000 claims abstract description 32
- 230000008859 change Effects 0.000 claims description 120
- 230000006870 function Effects 0.000 description 153
- 230000006399 behavior Effects 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000003491 array Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000010998 test method Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Time Recorders, Dirve Recorders, Access Control (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种车辆自动驾驶合规性的监测方法、监测系统和存储介质。监测方法包括获取目标车辆自动驾驶过程中所在的场景信息;从场景信息中获取目标车辆自动驾驶过程中合规性监测功能对应的触发信息,并判断触发信息是否满足预设的触发条件;若是,通过合规性监测功能从场景信息中获取对应的监控信息对目标车辆自动驾驶的合规性进行监测。本方案获取实时场景信息的方式非常简单,能够避免信息模糊的情况,非常适用于车辆自动驾驶的过程,能够被车辆准确识别场景信息,从而可以更加准确地通过合规性监测功能对目标车辆自动驾驶的合规性进行监测。
Description
技术领域
本发明属于车辆自动驾驶技术领域,具体涉及一种车辆自动驾驶合规性的监测方法、监测系统和存储介质。
背景技术
随着自动驾驶车辆的发展,自动驾驶车辆与人类驾驶车辆将共享交通设施,也应共同遵守一致的交通规则。但是,目前的交通规则是针对人类驾驶采用自然语言编纂而成的,其中很多语言是模糊的,容易导致自动驾驶车辆对这些交通规则无法准确理解。因此,对当前的交通规则进行数字化,使得自动驾驶汽车可以理解并遵守交通规则显得至关重要。通过对交通规则数字化后,也便于实现对自动驾驶车辆行为的实时合规性监测。
目前,为了对自动驾驶车辆行为的合规性监测,提出了一种自动驾驶汽车交通法规符合性仿真测试方法及系统。该系统按照分类原则设计原子命题,并将其用逻辑语言编写、组合形成形式化交规。通过获取交通参与者的信息,对应相应的形式化交规,并根据获取的交通参与者的信息判断交规中原子命题的真伪,以此代表交通参与者是否遵守交规。但是,多数原子命题对于自动驾驶汽车而言仍是模糊的,而且该系统对于获取信息要求过高,很多信息难以获取或只能间接获得。现有方案仅适用于对采集的车辆数据进行离线式合规性判断,且对于获取信息依赖性过高,不能作为自动驾驶汽车的合规性监测来使用,无法满足车辆自动驾驶的需要。
发明内容
鉴于上述问题,提出了本发明以便提供一种克服上述问题或者至少部分地解决上述问题的车辆自动驾驶合规性的监测方法、监测系统和存储介质。
根据本发明的一个方面,本发明提供了一种车辆自动驾驶合规性的监测方法,包括:
获取目标车辆自动驾驶过程中所在的场景信息;
从所述场景信息中获取所述目标车辆自动驾驶过程中合规性监测功能对应的触发信息,并判断所述触发信息是否满足预设的触发条件;
若是,通过所述合规性监测功能从所述场景信息中获取对应的监控信息对所述目标车辆自动驾驶的合规性进行监测。
可选的,所述合规性监测功能包括超车合规性监测功能;
所述触发条件包括:
所述目标车辆预设范围内所在的目标车道上存在前车以及下列至少之一;
所述前车的速度小于所述目标车辆的速度;
所述前车与所述目标车辆的碰撞时间小于预设的超车触发碰撞时间;
所述目标车辆以大于预设换道横向速度的横向速度与车道线相交;
其中,所述前车表示所述目标车辆前方至所述目标车辆距离最小的车辆;
通过所述合规性监测功能对所述目标车辆自动驾驶的合规性进行监测包括下列至少之一:
通过所述超车合规性监测功能判断所述目标车辆的换道方式是否为跨实线换道,若是,则非合规;
通过所述超车合规性监测功能判断所述目标车辆与同车道前车的车距是否大于第一预设安全距离,若是,则合规;
通过所述超车合规性监测功能判断所述目标车辆与同车道左侧车道的最近前车辆的车距是否大于第一预设安全距离,若是,则合规;
通过所述超车合规性监测功能判断所述目标车辆与同车道左侧车道的最近后车辆的车距是否大于第一预设安全距离,若是,则合规;
通过所述超车合规性监测功能判断所述目标车辆的换道持续时长是否小于或等于预设最大允许换道时长,若是,则合规;
通过所述超车合规性监测功能判断所述目标车辆的速度与被超车辆的速度的差值是否大于预设超车速度差值,若是,则合规。
可选的,所述目标车辆预设范围内所在的目标车道上存在前车通过以下方式确定:
根据目标车辆的坐标和所在道路的车道线参数确定所述目标车辆所在的车道;
根据目标车辆预设范围内其他车辆的坐标和所在道路的车道线参数确定所述其他车辆所在的车道;
根据所述目标车辆所在的车道和预设范围内的其他车辆所在的车道确定目标车道上存在前车;其中车道线经目标车辆坐标系下的三次拟合曲线拟合而成;
所述前车的速度小于所述目标车辆的速度通过下列方式确定:
所述前车的纵向速度小于所述目标车辆的纵向速度;
所述前车与所述目标车辆的碰撞时间小于预设的超车触发碰撞时间通过下列方式确定:
使目标车辆的纵向速度与前车的纵向速度的差值与超车触发碰撞时间相乘大于预设的超车触发距离;其中,所述超车触发距离为前车与目标车辆之间沿目标车辆左侧车道线的距离;
所述目标车辆以大于预设换道横向速度的横向速度与车道线相交通过下列方式确定:
根据所述目标车辆宽度方向的车身位置与车道线的位置关系确定所述目标车辆所相交的车道线;
将所述目标车辆的横向速度和预设换道横向速度进行比较,以确定所述目标车辆以大于预设换道横向速度的横向速度与车道线相交;
通过所述超车合规性监测功能判断所述目标车辆的换道方式是否为跨实线换道包括:
将所述目标车辆看作矩形,判断矩形的两个对角线是否与实线均有交点,若是,确定所述目标车辆的换道方式为跨实线换道;
通过所述超车合规性监测功能判断所述目标车辆与同车道前车的车距是否大于第一预设安全距离包括:
计算所述目标车辆的纵向速度与所述前车的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离;
通过所述超车合规性监测功能判断所述目标车辆与同车道左侧车道的最近前车辆的车距是否大于第一预设安全距离包括:
计算所述目标车辆的纵向速度与同车道左侧车道的最近前车辆的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离;
通过所述超车合规性监测功能判断所述目标车辆与同车道左侧车道的最近后车辆的车距是否大于第一预设安全距离包括:
计算所述目标车辆的纵向速度与同车道左侧车道的最近后车辆的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离。
可选的,所述合规性监测功能包括限速合规性监测功能;
所述触发条件包括:
所述目标车辆位于高速公路主路;
通过所述合规性监测功能对所述目标车辆自动驾驶的合规性进行监测,包括:
通过所述限速合规性监测功能对所述目标车辆自动驾驶的速度合规性进行监测。
可选的,通过所述限速合规性监测功能对所述目标车辆自动驾驶的速度合规性进行监测包括:
当所述目标车辆位于限速标志范围内时,通过所述限速合规性监测功能判断所述目标车辆的速度是否属于限速标志范围,若是,则合规;
当所述目标车辆位于限速标志范围外,且与所述目标车辆同方向的主车道数大于或等于2时,通过所述限速合规性监测功能判断所述目标车辆的速度是否属于其所在目标车道规定的速度范围,若是,则合规。
可选的,所述合规性监测功能包括车距限制合规性监测功能;
所述触发条件包括:
所述目标车辆位于高速公路主路;
通过所述合规性监测功能对所述目标车辆自动驾驶的合规性进行监测,包括:
通过所述车距限制合规性监测功能对所述目标车辆自动驾驶的车距合规性进行监测。
可选的,通过所述车距限制合规性监测功能对所述目标车辆自动驾驶的车距合规性进行监测包括:
通过所述车距限制合规性监测功能判断所述目标车辆的速度是否大于第一预设速度,且所述目标车辆与同车道的最近其他车辆的距离是否大于第二预设安全距离,若是,则合规;或
通过所述车距限制合规性监测功能判断所述目标车辆的速度是否小于或等于所述第一预设速度,且所述目标车辆与同车道的最近其他车辆的距离是否大于第三预设安全距离,若是,则合规;
其中,所述第二预设安全距离大于所述第三预设安全距离。
可选的,所述合规性监测功能包括换道合规性监测功能;
所述触发条件包括:
所述目标车辆以大于预设换道横向速度的横向速度与车道线相交;
通过所述合规性监测功能对所述目标车辆自动驾驶的合规性进行监测包括下列至少之一:
通过所述换道合规性监测功能判断所述目标车辆的换道方式是否为跨实线换道,若是,则非合规;
通过所述换道合规性监测功能判断所述目标车辆的换道持续时长是否小于或等于预设最大允许换道时长,若是,则合规;
当所述目标车辆向左换道时,通过所述换道合规性监测功能判断所述目标车辆与同车道的前车以及左侧车道的最近其他车辆的距离是否分别小于第四预设安全距离,若是,则合规;或当所述目标车辆向右换道时,通过所述换道合规性监测功能判断所述目标车辆与同车道的前车以及右侧车道的最近其他车辆的距离是否分别小于第四预设安全距离,若是,则合规。
根据本发明的另一个方面,本发明提供了一种车辆自动驾驶合规性的监测系统,包括:
场景获取模块,用于获取目标车辆自动驾驶过程中所在的场景信息;
监测触发条件模块,用于从所述场景信息中获取所述目标车辆自动驾驶过程中合规性监测功能对应的触发信息,并判断所述触发信息是否满足预设的触发条件;
若是,合规性监测功能模块,用于从所述场景信息中获取对应的监控信息对所述目标车辆自动驾驶的合规性进行监测。
根据本发明的又一个方面,本发明提供了一种机器可读存储介质,其上存储有机器可执行程序,所述机器可执行程序被处理器执行时实现根据上述任一项所述的车辆自动驾驶合规性的监测方法。
本发明的有益效果为:
本发明的车辆自动驾驶合规性的监测方法,包括获取目标车辆自动驾驶过程中所在的场景信息,从场景信息中获取目标车辆自动驾驶过程中合规性监测功能对应的触发信息,并判断触发信息是否满足预设的触发条件,若是,通过合规性监测功能从场景信息中获取对应的监控信息对目标车辆自动驾驶的合规性进行监测,本方案获取实时场景信息的方式非常简单,能够避免信息模糊的情况,非常适用于车辆自动驾驶的过程,能够被车辆准确识别场景信息,从而可以更加准确地通过合规性监测功能对目标车辆自动驾驶的合规性进行实时监测。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明一个实施例提供的车辆自动驾驶合规性的监测方法的流程图;
图2是本发明另一个实施例提供的车辆自动驾驶合规性的监测方法的流程图;
图3是本发明一个实施例提供的车辆自动驾驶合规性的监测系统的结构示意图;
图4是本发明另一个实施例提供的车辆自动驾驶合规性的监测系统的结构示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将对本发明的技术方案进行详细的描述。显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所得到的所有其它实施方式,都属于本发明所保护的范围。
图1是本发明一个实施例提供的车辆自动驾驶合规性的监测方法的流程图。如图1所示,车辆自动驾驶合规性的监测方法可包括以下步骤:
步骤S102:获取目标车辆自动驾驶过程中所在的场景信息。可以理解,本步骤中获取的场景信息属于实时场景信息,可以采用相关的采集设备进行采集获取,场景信息可以包括目标车辆的信息,目标车辆预设范围内其他车辆的信息以及道路信息等,均属于能够比较直接得到的场景信息,相对于现有技术中获取用自然语言编纂而成的信息,或相对于现有技术中用逻辑语言编写、组合形成形式化交规信息,本步骤中的场景信息属于比较初始的信息,获取方式也非常简单,对获取场景信息的功能要求较低,能够被准确识别,避免信息模糊的情况,并且,实时性好,落地性强,有利于后续步骤更加准确地对目标车辆自动驾驶进行合规性的监测。
具体地,获取目标车辆自动驾驶过程中所在的场景信息可包括通过高精地图结合全球定位系统(Global Positioning System,GPS)及信息网络系统(Information NetworkSystem,INS)获取目标车辆在全局坐标系下的纵坐标XEgo、横坐标YEgo以及目标车辆航向角θEgo,同时获取限速标志纵坐标位置Xsl_sign、限速标志横坐标位置Ysl_sign以及解除限速标志纵坐标位置Xrsl_sign、解除限速标志横坐标位置Yrsl_sign,以及同方向车道数Nalllane、主车道数Nmainway、目标车辆所在道路类别LTEgo(例如道路类别代码:1表示主路,2表示应急车道,3表示入口匝道,4表示出口匝道,5表示加速车道,6表示减速车道);通过摄像头与雷达感知周围环境,获取周围车辆(例如预设范围内的车辆)在目标车辆坐标下的纵坐标xTgt、横坐标yTgt及航向角θTgt,同时获取他车(周围车辆)的纵向速度vxTgt、横向速度vyTgt、车辆长度LTgt及车辆宽度wTgt,并感知限速标志限制的速度上限Vsign_max及速度下限Vsign_min,同时感知从最内侧车道线依次向外的每条车道线的类型T(i)(车道线类型代码:1表示白虚线,2表示白实线,3表示黄虚线,4表示黄实线),并用目标车辆坐标系下的三次拟合曲线拟合车道线,返回三次拟合参数,对于每一条车道线,可以通过三次拟合曲线公式(1)进行拟合:
yline(i)=b3ix3+b2ix2+b1ix+b0i,i=1,2,…Nalllane (1)
还可以通过目标车辆的车速传感器获取目标车辆的纵向速度vxEgo和横向速度vyEgo,加速度传感器获取纵向加速度axEgo及横向加速度ayEgo。场景信息可以包括上述中的一种或多种。
步骤S104:从场景信息中获取目标车辆自动驾驶过程中合规性监测功能对应的触发信息,并判断触发信息是否满足预设的触发条件。可以理解,本实施例中可以包括多个合规性监测功能,每个合规性监测功能都有与自己对应的触发信息和对应的触发条件。不同的合规性监测功能可以相互独立运行。
若是,执行步骤S106:通过合规性监测功能从场景信息中获取对应的监控信息对目标车辆自动驾驶的合规性进行监测。
在本实施例中,获取目标车辆自动驾驶过程中所在的场景信息,从场景信息中获取目标车辆自动驾驶过程中合规性监测功能对应的触发信息,并判断触发信息是否满足预设的触发条件,若是,通过合规性监测功能从场景信息中获取对应的监控信息对目标车辆自动驾驶的合规性进行监测,本实施例获取实时场景信息的方式非常简单,对获取场景信息的功能要求较低,能够避免信息模糊的情况,非常适用于车辆自动驾驶的过程,能够被车辆准确识别场景信息,从而可以更加准确地通过合规性监测功能对目标车辆自动驾驶的合规性进行实时监测。
在本发明一个实施例中,合规性监测功能可包括超车合规性监测功能;
触发条件可包括:
目标车辆预设范围内所在的目标车道上存在前车以及下列至少之一;
前车的速度小于目标车辆的速度;
前车与目标车辆的碰撞时间小于预设的超车触发碰撞时间;
目标车辆以大于预设换道横向速度的横向速度与车道线相交;
其中,前车表示目标车辆前方至目标车辆距离最小的车辆。
通过合规性监测功能对目标车辆自动驾驶的合规性进行监测包括下列至少之一:
通过超车合规性监测功能判断目标车辆的换道方式是否为跨实线换道,若是,则非合规;
通过超车合规性监测功能判断目标车辆与同车道前车的车距是否大于第一预设安全距离,若是,则合规;
通过超车合规性监测功能判断目标车辆与同车道左侧车道的最近前车辆的车距是否大于第一预设安全距离,若是,则合规;
通过超车合规性监测功能判断目标车辆与同车道左侧车道的最近后车辆的车距是否大于第一预设安全距离,若是,则合规;
通过超车合规性监测功能判断目标车辆的换道持续时长是否小于或等于预设最大允许换道时长,若是,则合规;
通过超车合规性监测功能判断目标车辆的速度与被超车辆的速度的差值是否大于预设超车速度差值,若是,则合规。
在本实施例中,触发条件即超车意图。预设范围可以根据实际情况进行设置,一般情况下,预设范围可以与目标车辆的车速成正比,也就是说预设范围可以随着车速的变化而变化,是动态的范围,预设范围是动态的范围,属于突破传统思想桎梏的改进,可以在车速较快的时候获取更大范围的信息,保证安全,在车速较慢的时候获取较少的信息,在保证安全的时候可以减少计算量。本实施例通过超车合规性监测功能对目标车辆自动驾驶的超车合规性进行监测,可以准确地判断超车过程,输出结果,并且保证超车过程更加安全。输出结果的结果可以包括合规的结果或者不合规的结果。合规的结果或者不合规的结果可以通过代码的形式输出。并且,本实施例的超车合规性监测功能以及对应的触发条件与其他的合规性监测功能以及对应的触发条件是相互独立的,能够分别运行,便于维护和升级。另外,当退出触发条件后,对应的合规性监测功能也退出监测。
在本发明一个实施例中,目标车辆预设范围内所在的目标车道上存在前车通过以下方式确定:
根据目标车辆的坐标和所在道路的车道线参数确定目标车辆所在的车道;
根据目标车辆预设范围内其他车辆的坐标和所在道路的车道线参数确定其他车辆所在的车道;
根据目标车辆所在的车道和预设范围内的其他车辆所在的车道确定目标车道上存在前车;其中车道线经目标车辆坐标系下的三次拟合曲线拟合而成;
前车的速度小于目标车辆的速度通过下列方式确定:
前车的纵向速度小于目标车辆的纵向速度;
前车与目标车辆的碰撞时间小于预设的超车触发碰撞时间通过下列方式确定:
使目标车辆的纵向速度与前车的纵向速度的差值与超车触发碰撞时间相乘大于预设的超车触发距离;其中,超车触发距离为前车与目标车辆之间沿目标车辆左侧车道线的距离;
目标车辆以大于预设换道横向速度的横向速度与车道线相交通过下列方式确定:
根据目标车辆宽度方向的车身位置与车道线的位置关系确定目标车辆所相交的车道线;
将目标车辆的横向速度和预设换道横向速度进行比较,以确定目标车辆以大于预设换道横向速度的横向速度与车道线相交;
通过超车合规性监测功能判断目标车辆的换道方式是否为跨实线换道包括:
将目标车辆看作矩形,判断矩形的两个对角线是否与实线均有交点,若是,确定目标车辆的换道方式为跨实线换道;
通过超车合规性监测功能判断目标车辆与同车道前车的车距是否大于第一预设安全距离包括:
计算目标车辆的纵向速度与前车的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离;
通过超车合规性监测功能判断目标车辆与同车道左侧车道的最近前车辆的车距是否大于第一预设安全距离包括:
计算目标车辆的纵向速度与同车道左侧车道的最近前车辆的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离;
通过超车合规性监测功能判断目标车辆与同车道左侧车道的最近后车辆的车距是否大于第一预设安全距离包括:
计算目标车辆的纵向速度与同车道左侧车道的最近后车辆的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离。
具体地,对本实施例的实现方式进行详细介绍:
当合规性监测功能为超车合规性监测功能时,对应的触发信息可以包括目标车辆信息(vxEgo、vyEgo),他车(如周围车辆)信息(xTgt、yTgt、vxTgt、vyTgt、lTgt、wTgt),目标车辆行驶方向同方向的车道数Nalllane,车道线类型T(i)及车道线拟合参数[b3i,b2i,b1i,b0i],i=1,2,…Nalllane;监控信息可以包括自车(即目标车辆)信息(vxEgo、vyEgo),他车信息(xTgt、yTgt、vxTgt、vyTgt、lTgt、wTgt),同方向车道数Nalllane,车道线类型T(i)及车道线拟合参数[b3i,b2i,b1i,b0i],i=1,2,…Nalllane。
在目标车辆坐标系下,目标车辆的坐标始终为(0,0),当x=0时,计算各拟合曲线yline(i)的值,当yline(i)>0>yline(i+1)时,求得目标车辆位于第i个车道(LaneEg0=),即通过公式(2)求得目标车辆所在车道;
LaneEgo=i,yline(i)|x=0>0>yline(i+)|x=0 (2)
同理,对预设范围内任意其他车辆Tgt,当y_line(i)>yTgt>y_line(i+1)时,求得该车位于第i个车道(LaneTgt=),即通过公式(3)求得其他车辆所在车道;
根据目标车辆和其他车辆的速度和坐标可以监测“同车道存在前车,且前车速度低于目标车辆(目标车辆也就是自车)速度,前车与目标车辆的碰撞时间小于超车触发碰撞时间(TTCx_ottd)”,具体如下公式(4)至(6)所示;
其中,MfTgt为监测“同车道前车”结果,Mcvx为“纵向速度比较”结果,Mottd为监测“超车触发距离”结果。sTgt为他车与目标车辆坐标之间沿目标车辆左侧车道线的距离,该距离用公式(7)计算得到
另外,根据目标车辆宽度方向的车身位置与车道线的位置关系确定目标车辆所相交的车道线,将目标车辆的横向速度和预设换道横向速度进行比较,以确定目标车辆以大于预设换道横向速度的横向速度与车道线相交,具体如下:目标车辆的宽度(wEgo)与长度(lEgo)为固有信息,定义状态变量向左换道(cll)及向右换道(crl)分别如下公式(8)和(9)所示,通过以下公式(10)至(12)监测“目标车辆以大于预设换道横向速度(vycl)的横向速度与车道线相交”:
cll=(0.5wEgo-yline(i)|x=0.5lEgo)*(-0.5wEgo-(yline(i)|x=-0.5lEgo) (8)
crl=(-0.5wEgo-yline(i+1)|x=0.5lEgo)*(0.5wEgo-(yline(i+1)|x=-0.5lEgo) (9)
其中Mcll为监测“目标车辆向左换道”结果,1为向左换道,Mcrl为监测“目标车辆向右换道”结果,1为向右换道,Mlcvy为监测“目标车辆换道速度”结果,1为大于预设换道横向速度。最终得到的目标车辆意图超车的计算触发条件表达式如下(13)所示:
MotTC=MfTgt·Mcvx·Mottd·(Mcll+Mcrl)·Mlcvy (13)
MotTC为意图超车触发条件监测结果,若MotTC=1|t=t0,则判断t0时刻开始,目标车辆意图超车,该条例的合规性监测模块开始工作,生成“初始车道(InitiallaneEgo=laneEgo|t=t0)”及“控制变量1(control variable1)”的变量值,控制变量1默认为0,超车触发条件满足时将其置1,当其值为1时,后续超车合规性监测功能生效,开始工作。
将目标车辆看作矩形,判断矩形的两个对角线是否与实线均有交点,若是,确定目标车辆的换道方式为跨实线换道,可以通过以下公式(14)得到:
Mcsl为监测“目标车辆换道过程是否跨越实线”的结果。若Mcll·Mcsl=1,则认为目标车辆在跨越实线向左换道,若Mcrl=1则目标车辆在跨越实线向右换道,属于不合理的换道方式。
通过超车合规性监测功能判断目标车辆与同车道前车的车距是否大于第一预设安全距离可以通过以下公式(15)得到;
通过超车合规性监测功能判断目标车辆与同车道左侧车道的最近前车辆的车距是否大于第一预设安全距离可以通过以下公式(16)得到;
通过超车合规性监测功能判断目标车辆与同车道左侧车道的最近后车辆的车距是否大于第一预设安全距离可以通过以下公式(17)得到;
其中,Mdx_tgt为监测“与同车道前车保持第一预设安全距离”结果,Mdx_lf为监测“与左侧车道的最近前车辆保持第一预设安全距离”结果,Mdx_lr为监测“与左侧车道的最近后车辆保持第一预设安全距离”结果。若则道路条件满足同时监控换道应满足的交互条件(如目标车辆换道需与前车、左侧车道最近左前车、左侧车道最近左后车保持安全距离)。其中,TTCx为纵向碰撞时间,其为预先设定阈值参数,Tgt_lf=1为目标车辆左前方车道区域存在他车,Tgt_lf=0为目标车辆左前方车道区域不存在他车,Tgt_lr=1为目标车辆左后方车道区域存在他车,Tgt_lr=0为目标车辆左后方车道区域不存在他车。Tgt_lf采用以下公式(18)计算,Tgt_lr采用以下公式(19)计算:
通过超车合规性监测功能判断目标车辆的换道持续时长是否小于或等于预设最大允许换道时长(tmaxchangelane)可以通过公式(20)得到;
若Mcrl=1,则目标车辆在向右换道,则需监测目标车辆是否右侧超车。当目标车辆两条对角线与车道线没有交点时,即Mcll+Mcrl=0,若此时LaneEgo=InitiallaneEgo,目标车辆仍位于原车道,则目标车辆放弃超车,“控制变量1(control variable1)”的变量值置为0,清除“初始车道(InitiallaneEgo)”变量值;若此时LaneEgo=InitiallaneEgo-1,目标车辆进入超车道,则生成“控制变量2(control variable2)”的变量值,并将其置1,进入超车中状态判断;若此时LaneEgo=InitiallaneEgo+1,目标车辆向右换道,需监测目标车辆是否右侧超车,则生成“控制变量2(control variable2)”的变量值,并将其置2,进入右侧超车监测。控制变量2默认为0,变量值不为0时,后续对应的超车合规性监测功能生效。
在本发明一些其他实施例中,车辆自动驾驶合规性的监测方法还可包括超车中状态判断。
具体地,超车中状态判断可以包括:
超车中,目标车辆在超车道需与前方车辆保持安全距离,可以通过以下公式(21)计算,建议与右侧被超车辆保持预设的速度差,即目标车辆的速度与被超车辆的速度的差值大于预设超车速度差值(overtake_Δv),可以通过以下公式(22)计算:
其中,Mdx_f为监测“目标车辆在超车道需与前方车辆保持安全距离”结果,MΔv为监测“目标车辆的速度与被超车辆(右侧车辆)的速度的差值大于预设超车速度差值(overtake_Δv)”的结果,overtake_Δv为超车速度差,其为预先设定阈值参数。其中,Tgt_f=1为目标车辆前方车道区域存在他车,Tgt_f=0为目标车辆前方车道区域不存在他车,Tgt_r=1为目标车辆右侧车道区域存在他车,Tgt_r=0为目标车辆右侧车道区域不存在他车,Tgt_f可以用公式(23)表示,Tgt_r可以用公式(24)表示;
当目标车辆在超车道行驶时间超过超越时间(tOT)时,则认为目标车辆不再执行后续超车行为,目标车辆仅执行了向左换道,结束后续超车监测。为监测“目标车辆在执行超越动作行驶时间”的结果,用公式(25)表示,目标车辆在某一时刻t沿当前车道行驶且不变道记为:crl·cll|t>0,t∈(t2,t3),若/>则目标车辆仍在执行超车行为,继续超车后状态判断,若/>则目标车辆沿当前车道行驶且不变道时间超过超越时间,结束后续超车监测。
Mdx_f、MΔv和均为超车中状态判断需要监测的内容,若Mdx_f=1,则输出超车中“目标车辆与前车保持安全距离”满足的对应信号,否则输出相应的违规信号,若MΔv=1,则输出超车中“目标车辆与右侧车辆保持预设超车速度差值”满足的对应信号,否则输出相应的违规信号。
在目标车辆超车后,还可以进行超车后状态(回归原车道)判断。目标车辆应向右换道,即目标车辆矩形的右前左后对角线与车道线有交点(回归换道过程,不考虑是否换道成功,只要在骑线就认为在换道)。目标车辆换道需与前车、右侧车辆保持安全距离。Mdx_rf为监测“与右前方车辆保持安全距离”结果,通过公式(26)得到,Mdx_rr为监测“与右后方车辆保持安全距离”结果,通过公式(27)得到,sf_distance_return为超车安全回归距离,其为预先设定阈值参数。公式(36)Mdx_f为监测“与前方车辆保持安全距离”结果。
其中,Tgt_rf用公式(28)表示,Tgt_rf=1为目标车辆右前方车道区域存在他车,Tgt_rf=0为目标车辆右前方车道区域不存在他车,Tgt_rr用公式(29)表示,Tgt_rr=1为目标车辆左后方车道区域存在他车,Tgt_rr=0为目标车辆左后方车道区域不存在他车,Tgt_f用公式(37)表示,Tgt_f=1为目标车辆前方车道区域存在他车,Tgt_f=0为目标车辆前方车道区域不存在他车。
同时目标车辆换道持续时间不得超过最大允许换道时间(tmaxchangelane),因此需要监测“目标车辆向右换道时间”。
右侧超车监测。目标车辆向右换道后,若在右侧车道行驶时间超过超越时间(tOT),则认为目标车辆不再执行后续超车行为,目标车辆仅执行了向右换道,结束后续超车监测;若没有超过超越时间,则继续监测回归原车道时的行为,回归原车道时与左后车辆的距离应大于“非右侧超车判定距离(dno_otr)”。右侧超车监测采用公式(30)表示,Motr表示右侧超车监测结果。
监测Motr,若Motr=1,则目标车辆未违反从右侧超车,输出未从右侧超车对应信号,若Motr=0,则目标车辆从右侧超车,输出对应违规信号。
当目标车辆两条对角线与车道线没有交点时,即:Mcll+Mcrl=0时,若此时LaneEgo=InitiallaneEgo-1,目标车辆仍位于超车道,则目标车辆放弃回归原车道,重复超车中及超车后状态判断;若此时LaneEgo=InitiallaneEgo,目标车辆回归原车道,完成超车,两个控制变量(“控制变量1(control variable1)”与“控制变量2(control variable2)”)恢复默认值,清除初始车道(InitiallaneEgo)变量值,结束监测。
在本发明一个实施例中,合规性监测功能包括限速合规性监测功能;
触发条件包括:
目标车辆位于高速公路主路;
通过合规性监测功能对目标车辆自动驾驶的合规性进行监测,包括:
通过限速合规性监测功能对目标车辆自动驾驶的速度合规性进行监测。
在本实施例中,通过限速合规性监测功能对目标车辆自动驾驶的速度合规性进行监测,可以保证目标车辆在自动驾驶过程中的车速处于一个合理状态,保证自动驾驶的安全性。
在本发明一个实施例中,通过限速合规性监测功能对目标车辆自动驾驶的速度合规性进行监测包括:
当目标车辆位于限速标志范围内时,通过限速合规性监测功能判断目标车辆的速度是否属于限速标志范围,若是,则合规;
当目标车辆位于限速标志范围外,且与目标车辆同方向的主车道数大于或等于2时,通过限速合规性监测功能判断目标车辆的速度是否属于其所在目标车道规定的速度范围,若是,则合规。
在本实施例中,考虑到道路不同的范围可能对速度的要求不同,本实施例对道路进行了进一步的划分,将道路划分为了多种不同的情况,根据不同的情况对目标车辆自动驾驶的速度合规性进行监测,可以提高监测的合理性和准确性。
具体地,触发信息可包括目标车辆信息(XEgo、YEgo、vxEgo、θEgo),限速标志纵坐标位置Xsl_sign、限速标志横坐标位置Ysl_sign以及解除限速标志纵坐标位置Xrsl_sign、解除限速标志横坐标位置Yrsl_sign,以及同方向主车道数Nmainway、目标车辆所在道路类别LTEgo,车道线类型T(i)及车道线拟合参数[b3i,b2i,b1i,b0i],i=1,2,…Nallane。
监控信息可包括目标车辆信息(XEgo、YEgo、vxEgo、θEgo),限速标志纵坐标位置Xsl_sign、限速标志横坐标位置Ysl_sign以及解除限速标志纵坐标位置Xrsl_sign、解除限速标志横坐标位置Yrsl_sign,限速标志限制的速度上限Vsign_max及速度下限Vsign_min,以及同方向主车道数Nmainway,车道线类型T(i)及车道线拟合参数[b3i,b2i,b1i,b0i],i=1,2,…Nallane。
在确定目标车辆是否位于限速标志范围内时,通过公式(31)将限速标志坐标及解除限速标志坐标从全局坐标系转换到目标车辆坐标系:
得到目标车辆坐标系下限速标志纵坐标位置xsl_sign、限速标志横坐标位置ysl_sign以及解除限速标志纵坐标位置xrel_sign、解除限速标志横坐标位置yrel_sign,无限速标志或解除限速标志时,其在目标车辆坐标系下的值为∞。
其中,Msl1为监测“目标车辆位于限速标志范围内的速度是否合规”的结果,Msl2为监测“目标车辆位于无限速标志管理、同方向主车道数为2的区域内的速度是否合规”的结果,Msl3为监测“目标车辆位于无限速标志管理、同方向主车道数大于2的区域内的速度是否合规”的结果。综上,可以通过以下公式(34)Msl为监测的结果,若其值为1,则输出目标车辆速度合规的对应信号,否则,输出目标车辆速度不合规的违规信息。
Msl=Msl1+Msl2+Msl3 公式(34)
在本发明一个实施例中,合规性监测功能包括车距限制合规性监测功能;
触发条件包括:
目标车辆位于高速公路主路;
通过合规性监测功能对目标车辆自动驾驶的合规性进行监测,包括:
通过车距限制合规性监测功能对目标车辆自动驾驶的车距合规性进行监测。在本实施例中,通过车距限制合规性监测功能对目标车辆自动驾驶的车距合规性进行监测,可以提高目标车辆自动驾驶的安全性。
在本发明一个实施例中,通过车距限制合规性监测功能对目标车辆自动驾驶的车距合规性进行监测包括:
通过车距限制合规性监测功能判断目标车辆的速度是否大于第一预设速度,且目标车辆与同车道的最近其他车辆的距离是否大于第二预设安全距离,若是,则合规;或
通过车距限制合规性监测功能判断目标车辆的速度是否小于或等于第一预设速度,且目标车辆与同车道的最近其他车辆的距离是否大于第三预设安全距离,若是,则合规;
其中,第二预设安全距离大于第三预设安全距离。
在本实施例中,考虑到不同的车速对安全距离的要求不同,通过车距限制合规性监测功能判断目标车辆的速度是否大于第一预设速度,且目标车辆与同车道的最近其他车辆的距离是否大于第二预设安全距离;或通过车距限制合规性监测功能判断目标车辆的速度是否小于或等于第一预设速度,且目标车辆与同车道的最近其他车辆的距离是否大于第三预设安全距离,实现了车距和车速两者之间的相互调整,使安全距离能够随车速动态变化,可以保证目标车辆自动驾驶的安全性,并且能够使目标车辆的速度根据安全距离进行最大化调整,提高行驶效率。
触发信息包括目标车辆速度vxEgo,他车信息(xTgt、yTgt),车道线拟合参数[b3i,b2i,b1i,b0i],i=1,2,…Nalllane。该条例的监测模块从CAN总线读取该条例所需的信息。
监测信息包括目标车辆速度vxEgo,他车信息(xTgt、yTgt),车道线拟合参数[b3i,b2i,b1i,b0i],i=1,2,…Nallane。通过车距限制合规性监测功能对目标车辆自动驾驶的车距合规性进行监测可通过以下公式(35)得到:
Mdl为监测的结果,若其值为1,则输出目标车辆距离合规的对应信号,否则,输出目标车辆距离不合规的违规信息。
在本发明一个实施例中,合规性监测功能包括换道合规性监测功能;
触发条件包括:
目标车辆以大于预设换道横向速度的横向速度与车道线相交;
通过合规性监测功能对目标车辆自动驾驶的合规性进行监测包括下列至少之一:
通过换道合规性监测功能判断目标车辆的换道方式是否为跨实线换道,若是,则非合规;
通过换道合规性监测功能判断目标车辆的换道持续时长是否小于或等于预设最大允许换道时长,若是,则合规;
当目标车辆向左换道时,通过换道合规性监测功能判断目标车辆与同车道的前车以及左侧车道的最近其他车辆的距离是否分别小于第四预设安全距离,若是,则合规;或当目标车辆向右换道时,通过换道合规性监测功能判断目标车辆与同车道的前车以及右侧车道的最近其他车辆的距离是否分别小于第四预设安全距离,若是,则合规。
在本实施例中,为了减少或避免目标车辆换道过程中出现事故的概率以及换道的正确性,通过上述换道合规性监测功能对换道的合规性进行监测。
具体地,触发信息可以包括目标车辆信息(vxEgo、vyEgo),他车信息(xTgt、yTgt、vxTgt、vyTgt、lTgt、wTgt),同方向车道数Nallane,车道线类型T(i)及车道线拟合参数[b3i,b2i,b1i,b0i],i=1,2,…Nallane。换道合规性监测功能中,触发条件的确定以及各个合规性监测的具体实现方式都可以参照上述实施例中超车合规性监测功能对应的方式,这里不再一一赘述。
图2是本发明另一个实施例提供的车辆自动驾驶合规性的监测方法的流程图;在本发明一个具体实施例中,车辆自动驾驶合规性的监测方法可包括:
步骤S202:获取目标车辆自动驾驶过程中所在的场景信息。
步骤S204:从场景信息中获取目标车辆自动驾驶过程中合规性监测功能对应的触发信息。
步骤S206:判断触发信息是否满足预设的触发条件。
若是,执行步骤S208;若否,返回步骤S206;
执行步骤S208:通过合规性监测功能从场景信息中获取对应的监控信息。
步骤S210:根据监控信息判断目标车辆自动驾驶是否合规。
若是,执行步骤S212;若否,执行步骤S214。
步骤S212:输出合规信息。
步骤S214:输出违规信息。
步骤S216:判断是否满足合规性监测功能的退出条件。
若是,执行步骤S218,若否,返回步骤S208。
步骤S218:退出合规性监测功能的监测。
图3是本发明一个实施例提供的车辆自动驾驶合规性的监测系统800的结构示意图;图4是本发明另一个实施例提供的车辆自动驾驶合规性的监测系统800的结构示意图。基于同一构思,本发明还提供了一种车辆自动驾驶合规性的监测系统800。监测系统800可包括场景获取模块801、监测触发条件模块802以及合规性监测功能模块803。场景获取模块801用于获取目标车辆自动驾驶过程中所在的场景信息。监测触发条件模块802用于从场景信息中获取目标车辆自动驾驶过程中合规性监测功能对应的触发信息,并判断触发信息是否满足预设的触发条件。若是,合规性监测功能模块803用于从场景信息中获取对应的监控信息对目标车辆自动驾驶的合规性进行监测。
在本实施例中,场景获取模块801可以包括高精地图获取模块、摄像头、雷达以及车辆上的各种传感器等。场景获取模块801通过CAN总线分别与监测触发条件模块802和合规性监测功能模块803信号连接。场景获取模块801可以将场景信息发送至CAN总线。监测触发条件模块802和合规性监测功能模块803分别可以从CAN总线获取对应的触发信息和对应的监控信息对目标车辆自动驾驶的合规性进行监测。
在本发明一个实施例中,合规性监测功能模块包括超车合规性监测功能模块8031;监测触发条件模块802包括超车触发条件模块8021。
超车触发条件模块8021对应的触发条件包括:
目标车辆预设范围内所在的目标车道上存在前车以及下列至少之一;
前车的速度小于目标车辆的速度;
前车与目标车辆的碰撞时间小于预设的超车触发碰撞时间;
目标车辆以大于预设换道横向速度的横向速度与车道线相交;
其中,前车表示目标车辆前方至目标车辆距离最小的车辆。
超车合规性监测功能模块8031具有超车合规性监测功能,用于实现下列至少之一:
通过超车合规性监测功能判断目标车辆的换道方式是否为跨实线换道,若是,则非合规;
通过超车合规性监测功能判断目标车辆与同车道前车的车距是否大于第一预设安全距离,若是,则合规;
通过超车合规性监测功能判断目标车辆与同车道左侧车道的最近前车辆的车距是否大于第一预设安全距离,若是,则合规;
通过超车合规性监测功能判断目标车辆与同车道左侧车道的最近后车辆的车距是否大于第一预设安全距离,若是,则合规;
通过超车合规性监测功能判断目标车辆的换道持续时长是否小于或等于预设最大允许换道时长,若是,则合规;
通过超车合规性监测功能判断目标车辆的速度与被超车辆的速度的差值是否大于预设超车速度差值,若是,则合规。
在本发明一个实施例中,目标车辆预设范围内所在的目标车道上存在前车通过以下方式确定:
根据目标车辆的坐标和所在道路的车道线参数确定目标车辆所在的车道;
根据目标车辆预设范围内其他车辆的坐标和所在道路的车道线参数确定其他车辆所在的车道;
根据目标车辆所在的车道和预设范围内的其他车辆所在的车道确定目标车道上存在前车;其中车道线经目标车辆坐标系下的三次拟合曲线拟合而成;
前车的速度小于目标车辆的速度通过下列方式确定:
前车的纵向速度小于目标车辆的纵向速度;
前车与目标车辆的碰撞时间小于预设的超车触发碰撞时间通过下列方式确定:
使目标车辆的纵向速度与前车的纵向速度的差值与超车触发碰撞时间相乘大于预设的超车触发距离;其中,超车触发距离为前车与目标车辆之间沿目标车辆左侧车道线的距离;
目标车辆以大于预设换道横向速度的横向速度与车道线相交通过下列方式确定:
根据目标车辆宽度方向的车身位置与车道线的位置关系确定目标车辆所相交的车道线;
将目标车辆的横向速度和预设换道横向速度进行比较,以确定目标车辆以大于预设换道横向速度的横向速度与车道线相交;
通过超车合规性监测功能判断目标车辆的换道方式是否为跨实线换道包括:
将目标车辆看作矩形,判断矩形的两个对角线是否与实线均有交点,若是,确定目标车辆的换道方式为跨实线换道;
通过超车合规性监测功能判断目标车辆与同车道前车的车距是否大于第一预设安全距离包括:
计算目标车辆的纵向速度与前车的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离;
通过超车合规性监测功能判断目标车辆与同车道左侧车道的最近前车辆的车距是否大于第一预设安全距离包括:
计算目标车辆的纵向速度与同车道左侧车道的最近前车辆的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离;
通过超车合规性监测功能判断目标车辆与同车道左侧车道的最近后车辆的车距是否大于第一预设安全距离包括:
计算目标车辆的纵向速度与同车道左侧车道的最近后车辆的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离。
在本发明一个实施例中,合规性监测功能模块包括限速合规性监测功能模块8032。监测触发条件模块802包括限速触发条件模块8022。
限速触发条件模块8022的触发条件包括:
目标车辆位于高速公路主路。
限速合规性监测功能模块8032具有限速合规性监测功能,用于通过限速合规性监测功能对目标车辆自动驾驶的速度合规性进行监测。
在本发明一个实施例中,通过限速合规性监测功能对目标车辆自动驾驶的速度合规性进行监测包括:
当目标车辆位于限速标志范围内时,通过限速合规性监测功能判断目标车辆的速度是否属于限速标志范围,若是,则合规;
当目标车辆位于限速标志范围外,且与目标车辆同方向的主车道数大于或等于2时,通过限速合规性监测功能判断目标车辆的速度是否属于其所在目标车道规定的速度范围,若是,则合规。
在本发明一个实施例中,合规性监测功能模块包括车距限制合规性监测功能模块8033。监测触发条件模块802包括车距触发条件模块8023。
车距触发条件模块8023的触发条件包括:目标车辆位于高速公路主路。
车距限制合规性监测功能模块8033具有车距限制合规性监测功能,用于通过车距限制合规性监测功能对目标车辆自动驾驶的车距合规性进行监测。
在本发明一个实施例中,通过车距限制合规性监测功能对目标车辆自动驾驶的车距合规性进行监测包括:
通过车距限制合规性监测功能判断目标车辆的速度是否大于第一预设速度,且目标车辆与同车道的最近其他车辆的距离是否大于第二预设安全距离,若是,则合规;或
通过车距限制合规性监测功能判断目标车辆的速度是否小于或等于第一预设速度,且目标车辆与同车道的最近其他车辆的距离是否大于第三预设安全距离,若是,则合规;
其中,第二预设安全距离大于第三预设安全距离。
在本发明一个实施例中,合规性监测功能模块包括换道合规性监测功能模块8034。监测触发条件模块802包括换道触发条件模块8024。
换道触发条件模块8024的触发条件包括:
目标车辆以大于预设换道横向速度的横向速度与车道线相交。
换道合规性监测功能模块8034具有换道合规性监测功能,用于实现下列至少之一:
通过换道合规性监测功能判断目标车辆的换道方式是否为跨实线换道,若是,则非合规;
通过换道合规性监测功能判断目标车辆的换道持续时长是否小于或等于预设最大允许换道时长,若是,则合规;
当目标车辆向左换道时,通过换道合规性监测功能判断目标车辆与同车道的前车以及左侧车道的最近其他车辆的距离是否分别小于第四预设安全距离,若是,则合规;或当目标车辆向右换道时,通过换道合规性监测功能判断目标车辆与同车道的前车以及右侧车道的最近其他车辆的距离是否分别小于第四预设安全距离,若是,则合规。
基于同一构思,本发明还提供了一种机器可读存储介质,其上存储有机器可执行程序,所述机器可执行程序被处理器执行时实现根据上述任一项实施例所述的车辆自动驾驶合规性的监测方法。
以上,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。
可以理解的是,上述各实施例中相同或相似部分可以相互参考,在一些实施例中未详细说明的内容可以参见其他实施例中相同或相似的内容。
需要说明的是,在本发明的描述中,术语“第一”、“第二”等仅用于描述目的,而不能理解为指示或暗示相对重要性。此外,在本发明的描述中,除非另有说明,“多个”的含义是指至少两个。
流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为,表示包括一个或更多个用于实现特定逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分,并且本发明的优选实施方式的范围包括另外的实现,其中可以不按所示出或讨论的顺序,包括根据所涉及的功能按基本同时的方式或按相反的顺序,来执行功能,这应被本发明的实施例所属技术领域的技术人员所理解。
应当理解,本发明的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中,多个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来实现。例如,如果用硬件来实现,和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来实现:具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。
本技术领域的普通技术人员可以理解实现上述实施例方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成,的程序可以存储于一种计算机可读存储介质中,该程序在执行时,包括方法实施例的步骤之一或其组合。
此外,在本发明各个实施例中的各功能单元可以集成在一个处理模块中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时,也可以存储在一个计算机可读取存储介质中。
上述提到的存储介质可以是只读存储器,磁盘或光盘等。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (10)
1.一种车辆自动驾驶合规性的监测方法,其特征在于,包括:
获取目标车辆自动驾驶过程中所在的场景信息;
从所述场景信息中获取所述目标车辆自动驾驶过程中合规性监测功能对应的触发信息,并判断所述触发信息是否满足预设的触发条件;
若是,通过所述合规性监测功能从所述场景信息中获取对应的监控信息对所述目标车辆自动驾驶的合规性进行监测。
2.根据权利要求1所述的车辆自动驾驶合规性的监测方法,其特征在于,
所述合规性监测功能包括超车合规性监测功能;
所述触发条件包括:
所述目标车辆预设范围内所在的目标车道上存在前车以及下列至少之一;
所述前车的速度小于所述目标车辆的速度;
所述前车与所述目标车辆的碰撞时间小于预设的超车触发碰撞时间;
所述目标车辆以大于预设换道横向速度的横向速度与车道线相交;
其中,所述前车表示所述目标车辆前方至所述目标车辆距离最小的车辆;
通过所述合规性监测功能对所述目标车辆自动驾驶的合规性进行监测包括下列至少之一:
通过所述超车合规性监测功能判断所述目标车辆的换道方式是否为跨实线换道,若是,则非合规;
通过所述超车合规性监测功能判断所述目标车辆与同车道前车的车距是否大于第一预设安全距离,若是,则合规;
通过所述超车合规性监测功能判断所述目标车辆与同车道左侧车道的最近前车辆的车距是否大于第一预设安全距离,若是,则合规;
通过所述超车合规性监测功能判断所述目标车辆与同车道左侧车道的最近后车辆的车距是否大于第一预设安全距离,若是,则合规;
通过所述超车合规性监测功能判断所述目标车辆的换道持续时长是否小于或等于预设最大允许换道时长,若是,则合规;
通过所述超车合规性监测功能判断所述目标车辆的速度与被超车辆的速度的差值是否大于预设超车速度差值,若是,则合规。
3.根据权利要求2所述的车辆自动驾驶合规性的监测方法,其特征在于,
所述目标车辆预设范围内所在的目标车道上存在前车通过以下方式确定:
根据目标车辆的坐标和所在道路的车道线参数确定所述目标车辆所在的车道;
根据目标车辆预设范围内其他车辆的坐标和所在道路的车道线参数确定所述其他车辆所在的车道;
根据所述目标车辆所在的车道和预设范围内的其他车辆所在的车道确定目标车道上存在前车;其中车道线经目标车辆坐标系下的三次拟合曲线拟合而成;
所述前车的速度小于所述目标车辆的速度通过下列方式确定:
所述前车的纵向速度小于所述目标车辆的纵向速度;
所述前车与所述目标车辆的碰撞时间小于预设的超车触发碰撞时间通过下列方式确定:
使目标车辆的纵向速度与前车的纵向速度的差值与超车触发碰撞时间相乘大于预设的超车触发距离;其中,所述超车触发距离为前车与目标车辆之间沿目标车辆左侧车道线的距离;
所述目标车辆以大于预设换道横向速度的横向速度与车道线相交通过下列方式确定:
根据所述目标车辆宽度方向的车身位置与车道线的位置关系确定所述目标车辆所相交的车道线;
将所述目标车辆的横向速度和预设换道横向速度进行比较,以确定所述目标车辆以大于预设换道横向速度的横向速度与车道线相交;
通过所述超车合规性监测功能判断所述目标车辆的换道方式是否为跨实线换道包括:
将所述目标车辆看作矩形,判断矩形的两个对角线是否与实线均有交点,若是,确定所述目标车辆的换道方式为跨实线换道;
通过所述超车合规性监测功能判断所述目标车辆与同车道前车的车距是否大于第一预设安全距离包括:
计算所述目标车辆的纵向速度与所述前车的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离;
通过所述超车合规性监测功能判断所述目标车辆与同车道左侧车道的最近前车辆的车距是否大于第一预设安全距离包括:
计算所述目标车辆的纵向速度与同车道左侧车道的最近前车辆的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离;
通过所述超车合规性监测功能判断所述目标车辆与同车道左侧车道的最近后车辆的车距是否大于第一预设安全距离包括:
计算所述目标车辆的纵向速度与同车道左侧车道的最近后车辆的纵向速度的差值,并乘以预设纵向碰撞时间,得到该车距,判断该车距是否大于第一预设安全距离。
4.根据权利要求1所述的车辆自动驾驶合规性的监测方法,其特征在于,
所述合规性监测功能包括限速合规性监测功能;
所述触发条件包括:
所述目标车辆位于高速公路主路;
通过所述合规性监测功能对所述目标车辆自动驾驶的合规性进行监测,包括:
通过所述限速合规性监测功能对所述目标车辆自动驾驶的速度合规性进行监测。
5.根据权利要求4所述的车辆自动驾驶合规性的监测方法,其特征在于,
通过所述限速合规性监测功能对所述目标车辆自动驾驶的速度合规性进行监测包括:
当所述目标车辆位于限速标志范围内时,通过所述限速合规性监测功能判断所述目标车辆的速度是否属于限速标志范围,若是,则合规;
当所述目标车辆位于限速标志范围外,且与所述目标车辆同方向的主车道数大于或等于2时,通过所述限速合规性监测功能判断所述目标车辆的速度是否属于其所在目标车道规定的速度范围,若是,则合规。
6.根据权利要求1所述的车辆自动驾驶合规性的监测方法,其特征在于,
所述合规性监测功能包括车距限制合规性监测功能;
所述触发条件包括:
所述目标车辆位于高速公路主路;
通过所述合规性监测功能对所述目标车辆自动驾驶的合规性进行监测,包括:
通过所述车距限制合规性监测功能对所述目标车辆自动驾驶的车距合规性进行监测。
7.根据权利要求6所述的车辆自动驾驶合规性的监测方法,其特征在于,
通过所述车距限制合规性监测功能对所述目标车辆自动驾驶的车距合规性进行监测包括:
通过所述车距限制合规性监测功能判断所述目标车辆的速度是否大于第一预设速度,且所述目标车辆与同车道的最近其他车辆的距离是否大于第二预设安全距离,若是,则合规;或
通过所述车距限制合规性监测功能判断所述目标车辆的速度是否小于或等于所述第一预设速度,且所述目标车辆与同车道的最近其他车辆的距离是否大于第三预设安全距离,若是,则合规;
其中,所述第二预设安全距离大于所述第三预设安全距离。
8.根据权利要求1所述的车辆自动驾驶合规性的监测方法,其特征在于,
所述合规性监测功能包括换道合规性监测功能;
所述触发条件包括:
所述目标车辆以大于预设换道横向速度的横向速度与车道线相交;
通过所述合规性监测功能对所述目标车辆自动驾驶的合规性进行监测包括下列至少之一:
通过所述换道合规性监测功能判断所述目标车辆的换道方式是否为跨实线换道,若是,则非合规;
通过所述换道合规性监测功能判断所述目标车辆的换道持续时长是否小于或等于预设最大允许换道时长,若是,则合规;
当所述目标车辆向左换道时,通过所述换道合规性监测功能判断所述目标车辆与同车道的前车以及左侧车道的最近其他车辆的距离是否分别小于第四预设安全距离,若是,则合规;或当所述目标车辆向右换道时,通过所述换道合规性监测功能判断所述目标车辆与同车道的前车以及右侧车道的最近其他车辆的距离是否分别小于第四预设安全距离,若是,则合规。
9.一种车辆自动驾驶合规性的监测系统,其特征在于,包括:
场景获取模块,用于获取目标车辆自动驾驶过程中所在的场景信息;
监测触发条件模块,用于从所述场景信息中获取所述目标车辆自动驾驶过程中合规性监测功能对应的触发信息,并判断所述触发信息是否满足预设的触发条件;
若是,合规性监测功能模块,用于从所述场景信息中获取对应的监控信息对所述目标车辆自动驾驶的合规性进行监测。
10.一种机器可读存储介质,其上存储有机器可执行程序,所述机器可执行程序被处理器执行时实现根据权利要求1至8任一项所述的车辆自动驾驶合规性的监测方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310446883.8A CN116373890B (zh) | 2023-04-24 | 2023-04-24 | 车辆自动驾驶合规性的监测方法、监测系统和存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310446883.8A CN116373890B (zh) | 2023-04-24 | 2023-04-24 | 车辆自动驾驶合规性的监测方法、监测系统和存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116373890A true CN116373890A (zh) | 2023-07-04 |
CN116373890B CN116373890B (zh) | 2024-06-25 |
Family
ID=86980684
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310446883.8A Active CN116373890B (zh) | 2023-04-24 | 2023-04-24 | 车辆自动驾驶合规性的监测方法、监测系统和存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116373890B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116935698A (zh) * | 2023-08-09 | 2023-10-24 | 苏州大学 | 一种基于可见光通信的车辆换道意图交互方法和系统 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102013019424A1 (de) * | 2013-11-20 | 2015-05-21 | Audi Ag | Verfahren zum Betrieb eines Fahrzeugsystems zur Überwachung eines Fahrers und Kraftfahrzeug |
US20180141564A1 (en) * | 2016-07-05 | 2018-05-24 | Uber Technologies, Inc. | Autonomous vehicle performance optimization system |
CN108594812A (zh) * | 2018-04-16 | 2018-09-28 | 电子科技大学 | 一种结构化道路的智能车辆平滑轨迹规划方法 |
JP2018180810A (ja) * | 2017-04-10 | 2018-11-15 | パナソニック インテレクチュアル プロパティ コーポレーション オブ アメリカPanasonic Intellectual Property Corporation of America | 交通違反検知装置、システム、交通違反検知方法およびプログラム |
JP2019018852A (ja) * | 2018-10-30 | 2019-02-07 | みこらった株式会社 | 自動運転車及び自動運転車用プログラム |
KR20190057475A (ko) * | 2017-11-20 | 2019-05-29 | 주식회사 에스더블유엠 | 자율주행 차량 주행 제어방법 및 장치 |
CN113071505A (zh) * | 2021-04-16 | 2021-07-06 | 阿波罗智联(北京)科技有限公司 | 驾驶行为习惯的确定、车辆行驶控制方法、装置及设备 |
CN113963531A (zh) * | 2021-09-07 | 2022-01-21 | 北京动视元科技有限公司 | 用于行驶车辆保持安全车距的检测方法及其显示方式 |
CN115339450A (zh) * | 2022-08-31 | 2022-11-15 | 重庆长安汽车股份有限公司 | 一种自动驾驶车辆换道安全级别打分方法、系统及介质 |
CN115402313A (zh) * | 2022-08-31 | 2022-11-29 | 武汉路特斯科技有限公司 | 自动驾驶车辆控制方法、装置、设备及存储介质 |
CN115402312A (zh) * | 2022-09-27 | 2022-11-29 | 中兴智能汽车有限公司 | 自动驾驶车辆限速装置和方法 |
CN115440023A (zh) * | 2021-06-04 | 2022-12-06 | 华为技术有限公司 | 交通违规行为的判定方法和装置 |
CN115662118A (zh) * | 2022-10-18 | 2023-01-31 | 中国科学院软件研究所 | 面向自动驾驶测试的交规合规性自动化判定方法及装置 |
-
2023
- 2023-04-24 CN CN202310446883.8A patent/CN116373890B/zh active Active
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102013019424A1 (de) * | 2013-11-20 | 2015-05-21 | Audi Ag | Verfahren zum Betrieb eines Fahrzeugsystems zur Überwachung eines Fahrers und Kraftfahrzeug |
US20180141564A1 (en) * | 2016-07-05 | 2018-05-24 | Uber Technologies, Inc. | Autonomous vehicle performance optimization system |
JP2018180810A (ja) * | 2017-04-10 | 2018-11-15 | パナソニック インテレクチュアル プロパティ コーポレーション オブ アメリカPanasonic Intellectual Property Corporation of America | 交通違反検知装置、システム、交通違反検知方法およびプログラム |
KR20190057475A (ko) * | 2017-11-20 | 2019-05-29 | 주식회사 에스더블유엠 | 자율주행 차량 주행 제어방법 및 장치 |
CN108594812A (zh) * | 2018-04-16 | 2018-09-28 | 电子科技大学 | 一种结构化道路的智能车辆平滑轨迹规划方法 |
JP2019018852A (ja) * | 2018-10-30 | 2019-02-07 | みこらった株式会社 | 自動運転車及び自動運転車用プログラム |
CN113071505A (zh) * | 2021-04-16 | 2021-07-06 | 阿波罗智联(北京)科技有限公司 | 驾驶行为习惯的确定、车辆行驶控制方法、装置及设备 |
CN115440023A (zh) * | 2021-06-04 | 2022-12-06 | 华为技术有限公司 | 交通违规行为的判定方法和装置 |
CN113963531A (zh) * | 2021-09-07 | 2022-01-21 | 北京动视元科技有限公司 | 用于行驶车辆保持安全车距的检测方法及其显示方式 |
CN115339450A (zh) * | 2022-08-31 | 2022-11-15 | 重庆长安汽车股份有限公司 | 一种自动驾驶车辆换道安全级别打分方法、系统及介质 |
CN115402313A (zh) * | 2022-08-31 | 2022-11-29 | 武汉路特斯科技有限公司 | 自动驾驶车辆控制方法、装置、设备及存储介质 |
CN115402312A (zh) * | 2022-09-27 | 2022-11-29 | 中兴智能汽车有限公司 | 自动驾驶车辆限速装置和方法 |
CN115662118A (zh) * | 2022-10-18 | 2023-01-31 | 中国科学院软件研究所 | 面向自动驾驶测试的交规合规性自动化判定方法及装置 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116935698A (zh) * | 2023-08-09 | 2023-10-24 | 苏州大学 | 一种基于可见光通信的车辆换道意图交互方法和系统 |
Also Published As
Publication number | Publication date |
---|---|
CN116373890B (zh) | 2024-06-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11532167B2 (en) | State machine for obstacle avoidance | |
US11186275B2 (en) | Vehicle control system | |
US10322720B2 (en) | Vehicle control device including object detection, speed distribution area setting and avoidance control execution sections | |
US11427191B2 (en) | Obstacle avoidance action | |
US20210188356A1 (en) | Vehicle control device | |
US20210009115A1 (en) | Vehicle control device | |
US20210188258A1 (en) | Vehicle control device | |
JP6296162B2 (ja) | 車両の走行制御装置及び方法 | |
US20200317192A1 (en) | Vehicle control device | |
US11396293B2 (en) | Driving support control device | |
US20210188262A1 (en) | Vehicle control device | |
US20200094829A1 (en) | Driving support control device | |
JP6327708B2 (ja) | 車両の運転支援装置 | |
EP3715791A1 (en) | Vehicle driving support system, method, computer-program product, and vehicle | |
DE112020005298T5 (de) | Fahrzeugsteuersystem und fahrzeugsteuerverfahren | |
CN112389466A (zh) | 车辆自动避让方法、装置、设备及存储介质 | |
JP2016084038A (ja) | 車両の走行制御装置 | |
EP3738849A1 (en) | Vehicle control device | |
JP6412346B2 (ja) | 車両の運転支援装置 | |
CN109843679B (zh) | 车辆控制装置 | |
US11608062B2 (en) | Vehicle control method and vehicle control device | |
US11180141B2 (en) | Vehicle control system | |
JP2021028210A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
WO2021086781A1 (en) | Obstacle avoidance action | |
CN116373890B (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 |