CN111951604A - 车辆速度确定方法、装置、设备和存储介质 - Google Patents
车辆速度确定方法、装置、设备和存储介质 Download PDFInfo
- Publication number
- CN111951604A CN111951604A CN201910353587.7A CN201910353587A CN111951604A CN 111951604 A CN111951604 A CN 111951604A CN 201910353587 A CN201910353587 A CN 201910353587A CN 111951604 A CN111951604 A CN 111951604A
- Authority
- CN
- China
- Prior art keywords
- speed
- lane
- vehicle
- updated
- distance
- 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 68
- 230000006870 function Effects 0.000 claims description 168
- 230000008859 change Effects 0.000 claims description 83
- 238000012545 processing Methods 0.000 claims description 11
- 238000004590 computer program Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 4
- 238000004088 simulation Methods 0.000 description 14
- 238000010586 diagram Methods 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 5
- 230000008569 process Effects 0.000 description 4
- 238000004458 analytical method Methods 0.000 description 3
- 230000006399 behavior Effects 0.000 description 3
- 238000013461 design Methods 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/052—Detecting movement of traffic to be counted or controlled with provision for determining speed or overspeed
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明提供一种车辆速度确定方法、装置、设备和存储介质。该方法包括:根据主车的至少一项行驶参数和预设的更新时间步长,确定所述主车的至少一个待更新速度;确定所述至少一个待更新速度中是否存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度;若存在,则将满足所述避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,作为所述主车在下一更新时刻的速度。本发明实施例确定的速度更准确,更能体现真实道路场景中车辆的运动。
Description
技术领域
本发明涉及智能交通技术领域,尤其涉及一种车辆速度确定方法、装置、设备和存储介质。
背景技术
交通流仿真技术是用仿真技术来研究交通行为,是对交通运动随时间和空间的变化进行跟踪描述的技术,涉及描述交通运输***在一定的时间内实时运动的数学模型。交通流仿真技术按照仿真对象的粒度可以分为微观交通流仿真、中观交通流仿真和宏观交通流仿真。微观交通流仿真对交通运输***的要素及行为的细节粒度描述程度最高,对交通流的描述是以单个车辆为基本单元,车辆在道路上的跟车、超车以及车道变换等微观行为都能得到较真实的反映,在交通工程理论研究、道路几何设计方案分析、交通管理***设计方案评价分析、道路交通安全分析和智能交通***(Intelligent Transport System,简称ITS)中都有很好的应用,因此得到了较大的发展。
微观交通流仿真一般采用如下方案:通过主车与前车的距离和相对速度,主车的期望速度等约束来计算主车的速度。该方案中需要事先人为约定车辆的轨迹,使得车辆运动轨迹单一,车辆的运动与真实车辆的运动在物理约束上有所差异,确定主车的速度的准确性较低,不能体现真实道路场景中车辆的运动。
发明内容
本发明提供一种车辆速度确定方法、装置、设备和存储介质,以提高车辆速度确定的准确性。
第一方面,本发明提供一种车辆速度确定方法,包括:
根据主车的至少一项行驶参数和预设的更新时间步长,确定所述主车的至少一个待更新速度;
确定所述至少一个待更新速度中是否存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度;
若存在,则将满足所述避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,作为所述主车在下一更新时刻的速度。
第二方面,本发明提供一种车辆速度确定装置,包括:
第一确定模块,用于根据主车的至少一项行驶参数和预设的更新时间步长,确定所述主车的至少一个待更新速度;
第二确定模块,用于确定所述至少一个待更新速度中是否存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度;
处理模块,用于若所述第二确定模块确定存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,则将满足所述避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,作为所述主车在下一更新时刻的速度。
第三方面,本发明实施例提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现第一方面中任一项所述的方法。
第四方面,本发明实施例提供一种电子设备,包括:
处理器;以及
存储器,用于存储所述处理器的可执行指令;
其中,所述处理器配置为经由执行所述可执行指令来执行第一方面中任一项所述的方法。
本发明实施例提供的车辆速度确定方法、装置、设备和存储介质,根据主车的至少一项行驶参数和预设的更新时间步长,确定所述主车的至少一个待更新速度;确定所述至少一个待更新速度中是否存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度;若存在,则将满足所述避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,作为所述主车在下一更新时刻的速度,提高了车辆速度确定的准确性,更能体现真实道路场景中车辆的运动。
附图说明
此处的附图被并入说明书中并构成本说明书的一部分,示出了符合本公开的实施例,并与说明书一起用于解释本公开的原理。
图1是本发明提供的车辆速度确定方法一实施例的流程示意图;
图2是本发明提供的方法一实施例的道路场景示意图;
图3是本发明提供的车辆速度确定装置一实施例的结构示意图;
图4是本发明提供的电子设备实施例的结构示意图。
通过上述附图,已示出本公开明确的实施例,后文中将有更详细的描述。这些附图和文字描述并不是为了通过任何方式限制本公开构思的范围,而是通过参考特定实施例为本领域技术人员说明本公开的概念。
具体实施方式
这里将详细地对示例性实施例进行说明,其示例表示在附图中。下面的描述涉及附图时,除非另有表示,不同附图中的相同数字表示相同或相似的要素。以下示例性实施例中所描述的实施方式并不代表与本公开相一致的所有实施方式。相反,它们仅是与如所附权利要求书中所详述的、本公开的一些方面相一致的装置和方法的例子。
本发明的说明书和权利要求书及所述附图中的术语“包括”和“具有”以及它们任何变形,意图在于覆盖不排他的包含。例如包含了一系列步骤或单元的过程、方法、***、产品或设备没有限定于已列出的步骤或单元,而是可选地还包括没有列出的步骤或单元,或可选地还包括对于这些过程、方法、产品或设备固有的其它步骤或单元。
首先对本发明所涉及的应用场景进行介绍:
本发明实施例提供的车辆速度确定方法,应用于主动安全驾驶场景中对车辆速度的确定,以提高车辆的安全性能。其中,上述车辆例如为自动驾驶车辆,或普通车辆。本发明实施例中的道路场景例如为高速路场景、城市环线、普通道路等。以下实施例中以高速路进行举例说明。
由于目前微观交通流仿真方法的约束条件简单,往往根据路网结构加入大量人为适应性约束,如车辆轨迹,速度,转弯,变道等内容,因此使交通流仿真方法难以具有不同路网结构间的普适性。而本发明实施例的方法根据交通流环境(即道路、相邻车辆等)的约束条件从合理速度中确定较优的速度,不受路况限制,具有很好的交通流环境自适应性,对于不同的路网和交通流密度均可以得到较好的仿真结果,大大增加了车辆在交通流中运动状态的多样性。
由于一些简单的交通流仿真模型缺少对车辆的动力学模型考虑,导致车辆在转弯,变道等情况下运动方式与真实车辆运动存在较大差异,因此本发明实施例的方法在确定车辆速度时加入对车辆动力学模型约束的考虑,使车辆速度满足车辆运动的物理约束。
本发明提供的方法可由电子设备如处理器执行相应的软件代码实现,也可由该电子设备在执行相应的软件代码的同时,通过和其他设备或服务器进行数据交互来实现,如其他设备或服务器执行部分操作,来控制该电子设备执行车辆速度确定方法。
下面的实施例均以电子设备为执行主体进行说明。以下实施例中以自动驾驶车辆为例进行说明。
下面以具体的实施例对本发明的技术方案进行详细说明。下面这几个具体的实施例可以相互结合,对于相同或相似的概念或过程可能在某些实施例不再赘述。
图1是本发明提供的车辆速度确定方法一实施例的流程示意图。如图1所示,本实施例提供的方法,包括:
步骤101、根据主车的至少一项行驶参数和预设的更新时间步长,确定主车在下一更新时刻的至少一个待更新速度。
具体的,主车为当前道路场景中任意一辆车辆,主车的至少一项行驶参数例如包括:当前速度、加速度范围、车轮转角范围等,当前速度可以是预设的初始速度,也可以是前一更新时刻更新的速度。
根据主车的至少一项行驶参数和预设的更新时间步长,计算出多个可作为主车速度的待更新速度。
在确定速度之前,可以根据预设的道路场景条件构建路网结构;所述路网结构中可以包括:多个并行的车道;车道可以通过一些离散的线段实现。
根据预设的交通流密度确定该路网结构中的车辆个数和车辆的初始位置;
具体可以根据高速路场景构建路网结构,随机初始化车辆的速度。
当前道路场景中的车辆的信息包括以下至少一项:车辆的尺寸、加速度范围、车轮转角范围、期望速度、初始位置、初始速度、初始方向。
步骤102、确定至少一个待更新速度中是否存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度。
具体的,车辆动力学约束是指主车的速度方向变化角度需合理,即主车的速度方向变化角度需满足一定的条件。
避障约束条件是指主车与主车所在的当前车道的前车之间的距离需满足一定条件,即根据该主车与主车所在的当前车道的前车之间的距离得出的避障能量函数需小于第一预设阈值。
车道约束条件是指主车与主车所在的当前车道或主车待进入的目标车道之间需满足一定的约束条件,例如与当前车道方向的夹角或距离,与目标车道方向的夹角或距离。
需确定同时满足上述避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度。
在本发明的一实施例中,具体可以采用如下方式确定是否存在同时满足上述避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度:
根据各个待更新速度,确定各个待更新速度在下一更新时刻的速度方向变化角度;
根据预设的速度与速度方向变化角度的关系以及主车的车轮转角范围,确定各个所述待更新速度在下一更新时刻的速度方向变化角度是否合理;
若各个待更新速度在下一更新时刻的速度方向变化角度合理,则各个待更新速度满足车辆动力学模型约束;
确定满足车辆动力学模型约束的各个待更新速度,是否满足避障约束条件和车道约束条件。
具体的,首先可以确定各个待更新速度是否满足车辆动力学模型约束,若满足则进一步确定是否满足避障约束条件和车道约束条件。
满足车辆动力学模型约束,即需要确定该待更新速度在下一更新时刻的速度方向变化角度是否合理,若合理,则满足车辆动力学模型约束。
速度方向变化角度是否合理,可以根据车轮转角范围以及速度与速度方向变化角度的关系确定,例如速度方向变化角度是否在车轮转角范围内,若是,且满足速度与速度方向变化角度的关系,则该速度方向变化角度合理,例如该待更新速度较大,则速度方向变化角度应较小,否则车辆行驶较为危险。
确定该待更新速度对应的速度方向变化角度,可以根据待更新速度、当前的车轮转角、主车的轴距、更新时间步长确定出来。
进一步的,确定满足车辆动力学模型约束的各个待更新速度,是否满足所述避障约束条件和车道约束条件,具体可以采用如下方式实现:
根据各个所述待更新速度,确定各个所述待更新速度对应的所述避障约束条件中的避障能量函数;
若所述避障能量函数的值小于第一预设阈值,则确定各个所述待更新速度满足所述避障约束条件;
确定各个所述待更新速度是否满足所述车道约束条件。
具体的,先确定车辆的待更新速度是否满足避障约束条件,再确定是否满足车道约束条件。
确定是否满足避障约束条件,即确定待更新速度对应的避障能量函数的数值是否小于第一预设阈值,若小于则该待更新速度满足该避障约束条件,若大于或等于则不满足该避障约束条件。其中,避障能量函数可以根据主车与前车的距离确定出来。避障能量函数的值越大说明主车与前车发生碰撞的可能性越大。
进一步的,确定满足车辆动力学模型约束和避障约束条件的各个待更新速度,是否满足车道约束条件,具体可以采用如下方式实现:
根据各个待更新速度,确定待更新速度对应的车道约束条件中的速度方向能量函数、车道距离能量函数和车道方向能量函数;
若速度方向能量函数的值小于第二预设阈值、车道距离能量函数的值小于第三预设阈值,且车道方向能量函数的值小于第四预设阈值,则确定各个待更新速度满足车道约束条件。
具体的,确定是否满足车道约束条件,即确定待更新速度对应的速度方向能量函数、车道距离能量函数、车道方向能量函数的数值是否小于各自对应的预设阈值,若均小于则该待更新速度满足该车道约束条件,若有至少一个函数的数值大于或等于预设阈值则不满足该车道约束条件。
其中,速度方向能量函数可以根据主车与当前车道方向(或目标车道方向)的夹角确定出来,该速度方向能量函数的数值越大,说明主车与当前车道方向的夹角越大,车辆行驶越危险。
车道距离能量函数可以根据主车与当前车道(或目标车道)的距离确定出来,具体是主车与当前车道的中心线的距离,该车道距离能量函数的数值越大,说明主车与当前车道的距离越大,车辆行驶越危险。
车道方向能量函数可以根据主车的方向与当前车道方向(或目标车道方向)的夹角确定出来,该车道方向能量函数的数值越大,说明主车的方向与当前的车道方向的夹角越大,车辆行驶越危险。
步骤103、若存在,则将满足避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,作为主车在下一更新时刻的速度。
进一步的,若存在多个满足避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,可以确定一个较优的待更新速度作为主车在下一更新时刻的速度:
从各个满足所述避障约束条件、所述车道约束条件和所述车辆动力学模型约束的待更新速度中,查找使得所述避障能量函数、速度方向能量函数、车道距离能量函数以及车道方向能量函数之和最小的待更新速度。
进一步的,在本发明的一实施例中,该方法还可以包括如下步骤:
若所述主车的避障能量函数的值为零时,则根据预设的期望速度以及所述主车的待更新速度,确定所述待更新速度对应的速度期望约束函数;
所述从各个满足所述避障约束条件、所述车道约束条件和所述车辆动力学模型约束的待更新速度中,查找使得所述避障能量函数、速度方向能量函数、车道距离能量函数以及车道方向能量函数之和最小的待更新速度,包括:
从各个满足所述避障约束条件、所述车道约束条件和所述车辆动力学模型约束的待更新速度中,查找使得所述避障能量函数、速度方向能量函数、车道距离能量函数、车道方向能量函数以及所述速度期望约束函数之和最小的待更新速度。
具体的,若避障能量函数的数值为0,则说明与前车不会发生碰撞,则可以将主车的速度更新为尽量与期望速度接近的速度,速度期望约束函数可以根据期望速度和待更新速度的差值得到。
具体可以将使得避障能量函数、速度方向能量函数、车道距离能量函数、车道方向能量函数以及速度期望约束函数之和最小的待更新速度,作为主车在下一更新时刻的速度。
进一步的,可以基于该待更新速度,确定主车在下一更新时刻的位置。
下一更新时刻的位置可以基于主车当前的位置、更新时间步长以及下一更新时刻的速度计算得到。
本实施例的方法,根据主车的当前速度、加速度范围、车轮转角范围和预设的更新时间步长,确定所述主车的至少一个待更新速度;确定所述至少一个待更新速度中是否存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度;若存在,则将满足所述避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,作为所述主车在下一更新时刻的速度,提高了车辆速度确定的准确性,更能体现真实道路场景中车辆的运动。
在上述实施例的基础上,进一步的,确定所述主车在下一更新时刻的速度方向变化角度,具体可以包括如下方式实现:
根据主车的车轮转角、轴距和待更新速度,确定主车在下一更新时刻的速度方向变化角度。
具体可以根据如下公式(1)确定待更新速度在下一更新时刻的速度方向变化角度Δθ;
Δθ=tan(Φ)/L×v0×Δt (1);
其中,Φ为车轮转角,L为轴距,v0为所述待更新速度,Δt为所述更新时间步长。
进一步的,确定各个待更新速度在下一更新时刻的速度方向变化角度是否合理,具体可以包括如下方式实现:
确定所述速度方向变化角度是否在所述主车的车轮转角范围内;
若是,则根据速度与速度方向变化角度的关系以及速度方向变化角度,确定速度方向变化角度是否合理。
具体的,若速度方向变化角度在主车的车轮转角范围内,则初步判定速度方向变化角度合理,再通过速度与速度方向变化角度的关系进一步确认该速度方向变化角度是否合理,即若速度较大,则速度方向变化角度应较小,在一定范围内。
在上述实施例的基础上,进一步的,确定避障能量函数之前还可以进行如下操作:
若所述主车所在的当前车道中存在前车,根据所述主车的待更新速度和所述前车的当前速度,确定所述主车与所述前车沿所述当前车道方向在下一更新时刻的第一距离,并预测所述主车与所述前车沿所述当前车道方向在预设时长后的第二距离;
若所述第一距离和所述第二距离大于预设的安全距离,则确定所述避障能量函数。
具体的,若主车所在的当前车道中存在前车,确定主车与前车在下一更新时刻的第一距离,并预测该主车与前车在预设时长后的第二距离,若该第一距离或第二距离小于预设的安全距离,则主车和前车可能会发生碰撞,则舍弃该待更新速度。
若第一距离和第二距离大于预设的安全距离,则确定避障能量函数。根据避障能量函数进一步确定该待更新速度是否满足避障约束条件。
其中,安全距离是指保持主车的当前车速(即待更新速度),前车车速降为0时在安全时间内不发生相撞的距离。
其中,第一距离s可以根据如下公式得到:
s=p0+v0×Δt–(p1+v1×Δt);
其中,p0,p1分别为所述主车与所述当前车道的前车的当前位置,v0为所述待更新速度,v1为所述当前车道的前车的当前车速;
第二距离sp可以根据如下公式得到:
sp=p0+v0×Δt×εp–(p1+v1×Δt×εp);
其中,εp为预设的预测步长;Δt×εp为预设时长。
进一步的,确定各个所述待更新速度对应的所述避障约束条件中的避障能量函数,具体可以通过如下方式实现:
若所述主车处于非变道状态,则根据所述待更新速度、所述第一距离、所述第二距离以及预设的安全时间,确定所述避障能量函数;
若所述主车处于变道状态,则根据所述待更新速度、所述第一距离、所述第二距离、第三距离、第四距离以及预设的安全时间,确定所述避障能量函数;所述第三距离为所述主车与目标车道的前车之间的距离,所述第四距离为在预设时长后所述主车与所述目标车道的前车之间的预测距离。
具体的,若主车处于非变道状态,即主车一直沿着主车所在的当前车道行驶,可根据如下公式(2)确定待更新速度对应的避障能量函数enRep;
enRep=ρrep×(v0×tsafe-min(s,sp)) (2);
其中,ρrep为预设的第一权重,tsafe为预设的安全时间,s为所述第一距离,sp为所述第二距离;第一距离和第二距离的计算公式参见前述实施例;
若所述主车处于变道状态,即主车从当前车道向目标车道变道,可以根据如下公式(3)确定所述待更新速度对应的避障能量函数enRep;
enRep=ρrep×(v0×tsafe-min(s,sp,st,stp)) (3);
其中,st为所述第三距离,stp为所述第四距离;第三距离为主车与目标车道的前车之间的距离,第四距离为在预设时长后主车与目标车道的前车之间的预测距离;具体可以根据如下公式计算:
st=p0+v0×Δt–(p2+v2×Δt);
stp=p0+v0×Δt×εp–(p2+v2×Δt×εp);
其中,p0,p2分别为主车与目标车道的前车的当前位置,v0为待更新速度,v2为目标车道的前车的当前车速;Δt×εp为预设时长。
进一步的,在确定所述避障能量函数之前,还可以确定所述主车是否处于变道状态,若是,则根据根据所述待更新速度、所述第一距离、所述第二距离、第三距离、第四距离以及预设的安全时间,确定所述避障能量函数,若否,则根据根据所述待更新速度、所述第一距离、所述第二距离以及预设的安全时间,确定所述避障能量函数。
在上述实施例的基础上,进一步的,确定所述车道约束条件中的速度方向能量函数、车道距离能量函数和车道方向能量函数具体可以采用如下方式:
若所述主车处于变道状态,则可以采用如下方式:
若所述主车与所述主车所在的当前车道的第一夹角大于预设的第一角度阈值,则根据所述第一夹角确定所述速度方向能量函数;
若所述第一夹角小于所述第一角度阈值,且所述主车与所述主车待进入的目标车道的第五距离大于预设的第二距离阈值,则根据所述主车与所述目标车道的第五距离确定所述车道距离能量函数;
若所述第一夹角小于所述第一预设阈值,所述主车与所述目标车道的距离小于所述第二距离阈值,且所述主车与所述目标车道方向的第二夹角大于预设的第二角度阈值,则根据所述主车第二夹角确定所述车道方向能量函数。
具体的,主车处于变道状态,即主车从当前车道向目标车道变道行驶,主车与主车所在的当前车道的第一夹角大于预设的第一角度阈值,此时尽量保持第一夹角的大小不变,可以适当变小,最好不要变大,否则可能会有逆行的风险。
可以根据如下公式(4)确定所述待更新速度对应的速度方向能量函数enVel;
enVel=ρvel×tan(|Δθ'|) (4);
其中,ρvel为预设的第二权重,此时Δθ'为主车与主车所在的当前车道的第一夹角。第一夹角为主车的方向与主车所在的当前车道的第一夹角,在主车的速度不为0时,主车的方向与速度方向相同。
即需保证速度方向能量函数需小于一定的阈值,即主车与主车所在的当前车道的第一夹角需小于预设的第一角度阈值,否则待更新速度不满足车道约束条件。
若第一夹角小于第一角度阈值,且主车与主车待进入的目标车道的第五距离大于预设的第二距离阈值,则根据如下公式(5)确定所述待更新速度对应的车道距离能量函数enLanePos;
enLanePos=ρlanePos×slane×slane (5);
其中,ρlanePos为预设的第三权重,此时slane为主车与目标车道的第五距离。
待更新速度对应的车道距离能量函数也需满足一定条件,即小于一定的阈值,即主车与目标车道的距离需小于一定的阈值,才能使得主车进入目标车道行驶,才能保证待更新速度满足车道约束条件。
若第一夹角小于第一预设阈值,主车与目标车道的第五距离小于第二距离阈值,且主车与目标车道方向的第二夹角大于预设的第二角度阈值,则可以根据如下公式(6)确定待更新速度对应的车道方向能量函数enLaneDir;
enLaneDir=ρlaneDir×tan(Δθ") (6);
其中ρlaneDir为预设的第四权重,此时Δθ"为主车与目标车道方向的第二夹角。
待更新速度对应的车道方向能量函数也需满足一定条件,即小于一定的阈值,即主车与目标车道方向的第二夹角也需小于第二角度阈值,使得主车的速度方向不偏离目标车道,才能保证待更新速度满足车道约束条件。
在本发明的一实施例中,在所述主车与所述目标车道的第五距离小于所述第二距离阈值,且所述主车与所述目标车道方向的第二夹角小于第二角度阈值,则此时主车进入目标车道,尽量保证主车沿着目标车道方向开,即速度方向能量函数尽量小。
若所述主车处于非变道状态,则可以采用如下方式:
若所述主车与所述主车所在的当前车道的距离大于预设的第二距离阈值,则根据所述主车与所述主车所在的当前车道的距离确定所述车道距离能量函数;
若所述主车与所述主车所在的当前车道的距离小于所述第二距离阈值,且所述主车与所述主车所在的当前车道方向的第三夹角大于预设的第一角度阈值,则根据所述第三夹角确定所述车道方向能量函数;
若所述主车与所述主车所在的当前车道的距离小于所述第二距离阈值,且所述第三夹角小于所述第一角度阈值,则根据所述第三夹角确定所述速度方向能量函数。
具体的,主车处于非变道状态,则主车沿着当前车道行驶,主车与主车所在的当前车道的距离大于预设的第二距离阈值,则根据前述公式(5)确定待更新速度对应的车道距离能量函数enLanePos,此时公式(5)中slane为主车与当前车道的距离。
待更新速度对应的车道距离能量函数也需满足一定条件,即小于一定的阈值,即主车与当前车道的距离小于一定阈值,保证主车不偏离当前车道,不进入其他车道,才能保证待更新速度满足车道约束条件。
若主车与当前车道的距离小于第二距离阈值,且主车与当前车道方向的第三夹角大于预设的第一角度阈值,则可以根据前述公式(6)确定待更新速度对应的车道方向能量函数enLaneDir,此时Δθ"为主车与当前车道方向的第三夹角。
待更新速度对应的车道方向能量函数也需满足一定条件,即小于一定的阈值,即主车与当前车道方向的第三夹角也需小于第一角度阈值,使得主车的速度方向不偏离当前车道,才能保证待更新速度满足车道约束条件。
主车与当前车道方向的第三夹角大于预设的第一角度阈值,此时应尽量减小第三夹角的大小。
若主车与当前车道的距离小于第二距离阈值,且第三夹角小于第一角度阈值,则可以根据前述公式(4)确定所述待更新速度对应的速度方向能量函数enVel,此时公式(4)中Δθ'为主车与当前车道方向的第三夹角。
即需保证速度方向能量函数需小于一定的阈值,即主车与主车所在的当前车道的第三夹角需小于预设的第一角度阈值,尽量保证主车沿着当前车道方向开,否则待更新速度不满足车道约束条件。
其中,第一角度阈值和第二角度阈值可以相等,或不等,本发明实施例对此并不限定。
上述具体实施方式中,根据车辆动力学模型约束、避障约束条件和车道约束条件确定车辆的速度,提高了车辆速度确定的准确性,更能体现真实道路场景中车辆的运动。
在上述实施例的基础上,进一步的,本实施例的方法还可以包括:
确定主车是否从所述主车所在的当前车道向目标车道变道行驶;所述目标车道为所述当前车道相邻的车道;
若是,则确定所述主车处于变道状态;
若否,则确定所述主车处于所述非变道状态。
在本发明的一实施例中,还包括:
确定所述主车是否满足预设的变道发动条件;
若所述主车满足所述变道发动条件,则确定所述主车是否满足预设的变道决定条件;
若所述主车满足所述变道决定条件,则控制所述主车从所述主车所在的当前车道向目标车道变道行驶。
具体的,确定主车是否处于变道状态,即确定主车是否从当前车道向目标车道变道行驶,这之前需确定该主车是否进行变道:
首先确定该主车是否满足变道发动条件,若是,则进一步确定该主车是否满足变道决定条件,若满足变道决定条件,则控制所述主车从当前车道向目标车道变道行驶,此时主车处于变道状态。
进一步的,确定主车是否满足变道发动条件具体可以采用如下方式:
确定所述主车所在的当前车道是否存在相邻车道;
若所述主车所在的当前车道存在相邻车道,确定所述当前车道中是否存在前车;
若所述当前车道中存在前车,则确定所述前车是否处于非变道状态;
若所述前车处于非变道状态,则确定所述主车满足所述变道发动条件。
具体的,如图2所示,若主车1所在的当前车道存在相邻车道,且当前车道中存在前车2,并且该前车处于非变道状态,则主车满足变道发动条件,即可以启动变道。
进一步,需确定该主车是否满足变道决定条件,若满足变道决定条件则向目标车道进行变道,具体可以采用如下方式:
确定主车与当前车道中前车的距离,和主车与目标车道中前车的距离之间的差值是否小于预设的第一距离阈值;
若是,则确定主车与目标车道中前车沿目标车道方向的距离是否大于预设的安全距离;
若是,则确定主车与目标车道中后车沿目标车道方向的距离是否大于安全距离;目标车道为当前车道的相邻车道;
若是,则确定主车满足变道决定条件。
具体的,如图2所示,主车1与当前车道中前车2的距离假设为L1,主车1与目标车道中前车4的距离假设为L2,L1与L2之间的差值若小于第一距离阈值,且主车1与目标车道中前车4距离大于安全距离,且主车1与目标车道中后车3的距离也大于安全距离,则主车满足变道决定条件,可以从当前车道向目标车道变道行驶。
在本发明的一实施例中,可以根据如下公式(7)确定所述待更新速度对应的速度期望约束函数enVelLimit;
enVelLimit=ρvelLimit×|v0-vlimit| (7);
其中,ρvelLimit为预设的第五权重,vlimit为期望速度,v0为待更新速度。
在本发明的一实施例中,在确定主车在下一更新时刻的速度后,可以对该速度进行插值,即主车在下一更新时刻的速度变化是平滑的,从当前速度逐渐变到确定出的待更新速度。
图3为本发明提供的车辆速度确定装置一实施例的结构图,如图3所示,本实施例的车辆速度确定装置,包括:
第一确定模块301,用于根据主车的至少一项行驶参数和预设的更新时间步长,确定所述主车的至少一个待更新速度;
第二确定模块302,用于确定所述至少一个待更新速度中是否存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度;
处理模块303,用于若所述第二确定模块确定存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,则将满足所述避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,作为所述主车在下一更新时刻的速度。
在一种可能的实现方式中,第二确定模块302,具体用于:
根据各个所述待更新速度,确定各个所述待更新速度在下一更新时刻的速度方向变化角度;
根据预设的速度与速度方向变化角度的关系以及所述主车的车轮转角范围,确定各个所述待更新速度在下一更新时刻的速度方向变化角度是否合理;
若各个所述待更新速度在下一更新时刻的速度方向变化角度合理,则各个所述待更新速度满足所述车辆动力学模型约束;
确定满足所述车辆动力学模型约束的各个所述待更新速度,是否满足所述避障约束条件和车道约束条件。
在一种可能的实现方式中,第二确定模块302,具体用于:
根据各个所述待更新速度,确定各个所述待更新速度对应的所述避障约束条件中的避障能量函数;
若所述避障能量函数的值小于第一预设阈值,则确定各个所述待更新速度满足所述避障约束条件;
确定各个所述待更新速度是否满足所述车道约束条件。
在一种可能的实现方式中,第二确定模块302,具体用于:
根据各个所述待更新速度,确定所述待更新速度对应的所述车道约束条件中的速度方向能量函数、车道距离能量函数和车道方向能量函数;
若所述速度方向能量函数的值小于第二预设阈值、所述车道距离能量函数的值小于第三预设阈值,且所述车道方向能量函数的值小于第四预设阈值,则确定各个所述待更新速度满足所述车道约束条件。
在一种可能的实现方式中,处理模块302,具体用于:
从各个满足所述避障约束条件、所述车道约束条件和所述车辆动力学模型约束的待更新速度中,查找使得所述避障能量函数、速度方向能量函数、车道距离能量函数以及车道方向能量函数之和最小的待更新速度,将所述待更新速度作为所述主车在下一更新时刻的速度。
在一种可能的实现方式中,第二确定模块302,具体用于:
根据所述主车的车轮转角、轴距和所述待更新速度,确定所述主车在下一更新时刻的速度方向变化角度;
确定所述速度方向变化角度是否在所述主车的车轮转角范围内;
若是,则根据所述速度与速度方向变化角度的关系以及所述速度方向变化角度,确定所述速度方向变化角度是否合理。
在一种可能的实现方式中,第二确定模块302,还用于:
若所述主车所在的当前车道中存在前车,根据所述主车的待更新速度和所述前车的当前速度,确定所述主车与所述前车沿所述当前车道方向在下一更新时刻的第一距离,并预测所述主车与所述前车沿所述当前车道方向在预设时长后的第二距离;
若所述第一距离和所述第二距离大于预设的安全距离,则确定所述避障能量函数。
在一种可能的实现方式中,第二确定模块302,具体用于:
若所述主车处于非变道状态,则根据所述待更新速度、所述第一距离、所述第二距离以及预设的安全时间,确定所述避障能量函数;
若所述主车处于变道状态,则根据所述待更新速度、所述第一距离、所述第二距离、第三距离、第四距离以及预设的安全时间,确定所述避障能量函数;所述第三距离为所述主车与目标车道的前车之间的距离,所述第四距离为在预设时长后所述主车与所述目标车道的前车之间的预测距离。
在一种可能的实现方式中,若所述主车处于变道状态,第二确定模块302,具体用于:
若所述主车与所述主车所在的当前车道的第一夹角大于预设的第一角度阈值,则根据所述第一夹角确定所述速度方向能量函数;
若所述第一夹角小于所述第一角度阈值,且所述主车与所述主车待进入的目标车道的第五距离大于预设的第二距离阈值,则根据所述主车与所述目标车道的第五距离确定所述车道距离能量函数;
若所述第一夹角小于所述第一预设阈值,所述主车与所述目标车道的距离小于所述第二距离阈值,且所述主车与所述目标车道方向的第二夹角大于预设的第二角度阈值,则根据所述主车第二夹角确定所述车道方向能量函数。
在一种可能的实现方式中,若所述主车处于非变道状态,第二确定模块302,具体用于:
若所述主车与所述主车所在的当前车道的距离大于预设的第二距离阈值,则根据所述主车与所述主车所在的当前车道的距离确定所述车道距离能量函数;
若所述主车与所述主车所在的当前车道的距离小于所述第二距离阈值,且所述主车与所述主车所在的当前车道方向的第三夹角大于预设的第一角度阈值,则根据所述主车第三夹角确定所述车道方向能量函数;
若所述主车与所述主车所在的当前车道的距离小于所述第二距离阈值,且所述第三夹角小于所述第一角度阈值,则根据所述第三夹角确定所述速度方向能量函数。
在一种可能的实现方式中,处理模块303,还用于:
若所述主车的避障能量函数的值为零时,则根据预设的期望速度以及所述主车的待更新速度,确定所述待更新速度对应的速度期望约束函数;
从各个满足所述避障约束条件、所述车道约束条件和所述车辆动力学模型约束的待更新速度中,查找使得所述避障能量函数、速度方向能量函数、车道距离能量函数、车道方向能量函数以及所述速度期望约束函数之和最小的待更新速度。
在一种可能的实现方式中,处理模块303,还用于:
确定所述主车是否从所述主车所在的当前车道向目标车道变道行驶;所述目标车道为所述当前车道相邻的车道;
若是,则确定所述主车处于变道状态;
若否,则确定所述主车处于非变道状态。
在一种可能的实现方式中,处理模块303,还用于:
确定所述主车是否满足预设的变道发动条件;
若所述主车满足所述变道发动条件,则确定所述主车是否满足预设的变道决定条件;
若所述主车满足所述变道决定条件,则控制所述主车从所述主车所在的当前车道向目标车道变道行驶。
在一种可能的实现方式中,处理模块303,具体用于:
确定所述主车所在的当前车道是否存在相邻车道;
若所述主车所在的当前车道存在相邻车道,确定所述当前车道中是否存在前车;
若所述当前车道中存在前车,则确定所述前车是否处于非变道状态;
若所述前车处于非变道状态,则确定所述主车满足所述变道发动条件。
在一种可能的实现方式中,处理模块303,具体用于:
确定所述主车与所述当前车道中前车的距离,和所述主车与目标车道中前车的距离之间的差值是否小于预设的第一距离阈值;
若是,则确定所述主车与所述目标车道中前车沿所述目标车道方向的距离是否大于预设的安全距离;
若是,则确定所述主车与所述目标车道中后车沿所述目标车道方向的距离是否大于所述安全距离;所述目标车道为所述当前车道的相邻车道;
若是,则确定所述主车满足所述变道决定条件。
在一种可能的实现方式中,所述第一确定模块301,具体用于:
根据预设的道路场景条件构建路网结构;所述路网结构中包括:多个并行的车道;
根据预设的交通流密度确定所述路网结构中的车辆个数和车辆的初始位置;
其中,所述车辆的信息包括以下至少一项:车辆的尺寸、加速度范围、车轮转角范围、期望速度、初始位置、初始速度、初始方向。
在一种可能的实现方式中,处理模块303,还用于:
根据所述主车在下一更新时刻的速度,确定所述主车在下一更新时刻的位置。
在一种可能的实现方式中,所述第二确定模块302,具体用于:
根据如下公式(1)确定所述待更新速度在下一更新时刻的速度方向变化角度Δθ;
Δθ=tan(Φ)/L×v0×Δt (1);
其中,Φ为车轮转角,L为轴距,v0为所述待更新速度,Δt为所述更新时间步长。
在一种可能的实现方式中,所述第二确定模块302,具体用于:
若所述主车处于非变道状态,根据如下公式(2)确定所述待更新速度对应的避障能量函数enRep;
enRep=ρrep×(v0×tsafe-min(s,sp)) (2);
其中,ρrep为预设的第一权重,tsafe为预设的安全时间,s为所述第一距离,sp为所述第二距离;s=p0+v0×Δt–(p1+v1×Δt);sp=p0+v0×Δt×εp–(p1+v1×Δt×εp);p0,p1分别为所述主车与所述当前车道的前车的当前位置,v0为所述待更新速度,v1为所述当前车道的前车的当前车速,εp为预设的预测步长;
若所述主车处于变道状态,根据如下公式(3)确定所述待更新速度对应的避障能量函数enRep;
enRep=ρrep×(v0×tsafe-min(s,sp,st,stp)) (3);
其中,st为所述第三距离,stp为所述第四距离;
st=p0+v0×Δt–(p2+v2×Δt);
stp=p0+v0×Δt×εp–(p2+v2×Δt×εp);
其中,p0,p2分别为所述主车与所述目标车道的前车的当前位置,v0为所述待更新速度,v2为所述目标车道的前车的当前车速。
在一种可能的实现方式中,所述第二确定模块302,具体用于:
根据如下公式(4)确定所述待更新速度对应的速度方向能量函数enVel;
enVel=ρvel×tan(|Δθ'|) (4);
其中,ρvel为预设的第二权重,Δθ'为所述第一夹角或所述第三夹角。
在一种可能的实现方式中,所述第二确定模块302,具体用于:
根据如下公式(5)确定所述待更新速度对应的车道距离能量函数enLanePos;
enLanePos=ρlanePos×slane×slane (5);
其中,ρlanePos为预设的第三权重,slane为所述主车与目标车道的距离,或所述主车与所述主车所在的当前车道的距离。
在一种可能的实现方式中,所述第二确定模块302,具体用于:
根据如下公式(6)确定待更新速度对应的车道方向能量函数enLaneDir;
enLaneDir=ρlaneDir×tan(Δθ") (6);
其中ρlaneDir为预设的第四权重,Δθ"为所述第二夹角或所述第三夹角。
在一种可能的实现方式中,所述处理模块303,具体用于:
根据如下公式(7)确定所述待更新速度对应的速度期望约束函数enVelLimit;
enVelLimit=ρvelLimit×|v0-vlimit| (7);
其中,ρvelLimit为预设的第五权重,vlimit为期望速度,v0为所述待更新速度。
本实施例的装置,可以用于执行上述方法实施例的技术方案,其实现原理和技术效果类似,此处不再赘述。
图4为本发明提供的电子设备实施例的结构图,如图4所示,该电子设备包括:
处理器401,以及,用于存储处理器401的可执行指令的存储器402。
可选的,还可以包括:收发器403,用于实现与其他设备的通信。
上述部件可以通过一条或多条总线进行通信。
其中,处理器401配置为经由执行所述可执行指令来执行前述方法实施例中对应的方法,其具体实施过程可以参见前述方法实施例,此处不再赘述。
本发明实施例中还提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现前述方法实施例中对应的方法,其具体实施过程可以参见前述方法实施例,其实现原理和技术效果类似,此处不再赘述。
本领域技术人员在考虑说明书及实践这里公开的发明后,将容易想到本公开的其它实施方案。本发明旨在涵盖本公开的任何变型、用途或者适应性变化,这些变型、用途或者适应性变化遵循本公开的一般性原理并包括本公开未公开的本技术领域中的公知常识或惯用技术手段。说明书和实施例仅被视为示例性的,本公开的真正范围和精神由下面的权利要求书指出。
应当理解的是,本公开并不局限于上面已经描述并在附图中示出的精确结构,并且可以在不脱离其范围进行各种修改和改变。本公开的范围仅由所附的权利要求书来限制。
Claims (26)
1.一种车辆速度确定方法,其特征在于,包括:
根据主车的至少一项行驶参数和预设的更新时间步长,确定所述主车的至少一个待更新速度;
确定所述至少一个待更新速度中是否存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度;
若存在,则将满足所述避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,作为所述主车在下一更新时刻的速度。
2.根据权利要求1所述的方法,其特征在于,所述确定所述至少一个待更新速度中是否存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,包括:
根据各个所述待更新速度,确定各个所述待更新速度在下一更新时刻的速度方向变化角度;
根据预设的速度与速度方向变化角度的关系以及所述主车的车轮转角范围,确定各个所述待更新速度在下一更新时刻的速度方向变化角度是否合理;
若各个所述待更新速度在下一更新时刻的速度方向变化角度合理,则各个所述待更新速度满足所述车辆动力学模型约束;
确定满足所述车辆动力学模型约束的各个所述待更新速度,是否满足所述避障约束条件和车道约束条件。
3.根据权利要求2所述的方法,其特征在于,所述确定满足所述车辆动力学模型约束的各个所述待更新速度,是否满足所述避障约束条件和车道约束条件,包括:
根据各个所述待更新速度,确定各个所述待更新速度对应的所述避障约束条件中的避障能量函数;
若所述避障能量函数的值小于第一预设阈值,则确定各个所述待更新速度满足所述避障约束条件;
确定各个所述待更新速度是否满足所述车道约束条件。
4.根据权利要求3所述的方法,其特征在于,所述确定各个所述待更新速度是否满足所述车道约束条件,包括:
根据各个所述待更新速度,确定所述待更新速度对应的所述车道约束条件中的速度方向能量函数、车道距离能量函数和车道方向能量函数;
若所述速度方向能量函数的值小于第二预设阈值、所述车道距离能量函数的值小于第三预设阈值,且所述车道方向能量函数的值小于第四预设阈值,则确定各个所述待更新速度满足所述车道约束条件。
5.根据权利要求4所述的方法,其特征在于,所述确定各个所述待更新速度满足所述车道约束条件之后,还包括:
从各个满足所述避障约束条件、所述车道约束条件和所述车辆动力学模型约束的待更新速度中,查找使得所述避障能量函数、速度方向能量函数、车道距离能量函数以及车道方向能量函数之和最小的待更新速度,将所述待更新速度作为所述主车在下一更新时刻的速度。
6.根据权利要求2所述的方法,其特征在于,所述根据各个所述待更新速度,确定各个所述待更新速度在下一更新时刻的速度方向变化角度,包括:
根据所述主车的车轮转角、轴距和所述待更新速度,确定所述主车在下一更新时刻的速度方向变化角度;
相应的,所述根据预设的速度与速度方向变化角度的关系以及所述主车的车轮转角范围,确定各个所述待更新速度在下一更新时刻的速度方向变化角度是否合理,包括:
确定所述速度方向变化角度是否在所述主车的车轮转角范围内;
若是,则根据所述速度与速度方向变化角度的关系以及所述速度方向变化角度,确定所述速度方向变化角度是否合理。
7.根据权利要求3所述的方法,其特征在于,确定各个所述待更新速度对应的所述避障约束条件中的避障能量函数之前,还包括:
若所述主车所在的当前车道中存在前车,根据所述主车的待更新速度和所述前车的当前速度,确定所述主车与所述前车沿所述当前车道方向在下一更新时刻的第一距离,并预测所述主车与所述前车沿所述当前车道方向在预设时长后的第二距离;
若所述第一距离和所述第二距离大于预设的安全距离,则确定所述避障能量函数。
8.根据权利要求7所述的方法,其特征在于,所述确定各个所述待更新速度对应的所述避障约束条件中的避障能量函数,包括:
若所述主车处于非变道状态,则根据所述待更新速度、所述第一距离、所述第二距离以及预设的安全时间,确定所述避障能量函数;
若所述主车处于变道状态,则根据所述待更新速度、所述第一距离、所述第二距离、第三距离、第四距离以及预设的安全时间,确定所述避障能量函数;所述第三距离为所述主车与目标车道的前车之间的距离,所述第四距离为在预设时长后所述主车与所述目标车道的前车之间的预测距离。
9.根据权利要求4所述的方法,其特征在于,若所述主车处于变道状态,所述根据所述待更新速度,确定所述车道约束条件中的速度方向能量函数、车道距离能量函数和车道方向能量函数,包括:
若所述主车与所述主车所在的当前车道的第一夹角大于预设的第一角度阈值,则根据所述第一夹角确定所述速度方向能量函数;
若所述第一夹角小于所述第一角度阈值,且所述主车与所述主车待进入的目标车道的第五距离大于预设的第二距离阈值,则根据所述主车与所述目标车道的第五距离确定所述车道距离能量函数;
若所述第一夹角小于所述第一预设阈值,所述主车与所述目标车道的距离小于所述第二距离阈值,且所述主车与所述目标车道方向的第二夹角大于预设的第二角度阈值,则根据所述主车第二夹角确定所述车道方向能量函数。
10.根据权利要求4所述的方法,其特征在于,若所述主车处于非变道状态,所述根据所述待更新速度,确定所述车道约束条件中的速度方向能量函数、车道距离能量函数和车道方向能量函数,包括:
若所述主车与所述主车所在的当前车道的距离大于预设的第二距离阈值,则根据所述主车与所述主车所在的当前车道的距离确定所述车道距离能量函数;
若所述主车与所述主车所在的当前车道的距离小于所述第二距离阈值,且所述主车与所述主车所在的当前车道方向的第三夹角大于预设的第一角度阈值,则根据所述主车第三夹角确定所述车道方向能量函数;
若所述主车与所述主车所在的当前车道的距离小于所述第二距离阈值,且所述第三夹角小于所述第一角度阈值,则根据所述第三夹角确定所述速度方向能量函数。
11.根据权利要求5所述的方法,其特征在于,还包括:
若所述主车的避障能量函数的值为零时,则根据预设的期望速度以及所述主车的待更新速度,确定所述待更新速度对应的速度期望约束函数;
所述从各个满足所述避障约束条件、所述车道约束条件和所述车辆动力学模型约束的待更新速度中,查找使得所述避障能量函数、速度方向能量函数、车道距离能量函数以及车道方向能量函数之和最小的待更新速度,包括:
从各个满足所述避障约束条件、所述车道约束条件和所述车辆动力学模型约束的待更新速度中,查找使得所述避障能量函数、速度方向能量函数、车道距离能量函数、车道方向能量函数以及所述速度期望约束函数之和最小的待更新速度。
12.根据权利要求1-11任一项所述的方法,其特征在于,还包括:
确定所述主车是否从所述主车所在的当前车道向目标车道变道行驶;所述目标车道为所述当前车道相邻的车道;
若是,则确定所述主车处于变道状态;
若否,则确定所述主车处于非变道状态。
13.根据权利要求1-11任一项所述的方法,其特征在于,还包括:
确定所述主车是否满足预设的变道发动条件;
若所述主车满足所述变道发动条件,则确定所述主车是否满足预设的变道决定条件;
若所述主车满足所述变道决定条件,则控制所述主车从所述主车所在的当前车道向目标车道变道行驶。
14.根据权利要求13所述的方法,其特征在于,所述确定所述主车是否满足预设的变道发动条件,包括:
确定所述主车所在的当前车道是否存在相邻车道;
若所述主车所在的当前车道存在相邻车道,确定所述当前车道中是否存在前车;
若所述当前车道中存在前车,则确定所述前车是否处于非变道状态;
若所述前车处于非变道状态,则确定所述主车满足所述变道发动条件。
15.根据权利要求13所述的方法,其特征在于,所述确定所述主车是否满足预设的变道决定条件,包括:
确定所述主车与所述当前车道中前车的距离,和所述主车与目标车道中前车的距离之间的差值是否小于预设的第一距离阈值;
若是,则确定所述主车与所述目标车道中前车沿所述目标车道方向的距离是否大于预设的安全距离;
若是,则确定所述主车与所述目标车道中后车沿所述目标车道方向的距离是否大于所述安全距离;所述目标车道为所述当前车道的相邻车道;
若是,则确定所述主车满足所述变道决定条件。
16.根据权利要求1-11任一项所述的方法,其特征在于,还包括:
根据预设的道路场景条件构建路网结构;所述路网结构中包括:多个并行的车道;
根据预设的交通流密度确定所述路网结构中的车辆个数和车辆的初始位置;
其中,所述车辆的信息包括以下至少一项:车辆的尺寸、加速度范围、车轮转角范围、期望速度、初始位置、初始速度、初始方向。
17.根据权利要求1-11任一项所述的方法,其特征在于,所述将满足所述避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,作为所述主车在下一更新时刻的速度之后,还包括:
根据所述主车在下一更新时刻的速度,确定所述主车在下一更新时刻的位置。
18.根据权利要求2所述的方法,其特征在于,所述确定各个待更新速度在下一更新时刻的速度方向变化角度,包括:
根据如下公式(1)确定所述待更新速度在下一更新时刻的速度方向变化角度Δθ;
Δθ=tan(Φ)/L×v0×Δt (1);
其中,Φ为车轮转角,L为轴距,v0为所述待更新速度,Δt为所述更新时间步长。
19.根据权利要求8所述的方法,其特征在于,所述确定各个所述待更新速度对应的所述避障约束条件中的避障能量函数,包括:
若所述主车处于非变道状态,根据如下公式(2)确定所述待更新速度对应的避障能量函数enRep;
enRep=ρrep×(v0×tsafe-min(s,sp)) (2);
其中,ρrep为预设的第一权重,tsafe为预设的安全时间,s为所述第一距离,sp为所述第二距离;s=p0+v0×Δt–(p1+v1×Δt);sp=p0+v0×Δt×εp–(p1+v1×Δt×εp);p0,p1分别为所述主车与所述当前车道的前车的当前位置,v0为所述待更新速度,v1为所述当前车道的前车的当前车速,εp为预设的预测步长;
若所述主车处于变道状态,根据如下公式(3)确定所述待更新速度对应的避障能量函数enRep;
enRep=ρrep×(v0×tsafe-min(s,sp,st,stp)) (3);
其中,st为所述第三距离,stp为所述第四距离;
st=p0+v0×Δt–(p2+v2×Δt);
stp=p0+v0×Δt×εp–(p2+v2×Δt×εp);
其中,p0,p2分别为所述主车与所述目标车道的前车的当前位置,v0为所述待更新速度,v2为所述目标车道的前车的当前车速。
20.根据权利要求9或10所述的方法,其特征在于,所述确定所述速度方向能量函数,包括:
根据如下公式(4)确定所述待更新速度对应的速度方向能量函数enVel;
enVel=ρvel×tan(|Δθ'|) (4);
其中,ρvel为预设的第二权重,Δθ'为所述第一夹角或所述第三夹角。
21.根据权利要求9或10所述的方法,其特征在于,所述确定所述车道距离能量函数,包括:
根据如下公式(5)确定所述待更新速度对应的车道距离能量函数enLanePos;
enLanePos=ρlanePos×slane×slane (5);
其中,ρlanePos为预设的第三权重,slane为所述主车与目标车道的距离,或所述主车与所述主车所在的当前车道的距离。
22.根据权利要求9或10所述的方法,其特征在于,所述确定所述车道方向能量函数,包括:
根据如下公式(6)确定待更新速度对应的车道方向能量函数enLaneDir;
enLaneDir=ρlaneDir×tan(Δθ") (6);
其中ρlaneDir为预设的第四权重,Δθ"为所述第二夹角或所述第三夹角。
23.根据权利要求11所述的方法,其特征在于,所述根据预设的期望速度以及所述主车的待更新速度,确定速度期望约束函数,包括:
根据如下公式(7)确定所述待更新速度对应的速度期望约束函数enVelLimit;
enVelLimit=ρvelLimit×|v0-vlimit| (7);
其中,ρvelLimit为预设的第五权重,vlimit为期望速度,v0为所述待更新速度。
24.一种车辆速度确定装置,其特征在于,包括:
第一确定模块,用于根据主车的至少一项行驶参数和预设的更新时间步长,确定所述主车的至少一个待更新速度;
第二确定模块,用于确定所述至少一个待更新速度中是否存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度;
处理模块,用于若所述第二确定模块确定存在同时满足预设的避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,则将满足所述避障约束条件、车道约束条件和车辆动力学模型约束的待更新速度,作为所述主车在下一更新时刻的速度。
25.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1-23任一项所述的方法。
26.一种电子设备,其特征在于,包括:
处理器;以及
存储器,用于存储所述处理器的可执行指令;
其中,所述处理器配置为经由执行所述可执行指令来执行权利要求1-23任一项所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910353587.7A CN111951604B (zh) | 2019-04-29 | 2019-04-29 | 车辆速度确定方法、装置、设备和存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910353587.7A CN111951604B (zh) | 2019-04-29 | 2019-04-29 | 车辆速度确定方法、装置、设备和存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111951604A true CN111951604A (zh) | 2020-11-17 |
CN111951604B CN111951604B (zh) | 2022-05-10 |
Family
ID=73335419
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910353587.7A Active CN111951604B (zh) | 2019-04-29 | 2019-04-29 | 车辆速度确定方法、装置、设备和存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111951604B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101075352A (zh) * | 2007-06-29 | 2007-11-21 | 中国科学院计算技术研究所 | 一种用于动态实体的分层避障方法 |
US20090099728A1 (en) * | 2007-10-16 | 2009-04-16 | Hitachi, Ltd. | Control apparatus for avoiding collision |
CN103226891A (zh) * | 2013-03-26 | 2013-07-31 | 中山大学 | 一种基于视频的车辆碰撞事故检测方法及*** |
CN103386975A (zh) * | 2013-08-02 | 2013-11-13 | 重庆市科学技术研究院 | 一种基于机器视觉的车辆避障方法及*** |
JP2017120473A (ja) * | 2015-12-28 | 2017-07-06 | 三菱電機株式会社 | 運転支援装置 |
CN107610494A (zh) * | 2017-08-28 | 2018-01-19 | 西北工业大学 | 基于信息物理融合***的agv车辆***及交通控制方法 |
CN107856668A (zh) * | 2017-09-22 | 2018-03-30 | 江西博能上饶客车有限公司 | 一种车辆转向自动防护***及方法 |
-
2019
- 2019-04-29 CN CN201910353587.7A patent/CN111951604B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101075352A (zh) * | 2007-06-29 | 2007-11-21 | 中国科学院计算技术研究所 | 一种用于动态实体的分层避障方法 |
US20090099728A1 (en) * | 2007-10-16 | 2009-04-16 | Hitachi, Ltd. | Control apparatus for avoiding collision |
CN103226891A (zh) * | 2013-03-26 | 2013-07-31 | 中山大学 | 一种基于视频的车辆碰撞事故检测方法及*** |
CN103386975A (zh) * | 2013-08-02 | 2013-11-13 | 重庆市科学技术研究院 | 一种基于机器视觉的车辆避障方法及*** |
JP2017120473A (ja) * | 2015-12-28 | 2017-07-06 | 三菱電機株式会社 | 運転支援装置 |
CN107610494A (zh) * | 2017-08-28 | 2018-01-19 | 西北工业大学 | 基于信息物理融合***的agv车辆***及交通控制方法 |
CN107856668A (zh) * | 2017-09-22 | 2018-03-30 | 江西博能上饶客车有限公司 | 一种车辆转向自动防护***及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111951604B (zh) | 2022-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Ajanovic et al. | Search-based optimal motion planning for automated driving | |
CN112292646B (zh) | 车辆的控制***、用于控制车辆的方法和非暂时性计算机可读存储器 | |
CN111653113B (zh) | 车辆的局部路径确定方法、装置、终端和存储介质 | |
US20200189597A1 (en) | Reinforcement learning based approach for sae level-4 automated lane change | |
CN113247023B (zh) | 一种行驶规划方法、装置、计算机设备及存储介质 | |
Liu et al. | Real-time longitudinal and lateral state estimation of preceding vehicle based on moving horizon estimation | |
JP2021020580A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
Ma et al. | Collision-avoidance lane change control method for enhancing safety for connected vehicle platoon in mixed traffic environment | |
CN111679660A (zh) | 一种融合类人驾驶行为的无人驾驶深度强化学习方法 | |
CN114644016A (zh) | 车辆自动驾驶决策方法、装置、车载终端和存储介质 | |
Liu et al. | Research on Local Dynamic Path Planning Method for Intelligent Vehicle Lane‐Changing | |
Althoff et al. | Stochastic reachable sets of interacting traffic participants | |
Kim et al. | Hardware-in-the-loop for connected automated vehicles testing in real traffic | |
Guo et al. | Self-defensive coordinated maneuvering of an intelligent vehicle platoon in mixed traffic | |
CN112542061B (zh) | 基于车联网的借道超车控制方法、装置、***及存储介质 | |
Vasic et al. | An overtaking decision algorithm for networked intelligent vehicles based on cooperative perception | |
CN111951604B (zh) | 车辆速度确定方法、装置、设备和存储介质 | |
JP2021133689A (ja) | 走行支援装置、走行支援方法、および走行支援プログラム | |
CN113788029B (zh) | 车辆控制方法、装置及计算机程序产品 | |
CN115810291A (zh) | 一种关联目标识别方法、装置、路侧设备及车辆 | |
Bansal et al. | Model-based systems engineering applied to the trajectory planning for autonomous vehicles | |
Li et al. | Decision making for autonomous vehicles | |
Liu et al. | Multi-agent collaborative adaptive cruise control based on reinforcement learning | |
CN113635900A (zh) | 一种预测巡航过程中基于能量管理的换道决策控制方法 | |
Kim et al. | Facilitating cooperative and distributed multi-vehicle lane change maneuvers |
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 |