CN114655214A - 一种驶经汇流口的分段控制方法和控制系统 - Google Patents
一种驶经汇流口的分段控制方法和控制系统 Download PDFInfo
- Publication number
- CN114655214A CN114655214A CN202210460577.5A CN202210460577A CN114655214A CN 114655214 A CN114655214 A CN 114655214A CN 202210460577 A CN202210460577 A CN 202210460577A CN 114655214 A CN114655214 A CN 114655214A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- lane
- confluence
- vehicles
- convergence
- 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
- 238000000034 method Methods 0.000 title claims abstract description 23
- 238000011217 control strategy Methods 0.000 claims abstract description 45
- 230000004927 fusion Effects 0.000 claims abstract description 8
- 230000001149 cognitive effect Effects 0.000 claims abstract description 6
- 230000000007 visual effect Effects 0.000 claims description 8
- 238000001514 detection method Methods 0.000 claims description 5
- 230000019771 cognition Effects 0.000 claims description 4
- 238000012216 screening Methods 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000002452 interceptive effect Effects 0.000 claims description 3
- 230000003993 interaction Effects 0.000 abstract description 4
- 230000009471 action Effects 0.000 abstract description 3
- 230000008859 change Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000002708 enhancing effect Effects 0.000 description 2
- 238000002955 isolation Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000012795 verification 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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/802—Longitudinal distance
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/803—Relative lateral speed
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/804—Relative longitudinal speed
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种驶经汇流口的分段控制方法和控制系统,控制系统包括地图、传感器、控制器和执行器;所述地图用于提供汇流区域信息以及本车所在车道信息;所述传感器用于检测车辆周边的道路和环境信息;所述控制器包括认知模块、目标融合模块、规划决策模块和控制模块。本发明基于当前低成本组合辅助驾驶系统方案,根据本车所处车道位置、是否处于跟车巡航状态、汇入车道是否有车辆、汇入车道车辆的相对纵向位置和相对车速、汇入车道车辆所处汇入车道的纵向位置以及汇入车辆的换道动作等来修订车辆驶经汇流口的纵向控制策略、HMI交互策略,从而实现在结构化道路上安全、舒适地通过汇流区域,同时还降低了人为介入的概率。
Description
技术领域
本发明属于自动驾驶技术领域,具体涉及一种驶经汇流口的分段控制方法和控制系统。
背景技术
随着全球自动驾驶技术的飞速发展,隶属于L2驾驶自动化的组合辅助驾驶系统已日益普及。但缺乏V2X、激光雷达、高精地图和高算力控制器的低成本的组合辅助驾驶系统仍存在较多受限场景,行驶至该受限场景时,仍需驾驶员提前主动介入,特别是在体验感更佳的结构化道路上驶经汇流路口时,仍按照常规的巡航逻辑进行控制,会极大降低用户的安全感和驾驶体验。
现有技术中,如CN111127908A提供了一种用于车辆汇流的自动驾驶控制方法,判断本车在处于汇流区域并且即将通过道路的出口或者入口的情况下,计算本车与其他车辆的相对位置、车速等参数,并计算本车保持当前车速的情况下是否会与其他车辆相撞,并基于计算结果来采取相应的措施,使车辆能够安全地通过该汇流区域。但当目标车道车辆被护栏等遮挡时,本车并无法提前检测该车辆并计算碰撞风险,且该专利默认汇流车道车辆具备优先通行权,而实际上并非所有辅路车辆都会减速让行。
再如CN111192468A定义了本车要进入分流或汇流目标车道时,在过渡车道内的加、减速逻辑,同时也结合V2X、激光雷达等检测目标车道障碍物的碰撞风险,规划最优换道轨迹,实现安全、平稳的进入分流或汇流目标车道。但该专利基于当前不太成熟的V2X、成本较高的激光雷达等,是当下低成本的组合辅助驾驶系统无法实现的。
发明内容
针对现有技术的上述不足,本发明要解决的技术问题是提供一种驶经汇流口的分段控制方法和控制系统,解决了基于当前低成本组合辅助驾驶系统方案,车辆驶经汇流口时的纵向控制策略需要优化、人为介入的概率需要降低的问题,取得确保系统控制的延续性、增强系统使用时的体验感的效果。
为解决上述技术问题,本发明采用如下技术方案:
一种驶经汇流口的分段控制方法,包括以下步骤:
判断本车是否处于汇流车道以及是否处于汇流区域,同时对汇入车道车辆和前方跟车车辆进行车辆检测;
获取本车、前方跟车车辆以及汇入车道车辆的汇流区域信息来预测汇入车辆汇流行为的可能性;
根据本车的汇流区域信息、汇入车辆汇流行为的可能性以及车辆检测所得的相关信息来调整本车的控制策略。
进一步完善上述技术方案,所述汇流区域信息包括:本车和前方跟车车辆所处的汇流区域位置、汇入车道车辆所处的汇流区域位置;
汇入车道和本车所在车道的汇流区域包括初段汇流区域、中段汇流区域和终段汇流区域;
本车的汇流区域信息还包括本车距离汇流路口起点的距离、距离汇流点的距离和距离汇流路口终点的距离。
进一步地,获取本车的汇流区域信息以及本车所处车道信息来判断本车是否处于汇流区域以及是否处于汇流车道;
车辆检测时,根据前方跟车车辆的横向位置、本车所在车道的车道线曲率筛选出汇入车道车辆、前方跟车车辆,并输出对应的相对横纵向距离、相对横纵向速度。
进一步地,根据本车所处汇流区域的位置、前方跟车车辆以及本车所处汇流区域的位置并结合汇流车道车辆与汇入车道车辆的相对纵向距离和纵向TTC来预测汇入车辆汇流行为的可能性;所述汇流车道车辆包括本车与前方跟车车辆,汇入车辆汇流行为的可能性包括高、较高、中、较低或低;
结合汇流车道车辆与汇入车道车辆的相对纵向距离预测的汇入车辆汇流行为可能性为第一可能性;
结合汇流车道车辆与汇入车道车辆的纵向TTC预测的汇入车辆汇流行为可能性为第二可能性;
将第一可能性与第二可能性相比较并选取较高的可能性作为最终的汇入车辆汇流行为的可能性Conf并输出。
进一步地,定义所述汇入车辆汇流行为的可能性和汇入车辆汇流行为的可能性Conf:
大于85%为高;65%-85%为较高;45%-65%为中;25%-45%为较低;小于25%为低。
进一步地,根据本车所处的汇流区域位置、汇入车辆汇流行为的可能性Conf并结合本车分别与前方跟车车辆、汇入车道车辆的相对横纵向距离及相对横纵向速度来调整本车的控制策略;
调整本车的控制策略包括:
若本车不处于汇流车道,则维持原巡航控制策略;
若本车处于汇流车道,且前方有跟车车辆时,根据本车所处的汇流区域位置来调整控制策略;
若本车处于汇流车道,且前方无跟车车辆时,根据本车所处的汇流区域位置来调整控制策略。
进一步地,若本车处于汇流车道,且前方有跟车车辆时:
当本车驶入初段汇流区域后,按照最小时距进行巡航控制,并规划注意汇入车道车辆汇入本车所在车道的提示请求;
当本车驶入中段汇流区域和终段汇流区域后,且汇入车辆汇流行为的可能性Conf为较高或高,规划出对应的减速度并控制本车减速,同时规划出对应的远离汇入车道的横向偏移量以及鸣笛请求,并升级注意汇入车道车辆汇入本车所在车道的提示请求;
当本车驶过终段汇流区域或无汇入车道车辆,恢复原巡航控制策略。
进一步地,若本车处于汇流车道,且前方无跟车车辆时:
根据本车距离汇流路口的起点距离提前规划出对应的减速度并控制本车减速到一个安全车速,若本车当前车速未超过该安全车速,则维持当前车速行驶;当本车到达汇流路口起点时,规划注意汇入车道车辆汇入本车所在车道的提示请求并规划鸣笛请求;
当本车到达汇流点时,且汇入车辆汇流行为的可能性Conf为低或较低,或无汇入车道车辆时,恢复原巡航控制策略;
当本车到达汇流点时,且汇入车辆汇流行为的可能性Conf为中时,维持所述安全车速行驶,并规划出对应的远离汇入车道的横向偏移量;
当本车到达汇流点时,且汇入车辆汇流行为的可能性Conf为较高或高时,规划出对应的减速度并控制本车减速,同时规划出对应的远离汇入车道的横向偏移量以及鸣笛请求,并升级注意汇入车道车辆汇入本车所在车道的提示请求;
当本车驶过终段汇流区域或无汇入车道车辆,恢复原巡航控制策略。
进一步地,所述本车的控制策略还包括横纵向控制,根据规划的指定的减速度或横向偏移量发出加速、减速或转向控制命令并执行;
所述本车的控制策略还包括HMI交互控制,根据规划的鸣笛请求、注意汇入车道车辆汇入本车所在车道的提示请求或升级的注意汇入车道车辆汇入本车所在车道的提示请求来发出鸣笛请求以及视觉、听觉或触觉提示、报警请求并执行。
本发明还涉及一种驶经汇流口的分段控制系统,包括地图、传感器、控制器和执行器;
所述地图用于提供汇流区域信息以及本车所在车道信息;
所述传感器用于检测车辆周边的道路和环境信息;
所述控制器包括认知模块、目标融合模块、规划决策模块和控制模块;认知模块用于判断本车是否处于汇流区域以及是否处于汇流车道、预测汇入车辆汇流行为的可能性Conf;目标融合模块用于将传感器检测到的相关信息进行融合,筛选目标车辆并输出对应的距离和速度信息;规划决策模块用于调整本车的控制策略;控制模块用于根据规划决策模块所规划的控制策略向执行器下发控制命令;
所述执行器用于执行来自控制模块的控制命令。
相比现有技术,本发明具有如下有益效果:
本发明的一种驶经汇流口的分段控制方法,基于当前低成本组合辅助驾驶系统方案,根据本车所处车道位置、是否处于跟车巡航状态、汇入车道是否有车辆、汇入车道车辆的相对纵向位置和相对车速、汇入车道车辆所处汇入车道的纵向位置以及汇入车辆的换道动作等来修订车辆驶经汇流口的纵向控制策略、HMI交互策略,从而实现在结构化道路上安全、舒适地通过汇流区域,同时还降低了人为介入的概率。
附图说明
图1为实施例的一种驶经汇流口的分段控制方法的流程图;
图2为实施例的汇流区域的划分场景示意图;
图3为本发明中车辆行为预测的示意图;
图4为实施例的一种驶经汇流口的分段控制系统的结构框图。
具体实施方式
下面结合附图对本发明的具体实施方式作进一步的详细说明。
请参见图1-图3,具体实施例的一种驶经汇流口的分段控制方法,包括以下步骤:
判断本车是否处于汇流区域以及是否处于汇流车道,同时对汇入车道车辆和前方跟车车辆进行车辆检测;
获取本车、前方跟车车辆以及汇入车道车辆的汇流区域信息来预测汇入车辆汇流行为的可能性;
根据本车的汇流区域信息、汇入车辆汇流行为的可能性以及车辆检测所得的相关信息来调整本车的控制策略。
实施例的一种驶经汇流口的分段控制方法,基于当前低成本组合辅助驾驶系统方案,根据本车所处车道位置、是否处于跟车巡航状态、汇入车道是否有车辆、汇入车道车辆的相对纵向位置和相对车速、汇入车道车辆所处汇入车道的纵向位置以及汇入车辆的换道动作等来修订车辆驶经汇流口的纵向控制策略、HMI交互策略,从而实现在结构化道路上安全、舒适地通过汇流区域,同时还降低了人为介入的概率。
请参见图4,本发明还提供了一种驶经汇流口的分段控制系统,包括地图、传感器、控制器和执行器;
所述地图用于提供汇流区域信息以及本车所在车道信息;
所述传感器用于检测车辆周边的道路和环境信息;
所述控制器包括认知模块、目标融合模块、规划决策模块和控制模块;认知模块用于判断本车是否处于汇流区域以及是否处于汇流车道、预测汇入车辆汇流行为的可能性Conf;目标融合模块用于将传感器检测到的相关信息进行融合,筛选目标车辆并输出对应的距离和速度信息;规划决策模块用于调整本车的控制策略;控制模块用于根据规划决策模块所规划的控制策略向执行器下发控制命令;
所述执行器用于执行来自控制模块的控制命令。
请继续参见图2,所述汇流区域信息包括:本车和前方跟车车辆所处的汇流区域位置、汇入车道车辆所处的汇流区域位置;汇入车道和本车所在车道的汇流区域包括初段汇流区域A1、中段汇流区域A2和终段汇流区域A3;本车的汇流区域信息还包括本车距离汇流路口起点的距离d1、距离汇流点的距离d2和距离汇流路口终点的距离d3。
其中,获取本车的汇流区域信息以及本车所处车道信息来判断本车是否处于汇流区域以及是否处于汇流车道。
实施时,判断本车是否处于汇流区域以及是否处于汇流车道,认知模块需根据车载传感器检测的周边车道线、护栏、路沿、标牌、地面标线和隔离桩、并结合车载地图提供的汇流区域信息以及本车所在车道信息来进行判断;当车辆未搭载高精地图时且摄像头未检测到可靠的汇流特征(包括地面标线、汇流标志)时,可以适当扩大常规的ADAS(高级驾驶辅助系统)地图提供的汇流区域;当车载地图未提供汇流区域信息以及本车所在车道信息时,认知模块也可以通过车载传感器所探测到的信息进行推测从而判断本车是否处于汇流区域以及是否处于汇流车道,具体方法如下:
车载传感器探测汇流标牌、护栏横向距离变化、车道线类型变化、车道线宽度变化、汇流口地面网格标线以及汇流口地面隔离柱来判断本车是否处于汇流区域;
车载传感器探测护栏距离本车的距离、最外侧车道线和路沿距离本车的距离,本车换道情况来判断本车是否处于汇流车道。
当然如果车载地图提供了汇流区域信息以及本车所在车道信息,也可根据上述方法来进行校验。
其中,车辆检测时,根据前方跟车车辆的横向位置、本车所在车道的车道线曲率筛选出汇入车道车辆、前方跟车车辆,并输出对应的相对横纵向距离、相对横纵向速度。
实施时,本车系统通过常见的辅助系统的超声波雷达、侧向毫米波雷达、前向毫米波雷达和前向摄像头实时检测“临道”车辆目标(即汇入车道车辆)的相对横纵向距离、相对横纵向速度;还通过前向毫米波雷达、前向摄像头实时检测前方巡航跟车目标(即前方跟车车辆)的相对横纵向距离、相对横纵向速度;目标融合模块将上述由传感器实时检测到的车辆目标进行融合后,根据前方跟车车辆的横向位置、本车所在车道的车道线曲率筛选出汇入车道车辆、前方跟车车辆,并输出对应的相对横纵向距离、相对横纵向速度。
其中,认知模块根据本车所处汇流区域的位置、前方跟车车辆以及本车所处汇流区域的位置并结合汇流车道车辆与汇入车道车辆的相对纵向距离和纵向TTC来预测汇入车辆汇流行为的可能性是高、较高、中、较低还是低;所述汇流车道车辆包括本车与前方跟车车辆;
结合汇流车道车辆与汇入车道车辆的相对纵向距离预测的汇入车辆汇流行为可能性为第一可能性;
结合汇流车道车辆与汇入车道车辆的纵向TTC预测的汇入车辆汇流行为可能性为第二可能性;
将第一可能性与第二可能性相比较并选取较高的可能性作为最终的汇入车辆汇流行为的可能性Conf并输出给规划决策模块。
实施时,请参见图3,这里应把主路上的本车和前方跟车车辆当作一个整体来与汇入车道车辆进行相对纵向距离和纵向TTC的比较,其中具体的第一可能性和第二可能性的判定请参加下述两个表格:
结合相对纵向距离:
结合纵向TTC:
汇流车道车辆与汇入车道车辆的纵向TTC指的是汇流车道车辆与汇入车道车辆纵向的碰撞时间。
且上表中若能识别的含义:指的是如果不能识别,则定义该可能性(第一可能性或第二可能性)为0。
请继续参见图3,其中:
汇入车辆1:处于本车或最近前车前方,相对纵向距离和纵向TTC大于0;
汇入车辆2,处于最近前车最前方与本车最后方之间,或与本车有重叠(无前车时),相对纵向距离和纵向TTC默认为0;
汇入车辆3,处于本车最后方之后,相对纵向距离和纵向TTC小于0。
且这里可以理解的是,参见图2和图3,本发明所述的汇流车道,指的是通常意义上主路的邻车道存在汇入车道的车道,即图3中本车所处的车道;汇入车道指的是汇入车辆所在的车道。
同时,对前述的汇入车辆汇流行为的可能性以及汇入车辆汇流行为的可能性Conf进行划分定义:
大于85%为高,65%-85%为较高,45%-65%为中,25%-45%为较低,小于25%为低;
在本发明实施例中,请参见图2,对所述初段汇流区域A1、中段汇流区域A2和终段汇流区域A3及逆行划分标定,且均沿主路的纵向距离进行划分:
初段汇流区域A1的终点是汇流点前方20m处;
终段汇流区域A3指的是距离汇流路口终点小于20m的这段汇流车道;
中段汇流区域A2指的是初段汇流区域A1与终段汇流区域A3之间的汇流车道。
这里需说明的是,上述参数仅是本发明实施例中所标定划分的参数,具体情况应根据本车的系统感知能力进行标定,但均应属于本发明的保护范围。
其中,规划决策模块根据本车所处的汇流区域位置、汇入车辆汇流行为的可能性Conf并结合本车分别与前方跟车车辆、汇入车道车辆的相对横纵向距离及相对横纵向速度来调整本车的控制策略。
调整本车的控制策略包括:
1)若本车不处于汇流车道,则维持原巡航控制策略;
2)若本车处于汇流车道,且前方有跟车车辆时:
当本车驶入初段汇流区域A1后,按照最小时距进行巡航控制,并规划注意汇入车道车辆汇入本车所在车道的提示请求;
当本车驶入中段汇流区域A2和终段汇流区域A3后,且汇入车辆汇流行为的可能性Conf为较高或高,规划出对应的减速度并控制本车减速,同时规划出对应的远离汇入车道的横向偏移量以及鸣笛请求,并升级注意汇入车道车辆汇入本车所在车道的提示请求;
当本车驶过终段汇流区域A3或无汇入车道车辆,恢复原巡航控制策略;
3)若本车处于汇流车道,且前方无跟车车辆时:
根据本车距离汇流路口的起点距离d1提前规划出对应的减速度并控制本车减速到一个安全车速,若本车当前车速未超过该安全车速,则维持当前车速行驶;当本车到达汇流路口起点时(即d1=0),规划注意汇入车道车辆汇入本车所在车道的提示请求并规划鸣笛请求;
当本车到达汇流点(即d2=0)时,且汇入车辆汇流行为Conf的可能性为低或较低,或无汇入车道车辆时,恢复原巡航控制策略;
当本车到达汇流点(即d2=0)时,且汇入车辆汇流行为的可能性Conf为中时,维持所述安全车速行驶,并规划出对应的远离汇入车道的横向偏移量;
当本车到达汇流点(即d2=0)时,且汇入车辆汇流行为的可能性Conf为较高或高时,规划出对应的减速度并控制本车减速,同时规划出对应的远离汇入车道的横向偏移量以及鸣笛请求,并升级注意汇入车道车辆汇入本车所在车道的提示请求;
当本车驶过终段汇流区域A3或无汇入车道车辆,恢复原巡航控制策略。
其中,所述本车的控制策略还包括横纵向控制,控制模块根据规划决策模块规划的指定的减速度或横向偏移量发出加速、减速或转向控制命令给执行器并执行;所述本车的控制策略还包括HMI交互控制,控制模块根据规划决策模块规划的鸣笛请求、注意汇入车道车辆汇入本车所在车道的提示请求或升级的注意汇入车道车辆汇入本车所在车道的提示请求来发出鸣笛请求以及视觉、听觉或触觉提示、报警请求给执行器并执行。
这里,所述原巡航控制策略,均指的是本车驶入汇流车道前的巡航控制策略。
实施时,HMI交互执行效果可采用如下形式(仅为举例说明):
注意汇入车辆的提示请求,仅需触发视觉、听觉提示。其中,视觉提示包括文字提示(前方通过汇流口,请注意观察汇入车辆),以及仪表场景重构显示的汇流口、汇入车辆(若能识别到);听觉提示,可以采用三声“叮叮叮”信息提示音,也可以语音播报“前方通过汇流口,请注意观察汇入车辆”;
升级的注意汇入车辆的提示请求,除强化“注意汇入车辆的提示请求”的提示效果外,还可采用触觉提示,如座椅震动。其中,强化的视觉提示包含文字提示(注意前方汇入车辆),仪表场景重构显示的汇入车辆(若能识别到)采用红色标注。听觉提示采用语音播报“注意前方汇入车辆”。
最后说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的宗旨和范围,其均应涵盖在本发明的权利要求范围当中。
Claims (10)
1.一种驶经汇流口的分段控制方法,其特征在于:包括以下步骤:
判断本车是否处于汇流车道以及是否处于汇流区域,同时对汇入车道车辆和前方跟车车辆进行车辆检测;
获取本车、前方跟车车辆以及汇入车道车辆的汇流区域信息来预测汇入车辆汇流行为的可能性;
根据本车的汇流区域信息、汇入车辆汇流行为的可能性以及车辆检测所得的相关信息来调整本车的控制策略。
2.根据权利要求1所述一种驶经汇流口的分段控制方法,其特征在于:所述汇流区域信息包括:本车和前方跟车车辆所处的汇流区域位置、汇入车道车辆所处的汇流区域位置;
汇入车道和本车所在车道的汇流区域包括初段汇流区域、中段汇流区域和终段汇流区域;
本车的汇流区域信息还包括本车距离汇流路口起点的距离、距离汇流点的距离和距离汇流路口终点的距离。
3.根据权利要求2所述一种驶经汇流口的分段控制方法,其特征在于:获取本车的汇流区域信息以及本车所处车道信息来判断本车是否处于汇流区域以及是否处于汇流车道;
车辆检测时,根据前方跟车车辆的横向位置、本车所在车道的车道线曲率筛选出汇入车道车辆、前方跟车车辆,并输出对应的相对横纵向距离、相对横纵向速度。
4.根据权利要求3所述一种驶经汇流口的分段控制方法,其特征在于:根据本车所处汇流区域的位置、前方跟车车辆以及本车所处汇流区域的位置并结合汇流车道车辆与汇入车道车辆的相对纵向距离和纵向TTC来预测汇入车辆汇流行为的可能性;所述汇流车道车辆包括本车与前方跟车车辆,汇入车辆汇流行为的可能性包括高、较高、中、较低或低;
结合汇流车道车辆与汇入车道车辆的相对纵向距离预测的汇入车辆汇流行为可能性为第一可能性;
结合汇流车道车辆与汇入车道车辆的纵向TTC预测的汇入车辆汇流行为可能性为第二可能性;
将第一可能性与第二可能性相比较并选取较高的可能性作为最终的汇入车辆汇流行为的可能性Conf并输出。
5.根据权利要求4所述一种驶经汇流口的分段控制方法,其特征在于:定义所述汇入车辆汇流行为的可能性和汇入车辆汇流行为的可能性Conf:
大于85%为高;65%-85%为较高;45%-65%为中;25%-45%为较低;小于25%为低。
6.根据权利要求5所述一种驶经汇流口的分段控制方法,其特征在于:根据本车所处的汇流区域位置、汇入车辆汇流行为的可能性Conf并结合本车分别与前方跟车车辆、汇入车道车辆的相对横纵向距离及相对横纵向速度来调整本车的控制策略;
调整本车的控制策略包括:
若本车不处于汇流车道,则维持原巡航控制策略;
若本车处于汇流车道,且前方有跟车车辆时,根据本车所处的汇流区域位置来调整控制策略;
若本车处于汇流车道,且前方无跟车车辆时,根据本车所处的汇流区域位置来调整控制策略。
7.根据权利要求6所述一种驶经汇流口的分段控制方法,其特征在于:若本车处于汇流车道,且前方有跟车车辆时:
当本车驶入初段汇流区域后,按照最小时距进行巡航控制,并规划注意汇入车道车辆汇入本车所在车道的提示请求;
当本车驶入中段汇流区域和终段汇流区域后,且汇入车辆汇流行为的可能性Conf为较高或高,规划出对应的减速度并控制本车减速,同时规划出对应的远离汇入车道的横向偏移量以及鸣笛请求,并升级注意汇入车道车辆汇入本车所在车道的提示请求;
当本车驶过终段汇流区域或无汇入车道车辆,恢复原巡航控制策略。
8.根据权利要求6所述一种驶经汇流口的分段控制方法,其特征在于:若本车处于汇流车道,且前方无跟车车辆时:
根据本车距离汇流路口的起点距离提前规划出对应的减速度并控制本车减速到一个安全车速,若本车当前车速未超过该安全车速,则维持当前车速行驶;当本车到达汇流路口起点时,规划注意汇入车道车辆汇入本车所在车道的提示请求并规划鸣笛请求;
当本车到达汇流点时,且汇入车辆汇流行为的可能性Conf为低或较低,或无汇入车道车辆时,恢复原巡航控制策略;
当本车到达汇流点时,且汇入车辆汇流行为的可能性Conf为中时,维持所述安全车速行驶,并规划出对应的远离汇入车道的横向偏移量;
当本车到达汇流点时,且汇入车辆汇流行为的可能性Conf为较高或高时,规划出对应的减速度并控制本车减速,同时规划出对应的远离汇入车道的横向偏移量以及鸣笛请求,并升级注意汇入车道车辆汇入本车所在车道的提示请求;
当本车驶过终段汇流区域或无汇入车道车辆,恢复原巡航控制策略。
9.根据权利要求1所述一种驶经汇流口的分段控制方法,其特征在于:所述本车的控制策略还包括横纵向控制,根据规划的指定的减速度或横向偏移量发出加速、减速或转向控制命令并执行;
所述本车的控制策略还包括HMI交互控制,根据规划的鸣笛请求、注意汇入车道车辆汇入本车所在车道的提示请求或升级的注意汇入车道车辆汇入本车所在车道的提示请求来发出鸣笛请求以及视觉、听觉或触觉提示、报警请求并执行。
10.一种驶经汇流口的分段控制系统,其特征在于:包括地图、传感器、控制器和执行器;
所述地图用于提供汇流区域信息以及本车所在车道信息;
所述传感器用于检测车辆周边的道路和环境信息;
所述控制器包括认知模块、目标融合模块、规划决策模块和控制模块;认知模块用于判断本车是否处于汇流区域以及是否处于汇流车道、预测汇入车辆汇流行为的可能性Conf;目标融合模块用于将传感器检测到的相关信息进行融合,筛选目标车辆并输出对应的距离和速度信息;规划决策模块用于调整本车的控制策略;控制模块用于根据规划决策模块所规划的控制策略向执行器下发控制命令;
所述执行器用于执行来自控制模块的控制命令。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210460577.5A CN114655214B (zh) | 2022-04-24 | 2022-04-24 | 一种驶经汇流口的分段控制方法和控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210460577.5A CN114655214B (zh) | 2022-04-24 | 2022-04-24 | 一种驶经汇流口的分段控制方法和控制系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114655214A true CN114655214A (zh) | 2022-06-24 |
CN114655214B CN114655214B (zh) | 2024-04-26 |
Family
ID=82037349
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210460577.5A Active CN114655214B (zh) | 2022-04-24 | 2022-04-24 | 一种驶经汇流口的分段控制方法和控制系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114655214B (zh) |
Citations (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1153685A (ja) * | 1997-07-31 | 1999-02-26 | Toyota Motor Corp | 合流支援装置 |
JP2969176B1 (ja) * | 1998-06-03 | 1999-11-02 | 建設省土木研究所長 | 車の自動合流制御方法及び装置 |
WO2005061265A1 (de) * | 2003-12-11 | 2005-07-07 | Daimlerchrysler Ag | Adaption einer automatischen folgeführung an potentiell auf die eigene fahrspur einscherende verkehrsteilnehmer |
JP2007304880A (ja) * | 2006-05-11 | 2007-11-22 | Toyota Motor Corp | 車両用運転支援装置 |
WO2011066850A1 (en) * | 2009-11-12 | 2011-06-09 | Tomtom Belgium N.V. | Navigation system with live speed warning for merging traffic flow |
JP2016018495A (ja) * | 2014-07-10 | 2016-02-01 | 日産自動車株式会社 | 走行支援装置及び走行支援方法 |
JP2017165197A (ja) * | 2016-03-15 | 2017-09-21 | 本田技研工業株式会社 | 車両制御システム、車両制御方法、および車両制御プログラム |
JP2018036861A (ja) * | 2016-08-31 | 2018-03-08 | 株式会社デンソー | 合流支援装置 |
CN109552327A (zh) * | 2018-12-18 | 2019-04-02 | 重庆长安汽车股份有限公司 | 提升自适应巡航系统弯道性能的系统及方法 |
CN110379182A (zh) * | 2019-07-12 | 2019-10-25 | 同济大学 | 一种基于车路广义动力学的匝道合流区协同控制系统 |
CN110570049A (zh) * | 2019-09-19 | 2019-12-13 | 西南交通大学 | 一种高速公路混合交通流汇流协同优化底层控制方法 |
WO2020063815A1 (zh) * | 2018-09-30 | 2020-04-02 | 长城汽车股份有限公司 | 道路特征点提取方法及系统 |
CN111127908A (zh) * | 2019-12-30 | 2020-05-08 | 戴姆勒股份公司 | 用于车辆汇流的自动驾驶控制方法 |
CN111149140A (zh) * | 2017-09-26 | 2020-05-12 | 日产自动车株式会社 | 驾驶辅助方法及驾驶辅助装置 |
CN111192468A (zh) * | 2019-12-31 | 2020-05-22 | 武汉中海庭数据技术有限公司 | 基于路口内加减速的自动行驶方法及系统、服务器及介质 |
JP2020090196A (ja) * | 2018-12-05 | 2020-06-11 | 日産自動車株式会社 | 運転支援車両の合流方法及び合流装置 |
US20200369281A1 (en) * | 2019-05-21 | 2020-11-26 | Suzuki Motor Corporation | Driving Control Apparatus For Vehicle |
CN112249009A (zh) * | 2020-10-29 | 2021-01-22 | 腾讯科技(深圳)有限公司 | 车速控制方法、装置、系统及电子设备 |
CN112585660A (zh) * | 2018-06-29 | 2021-03-30 | 日产自动车株式会社 | 行驶辅助方法及车辆控制装置 |
CN113002562A (zh) * | 2019-12-19 | 2021-06-22 | 丰田自动车株式会社 | 车辆控制装置以及存储介质 |
US20210323606A1 (en) * | 2020-04-17 | 2021-10-21 | Subaru Corporation | Driving support device for vehicle |
JP2021169278A (ja) * | 2020-04-16 | 2021-10-28 | 日産自動車株式会社 | 走行支援方法、及び、走行支援装置 |
CN113990085A (zh) * | 2021-10-11 | 2022-01-28 | 南京航空航天大学 | 一种匝道汇入区域的交通疏解方法及系统 |
-
2022
- 2022-04-24 CN CN202210460577.5A patent/CN114655214B/zh active Active
Patent Citations (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1153685A (ja) * | 1997-07-31 | 1999-02-26 | Toyota Motor Corp | 合流支援装置 |
JP2969176B1 (ja) * | 1998-06-03 | 1999-11-02 | 建設省土木研究所長 | 車の自動合流制御方法及び装置 |
WO2005061265A1 (de) * | 2003-12-11 | 2005-07-07 | Daimlerchrysler Ag | Adaption einer automatischen folgeführung an potentiell auf die eigene fahrspur einscherende verkehrsteilnehmer |
JP2007304880A (ja) * | 2006-05-11 | 2007-11-22 | Toyota Motor Corp | 車両用運転支援装置 |
WO2011066850A1 (en) * | 2009-11-12 | 2011-06-09 | Tomtom Belgium N.V. | Navigation system with live speed warning for merging traffic flow |
JP2016018495A (ja) * | 2014-07-10 | 2016-02-01 | 日産自動車株式会社 | 走行支援装置及び走行支援方法 |
JP2017165197A (ja) * | 2016-03-15 | 2017-09-21 | 本田技研工業株式会社 | 車両制御システム、車両制御方法、および車両制御プログラム |
JP2018036861A (ja) * | 2016-08-31 | 2018-03-08 | 株式会社デンソー | 合流支援装置 |
CN111149140A (zh) * | 2017-09-26 | 2020-05-12 | 日产自动车株式会社 | 驾驶辅助方法及驾驶辅助装置 |
CN112585660A (zh) * | 2018-06-29 | 2021-03-30 | 日产自动车株式会社 | 行驶辅助方法及车辆控制装置 |
WO2020063815A1 (zh) * | 2018-09-30 | 2020-04-02 | 长城汽车股份有限公司 | 道路特征点提取方法及系统 |
JP2020090196A (ja) * | 2018-12-05 | 2020-06-11 | 日産自動車株式会社 | 運転支援車両の合流方法及び合流装置 |
CN109552327A (zh) * | 2018-12-18 | 2019-04-02 | 重庆长安汽车股份有限公司 | 提升自适应巡航系统弯道性能的系统及方法 |
US20200369281A1 (en) * | 2019-05-21 | 2020-11-26 | Suzuki Motor Corporation | Driving Control Apparatus For Vehicle |
CN110379182A (zh) * | 2019-07-12 | 2019-10-25 | 同济大学 | 一种基于车路广义动力学的匝道合流区协同控制系统 |
CN110570049A (zh) * | 2019-09-19 | 2019-12-13 | 西南交通大学 | 一种高速公路混合交通流汇流协同优化底层控制方法 |
CN113002562A (zh) * | 2019-12-19 | 2021-06-22 | 丰田自动车株式会社 | 车辆控制装置以及存储介质 |
CN111127908A (zh) * | 2019-12-30 | 2020-05-08 | 戴姆勒股份公司 | 用于车辆汇流的自动驾驶控制方法 |
CN111192468A (zh) * | 2019-12-31 | 2020-05-22 | 武汉中海庭数据技术有限公司 | 基于路口内加减速的自动行驶方法及系统、服务器及介质 |
JP2021169278A (ja) * | 2020-04-16 | 2021-10-28 | 日産自動車株式会社 | 走行支援方法、及び、走行支援装置 |
US20210323606A1 (en) * | 2020-04-17 | 2021-10-21 | Subaru Corporation | Driving support device for vehicle |
CN112249009A (zh) * | 2020-10-29 | 2021-01-22 | 腾讯科技(深圳)有限公司 | 车速控制方法、装置、系统及电子设备 |
CN113990085A (zh) * | 2021-10-11 | 2022-01-28 | 南京航空航天大学 | 一种匝道汇入区域的交通疏解方法及系统 |
Non-Patent Citations (4)
Title |
---|
张荣辉;游峰;初鑫男;郭烈;何兆成;王荣本;: "车-车协同下无人驾驶车辆的换道汇入控制方法", 中国公路学报, no. 04, 15 April 2018 (2018-04-15) * |
杨晓芳;范柏桐;付强;: "基于车车通信的快速路入口匝道车速控制研究", 交通运输研究, no. 06, 15 December 2019 (2019-12-15) * |
薛行健;戈林娟;邓力容;刘雪娇;: "快速路匝道合流区流量、加速车道长度与通行能力关系", 铁道科学与工程学报, no. 02, 15 February 2020 (2020-02-15) * |
陈慧;王洁新;: "基于驾驶人不满度的高速公路自动驾驶换道决策", 中国公路学报, no. 12, 15 December 2019 (2019-12-15) * |
Also Published As
Publication number | Publication date |
---|---|
CN114655214B (zh) | 2024-04-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110395251B (zh) | 一种基于多传感器融合数据的自动紧急制动决策方法 | |
CN110356377B (zh) | 一种自动紧急制动的决策方法、车载设备及存储介质 | |
CN107433948B (zh) | 路径引导装置以及路径引导方法 | |
US10782683B2 (en) | Vehicle control device | |
JP6677822B2 (ja) | 車両制御装置 | |
US8515615B2 (en) | Vehicle travel control apparatus | |
JP2018173787A (ja) | 車両制御装置 | |
WO2017010264A1 (ja) | 車両制御装置、車両制御方法、および車両制御プログラム | |
US10994735B2 (en) | Vehicle control device | |
CN108510795A (zh) | 协同车辆导航 | |
US20150344033A1 (en) | Apparatus and computer program for assisting driver of vehicle | |
EP2042962A1 (en) | Driving support system | |
JP6630443B2 (ja) | 車両制御装置 | |
US20140058579A1 (en) | Driving assist device and driving assist method | |
JP6729326B2 (ja) | 自動運転装置 | |
JP7172287B2 (ja) | 自動運転システム | |
WO2018105061A1 (ja) | 制御装置及び制御方法 | |
JP6817413B2 (ja) | 車両制御装置 | |
US10821980B2 (en) | Vehicle control device | |
US20190118833A1 (en) | Vehicle control device | |
CN111127908A (zh) | 用于车辆汇流的自动驾驶控制方法 | |
JP2020052658A (ja) | 自動運転システム | |
WO2021054051A1 (ja) | 電子制御装置 | |
JP7064357B2 (ja) | 車両制御装置 | |
EP4250048A1 (en) | Method and apparatus for determining transverse planning constraint |
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 |