基于分层学习和潜在风险模型的多车轨迹预测系统

1.本发明涉及的是一种无人驾驶领域的技术，具体是一种基于分层学习和潜在风险模型融合的多车轨迹预测系统和系统。


背景技术：

2.在复杂交通场景中，自动驾驶车辆不仅需要感知周边的交通环境，并要能够对环境的变化做出预测，从而避免潜在的碰撞风险，提高行驶的安全性。由于不同车辆驾驶员驾驶意图、驾驶习惯的多样性和差异性，车辆行驶轨迹是多种多样的。另一方面，车辆行驶时候还深受周边其他车辆行驶行为的影响，并且受到了道路环境以及交通要素(车道线、指示标志)等的约束。然而，仅仅根据周边车辆的位置、速度、加速度等信息，使用运动学模型进行位置推算，不能考虑车辆在机动过程中(例如变道、超车等)由于方向盘转角、油门、刹车输入改变且未知带来的车辆运动状态的变化，即不能考虑运动的不确定性，从而导致该种方法的预测精度低；其次，即使对于相同的驾驶场景，具有不同驾驶经验和习惯的驾驶员选择的行车决策和轨迹选择是不一样的，具有轨迹意图选择的不确定性；除此之外，多车轨迹预测不仅需要车辆之间的交互影响，而且需要考虑道路环境以及交通要素(不同类型的车道线等)对于车辆未来轨迹的影响，这有利于提高轨迹预测的准确性。最后，现有方法缺乏对于上述不同交互影响的显式评估，不具有物理可解释性，限制了轨迹预测方法在自动驾驶车辆危险评估和轨迹规划中的可靠应用。


技术实现要素：

