CN113276882A - 自动驾驶车辆控制方法、控制系统及目标速度的计算方法 - Google Patents
自动驾驶车辆控制方法、控制系统及目标速度的计算方法 Download PDFInfo
- Publication number
- CN113276882A CN113276882A CN202110433357.9A CN202110433357A CN113276882A CN 113276882 A CN113276882 A CN 113276882A CN 202110433357 A CN202110433357 A CN 202110433357A CN 113276882 A CN113276882 A CN 113276882A
- Authority
- CN
- China
- Prior art keywords
- road surface
- vehicle
- automatic driving
- visibility
- state data
- 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
- 238000000034 method Methods 0.000 title claims abstract description 48
- 238000004364 calculation method Methods 0.000 title abstract description 13
- 238000012545 processing Methods 0.000 claims abstract description 19
- 230000001133 acceleration Effects 0.000 claims description 35
- 230000008569 process Effects 0.000 claims description 7
- 238000004891 communication Methods 0.000 claims description 6
- 238000002310 reflectometry Methods 0.000 claims description 6
- 230000008878 coupling Effects 0.000 abstract description 2
- 238000010168 coupling process Methods 0.000 abstract description 2
- 238000005859 coupling reaction Methods 0.000 abstract description 2
- 230000007613 environmental effect Effects 0.000 description 16
- 238000010586 diagram Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 238000013461 design Methods 0.000 description 3
- 230000000007 visual effect Effects 0.000 description 3
- 238000013135 deep learning Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000003993 interaction Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000011282 treatment Methods 0.000 description 2
- 230000001960 triggered effect Effects 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 239000000853 adhesive Substances 0.000 description 1
- 230000001070 adhesive effect Effects 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000003066 decision tree Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011031 large-scale manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000001579 optical reflectometry Methods 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000007704 transition Effects 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
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/005—Handover processes
- B60W60/0053—Handover processes from vehicle to occupant
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/105—Speed
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Human Computer Interaction (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了自动驾驶车辆控制方法、控制系统及目标速度的计算方法,控制方法包括:实时采集车辆行驶路面的能见度状态数据和路面湿滑程度状态数据;将路面湿滑程度状态数据处理后与相应的预设范围进行比较,以得到当前路面湿滑程度的等级,将能见度状态数据处理后与相应的预设范围进行比较,以得到当前能见度的等级;根据当前路面湿滑程度的等级和当前能见度的等级,匹配到数据库中预设的目标速度;自动驾驶中的所述车辆由当前车速自动降速或提速至所述目标速度,以便继续自动驾驶。本发明提供的自动驾驶车辆控制方法、控制系统及目标速度的计算方法对多维场景层进行耦合处理,采用有限状态机的解决方法,调配控制效率更迅速。
Description
技术领域
本发明涉及车辆自动驾驶技术领域,特别涉及自动驾驶车辆控制方法、控制系统及目标速度的计算方法。
背景技术
天气环境和路面状况是影响行车安全的重要因素,目前的L3及以上级别自动驾驶车辆的技术水平在恶劣天气环境中由于传感器性能受到外界因素的影响而无法正常工作,自动驾驶车辆感知系统性能极大降低,导致自动驾驶车辆无法正常行驶。当前方路面湿滑,车辆与路面的摩擦系数变小,附着力降低,容易发生打滑等安全风险。自动驾驶车辆的决策模块功能是从感知模块获取环境信息,最后对控制模块输出指令。针对恶劣环境和湿滑路面场景的决策问题,现存的势场法、深度学习算法、决策树算法等行为决策控制算法都不适合作为最优的控制机制。
现有的自动驾驶技术,在不考虑天气状况的策略中,加速刹车控制往往参照自车和前车的状态(加速、减速、距离等),可能造成在湿滑路面制动力不足而追尾等事故。在考虑到天气状况影响下,多为直接退出功能的解决方案,无法在较为恶劣的天气情况下行驶,目前的技术为在识别到不良的天气情况时通过人机交互接口提醒驾驶员人工接管驾驶任务,在天气由好转至天气不好再转为天气好的一段驾驶任务内需驾驶员承担天气不好一段的驾驶路程,且需要两次人机交互,会造成体验感不佳。
发明内容
为了克服现有技术存在的不足,本发明提供了自动驾驶车辆控制方法、控制系统及目标速度的计算方法,所述技术方案如下:
一方面,本发明提供了一种自动驾驶车辆控制方法,包括以下步骤:
S1、实时采集车辆行驶路面的能见度状态数据和路面湿滑程度状态数据;
S2、将路面湿滑程度状态数据处理后与相应的预设范围进行比较,以得到当前路面湿滑程度的等级,将能见度状态数据处理后与相应的预设范围进行比较,以得到当前能见度的等级;
S3、根据当前路面湿滑程度的等级和当前能见度的等级,匹配到数据库中预设的目标速度;
S4、自动驾驶中的所述车辆由当前车速自动降速或提速至所述目标速度,以便继续自动驾驶。
进一步地,所述路面湿滑程度状态按照路面摩擦系数的范围分为若干个等级,所述能见度状态按照可视距离的范围分为若干个等级。
进一步地,所述路面湿滑程度的等级分别映射到车辆的一个最大加速度。
进一步地,所述路面湿滑程度的等级与所述能见度的等级的不同组合结果分别映射到车辆的一个目标速度。
进一步地,在步骤S1中,还包括采集车辆行驶路面的雨量状态数据,若雨量状态数据、能见度状态数据和路面湿滑程度状态数据中任一项数据经处理后超出相应的阈值,则由自动驾驶模式切换为手动驾驶模式,不执行步骤S2-S4。
进一步地,在判断路面湿滑程度状态数据经处理后是否超出相应的阈值时,还包括以下步骤:
S101、把传感器获取的道路图像分成多个区域,将平均亮度作为对每一个区域对应的灰度均值,将所述道路图像的上半部分区域的所有平均亮度值相加得到第一数值,剩下区域的所有平均亮度值相加得到为第二数值,将第一数值和第二数值进行作差处理,进而得到路面反光度;
S102、根据所述道路图像,得到其对应的梯度图像,进而处理得到所述梯度图像中任意一点的锐度值,从而得到所述道路图像的平均锐度;
S103、将所述路面反光度和所述平均锐度乘以各自的权值后再进行作差处理,并将作差结果与相应阈值进行比较,若大于相应阈值,则由自动驾驶模式切换为手动驾驶模式,若小于或等于相应阈值,则仍保持自动驾驶模式。
另一方面,本发明提供了一种自动驾驶车辆控制方法,其特征在于,包括以下步骤:
S1、实时采集车辆行驶路面的天气状态数据和路面湿滑程度状态数据;
S2、将路面湿滑程度状态数据处理后与相应的预设值进行比较,以判断当前路面是否湿滑,若判断为湿滑路面,则输出减速指令,所述车辆开始减速自动行驶,若判断为干燥路面,则输出速度保持指令,车辆保持原速自动行驶;
S3、将天气状态数据处理后与相应的预设值进行比较,以判断当前天气状态是否符合设定要求,若判断为符合设定要求,则所述车辆根据路面状况自动行驶,若判断为不符合设定要求,则对应匹配到数据库中预设的目标速度,所述车辆减速至所述目标速度进行自动行驶。
再一方面,本发明提供了一种自动驾驶车辆控制系统,包括用于输出环境能见度状况的摄像头传感器、用于输出道路图像的图像传感器、防抱死系统和自动驾驶域控制器,所述摄像头传感器、所述图像传感器和所述防抱死系统均与所述自动驾驶域控制器通信连接,所述自动驾驶域控制器能够将对所述摄像头传感器和所述图像传感器采集的信息进行处理,以得到能见度等级和路面湿滑程度等级,并匹配出数据库中相应预设的目标速度,通过防抱死系统将车速制动到相应预设的目标速度。
进一步地,所述自动驾驶车辆控制系统包括雨量传感器,所述雨量传感器与所述自动驾驶域控制器通信连接,若所述雨量传感器检测到的数据超出最大相应的阈值,则所述自动驾驶域控制器由自动驾驶模式切换为手动驾驶模式。
再一方面,本发明提供了一种自动驾驶车辆目标速度的计算方法,包括以下步骤:
S1、通过传感器读取车辆的各类瞬时参数,以得出所述车辆所需的制动力;
S2、将所述制动力通过防抱死系统按照特定比例加载到每个车轮的制动器,以实时得到每个车轮的滑移率,并记录每个车轮滑移率为不同数值时的角加速度以及对应的实时制动力;
S3、通过Kienche模型计算得出当前路面状况下的最佳滑移率和最大摩擦系数;
S4、将所述最佳滑移率加载到防抱死系统中,使得防抱死系统控制车轮的滑移率保持在的一定范围内,并依据所述最大摩擦系数,以得到当前路面状况下的最大加速度;
S5、根据不同能见度下对应的可视距离,通过以下公式得到当前能见度状态下的目标车速,记作Vi,
式中,V0—车辆初始速度;
ai—不同路面状况下的最大加速度;
Li—不同能见度下的可视距离。
进一步地,所述路面状况包括干燥路面和湿滑路面,所述湿滑路面按照路面摩擦系数的范围分为若干个等级,不同等级的所述湿滑路面分别映射到车辆的一个最大加速度。
本发明提供的技术方案带来的有益效果如下:
(1)综合考虑恶劣天气及湿滑路面两层场景层进行耦合处理,在多维恶劣场景下进行自动驾驶车辆决策;
(2)采用有限状态机的解决方法,调配控制效率更迅速;
(3)对车载处理器的算力要求较低,有较高的实时性。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的自动驾驶车辆控制方法中不同环境因素下状态机切换示意图;
图2是本发明实施例提供的自动驾驶车辆控制方法的流程示意图;
图3是本发明实施例提供的自动驾驶车辆控制方法中车辆行驶在恶劣天气、湿滑路面区域的示意图;
图4是本发明实施例提供的自动驾驶车辆控制方法中车辆行驶在良好天气、正常路面区域的示意图。
具体实施方式
为了使本技术领域的人员更好地理解本发明方案,更清楚地了解本发明的目的、技术方案及其优点,以下结合具体实施例并参照附图对本发明实施例中的技术方案进行清楚、完整地描述。需要说明的是,附图中未绘示或描述的实现方式,为所属技术领域中普通技术人员所知的形式。另外,虽然本文可提供包含特定值的参数的示范,但应了解,参数无需确切等于相应的值,而是可在可接受的误差容限或设计约束内近似于相应的值。显然,所描述的实施例仅仅是本发明一部分的实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明保护的范围。除此,本发明的说明书和权利要求书中的术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、装置、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
在本发明的一个实施例中,提供了一种自动驾驶车辆控制方法,参见图1,包括以下步骤:
S1、实时采集车辆行驶路面的能见度状态数据和路面湿滑程度状态数据;
S2、将路面湿滑程度状态数据处理后与相应的预设范围进行比较,以得到当前路面湿滑程度的等级,将能见度状态数据处理后与相应的预设范围进行比较,以得到当前能见度的等级;
S3、根据当前路面湿滑程度的等级和当前能见度的等级,匹配到数据库中预设的目标速度;
S4、自动驾驶中的所述车辆由当前车速自动降速或提速至所述目标速度,以便继续自动驾驶。
在步骤S1中,还包括采集车辆行驶路面的雨量状态数据,若雨量状态数据、能见度状态数据和路面湿滑程度状态数据中任一项数据经处理后超出相应的阈值,则由自动驾驶模式切换为手动驾驶模式,不执行步骤S2-S4。
其中,在判断雨量状态数据经处理后是否超出相应的阈值时,设X1为雨量传感器输出的雨量大小信息,设X2为预先设定的雨量阈值,当X1-X2>0时,则说明所处的天气为雨量过大,自动驾驶车辆的传感器性能受到限制;若X1-X2<0时,则说明雨量状态在自动驾驶车辆传感器的可接受范围内,不会影响传感器的性能,车辆可以正常行驶。
在判断能见度状态数据经处理后是否超出相应的阈值时,设Q1为摄像头传感器输出的环境能见度状况,其能见度等级定义为:极差、一般、良好,不同能见度下摄像头传感器对应的视距分别记为Lheavy、Llight、Lclear,当能见度等级为极差时,Q1=0,当能见度等级为其他情况时,Q1=1,设Q2为Q1的置信度;
当Q1×Q2>0.9时,则说明环境能见度较差,自动驾驶车辆传感器的性能受到限制,无法正常工作,需转换为手动驾驶;当Q1×Q2<0.9时,则说明环境能见度在传感器正常工作的范围内,性能不会受到影响。
在判断路面湿滑程度状态数据经处理后是否超出相应的阈值时,还包括以下步骤:
S101、把传感器获取的道路图像分成多个区域,将平均亮度作为对每一个区域对应的灰度均值,将所述道路图像的上半部分区域的所有平均亮度值相加得到第一数值,剩下区域的所有平均亮度值相加得到为第二数值,将第一数值和第二数值进行作差处理,进而得到路面反光度;
S102、根据所述道路图像,得到其对应的梯度图像,进而处理得到所述梯度图像中任意一点的锐度值,从而得到所述道路图像的平均锐度;
S103、将所述路面反光度和所述平均锐度乘以各自的权值后再进行作差处理,并将作差结果与相应阈值进行比较,若大于相应阈值,则由自动驾驶模式切换为手动驾驶模式,若小于或等于相应阈值,则仍保持自动驾驶模式。
具体地,路面反光度的计算方法为:把图像传感器获取的道路图像分成n个大小相同区域(i=1,2,3……n-1,n),将图像的上半部分区域所有的平均亮度值相加得到第一数值,记作χu,剩下区域的平均亮度值相加得到第二数值,记做χd,路面反光度记为Ψ,则其计算公式为Ψ=χu-χd。
路面平均锐度计算方法为:根据获取的道路图像,求其对应的梯度图像,计算梯度图像中任意一点对应的八邻域中每个点值乘以该点与八邻域中每个点的距离,所有的乘积之和就是图像中任意一点的锐度值,将所有的锐度值相加除以点的个数就可得到路面图像的平均锐度,记作Φ。
设Ψ为路面的反光度,设α为路面反光度的权值,设Φ为路面图像的平均锐度,设β为路面平均锐度的权值,设Γ为预先设定的路面湿滑程度阈值。当α×Ψ-β×Φ-Γ>0时,则说明前方路面湿滑程度较高,自动驾驶车辆行驶在该路面上时附着力较小,容易发生侧滑。当α×Ψ-β×Φ-Γ≤0时,则说明前方路面湿滑程度较低,车辆不会发生打滑。
在本发明的一个实施例中,所述路面湿滑程度状态按照路面摩擦系数的范围分为若干个等级,所述能见度状态按照可视距离的范围分为若干个等级,所述路面湿滑程度的等级分别映射到车辆的一个最大加速度,所述路面湿滑程度的等级与所述能见度的等级的不同组合结果分别映射到车辆的一个目标速度。需要说明的是,干燥路面的对应路面的情况也可以归纳对应到所述路面湿滑程度状态的一个等级中。本实施例的自动驾驶车辆控制方法基于有限状态机,适用于多维恶劣场景下,当L3及以上级别自动驾驶车辆行驶过程中在遇到恶劣的天气和湿滑的交通路面场景时,触发有限状态机在该状态下进行车辆状态的切换,使自动驾驶车辆减速进行低速缓慢行驶,自动驾驶车辆决策系统获取感知传感器得到的相关信息及CAN网络信息,将纵向决策有限状态机作为自动驾驶车辆的决策模块,根据有限状态机的不同状态对车辆的行驶状态进行切换,通过自动驾驶域控制器输出控制车辆行驶的控制信号,从预期功能安全角度出发,考虑了道路层和气象层两个维度的场景并进行了综合处理,更科学、严谨的控制车辆在不同场景下的安全行驶。
在本发明的一个实施例中,提供了一种自动驾驶车辆控制方法,参见图2,包括以下步骤:
S1、实时采集车辆行驶路面的天气状态数据和路面湿滑程度状态数据;
其中,天气状态数据包括能见度和雨量状态数据,经过综合处理后,能够判断当前天气状况是否良好。
S2、将路面湿滑程度状态数据处理后与相应的预设值进行比较,以判断当前路面是否湿滑,若判断为湿滑路面,则输出减速指令,并依据路面摩擦系数得到当前安全的最大加速度,所述车辆开始减速自动行驶,若判断为干燥路面,则输出速度保持指令,车辆保持原速自动行驶。
S3、将天气状态数据处理后与相应的预设值进行比较,以判断当前天气状态是否符合设定要求,若判断为符合设定要求,表示天气良好,则所述车辆根据路面状况自动行驶,若判断为不符合设定要求,表示天气恶劣,则根据能见度和路面状况最大加速度对应匹配到数据库中预设的目标速度,所述车辆减速至所述目标速度进行自动行驶。
自动驾驶车辆行驶过程中,车载雨量传感器获取实时雨量信息,摄像头传感器获取能见度信息,路面湿滑程度信息通过图像传感器获取的路面图像经处理得到。根据传感器获得的路面信息判断路面是否湿滑,若路面湿滑,决策系统输出车辆减速指令,其加速度大小根据实时计算得到的路面摩擦系数而定;若路面干燥、正常,自动驾驶车辆按原状态行驶。再根据雨量传感器及摄像头传感器获得的信息综合确认当前环境天气状况是否良好,若天气情况恶劣能见度较低,根据能见度大小和实时路面状况下的最大加速度范围减速至目标车速;若天气状况良好能见度较高,则根据路面状况确定车辆的行驶状态。自动驾驶车辆决策机制采用有限状态机,根据不同的转换条件触发不同行驶状态之间的切换。通过自动驾驶域控制器输出控制车辆行驶的控制信号。本发明从预期功能安全角度出发,考虑了道路层和气象层两个维度的场景并进行了综合处理,更科学、严谨的控制车辆在不同场景下的安全行驶。
在本发明的一个实施例中,提供了一种自动驾驶车辆控制系统,包括用于输出环境能见度状况的摄像头传感器、用于输出道路图像的图像传感器、防抱死系统和自动驾驶域控制器,所述摄像头传感器、所述图像传感器和所述防抱死系统均与所述自动驾驶域控制器通信连接,所述自动驾驶域控制器能够将对所述摄像头传感器和所述图像传感器采集的信息进行处理,以得到能见度等级和路面湿滑程度等级,并匹配出数据库中相应预设的目标速度,通过防抱死系统将车速制动到相应预设的目标速度。在一个实施例中,所述自动驾驶车辆控制系统包括雨量传感器,所述雨量传感器与所述自动驾驶域控制器通信连接,若所述雨量传感器检测到的数据超出最大相应的阈值,则所述自动驾驶域控制器由自动驾驶模式切换为手动驾驶模式。所述自动驾驶车辆控制系统能够识别出雨量大小、环境能见度大小以及路面湿滑程度等环境信息,根据感知得到的环境状态信息通过有限状态机决定自动驾驶车辆在不同环境条件下的行驶状态。
具体地,通过实时雨量传感器来实时感知所处环境雨量大小,并输出雨量大小信息,摄像头传感器获取所处环境能见度情况,图像传感器获取路面湿滑程度等环境信息。根据传感器输出提供的雨量大小信息、能见度信息及路面湿滑程度信息通过深度学习图像识别算法提取能见度大小及路面湿滑程度大小相关信息,进行分类操作后,推测雨量大小状态、能见度状况及路面的湿滑程度状态等相关信息,其中雨量大小信息是指雨量传感器实时感知到的所处环境的雨量大小;能见度信息是指所处环境能见度大小参考值及能见度的置信度;路面湿滑程度信息是指前方路面反光值、路面反光值的权值、前方路面图像的平均锐度、平均锐度的权值。
自动驾驶域控制器根据雨量状态、能见度状态及路面湿滑程度状态通过有限状态机决定自动驾驶车辆的行驶状态。参见图3,当所处环境天气状况雨量较大、能见度较低及路面湿滑程度较高的时候,自动驾驶车辆由正常行驶速度状态进入低速行驶速度状态。先判断路面状况,确认当前路面状态下的最大摩擦系数进而确定最大制动加速度,再根据最大制动加速度求得不同能见度环境下的车辆目标速度。通过较慢的行驶速度来弥补恶劣环境下传感器功能受限,识别能力较低及因为路面湿滑程度较高导致的自动驾驶车辆路面附着力较低容易发生打滑的安全问题,进而保证自身的行车安全。参见图4,当自动驾驶车辆行驶到雨量较小或天气晴朗、能见度较高及前方路面湿滑程度较低或路面干燥的时候,自动驾驶车辆由低速行驶状态进入正常速度行驶状态。在不同的天气环境下和不同的路面情况下,通过有限状态机根据不同的触发条件转换自动驾驶车辆的行驶状态来保证本车的安全正常行驶,即使在恶劣的环境条件下自动驾驶车辆能够弥补因传感器性能不足造成的严重影响,能够自主做出决策正常行驶。
在本发明的一个实施例中,提供了一种自动驾驶车辆目标速度的计算方法,包括以下步骤:
S1、通过传感器读取车辆的各类瞬时参数,以得出所述车辆所需的制动力;
S2、将所述制动力通过防抱死系统按照特定比例加载到每个车轮的制动器,以实时得到每个车轮的滑移率,并记录每个车轮滑移率为不同数值时的角加速度以及对应的实时制动力;
S3、通过Kienche模型计算得出当前路面状况下的最佳滑移率和最大摩擦系数;
S4、将所述最佳滑移率加载到防抱死系统中,使得防抱死系统控制车轮的滑移率保持在的一定范围内,并依据所述最大摩擦系数,以得到当前路面状况下的最大加速度;
S5、根据不同能见度下对应的可视距离,通过以下公式得到当前能见度状态下的目标车速,记作Vi,
式中,V0—车辆初始速度;
ai—不同路面状况下的最大加速度;
Li—不同能见度下的可视距离。
具体地,可按照以下步骤进行:
(1)自动驾驶域控制器通过各个传感器读取瞬时参数计算得出所需制动力,记作F;
(2)自动驾驶域控制器将制动力通过防抱死系统按照特定比例加载到每个车轮的制动器,域控制器实时得到每个车轮的滑移率,记录每个车轮的滑移率为0.03、0.06、0.1时的角加速度以及实时制动力;
(3)将制动力F通过ABS防抱死系统加载到每一个车轮制动器上,分配到两个前轮上的制动力都为0.3F,两个后轮上的制动力都为0.25F,自动驾驶域控制器根据记录的滑移率小于或等于0.1时的每个车轮的实时制动力以及角加速度信息,通过Kienche模型求出参数P1、P2,进而根据该模型计算得出当前路面状况下的最佳滑移率和最大摩擦系数,需要注意的是因在湿滑路面上行驶,要保证行驶安全,四个车轮最终的最佳滑移率都要大于0.1。
其中,Kienche模型利用公式(2)计算P1、P2,
其中,μ0.03、μ0.06、μ0.1分别代表当滑移率是0.03、0.06、0.1时对应的车轮与地面的摩擦系数,其对应计算公式如公式(3)至公式(5)所示,
其中,α0.03、α0.06、α0.1分别对应滑移率是0.03、0.06、0.1时的车轮角加速度;R为车轮半径;J为车轮的转动惯量;Tb为制动力矩;Fz为路面接触力。
通过Kienche模型,利用公式(6)和公式(7)计算得到的当前路面状况的最佳滑移率,记作λa,和最大摩擦系数,记作μmax,
(4)自动驾驶域控制器将上面计算得出的当前路面状况的最佳滑移率λa加载到防抱死系统中,使得防抱死系统控制车轮的滑移率保持在λa附近的一定范围内,与此同时,自动驾驶域控制器依据车速传感器得到的车辆速度信息通过差分处理得到此时的自动驾驶车辆的对应的加速度,可作为其安全值的最大加速度。
通过以上多次试验处理,以得到湿滑路面的摩擦系数,记作μ,取值范围为μ=(0.2,0.55),考虑摩擦系数的值分别为μ1=(0.2,0.3),μ2=[0.3,0.4)和μ3=[0.4,0.55)时,相应对应到其最大加速度值分别为a1、a2和a3。
(5)进行不同能见度下的目标速度确认,设自动驾驶车辆在不同能见度下的可视距离为Li,以可视距离作为车辆的制动距离,根据加速度公式,可得不同能见度情况下的目标车速为其中,V0为车辆初始速度,ai为不同路面状况的最大加速度。
根据能见度的不同确定车辆的行驶速度,当Li分为良好、一般、极差三个等级时,分别对应记作Lclear、Llight和Lheavy,其中,Lclear为环境能见度为[500,1000)m,Llight为环境能见度为[200,500)m,Lheavy为环境能见度(50,200)m,
所述路面状况包括干燥路面和湿滑路面,在湿滑路面情况下的目标速度Vi的对应取值为V1、V2和V3,干燥路面情况下的目标速度Vi的对应取值为V4、V5和V6。需要说明的是,所述湿滑路面按照路面摩擦系数的范围分为若干个等级,不同等级的所述湿滑路面分别映射到车辆的一个最大加速度,例如,设定湿滑路面有三个等级,分别记作μ1、μ2和μ3,μ1为路面摩擦系数为(0.2,0.3),此时车辆对应最大加速度为a1,μ2为路面摩擦系数为[0.3,0.4),此时车辆对应最大加速度为a2,μ3为路面摩擦系数为[0.4,0.55),此时车辆对应最大加速度为a3;不同等级的湿滑路面在同一能见度等级下的对应匹配到的目标速度可以不同,也可以相同。
不同环境因素下自动驾驶车辆行驶状态转换条件,参见图1,图1中当z=0时,表示前方路面干燥(图像识别),路面摩擦系数较大,执行器外部条件良好;当z=1时,表示前方路面湿滑程度较高,路面摩擦系数较低;
参见图3,自动驾驶车辆由正常速度行驶状态进入低速行驶状态需要满足以下条件,即所处天气状况恶劣和前方路面湿滑程度较高的情况,天气恶劣能见度较低对于自动驾驶车辆而言,表现为感知传感器性能受限,比如激光雷达、毫米波雷达性能大大降低,摄像头传感器的视野和清晰度降低,从而无法准确判断车头时距(THW)和碰撞时间(TTC),路面湿滑程度较高的情况下车辆轮胎抓地力减弱,附着力降低,容易发生打滑。参见图4,自动驾驶车辆由低速速度行驶状态进入正常行驶状态,表现为前方路面干燥(图像识别),路面摩擦系数较大。本实施例通过设计提升自动驾驶系统在天气不好一段驾驶任务的安全性,使得自动驾驶行程连贯,提升自动驾驶安全性和舒适度。
本发明提供的自动驾驶车辆控制方法、控制系统及目标速度的计算方法在考虑到天气、路面情况对自动驾驶纵向控制的影响,设计一套策略使得在不理想的天气、路面条件下提高自动驾驶运行的安全性。现有技术之前只单独考虑自动驾驶车辆的一个层次的交通场景,具有片面性与不确定性,存在交通风险。现将两个层次的交通场景进行耦合处理,综合多维度的感知自动驾驶车辆的行驶环境。在车速较高的情况下,强降雨及能见度较低会对自动驾驶各种传感器提取目标物特征、识别目标物产生较大影响,降低车速可以提高处于恶劣环境中自动驾驶车辆的感知能力,保证行车安全。本发明可以让L3及以上级别自动驾驶车辆在恶劣天气及前方湿滑路面情况下正常行驶,无需人工接管,极大地提高了在恶劣环境下的行车安全。本发明从预期功能安全的角度出发,尽量降低已知和未知不安全场景的风险,增加已知和未知安全场景区域。当在恶劣环境下由于传感器性能受限,自动驾驶车辆无法正常做出自主决策,通过降低车辆的行驶速度,来弥补传感器的性能不足的问题,在低速行驶的状态下,自动驾驶传感器的感知性能会得到一定程度的提升,可以保障车辆的自动驾驶功能正常运行,最大程度的保障行车安全。并且通过有限状态机的形式来实现决策功能,使得系统结构更加简约,对车载处理器的算力要求较低,有较高的实时性,自动驾驶车辆决策准确性也会明显提升,并且对异常状况的处理能力较高,更加适合自动驾驶的规模化生产落地。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种自动驾驶车辆控制方法,其特征在于,包括以下步骤:
S1、实时采集车辆行驶路面的能见度状态数据和路面湿滑程度状态数据;
S2、将路面湿滑程度状态数据处理后与相应的预设范围进行比较,以得到当前路面湿滑程度的等级,将能见度状态数据处理后与相应的预设范围进行比较,以得到当前能见度的等级;
S3、根据当前路面湿滑程度的等级和当前能见度的等级,匹配到数据库中预设的目标速度;
S4、自动驾驶中的所述车辆由当前车速自动降速或提速至所述目标速度,以便继续自动驾驶。
2.根据权利要求1所述的自动驾驶车辆控制方法,其特征在于,所述路面湿滑程度状态按照路面摩擦系数的范围分为若干个等级,所述能见度状态按照可视距离的范围分为若干个等级。
3.根据权利要求1所述的自动驾驶车辆控制方法,其特征在于,所述路面湿滑程度的等级分别映射到所述车辆的一个最大加速度,所述路面湿滑程度的等级与所述能见度的等级的不同组合结果分别映射到所述车辆的一个目标速度。
4.根据权利要求1所述的自动驾驶车辆控制方法,其特征在于,在步骤S1中,还包括采集车辆行驶路面的雨量状态数据,若雨量状态数据、能见度状态数据和路面湿滑程度状态数据中任一项数据经处理后超出相应的阈值,则由自动驾驶模式切换为手动驾驶模式,不执行步骤S2-S4。
5.根据权利要求4所述的自动驾驶车辆控制方法,其特征在于,在判断路面湿滑程度状态数据经处理后是否超出相应的阈值时,还包括以下步骤:
S101、把传感器获取的道路图像分成多个区域,将平均亮度作为对每一个区域对应的灰度均值,将所述道路图像的上半部分区域的所有平均亮度值相加得到第一数值,剩下区域的所有平均亮度值相加得到为第二数值,将第一数值和第二数值进行作差处理,进而得到路面反光度;
S102、根据所述道路图像,得到其对应的梯度图像,进而处理得到所述梯度图像中任意一点的锐度值,从而得到所述道路图像的平均锐度;
S103、将所述路面反光度和所述平均锐度乘以各自的权值后再进行作差处理,并将作差结果与相应阈值进行比较,若大于相应阈值,则由自动驾驶模式切换为手动驾驶模式,若小于或等于相应阈值,则仍保持自动驾驶模式。
6.一种自动驾驶车辆控制方法,其特征在于,包括以下步骤:
S1、实时采集车辆行驶路面的天气状态数据和路面湿滑程度状态数据;
S2、将路面湿滑程度状态数据处理后与相应的预设值进行比较,以判断当前路面是否湿滑,若判断为湿滑路面,则输出减速指令,所述车辆开始减速自动行驶,若判断为干燥路面,则输出速度保持指令,车辆保持原速自动行驶;
S3、将天气状态数据处理后与相应的预设值进行比较,以判断当前天气状态是否符合设定要求,若判断为符合设定要求,则所述车辆根据路面状况自动行驶,若判断为不符合设定要求,则对应匹配到数据库中预设的目标速度,所述车辆减速至所述目标速度进行自动行驶。
7.一种自动驾驶车辆控制系统,其特征在于,包括用于输出环境能见度状况的摄像头传感器、用于输出道路图像的图像传感器、防抱死系统和自动驾驶域控制器,所述摄像头传感器、所述图像传感器和所述防抱死系统均与所述自动驾驶域控制器通信连接,所述自动驾驶域控制器能够将对所述摄像头传感器和所述图像传感器采集的信息进行处理,以得到能见度等级和路面湿滑程度等级,并匹配出数据库中相应预设的目标速度,通过防抱死系统将车速制动到相应预设的目标速度。
8.根据权利要求7所述的自动驾驶车辆控制系统,其特征在于,包括雨量传感器,所述雨量传感器与所述自动驾驶域控制器通信连接,若所述雨量传感器检测到的数据超出最大相应的阈值,则所述自动驾驶域控制器由自动驾驶模式切换为手动驾驶模式。
9.一种自动驾驶车辆目标速度的计算方法,其特征在于,包括以下步骤:
S1、通过传感器读取车辆的各类瞬时参数,以得出所述车辆所需的制动力;
S2、将所述制动力通过防抱死系统按照特定比例加载到每个车轮的制动器,以实时得到每个车轮的滑移率,并记录每个车轮滑移率为不同数值时的角加速度以及对应的实时制动力;
S3、通过Kienche模型计算得出当前路面状况下的最佳滑移率和最大摩擦系数;
S4、将所述最佳滑移率加载到防抱死系统中,使得防抱死系统控制车轮的滑移率保持在的一定范围内,并依据所述最大摩擦系数,以得到当前路面状况下的最大加速度;
S5、根据不同能见度下对应的可视距离,通过以下公式得到当前能见度状态下的目标车速,记作Vi,
式中,V0—车辆初始速度;
ai—不同路面状况下的最大加速度;
Li—不同能见度下的可视距离。
10.根据权利要求9所述的自动驾驶车辆目标速度的计算方法,其特征在于,所述路面状况包括干燥路面和湿滑路面,所述湿滑路面按照路面摩擦系数的范围分为若干个等级,不同等级的所述湿滑路面分别映射到所述车辆的一个最大加速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110433357.9A CN113276882A (zh) | 2021-04-22 | 2021-04-22 | 自动驾驶车辆控制方法、控制系统及目标速度的计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110433357.9A CN113276882A (zh) | 2021-04-22 | 2021-04-22 | 自动驾驶车辆控制方法、控制系统及目标速度的计算方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113276882A true CN113276882A (zh) | 2021-08-20 |
Family
ID=77277123
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110433357.9A Pending CN113276882A (zh) | 2021-04-22 | 2021-04-22 | 自动驾驶车辆控制方法、控制系统及目标速度的计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113276882A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114155700A (zh) * | 2022-02-09 | 2022-03-08 | 中国气象局公共气象服务中心(国家预警信息发布中心) | 路面湿滑状态监测方法及系统 |
CN114291094A (zh) * | 2021-12-28 | 2022-04-08 | 清华大学苏州汽车研究院(相城) | 一种基于自动驾驶的路面状况感知响应系统及方法 |
CN114475597A (zh) * | 2022-02-28 | 2022-05-13 | 东风汽车集团股份有限公司 | 一种自动驾驶车辆跟车距离控制方法及控制系统 |
CN114566049A (zh) * | 2022-03-08 | 2022-05-31 | 华设设计集团股份有限公司 | 一种旅游服务区域用安全智能提示标识 |
CN114694376A (zh) * | 2022-02-23 | 2022-07-01 | 天津海关工业产品安全技术中心 | 车辆运行风险评估信息采集系统、风险评估系统及方法 |
WO2023236738A1 (zh) * | 2022-06-10 | 2023-12-14 | 宁波路特斯机器人有限公司 | 一种车辆自动驾驶控制方法、装置和计算机存储介质 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102011015509A1 (de) * | 2010-06-30 | 2012-01-05 | Wabco Gmbh | Verfahren und Vorrichtung zur Steuerung zumindest eines Fahrerassistenzsystems eines Fahrzeuges und damit ausgestattetes Fahrzeug |
CN104200673A (zh) * | 2014-09-01 | 2014-12-10 | 西南交通大学 | 一种基于道路图像的路面湿滑检测方法 |
DE102013113431A1 (de) * | 2013-12-04 | 2015-06-11 | Dr. Ing. H.C. F. Porsche Aktiengesellschaft | Bestimmen einer Aquaplaning-Gefahr |
CN108074409A (zh) * | 2016-11-11 | 2018-05-25 | 大陆汽车投资(上海)有限公司 | 道路安全驾驶辅助系统 |
CN109080608A (zh) * | 2018-06-04 | 2018-12-25 | 东南大学 | 一种无人驾驶车辆在雨雪湿滑路面紧急制动时的制动力控制方法 |
CN110194157A (zh) * | 2019-06-28 | 2019-09-03 | 广州小鹏汽车科技有限公司 | 一种车辆控制方法、系统及车辆 |
CN110780358A (zh) * | 2019-10-23 | 2020-02-11 | 重庆长安汽车股份有限公司 | 自动驾驶天气环境认知的方法、系统、计算机可读存储介质及车辆 |
CN111402586A (zh) * | 2020-03-26 | 2020-07-10 | 华东交通大学 | 基于车联网的公路气象环境预报预警控制系统和方法 |
CN112319491A (zh) * | 2020-10-28 | 2021-02-05 | 惠州市德赛西威汽车电子股份有限公司 | 一种安全驾驶预警方法及系统 |
-
2021
- 2021-04-22 CN CN202110433357.9A patent/CN113276882A/zh active Pending
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102011015509A1 (de) * | 2010-06-30 | 2012-01-05 | Wabco Gmbh | Verfahren und Vorrichtung zur Steuerung zumindest eines Fahrerassistenzsystems eines Fahrzeuges und damit ausgestattetes Fahrzeug |
DE102013113431A1 (de) * | 2013-12-04 | 2015-06-11 | Dr. Ing. H.C. F. Porsche Aktiengesellschaft | Bestimmen einer Aquaplaning-Gefahr |
CN104200673A (zh) * | 2014-09-01 | 2014-12-10 | 西南交通大学 | 一种基于道路图像的路面湿滑检测方法 |
CN108074409A (zh) * | 2016-11-11 | 2018-05-25 | 大陆汽车投资(上海)有限公司 | 道路安全驾驶辅助系统 |
CN109080608A (zh) * | 2018-06-04 | 2018-12-25 | 东南大学 | 一种无人驾驶车辆在雨雪湿滑路面紧急制动时的制动力控制方法 |
CN110194157A (zh) * | 2019-06-28 | 2019-09-03 | 广州小鹏汽车科技有限公司 | 一种车辆控制方法、系统及车辆 |
CN110780358A (zh) * | 2019-10-23 | 2020-02-11 | 重庆长安汽车股份有限公司 | 自动驾驶天气环境认知的方法、系统、计算机可读存储介质及车辆 |
CN111402586A (zh) * | 2020-03-26 | 2020-07-10 | 华东交通大学 | 基于车联网的公路气象环境预报预警控制系统和方法 |
CN112319491A (zh) * | 2020-10-28 | 2021-02-05 | 惠州市德赛西威汽车电子股份有限公司 | 一种安全驾驶预警方法及系统 |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114291094A (zh) * | 2021-12-28 | 2022-04-08 | 清华大学苏州汽车研究院(相城) | 一种基于自动驾驶的路面状况感知响应系统及方法 |
CN114291094B (zh) * | 2021-12-28 | 2024-05-17 | 清华大学苏州汽车研究院(相城) | 一种基于自动驾驶的路面状况感知响应系统及方法 |
CN114155700A (zh) * | 2022-02-09 | 2022-03-08 | 中国气象局公共气象服务中心(国家预警信息发布中心) | 路面湿滑状态监测方法及系统 |
CN114694376A (zh) * | 2022-02-23 | 2022-07-01 | 天津海关工业产品安全技术中心 | 车辆运行风险评估信息采集系统、风险评估系统及方法 |
CN114475597A (zh) * | 2022-02-28 | 2022-05-13 | 东风汽车集团股份有限公司 | 一种自动驾驶车辆跟车距离控制方法及控制系统 |
CN114566049A (zh) * | 2022-03-08 | 2022-05-31 | 华设设计集团股份有限公司 | 一种旅游服务区域用安全智能提示标识 |
CN114566049B (zh) * | 2022-03-08 | 2023-03-14 | 华设设计集团股份有限公司 | 一种旅游服务区域用安全智能提示标识 |
WO2023236738A1 (zh) * | 2022-06-10 | 2023-12-14 | 宁波路特斯机器人有限公司 | 一种车辆自动驾驶控制方法、装置和计算机存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113276882A (zh) | 自动驾驶车辆控制方法、控制系统及目标速度的计算方法 | |
CN110155046B (zh) | 自动紧急制动分级控制方法与系统 | |
CN107782727B (zh) | 基于融合的湿路面检测 | |
CN107257757B (zh) | 控制车辆间间距的方法 | |
CN112046454B (zh) | 一种基于车辆环境识别的自动紧急制动方法 | |
CN104691545B (zh) | 适应性车辆防碰撞方法 | |
Moon et al. | Design, tuning, and evaluation of a full-range adaptive cruise control system with collision avoidance | |
US7739023B2 (en) | Adaptive cruise control system and method for vehicle | |
CN109910879B (zh) | 一种结合安全距离与碰撞时间的车辆安全防撞控制方法 | |
EP1529695A1 (en) | Driver adaptive collision warning system | |
CN107472246A (zh) | 自适应巡航控制系统及其操作方法 | |
US20110040467A1 (en) | Adaptive cruise control system | |
CN107782413B (zh) | 水膜厚度的基于视觉的车载实时估计 | |
JP2013539572A (ja) | 運転者インタフェースタスクを管理する方法、及び、車両 | |
CN113147752B (zh) | 一种无人驾驶方法及系统 | |
CN113370800A (zh) | 车辆的扭矩控制方法、装置及车辆 | |
KR20160010083A (ko) | 노면 마찰계수를 이용한 자동 긴급 제동방법 | |
WO2023151227A1 (zh) | 确定车辆工况的方法、装置、存储介质和处理器 | |
JP6603585B2 (ja) | 車両の制御装置及び車両の制御方法 | |
US20200198621A1 (en) | Method for determining a maximum speed of a vehicle during a parking maneuver | |
CN116061913B (zh) | 基于自适应pid控制的井下车辆防追尾系统及控制方法 | |
CN111483458B (zh) | 一种动力系统控制方法及装置 | |
CN111016910A (zh) | 用于影响车辆的行驶动态的方法和行驶动态调节器 | |
CN113879303A (zh) | 自适应巡航控制方法及系统 | |
CN110723153A (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210820 |
|
RJ01 | Rejection of invention patent application after publication |