CN108583578A - 用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法 - Google Patents
用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法 Download PDFInfo
- Publication number
- CN108583578A CN108583578A CN201810383811.2A CN201810383811A CN108583578A CN 108583578 A CN108583578 A CN 108583578A CN 201810383811 A CN201810383811 A CN 201810383811A CN 108583578 A CN108583578 A CN 108583578A
- Authority
- CN
- China
- Prior art keywords
- lane
- decision
- information
- automatic driving
- weight
- 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
- 239000011159 matrix material Substances 0.000 title claims abstract description 62
- 230000004888 barrier function Effects 0.000 claims abstract description 20
- 238000011156 evaluation Methods 0.000 claims abstract description 16
- 238000004458 analytical method Methods 0.000 claims description 14
- 238000012545 processing Methods 0.000 claims description 14
- 238000004364 calculation method Methods 0.000 claims description 13
- 230000008569 process Effects 0.000 claims description 9
- 230000010365 information processing Effects 0.000 claims description 7
- 230000000694 effects Effects 0.000 claims description 3
- 238000013139 quantization Methods 0.000 claims description 2
- 238000012163 sequencing technique Methods 0.000 claims description 2
- 238000005516 engineering process Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 238000011002 quantification Methods 0.000 description 2
- 230000010391 action planning Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
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
- 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
-
- 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
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F18/00—Pattern recognition
- G06F18/20—Analysing
- G06F18/21—Design or setup of recognition systems or techniques; Extraction of features in feature space; Blind source separation
- G06F18/211—Selection of the most significant subset of features
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mathematical Physics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Data Mining & Analysis (AREA)
- Theoretical Computer Science (AREA)
- Artificial Intelligence (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Bioinformatics & Computational Biology (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Biology (AREA)
- Evolutionary Computation (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明提供一种用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法,包括下列步骤:(1)以自动驾驶车辆左侧车道、所在车道和右侧车道作为待决策车道,在确定的导航路线上,采集每条待决策车道上能继续行驶的距离和限速信息,对每条待决策车道信息进行量化,得到每条待决策车道的评价信息;(2)采集每条待决策车道上相对自动驾驶车辆纵向距离最近的前后两侧的障碍物信息,判断前后两个障碍物的当前位置和速度信息,以及设定时间后的位置信息,并计算出当前时刻和设定时间前后两个障碍物分别相对自动驾驶车辆的相对距离;(3)将上述信息整理得到待决策车道的综合评价信息,形成决策矩阵;(4)对决策矩阵处理,计算得到决策车道,从而实现自动驾驶车辆的实时自主车道决策。
Description
技术领域
本发明涉及一种自动驾驶方法,尤其是涉及一种用于自动驾驶车辆的基 于多目标决策矩阵的车道决策方法。
背景技术
自动驾驶是智能交通的关键技术,也是未来汽车发展的必然趋势。减少 驾驶压力、提高安全性、避免交通拥堵并降低污染是自动驾驶技术发展的主 要出发点。自动驾驶车辆作为一个复杂软硬件结合系统,其安全可靠运行需 要车载硬件、传感器集成、感知预测、决策规划控制等多个模块的协同配合 工作。其中决策规划模块是实现安全、可靠的车辆自动驾驶技术,从而实现 自动驾驶技术广泛普及的关键。
决策规划由车道决策和动作规划两部分组成。车道决策是指无人驾驶车 辆通过感知周边交通状况,结合车辆当前位置和路由意图,选择最合适的车 道行驶,是自动驾驶车辆的行为决策;动作规划是指自动驾驶车辆的动作决 策。
从车道决策的可行性、安全性和舒适性考虑,车道决策方法应该能够根 据路况信息综合选择最优的车道行驶。其中,可行性要求能够完成车道的自 主决策并保证到达目标位置,安全性要求车道决策必须保证行驶安全,舒适 性要求自动驾驶车辆避免频繁更换车道。
决策规划模块的实现需采集自动驾驶车辆周边重要的交通信息,不仅包 括其本身的当前位置、速度、运动方向以及所在车道,还包括通过感知得到 的障碍物、交通信号和车道信息。目前自动驾驶技术主要通过视觉传感器、 毫米波雷达、激光雷达等传感器感知自动驾驶车辆周围交通状况,传感器数 据经过处理后得到车辆周边障碍物的尺寸、位置、速度和运动方向等信息, 以及当前所在道路相关的交通信号。车道决策需在这些信息的基础上,作出 无人驾驶车辆的行驶策略。
自动驾驶车辆的决策规划模块的实现需由感知系统和地图提供信息输 入,其决策与规划过程可单独实现,也可同时实现。目前,车道决策一般采 用专家经验法、引力场方法、神经网络和障碍物威胁度等方法。这些方法普 遍存在考虑因素过多、计算复杂的缺点,或缺乏实时性和灵活性。
发明内容
根据现有自动驾驶车辆感知系统的特点,本发明提出了一种用于自动驾 驶车辆的基于多目标决策矩阵的车道决策方法,为车辆自动驾驶中道路决策 提供简单可靠的解决方案。
一种用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法,包括下 列步骤:
(1)以自动驾驶车辆左侧车道、所在车道和右侧车道作为待决策车道, 在确定的导航路线上,根据自动驾驶车辆的位置,在该时刻下,采集每条待 决策车道上能继续行驶的距离和限速信息,对每条待决策车道信息进行量 化,得到每条待决策车道的评价信息;
(2)采集每条待决策车道上相对自动驾驶车辆纵向距离最近的前后两 侧的障碍物信息,采集前后两个障碍物的当前位置和速度信息,以及经过一 段设定时间后的位置信息,并计算出当前时刻和到设定时间时前后两个障碍 物分别相对自动驾驶车辆的相对距离,获取每条待决策车道的四个相对距离 的信息;
(3)将上述得到的信息,即每条待决策车道的综合评价信息SL,前方 障碍物当前时刻的相对距离Sf、前方障碍物设定时间后的相对距离Sfn、后 方障碍物当前时刻的相对距离Sb、后方障碍物设定时间后的相对距离Sbn, 整理得到决策矩阵;
(4)对决策矩阵进行处理,通过决策方法对每条待决策车道进行综合 排序。其中,决策方法包括决策信息权重计算、决策分析两个过程,从而实 现自动驾驶车辆的实时自主车道决策,进而判断当前时刻应选择的待决策车 道。
进一步的,步骤(1)中,自动驾驶车辆所处位置所有车道最大可继续 行驶的距离为Lmax,最大限速为Vmax,某条待决策车道可继续行驶的距离 为Lr,车道限速为Vr,则该条待决策车道的综合评价结果为SL:
其中,WL、WV分别为该待决策车道可继续行驶的距离权重与该待决策 车道限速权重。
进一步的,步骤(2)中,当待决策车道上,相对自动驾驶车辆的前方 或后方没有障碍物时,假定存在与自动驾驶车辆速度相同的虚拟障碍物,且 其与自动驾驶车辆的相对距离为可变道的固定距离。
步骤(2)中,对不存在的车道或者不可跨越超车的车道,假定该车道 存在两个与自动驾驶车辆速度相同的虚拟障碍物,位于自动驾驶车辆的前方 和后方,且与自动驾驶车辆的相对距离为不可变道的固定距离。
步骤(2)中,对不存在的车道或者不可跨越超车的车道,车道综合评 价结果为固定最小值Slmin。
进一步的,步骤(3)中,根据待决策车道的评价信息和关键障碍物当 前时刻和设定时刻后的相对位置信息,形成一个3行5列的决策矩阵。
进一步的,步骤(4)中,决策信息权重包括经验权重Wh和路况信息权 重We,其中经验权重Wh根据经验给定:
Wh=(whl,whf,whfn,whb,whbn) (2)
whl、whf、whfn、whb、whbn分别为车道量化信息、当前时刻前方障碍物相对距离、 设定时间后前方障碍物相对距离、当前时刻后方障碍物相对距离、设定时间 后后方障碍物相对距离等属性的经验权重;
路况信息权重We采用熵权重分析方法得到,采集原始数据形成的决策 矩阵A如下式所示:
矩阵A中a1j,a2j,a3j分别为左侧车道、当前车道和右侧车道的决策信息处理结 果,j=1、2、3、4、5分别为自动驾驶车辆在每条待决策车道的车道量化信 息、当前时刻与前方障碍物相对距离、设定时间后与前方障碍物相对距离、 当前时刻与后方障碍物相对距离、设定时间后与后方障碍物相对距离;
利用路况信息权重和经验权重得到最终的权重W:
W=α*Wh+(1-α)*We (4)
其中0<α<1,为权重系数;可通过调整权重系数α和经验权重Wh对车道决 策的效果进行调整。
然后,根据决策矩阵A得到路况信息权重We的处理步骤如下:
根据熵权重计算方法对决策矩阵进行归一化,得到归一化后决策矩阵B:
其中,
第j项属性的熵值ej为:
其中m=3;得到熵值后,归一化得到各属性的熵权重:
式(8)中n=5。最后,熵权重具体为:
We=(wel,wef,wefn,web,webn) (9)
wel、wef、wefn、web、webn分别为车道量化信息、当前时刻前方障碍物相对距离、 若干时间后前方障碍物相对距离、当前时刻后方障碍物相对距离、若干时间 后后方障碍物相对距离等属性的熵权重。
并且,步骤(4)中,决策分析过程如下:
首先,利用归一化后的决策矩阵B和权重计算方法得到的权重W:
W=(wl,wf,wfn,wb,wbn) (10)
wl、wf、wfn、wb、wbn为综合经验权重和熵权重得到的各属性最终权重,利用归 一化决策矩阵B和权重W,计算得到加权规范化决策矩阵V:
其中,
vij=wj*bij(i∈m,j∈n) (12)
利用加权规范化决策矩阵可得到正理想解X+和负理想解X-,正理想解由加 权规范化决策矩阵中每一列的最大值组成,负理想解由加权规范决策矩阵中 每一列的最小值组成,
然后,分别计算每条待决策车道的决策方案与正理想解和负理想解的欧 式距离,可以得到不同决策方案与正负理想解的差异程度:
最后,计算每个决策方案与理想解的相对接近度指数Ci:
由于0≤Ci≤1,且Ci越大表明方案越接近正理想解,所以最终决策车道 为Ci值最大的车道。
与现有主要车道决策方法相比,本发明方法具有参数少、反应快、计算 量少的特点,决策过程具有良好实时性和自主性;选取的决策参数简洁、明 确,且可以针对不同场景获得保证安全性前提下兼顾舒适性和敏捷性的车道 决策结果。
附图说明
图1是本发明提供的方法实现流程图;
图2是车道信息示意图;
图3是障碍物信息采集示意图
图4是车道决策信息示意图;
图5是特殊情况示意图;
图6是某时刻自动驾驶车辆A交通状况示意图。
具体实施方式
在目前技术水平下,自动驾驶车辆的感知系统主要通过摄像头、雷达、 红外线和超声波等方式检测周围交通状况。能检测的包括自动驾驶车辆周边 障碍物的类型、速度、运动方向以及所在车道等信息;交通信号灯、道路交 通线、道路限速以及路标等交通信息。由于遮挡、光照、天气等复杂因素, 自动驾驶车辆仅仅对所检测的自身周围距离较近的障碍物的信息具有较高 的置信度。
从交通信息可靠性和车道决策的可行性出发,本发明涉及的方法提出以 自动驾驶车辆所在车道、自动驾驶车辆左侧车道和右侧车道为待决策车道, 以待决策车道上距离自动驾驶车辆最近的障碍物为关键障碍物;收集车道信 息和关键障碍物信息,处理形成决策矩阵并采用多属性决策进行车道决策的 方法。
本发明中采集到的相关信息,是通过自动驾驶车辆的感知系统获取的, 其数据都采用实时数据,采集的数据包括距离、速度,如果利用更多的传感 器进行数据采集,并通过更快的数据计算设备进行相关数据的处理,本发明 能够极大的提高精确度和准确性。
对于每一条待决策车道,本发明提出的决策信息由两部分组成:(1) 待决策车道的道路拓扑结构、道路限速和车道线等形成的车道信息;(2) 关键障碍物所在车道、速度、位置等形成的障碍物信息。
综合考虑自动驾驶车道决策方法的可行性和安全性,对于每一条待决策 车道,本发明方法提出的决策参数具体由5个参数组成:
(1)待决策车道的道路拓扑结构和道路限速量化后的车道信息;
(2)当前时刻,自动驾驶车辆与待决策车道前方最近障碍物的相对距 离;
(3)假设自动驾驶车辆和障碍物匀速行驶条件下,若干时间后(N秒), 自动驾驶车辆与待决策车道前方最近障碍物的相对距离;
(4)当前时刻,自动驾驶车辆与待决策车道后方最近障碍物的相对距 离;
(5)假设自动驾驶车辆和障碍物匀速行驶条件下,若干时间后(N秒), 自动驾驶车辆与待决策车道后方最近障碍物的相对距离。
车道决策方案的实现由信息收集、处理与决策分析三部分组成,下面分 别进行详细说明。
一、车道信息采集与处理
1.车道信息采集
图2为车道信息采集与处理示意图。如图2所示,车辆A为自动驾驶 车辆,M1-M3为本发明方法关注的待决策车道。根据目的地位置和导航规 划结果,通过电子地图得到自动驾驶车辆在不违反目的地导航指令的情况 下,也就是在当前导航规划的路线上,在该路线不同的待决策车道所能继续 行驶的距离Lr(m)以及各待决策车道的限速V_max(km/h)。比如M1车道的 限速是60,M2车道的限速是50,M3车道的限速是40。
综合考虑车道决策的可行性和自动驾驶车辆的敏捷性,利用待决策车道 能继续行驶的距离和限速对待决策车道信息进行量化,得到每条待决策车道 的综合评价。该评价结果决定了自动驾驶车辆选择哪一条待决策车道进行行 驶,从而按照导航规划的结果顺利到达目的地。另一方面,需检测并识别相 邻车道是否为可以跨越超车的车道(图2车道线)。
2.车道信息处理
如图2所示,将自动驾驶车辆A的左侧车道、当前车道和右侧车道在该 路线上分别可继续行驶的距离记为Lr1、Lr2、Lr3,每一条待决策车道的限速分 别为VL1、VL2,、VL3。
本发明方法按权重对每条待决策车道所能继续行驶的距离和限速进行量 化。假设某时刻,自动驾驶车辆所处位置的车道最大可继续行驶的距离为 Lmax,最大限速为Vmax。某条待决策车道可继续行驶的距离为Lr,车道限速 为Vr。该条待决策车道的综合评价结果为SL:
其中,WL、WV分别为该待决策车道可继续行驶的距离权重与该待决策 车道限速权重。
二、障碍物信息采集与处理
1.障碍物信息采集
图3为关键障碍物信息采集示意图,本发明方法仅关注待决策车道上相 对自动驾驶车辆距离最近的障碍物,这些障碍物被称为“关键障碍物”。障 碍物的类型包括传感器所能检测到的所有类型,如车辆、行人、不明障碍物 等。如图3所示,自动驾驶车辆左侧车道前后方的关键障碍物分别为行驶车 辆L1和L2,当前时刻,它们与自动驾驶车辆的相对纵向距离分别为Sf和 Sb;当前车道前方障碍物为行驶车辆C1,后方障碍物为不明障碍物C2;右 侧车道前方障碍物为行驶车辆R1,后方障碍物为行人R2。其他障碍物为非 关键障碍物,如图3车辆X。为实现本发明方法,需要收集处理每条待决策 车道上关键障碍物所在的车道、位置和速度等信息。
2、障碍物信息处理
如图4所示,以自动驾驶车辆A左侧车道为例,对关键障碍物信息的处理 进行说明。某时刻,自动驾驶车辆A位置如图4所示,自动驾驶车辆速度为 V。当前时刻,左侧前方最近障碍物为L1,其速度为VL1;后方最近障碍物 为L2,其速度为VL2。
本发明方法所述的相对距离是指自动驾驶车辆与障碍物之间的纵向相对 距离。例如,自动驾驶车辆当前位置在地图上的纵向坐标为SA,障碍物L1 在地图上的纵向坐标为SL1,则它们之间的相对距离为:SL1=|SA-SL1|。当前 时刻,根据自动驾驶车辆和前后方最近障碍物的位置(图4实线),可以得 到自动驾驶车辆与该条待决策车道上前方最近障碍物的相对距离Sf;自动驾 驶车辆与该条待决策车道上后方最近障碍物的相对距离Sb。
如图4所示,在假定自动驾驶车辆和障碍物匀速行驶的情况下,根据位置 和速度信息可以得到若干时间后(N秒),自动驾驶车辆与前后方最近障碍 物的相对距离(图4虚线)。若干时间后(N秒),自动驾驶车辆与该条待 决策车道上前方最近障碍物L1的相对距离为Sfn=Sf+VL1*N-VA*N;自动驾驶 车辆与该条待决策车道上后方最近障碍物L2的相对距离为 Sfn=Sf+VL1*N-VA*N。
三、特殊情况说明
在一些特殊情况下,为能够获得完整的车道决策信息,进行具体说明:
(1)如图5所示,当自动驾驶车辆位于最右侧车道时,此时不存在右侧 车道。对于此类情况,通过假定在右侧车道存在两个虚拟障碍物(R1、R2), 它们与自动驾驶车辆的相对距离为设定的固定距离Smin,所述设定距离使得 自动驾驶车辆不能变换到右侧车道,当车辆位于最左侧车道也属于此类情 况。当某侧车道为不可跨越超车车道时,按最右侧或最左侧车道处理。如果 是单行道,则假定两侧设置有车道,并都存在虚拟障碍物。
(2)当待决策车道上在自动驾驶车辆的前方没有或检测不到障碍物时 (图5左侧车道),则假定自动驾驶车辆前方存在虚拟障碍物(例如,图5 中L1),其与自动驾驶车辆之间的相对距离为本方法设定的相对距离(Smax), 该相对距离使得自动驾驶车辆能变换到该侧车道,与自动驾驶车辆所在车道 可继续行驶距离L之间的较小值,即Sf=min(Smax,L)。
(3)当待决策车道相对自动驾驶车辆的后方没有或检测不到障碍物时, 假定自动驾驶车辆后方存在虚拟障碍物(例如图5中C2),其与自动驾驶车 辆之间的相对距离为本方法设定的相对距离(Smax)。
(4)为便于处理若干时间后的相对距离,本方法中虚拟障碍物速度与自 动驾驶车辆速度相同。
(5)当不存在左侧或右侧车道,或某侧车道为不可跨越超车车道时,本 方法假定该待决策车道的综合评价结果为固定值Slmin。
经过上述处理方法,可以得到左侧、右侧以及自动驾驶车辆当前车道完 整的决策信息。
四、决策分析
本发明方法基于所收集的车道和关键障碍物信息,处理得到决策矩阵所 需的参数如表1所示。每条待决策车道的综合评价结果SL,前方障碍物当 前时刻的相对距离Sf、前方障碍物若干时间后(N秒)的相对距离Sfn、后 方障碍物当前时刻的相对距离Sb、后方障碍物若干时间后(N秒)的相对距 离Sbn。
表1决策矩阵示意表,每个空格中都有对应的数值,其中的XX是指 的计算出的数值。
SL | Sf | Sfn | Sb | Sbn | |
左侧车道 | xx | xx | xx | xx | xx |
当前车道 | xx | xx | xx | xx | xx |
右侧车道 | xx | xx | xx | xx | xx |
本发明采用多属性决策方法,通过决策方法对每条待决策车道进行综合 排序,实现自动驾驶车辆实时自主车道决策。对于本发明方法,将自动驾驶 车辆的当前车道和左右相邻车道共同形成的待决策车道分别做出决策方案, 而每个方案由该待决策车道的1个车道信息和4个障碍物的相对距离信息组 成。决策方法由决策信息权重计算、决策分析两部分组成。图6为某时刻自 动驾驶车辆A周边交通状况示意图(仅显示待决策车道上关键障碍物的位 置),下面以该实例对决策方法的过程进行介绍。
1.权重计算
如图1所示,本发明方法车道决策信息权重由路况信息权重和经验权重两 部分组成,其中经验权重Wh根据经验给定:
Wh=(whl,whf,whfn,whb,whbn) (2)
whl、whf、whfn、whb、whbn分别为车道量化信息、当前时刻前方障碍物相对距离、 若干时间后前方障碍物相对距离、当前时刻后方障碍物相对距离、若干时间 后后方障碍物相对距离等属性的经验权重。
路况信息权重We采用熵权重分析方法得到,下面对熵权重计算方法进行 简要说明。采集原始数据形成的决策矩阵,决策矩阵A如式(3)所示。
矩阵A中a1j,a2j,a3j分别为左侧车道、当前车道和右侧车道决策信息处理结果。 j=1、2、3、4、5分别为决策车道的车道量化信息、当前时刻与前方障碍物 相对距离、若干时间(或者说是设定时间)后与前方障碍物相对距离、当前 时刻与后方障碍物相对距离、若干时间后与后方障碍物相对距离。例如,对 于图6所示实例,决策矩阵为:
根据熵权重计算方法对决策矩阵进行归一化,得到归一化后的决策矩阵B:
其中,
对于图6所示实例,归一化后的决策矩阵为:
第j项属性的熵值ej为:
其中m=3。得到熵值后,归一化得到各属性的熵权重:
式(8)中n=5。最后,熵权重具体为:
We=(wel,wef,wefn,web,webn) (9)
wel、wef、wefn、web、webn分别为车道量化信息、当前时刻前方障碍物相对距离、 若干时间后前方障碍物相对距离、当前时刻后方障碍物相对距离、若干时间 后后方障碍物相对距离各属性的熵权重。
通过对路况信息权重和经验权重得到最终的权重W(0<α<1为权重系 数):
W=α*Wh+(1-α)*We (10)
本发明方法可通过调整权重系数α和经验权重Wh对车道决策的效果进 行调整,如高速行驶、城市道路行驶时设置不同的经验权重,在保证安全性 情况下实现舒适性和敏捷性的调节。
2.决策分析
决策分析采用传统的TOPSIS(Technique for Order Preference by Similarityto an Ideal Solution)多属性决策分析方法,决策分析过程如下:
首先,利用初始决策信息得到的归一化后的决策矩阵B和权重计算方法 得到权重向量W:
W=(wl,wf,wfn,wb,wbn) (11)
wl、wf、wfn、wb、wbn为综合经验权重和熵权重得到的各属性(分别为车道量化 信息、当前时刻前方障碍物相对距离、若干时间后前方障碍物相对距离、当 前时刻后方障碍物相对距离、若干时间后后方障碍物相对距离)最终权重。 利用归一化决策矩阵B和权重W,计算加权规范化决策矩阵V:
其中,
vij=wj*bij(i∈m,j∈n) (13)
利用加权规范化决策矩阵可得到正理想解X+和负理想解X-,正理想解由加 权规范化决策矩阵中每一列的最大值组成,负理想解由加权规范决策矩阵中 每一列的最小值组成,
然后,分别计算每条待决策车道的决策方案与正理想解和负理想解的欧 式距离,可以得到不同决策方案与正负理想解的差异程度:
最后,计算每个决策方案与理想解的相对接近度指数Ci:
由于0≤Ci≤1,且Ci越大表明方案越接近正理想解,所以最终决策车道为 Ci值最大的车道。对于图6所示实例,决策结果见表2,因而车道决策为继续 在当前道路行驶。
表2图6实例决策结果
车道 | 左侧车道 | 当前车道 | 右侧车道 |
计算结果 | 0.43 | 0.73 | 0.26 |
本发明具有以下特点:
1、图1提出的由信息收集、信息处理和决策分析三部分组成的车道决策 实现架构是本发明方法创新点之一。
2、本发明方法决策车道和关键障碍物的选取与考量,以及虚拟障碍物 的处理是其创新点之一。决策信息中车道可行走距离和限速信息体现了道路 决策的目的性,自动驾驶车辆与关键障碍物的相对距离和若干时间后的相对 距离综合考虑了道路决策的安全性和可行性。决策信息简洁、明确,是本发 明欲保护的主要创新点。
3、本发明方法中决策属性权重的选取与调整能够在安全可行前提下, 针对不同路况场景实现舒适性和敏捷性的调整,是本方法的一个重要创新 点。
4、本发明方法采集并处理自动驾驶车辆周边车道信息和关键障碍物信 息,并采用多属性决策方法实现实时、快捷的车道决策是本发明的一个重要 创新点。任何以自动驾驶车辆所在位置不同车道的障碍物和车道信息处理得 到决策矩阵,并采用多属性决策方法的车道决策方法属于本发明方法的变体 或扩展。
Claims (9)
1.一种用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法,其特征在于,包括下列步骤:
(1)以自动驾驶车辆左侧车道、所在车道和右侧车道作为待决策车道,在确定的导航路线上,根据自动驾驶车辆的位置,在该时刻下,采集每条待决策车道上能继续行驶的距离和限速信息,对每条待决策车道信息进行量化,得到每条待决策车道的评价信息;
(2)采集每条待决策车道上相对自动驾驶车辆纵向距离最近的前后两侧的障碍物信息,采集前后两个障碍物的当前位置和速度信息,以及经过一段设定时间后的位置信息,并计算出当前时刻和到设定时间时前后两个障碍物分别相对自动驾驶车辆的相对距离,获取每条待决策车道的四个相对距离的信息;
(3)将上述得到的信息,即每条待决策车道的综合评价信息SL,前方障碍物当前时刻的相对距离Sf、前方障碍物设定时间后的相对距离Sfn、后方障碍物当前时刻的相对距离Sb、后方障碍物设定时间后的相对距离Sbn,整理得到决策矩阵;
(4)对决策矩阵进行处理,通过决策方法对每条待决策车道进行综合排序。其中,决策方法包括决策信息权重计算、决策分析两个过程,从而实现自动驾驶车辆的实时自主车道决策,进而判断当前时刻应选择的待决策车道。
2.根据权利要求1所述的用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法,其特征在于:步骤(1)中,自动驾驶车辆所处位置所有车道最大可继续行驶的距离为Lmax,最大限速为Vmax,某条待决策车道可继续行驶的距离为Lr,车道限速为Vr,则该条待决策车道的综合评价结果为SL:
其中,WL、WV分别为该待决策车道可继续行驶的距离权重与该待决策车道限速权重。
3.根据权利要求1所述的用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法,其特征在于:步骤(2)中,当待决策车道上,相对自动驾驶车辆的前方或后方没有障碍物时,假定存在与自动驾驶车辆速度相同的虚拟障碍物,且其与自动驾驶车辆的相对距离为可变道的固定距离。
4.根据权利要求1所述的用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法,其特征在于:步骤(2)中,对不存在的车道或者不可跨越超车的车道,假定该车道存在两个与自动驾驶车辆速度相同的虚拟障碍物,位于自动驾驶车辆的前方和后方,且与自动驾驶车辆的相对距离为不可变道的固定距离。
5.根据权利要求1所述的用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法,其特征在于:步骤(2)中,对不存在的车道或者不可跨越超车的车道,车道综合评价结果为固定最小值Slmin。
6.根据权利要求1所述的用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法,其特征在于:步骤(3)中,根据待决策车道的评价信息和关键障碍物当前时刻和设定时刻后的相对位置信息,形成一个3行5列的决策矩阵。
7.根据权利要求1所述的用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法,其特征在于:步骤(4)中,决策信息权重包括经验权重Wh和路况信息权重We,其中经验权重Wh根据经验给定:
Wh=(whl,whf,whfn,whb,whbn) (2)
whl、whf、whfn、whb、whbn分别为车道量化信息、当前时刻前方障碍物相对距离、设定时间后前方障碍物相对距离、当前时刻后方障碍物相对距离、设定时间后后方障碍物相对距离等属性的经验权重;
路况信息权重We采用熵权重分析方法得到,采集原始数据形成的决策矩阵A如下式所示:
矩阵A中a1j,a2j,a3j分别为左侧车道、当前车道和右侧车道的决策信息处理结果,j=1、2、3、4、5分别为自动驾驶车辆在每条待决策车道的车道量化信息、当前时刻与前方障碍物相对距离、设定时间后与前方障碍物相对距离、当前时刻与后方障碍物相对距离、设定时间后与后方障碍物相对距离;
利用路况信息权重和经验权重得到最终的权重W:
W=α*Wh+(1-α)*We (4)
其中0<α<1,为权重系数;可通过调整权重系数α和经验权重Wh对车道决策的效果进行调整。
8.根据权利要求7所述的用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法,其特征在于,根据决策矩阵A得到路况信息权重We的处理步骤如下:
根据熵权重计算方法对决策矩阵进行归一化,得到归一化后决策矩阵B:
其中,
第j项属性的熵值ej为:
其中m=3;得到熵值后,归一化得到各属性的熵权重:
式(8)中n=5;最后,熵权重具体为:
We=(wel,wef,wefn,web,webn) (9)
wel、wef、wefn、web、webn分别为车道量化信息、当前时刻前方障碍物相对距离、若干时间后前方障碍物相对距离、当前时刻后方障碍物相对距离、若干时间后后方障碍物相对距离等属性的熵权重。
9.根据权利要求6所述的用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法,其特征在于:步骤(4)中,决策分析过程如下:
首先,利用归一化后的决策矩阵B和权重计算方法得到的权重W:
W=(wl,wf,wfn,wb,wbn) (10)
wl、wf、wfn、wb、wbn为综合经验权重和熵权重得到的各属性最终权重,利用归一化决策矩阵B和权重W,计算得到加权规范化决策矩阵V:
其中,
vij=wj*bij(i∈m,j∈n) (12)
利用加权规范化决策矩阵可得到正理想解X+和负理想解X-,正理想解由加权规范化决策矩阵中每一列的最大值组成,负理想解由加权规范决策矩阵中每一列的最小值组成,
然后,分别计算每条待决策车道的决策方案与正理想解和负理想解的欧式距离,可以得到不同决策方案与正负理想解的差异程度:
最后,计算每个决策方案与理想解的相对接近度指数Ci:
由于0≤Ci≤1,且Ci越大表明方案越接近正理想解,所以最终决策车道为Ci值最大的车道。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810383811.2A CN108583578B (zh) | 2018-04-26 | 2018-04-26 | 用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810383811.2A CN108583578B (zh) | 2018-04-26 | 2018-04-26 | 用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108583578A true CN108583578A (zh) | 2018-09-28 |
CN108583578B CN108583578B (zh) | 2019-12-31 |
Family
ID=63609558
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810383811.2A Active CN108583578B (zh) | 2018-04-26 | 2018-04-26 | 用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108583578B (zh) |
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109709965A (zh) * | 2018-12-28 | 2019-05-03 | 驭势科技(北京)有限公司 | 一种自动驾驶车辆的控制方法和自动驾驶系统 |
CN109712421A (zh) * | 2019-02-22 | 2019-05-03 | 百度在线网络技术(北京)有限公司 | 自动驾驶车辆的速度规划方法、装置和存储介质 |
CN109782776A (zh) * | 2019-03-28 | 2019-05-21 | 北京百度网讯科技有限公司 | 无人车的车道选择方法、装置及存储介质 |
CN109871017A (zh) * | 2019-02-20 | 2019-06-11 | 百度在线网络技术(北京)有限公司 | 自动驾驶参考线调用方法、装置和终端 |
CN110083153A (zh) * | 2019-04-12 | 2019-08-02 | 杭州飞步科技有限公司 | 无人车辆行驶路线获取方法及装置 |
CN110298131A (zh) * | 2019-07-05 | 2019-10-01 | 西南交通大学 | 一种混合驾驶环境下自动驾驶换道决策模型建立方法 |
CN110516935A (zh) * | 2019-08-13 | 2019-11-29 | 北京航空航天大学 | 一种基于端边云架构的矿车无人驾驶运输系统路权云智能分配方法 |
CN110532846A (zh) * | 2019-05-21 | 2019-12-03 | 华为技术有限公司 | 自动换道方法、装置及存储介质 |
CN110617828A (zh) * | 2018-12-29 | 2019-12-27 | 长城汽车股份有限公司 | 车辆自动驾驶时动态目标线的生成方法、生成系统及车辆 |
CN111024107A (zh) * | 2019-12-17 | 2020-04-17 | 国汽(北京)智能网联汽车研究院有限公司 | 路径确定方法、装置、设备及存储介质 |
CN111137292A (zh) * | 2018-11-01 | 2020-05-12 | 通用汽车环球科技运作有限责任公司 | 用于控制自主车辆的分层车道变换策略的基于空间和时间注意力的深度强化学习 |
WO2020135880A1 (zh) * | 2018-12-29 | 2020-07-02 | 长城汽车股份有限公司 | 车辆自动驾驶时的行车道选择方法、选择系统及车辆 |
CN111383452A (zh) * | 2019-12-03 | 2020-07-07 | 东南大学 | 一种城市路网短期交通运行状态估计与预测方法 |
CN111563046A (zh) * | 2020-05-15 | 2020-08-21 | 北京百度网讯科技有限公司 | 用于生成信息的方法和装置 |
CN112039704A (zh) * | 2020-08-31 | 2020-12-04 | 中国民航大学 | 一种基于风险传播的信息系统风险评估方法 |
CN112164238A (zh) * | 2020-09-17 | 2021-01-01 | 北京百度网讯科技有限公司 | 导航变道引导方法、装置、设备和存储介质 |
CN112406904A (zh) * | 2020-08-27 | 2021-02-26 | 腾讯科技(深圳)有限公司 | 自动驾驶策略的训练方法、装置、自动驾驶方法、设备、车辆和计算机可读存储介质 |
CN112540365A (zh) * | 2020-12-10 | 2021-03-23 | 中国第一汽车股份有限公司 | 一种评估方法、装置、设备及存储介质 |
CN113844451A (zh) * | 2021-09-30 | 2021-12-28 | 上海商汤临港智能科技有限公司 | 行驶设备控制方法、装置、电子设备及存储介质 |
CN114019971A (zh) * | 2021-11-04 | 2022-02-08 | 北京三快在线科技有限公司 | 一种无人设备控制方法、装置、存储介质及电子设备 |
CN114779830A (zh) * | 2022-05-13 | 2022-07-22 | 无锡科若斯科技有限公司 | 一种基于动态阈值的巡检无人机电量监测管理方法及系统 |
CN118182515A (zh) * | 2023-02-27 | 2024-06-14 | 华为技术有限公司 | 车辆换道决策方法、装置和存储介质 |
-
2018
- 2018-04-26 CN CN201810383811.2A patent/CN108583578B/zh active Active
Cited By (37)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111137292A (zh) * | 2018-11-01 | 2020-05-12 | 通用汽车环球科技运作有限责任公司 | 用于控制自主车辆的分层车道变换策略的基于空间和时间注意力的深度强化学习 |
CN111137292B (zh) * | 2018-11-01 | 2023-08-08 | 通用汽车环球科技运作有限责任公司 | 经执行器-评价网络架构学习车道变换策略的方法和系统 |
CN109709965A (zh) * | 2018-12-28 | 2019-05-03 | 驭势科技(北京)有限公司 | 一种自动驾驶车辆的控制方法和自动驾驶系统 |
CN110617828B (zh) * | 2018-12-29 | 2022-04-01 | 毫末智行科技有限公司 | 车辆自动驾驶时动态目标线的生成方法、生成系统及车辆 |
EP3888987A4 (en) * | 2018-12-29 | 2022-02-09 | Great Wall Motor Company Limited | Lane selection method for vehicle when self-driving, selection system, and vehicle |
CN110617828A (zh) * | 2018-12-29 | 2019-12-27 | 长城汽车股份有限公司 | 车辆自动驾驶时动态目标线的生成方法、生成系统及车辆 |
WO2020135880A1 (zh) * | 2018-12-29 | 2020-07-02 | 长城汽车股份有限公司 | 车辆自动驾驶时的行车道选择方法、选择系统及车辆 |
CN109871017B (zh) * | 2019-02-20 | 2022-09-13 | 阿波罗智能技术(北京)有限公司 | 自动驾驶参考线调用方法、装置和终端 |
CN109871017A (zh) * | 2019-02-20 | 2019-06-11 | 百度在线网络技术(北京)有限公司 | 自动驾驶参考线调用方法、装置和终端 |
CN109712421A (zh) * | 2019-02-22 | 2019-05-03 | 百度在线网络技术(北京)有限公司 | 自动驾驶车辆的速度规划方法、装置和存储介质 |
US11718318B2 (en) | 2019-02-22 | 2023-08-08 | Apollo Intelligent Driving (Beijing) Technology Co., Ltd. | Method and apparatus for planning speed of autonomous vehicle, and storage medium |
CN109712421B (zh) * | 2019-02-22 | 2021-06-04 | 百度在线网络技术(北京)有限公司 | 自动驾驶车辆的速度规划方法、装置和存储介质 |
CN109782776A (zh) * | 2019-03-28 | 2019-05-21 | 北京百度网讯科技有限公司 | 无人车的车道选择方法、装置及存储介质 |
CN110083153A (zh) * | 2019-04-12 | 2019-08-02 | 杭州飞步科技有限公司 | 无人车辆行驶路线获取方法及装置 |
WO2020233495A1 (zh) * | 2019-05-21 | 2020-11-26 | 华为技术有限公司 | 自动换道方法、装置及存储介质 |
CN110532846A (zh) * | 2019-05-21 | 2019-12-03 | 华为技术有限公司 | 自动换道方法、装置及存储介质 |
CN110532846B (zh) * | 2019-05-21 | 2022-09-16 | 华为技术有限公司 | 自动换道方法、装置及存储介质 |
CN110298131A (zh) * | 2019-07-05 | 2019-10-01 | 西南交通大学 | 一种混合驾驶环境下自动驾驶换道决策模型建立方法 |
CN110516935B (zh) * | 2019-08-13 | 2022-01-07 | 北京航空航天大学 | 一种基于端边云架构的矿车无人驾驶运输系统路权云智能分配方法 |
CN110516935A (zh) * | 2019-08-13 | 2019-11-29 | 北京航空航天大学 | 一种基于端边云架构的矿车无人驾驶运输系统路权云智能分配方法 |
CN111383452A (zh) * | 2019-12-03 | 2020-07-07 | 东南大学 | 一种城市路网短期交通运行状态估计与预测方法 |
CN111024107A (zh) * | 2019-12-17 | 2020-04-17 | 国汽(北京)智能网联汽车研究院有限公司 | 路径确定方法、装置、设备及存储介质 |
CN111563046A (zh) * | 2020-05-15 | 2020-08-21 | 北京百度网讯科技有限公司 | 用于生成信息的方法和装置 |
CN112406904B (zh) * | 2020-08-27 | 2022-02-01 | 腾讯科技(深圳)有限公司 | 自动驾驶策略的训练方法、自动驾驶方法、设备和车辆 |
CN112406904A (zh) * | 2020-08-27 | 2021-02-26 | 腾讯科技(深圳)有限公司 | 自动驾驶策略的训练方法、装置、自动驾驶方法、设备、车辆和计算机可读存储介质 |
CN112039704A (zh) * | 2020-08-31 | 2020-12-04 | 中国民航大学 | 一种基于风险传播的信息系统风险评估方法 |
CN112164238B (zh) * | 2020-09-17 | 2022-08-09 | 北京百度网讯科技有限公司 | 导航变道引导方法、装置、设备和存储介质 |
CN112164238A (zh) * | 2020-09-17 | 2021-01-01 | 北京百度网讯科技有限公司 | 导航变道引导方法、装置、设备和存储介质 |
CN112540365A (zh) * | 2020-12-10 | 2021-03-23 | 中国第一汽车股份有限公司 | 一种评估方法、装置、设备及存储介质 |
CN112540365B (zh) * | 2020-12-10 | 2022-07-12 | 中国第一汽车股份有限公司 | 一种评估方法、装置、设备及存储介质 |
CN113844451A (zh) * | 2021-09-30 | 2021-12-28 | 上海商汤临港智能科技有限公司 | 行驶设备控制方法、装置、电子设备及存储介质 |
CN113844451B (zh) * | 2021-09-30 | 2023-12-19 | 上海商汤临港智能科技有限公司 | 行驶设备控制方法、装置、电子设备及存储介质 |
CN114019971A (zh) * | 2021-11-04 | 2022-02-08 | 北京三快在线科技有限公司 | 一种无人设备控制方法、装置、存储介质及电子设备 |
CN114019971B (zh) * | 2021-11-04 | 2024-03-26 | 北京三快在线科技有限公司 | 一种无人设备控制方法、装置、存储介质及电子设备 |
CN114779830A (zh) * | 2022-05-13 | 2022-07-22 | 无锡科若斯科技有限公司 | 一种基于动态阈值的巡检无人机电量监测管理方法及系统 |
CN118182515A (zh) * | 2023-02-27 | 2024-06-14 | 华为技术有限公司 | 车辆换道决策方法、装置和存储介质 |
CN118182515B (zh) * | 2023-02-27 | 2025-03-21 | 深圳引望智能技术有限公司 | 车辆换道决策方法、装置和存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN108583578B (zh) | 2019-12-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108583578B (zh) | 用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法 | |
CN110333714B (zh) | 一种无人驾驶汽车路径规划方法和装置 | |
US10503172B2 (en) | Controlling an autonomous vehicle based on independent driving decisions | |
CN108628300B (zh) | 路径决定装置、车辆控制装置、路径决定方法及存储介质 | |
US11827214B2 (en) | Machine-learning based system for path and/or motion planning and method of training the same | |
US20220105959A1 (en) | Methods and systems for predicting actions of an object by an autonomous vehicle to determine feasible paths through a conflicted area | |
CN110692094B (zh) | 用于自动驾驶车的控制的车辆控制装置及方法 | |
CN114072841A (zh) | 根据图像使深度精准化 | |
CN112683288A (zh) | 一种交叉口环境下辅助盲人过街的智能引导机器人系统及方法 | |
US20220355825A1 (en) | Predicting agent trajectories | |
CN110378210B (zh) | 一种基于轻量化YOLOv3的车辆和车牌检测及长短焦融合测距方法 | |
US20210042542A1 (en) | Using captured video data to identify active turn signals on a vehicle | |
CN112614373B (zh) | 一种基于BiLSTM周车换道意图预测方法 | |
US11718290B2 (en) | Methods and systems for safe out-of-lane driving | |
US20210402991A1 (en) | Object Trajectory Association and Tracking | |
WO2021028533A1 (en) | Method, device, medium, and vehicle for providing individual driving experience | |
US20230415772A1 (en) | Trajectory planning based on extracted trajectory features | |
CN114103994A (zh) | 基于车辆自动清扫路面的控制方法、装置、设备及车辆 | |
WO2020164089A1 (en) | Trajectory prediction using deep learning multiple predictor fusion and bayesian optimization | |
Azadani et al. | Toward driver intention prediction for intelligent vehicles: A deep learning approach | |
WO2023177969A1 (en) | Method and system for assessing whether a vehicle is likely to leave an off-road parking area | |
CN116863432B (zh) | 基于深度学习的弱监督激光可行驶区域预测方法和系统 | |
CN113460083A (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
KR20230082520A (ko) | 운전가능한 도로 세그먼트들의 자동 주석 달기 | |
CN113753038A (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 |