3.本发明针对现有技术不能统一考虑车-车之间的交互作用以及道路边界和车道线对于车辆行驶的约束作用的不足，以及不能处理由于运动不确定性带来的未来行驶轨迹不同的缺陷，提出一种基于分层学习和潜在风险模型的多车轨迹预测系统，基于潜在风险模型建立车-车交互、车-路交互以及车-车道线交互的统一量化表征，充分考虑由于驾驶风格和习惯不同带来的运动不确定性和轨迹意图选择的不确定性影响，显著提高多车轨迹预测的精度，实现多车轨迹的准确预测，对提高自动驾驶车辆行驶安全性、舒适性具有重要意义。
4.本发明是通过以下技术方案实现的：
5.本发明涉及一种基于分层学习和潜在风险模型的多车轨迹预测系统，包括：基于条件变分编码器的候选轨迹生成模块、基于潜在风险模型的指导轨迹生成模块以及再学习模块，其中：候选轨迹生成模块根据周围车辆方向盘、油门和刹车，分别对周围每台车辆生成可行驶的候选轨迹；指导轨迹生成模块根据当前周围车辆的位置信息、速度信息以及道路与车道线信息建立潜在风险势场，进而利用风险势场计算每条候选轨迹的潜在风险值，根据潜在风险值为候选轨迹计算周围每台车辆的可能行驶概率并随机选择周围每台车辆的未来指导轨迹；再学习模块融合车辆历史轨迹和未来指导轨迹，最终得到周围每台车辆的未来预测行驶轨迹。
6.所述的可行驶的候选轨迹，通过以下方式生成：条件变分编码器利用采集到的周围每台车辆自然驾驶数据训练编码器和解码器，再利用编码器生成表征车辆历史轨迹和未来行驶轨迹潜在关系的条件概率分布，并在该条件概率分布中进行多次随机采集，最后将随机采样值和周边车辆的历史轨迹输入到解码器中，得到周围每台车辆的初步预测轨迹作为可能行驶的候选轨迹。
7.所述的潜在风险模型，即车辆、道路和车道线之间交互的统一风险表征势场eu＝e
l
+er+ev+es，其中：e
l
为考虑车道线对车辆轨迹约束作用的车道线风险势场，er为考虑道路对车辆轨迹约束作用的道路风险势场，ev为基于碰撞风险的考虑车车之间交互的车辆风险势场，es为考虑车辆自身惯性的速度风险势场。
8.所述的再学习模块，包括：三个全连接层和两个lstm层，其中：第一全连接层根据周围车辆时间周期th内历史轨迹序列信息，得到基础运动特征信息并输入第一lstm层得到最后时刻隐藏层的深度特征输出同时，利用第二全连接层处理指导轨迹生成模块中生成的未来指导轨迹的序列，得到指导轨迹序列的指导信息特征；将最后时刻隐藏层的深度特征输出指导信息特征同时输入第二lstm层，得到第二lstm所有时刻隐藏单元信息并输入第三全连接层中，得到预测周期tf内预测轨迹序列信息。
1.本发明涉及上述系统的多车轨迹预测方法，包括：
2.a、基于自动驾驶车辆当前位置，获取周边存在的多台车辆的行驶轨迹信息，获取道路曲率、宽度信息；获取车道线类型、曲率、宽度信息；
3.所述的行驶轨迹信息包括：位置、速度、加速度和航向角信息。
4.b、将多车行驶轨迹信息、道路信息以及车道线宽度信息投影至道路坐标系中，并保持同一要素在感知范围内存在时具有唯一身份标号(id信息)；将上述信息在投影坐标空间中的时空变化记录在储存器中，构建多车轨迹预测训练数据集；
5.c、基于多车轨迹预测中的不确定性和交互影响两方面，设计神经网络结构，构建轨迹预测模型；将上述数据集输入到预测模型中，完成多车轨迹预测模型的训练与优化；
6.d、根据自动驾驶车辆感知到的环境信息，利用上述多车轨迹预测模型预测周边车辆的运动轨迹。技术效果
7.与现有技术相比，本发明通过考虑周围车辆方向盘、油门和刹车输入未知带来的运动不确定性，实现了预测轨迹的多样性，从而增加该技术预测的鲁棒性；建立了车-车交互，车-路交互以及车-车道线交互的潜在风险势场，从而实现了多交通要素对车辆轨迹的影响表征，提高了轨迹预测的精度，提高自动驾驶车辆的安全性。
附图说明
8.图1为本发明流程图；
9.图2为实施例系统示意图；
10.图3为基于条件变分编码器的候选轨迹生成模块示意图；
11.图4为基于潜在风险模型的指导轨迹生成模块示意图；
12.图5为再学习模块示意图。
具体实施方式
13.如图1所示，为本实施例涉及一种基于分层学习和潜在风险模型融合的多车轨迹预测方法，包括以下步骤：
14.步骤1)根据车辆所带的摄像头和激光雷达传感器获取自动驾驶汽车周边多台车辆的运动轨迹信息以及道路、车道线信息；
15.步骤2)将步骤1)感知到的信息投影到以自动驾驶汽车为参考点建立的道路坐标系中，沿着道路方向为道路坐标系的纵向，垂直于道路方向为道路坐标系的纵向，将以上信息记录在存储器中，构建车辆轨迹预测样本数据集；
16.步骤3)利用上述多车轨迹训练集训练基于分层学习和潜在风险模型融合的多车轨迹预测系统；
17.步骤4)将周边车辆的行驶轨迹信息与道路、车道线信息输入到训练好的轨迹预测系统中，得到多车轨迹的精准预测。
18.如图2所示，为本实施例涉及一种实现上述方法的基于分层学习和潜在风险模型融合的多车轨迹预测系统，包括：基于条件变分编码器的候选轨迹生成模块、基于潜在风险模型的指导轨迹生成模块以及再学习模块，其中：基于条件变分编码器的候选轨迹生成模块考虑周围车辆方向盘、油门和刹车输入未知带来的运动不确定性，利用编码器和解码器生成车辆可行驶的候选轨迹；基于潜在风险模型的指导轨迹生成模块通过潜在风险模型建立当前的潜在风险势场，并根据风险代价分配候选轨迹概率，依据候选轨迹概率随机选择得到每台车辆的未来指导轨迹；再学习模块通过神经网络模型根据融合车辆历史轨迹以及未来指导轨迹信息，预测多车的行驶轨迹。
19.如图2所示，所述的可行驶的候选轨迹，通过候选轨迹生成模块将多车历史轨迹信息x以及多车未来的真实轨迹y输入到编码器中，通过编码器得到表征车辆历史轨迹和未来行驶轨迹潜在关系z的条件概率分布p(z|x,y)；对于隐藏状态z根据概率分布p(z|x,y)进行随机采样n次；将z值和输入信息x输入到解码器中对每台车辆得到n条候选轨迹。
20.如图2所示，所述的指导轨迹，通过指导轨迹生成模块根据当前场景中周边车辆位置、速度信息以及车道线、道路信息建立潜在风险势场eu；根据潜在势场eu对步骤3中每台车辆的n条候选轨迹进行风险评价，根据风险代价分配每条轨迹的概率，然后依据概率值进行随机选择，得到每台车辆的指导轨迹。
21.所述的指导轨迹生成模块将每台车辆的历史轨迹信息以及指导轨迹信息输入再学习模块的神经网络模型中，得到多车的预测轨迹。
22.优选地，基于条件变分编码器的候选轨迹生成模块和再学习模块需要通过采集的多车轨迹数据集进行训练和优化。
23.如图3所示，所述的基于条件变分编码器的候选轨迹生成模块包括：编码器单元和解码器单元，其中：编码器包括两个通道，每个通道由全连接层(fc)和长短时记忆网络层(lstm)组成，编码器单元根据周边车辆历史轨迹序列信息x和未来真实轨迹序列信息y，利用全连接层和lstm网络进行处理，得到两条通道的隐藏层信息，将两个通道的信息融合后通过一个全连接层得到条件概率分布z～p(z|x,y)的均值μ(x,y)和方差σ2(x,y)。
24.所述的解码器包括：两个通道，其中：第一通道通过全连接层处理隐藏状态信息z，第二通道包含全连接层(fc)和长短时记忆网络层(lstm)用来处理输入信息x，全连接层
(fc)和长短时记忆网络层(lstm)通过融合两个通道的信息，得到车辆可能行驶的候选轨迹位置序列信息。
25.在图4所示，所述的基于潜在风险模型的指导轨迹生成模块包括：潜在风险势场单元、轨迹概率分配单元和随机选择单元，其中：潜在风险势场单元根据当前输入信息x生成潜在风险势场eu＝e
l
+er+ev+es；轨迹概率分配单元将候选轨迹yc投影到风险势场中，计算每条候选轨迹的潜在风险值eu(yc)，并根据潜在风险值给候选轨迹分配周边车辆可能行驶的概率其中nc是候选轨迹的数量；随机选择单元通过随机选择得到每台车辆的未来指导轨迹yg。
26.如图5所示，所述的再学习模块包括：三个全连接层和两个lstm层，其中：第一全连接层根据历史轨迹序列信息，进行特征提取处理，得到深度特征信息，第二全连接层根据未来指导轨迹信息，进行特征提取处理，第一lstm层根据第一全连接层提取的深度特征信息，进行序列信息处理，获得最后时刻隐藏层的输出，第二lstm层根据第一lstm层输出信息和第二全连接层信息，进行信息融合处理，和序列信息生成，最后第三个全连接层输出最终预测轨迹。
27.与现有技术相比，本发明提出的多车轨迹预测系统与系统中，基于条件变分编码器的候选轨迹生成模块基于运动的不确定性进行建模，考虑了驾驶员风格不同带来的轨迹多样性，具有很好的鲁棒性；同时，通过潜在风险模型可以实现车辆之间、道路对车辆以及车道线对车辆影响的联合表征，具有很好的物理可解释性。该预测方法与系统通过以上两个方面的创新可以实现多车轨迹的高精度预测。
28.上述具体实施可由本领域技术人员在不背离本发明原理和宗旨的前提下以不同的方式对其进行局部调整，本发明的保护范围以权利要求书为准且不由上述具体实施所限，在其范围内的各个实现方案均受本发明之约束。