自动驾驶路径规划与行为预测最接地气详细综述

汽车ECU开发 2022-07-25 08:12

1.介绍

图1:路径规划在决策控制三大子领域中的主要应用
首先需要说明的是:路径规划(本文不严格区分轨迹规划与路径规划的定义,一律按照路径规划称呼)并不止属于单车自动驾驶,在车队列协同控制、交通流车辆协同规划、人机共驾等等各个领域中路径规划普遍存在。单车自动驾驶中,规划算法可与预测类算法结合提高车辆安全性;车队列协同控制中,不论车队列控制形式为leader-following还是predecessor-following等等,总要有某个智能体进行规划,后续车辆跟随并保证队列稳定性;人机共驾中,在车辆控制权的动态平衡过程中,控制权倾向于人还是机取决于驾驶员的控制量与已规划出的控制量的偏差。
上述三类只是简单的分类,路径规划以不同的形式存在于其中,如图1所示。限于篇幅,本文主要针对第一种进行讲解,即单车自动驾驶下与预测类算法相结合的路径规划,后两种看情况再次投稿细说。

2.行为预测与路径规划

图2:常用决策控制框架
单车决策控制一般可分解为行为预测、轨迹规划、风险评估三大子类,如图2所示。本文主要针对前两个问题。研究行为预测的方法又可分为Probability based approaches and Learning-based approaches,本节将按照以上两种方法进行细化讨论,并给出发展趋势如图4所示,其中横坐标为方法反应车车交互的能力,纵坐标为方法还原场景复杂度或真实度的能力,表格给出各方法在预测时域这一定量指标下的大概趋势。标中所列文献均保证了一定条件下相差不多的精确度,区分标准除了预测时域也可以用预测距离。
图3:各类方法的演变趋势与特征变化

2.1 Probability based approaches

## 2.1.1 Physics-based approaches
早期(2000-2010)针对上述三大问题的解决方案主要是基于运动学与动力学原理对ego-vehicle或者other vehicles进行建模,对于其运动状态带来的不确定性常被假设为正态分布[1-4],由此引入“高斯噪声”的概念。
有关假设不确定性为正态分布的应用最成熟的便是kalman filter[66][67],基于kalman filter的方法应用时的模式大致为在t时刻通过对外部事物的运动学以及动力学模型进行向前迭代,得到t+1时刻初步预测状态,而后在t+1时刻由车辆自带的传感器如GPS等获取位置等状态信息,两种状态信息进行融合后得到最终预测状态。由此过程得到外部车辆的预测轨迹,进而根据预测轨迹之间碰撞的可能性来进行风险预估是进行风险预估的一种常用方法[1]。
同样拥有此模型迭代-状态信息采集-状态信息融合更新过程的方式还有基于蒙特卡洛方法的粒子滤波[5-7],与基于kalman fliter的方法不同的是,此方法不仅可以根据t时刻的状态来预测未来状态,还可以根据t时刻之前的某一距离窗或时间窗内的状态来预测未来,如Christoph Hermes等人在[7]中利用t时刻30m的距离窗内的状态进行轨迹预测,预测时域可达到3s。
然而其距离窗长的特点也意味着要花费更多的时间进行状态采集,这直接限制了这一方式的实车应用,针对这一问题,Stefan Hoermann在[5]中通过使用雷达其他车辆的加速度,借此判断其driving style,并且在此基础上直接利用粒子滤波进行向前传播,不仅解决了距离窗的问题,还获得了2~5s的预测时域。
以上的所有方法虽然具有解释性强、算法相对轻便的优点,但是其最高的预测时域低的缺点使得其不能够单独出现在轨迹规划或风险评估模块中,现如今通常是将其与其他预测时域更长的算法结合进行使用,如BP-Network、LSTM-Network等等将在下文记叙。
## 2.1.2 Maneuver based approaches
图4:HMM(上)与DBN(下)结构区别[9][17]
这类方法中主要包括基于Hidden Markov Model(HMM)的方法,以及基于Dynamic Bayesian Network(DBN)的方法,上述两种方法在使用形式与内在本质上有着极大的相似性。关于HMM模型本身的详细介绍可参考文献[8],本节重点介绍其在DMAP上的应用。
相比于Physics-based approaches,基于HMM的方法特点在于不需要动力学或者运动学建模,预测时域更长并且更加稳定。HMM与Markov Model相比,除了一条显性状态序列以外,还有一条隐形状态序列,在其应用到DMAP上后,显性状态序列一般指的是可通过车辆传感器观测到的外部车辆的状态,例如速度、加速度等等,隐形状态序列一般指的是HMM输出的被检测物体的驾驶意图。
例如Thomas Streubel 等人在[9]利用外部车辆的速度、加速度以及前轮转角预测其打算拐弯还是直行,预测时域可达到7s,而显性状态与隐形状态之间的表现概率(emitting probability),以及隐形状态与隐形状态之间的传递概率(transition probability)的获取主要通过learning-based的方法,因此 HMM的预测准确性与所使用的数据集有很大依赖性[9]。
Xiaoxia Xiong等人在[10]中利用HMM与SVM结合构建碰撞预警系统,他将检测到的外部车辆的运动状态当作显性状态,将车辆安全性当作隐形状态,配合SVM给出的换道决策,根据周围场景进行风险预估,但是他在构建HMM时仅将外部车辆的状态纳入了决策,除了车辆以外,诸如行人或宠物等也应该纳入监测范围。
同样是针对HMM的构建问题,为了提高车辆之间的“交互性”,除了[10]中考虑的问题以外,Wei Liu等人在[31]中将外部车辆的“reaction”纳入建模,该reaction指的是外部车辆的四种状态:stopping、hesitating、normal and aggressive,具体通过外部车辆的速度的变化情况来判断,HMM构建完成后通过DESPOT算法进行求解,达到了在线运行的目的。
随着所考虑事物的多样化,模型便会愈加复杂,求解便愈发困难,HMM问题本身的复杂性就已经很高,在其问题求解上无法得到解析解,只能通过数值方法进行最优解逼近,而这种方法就很容易导致局部最优问题,为此Shai Shalev-Shwartz等人在[11]中利用无参数的强化学习的方法进行求解并且达到了比较好的效果,其泛化能力还有待提高。
单独一层HMM只是进行做外部车辆的行为预测,例如上文提到的外部车辆的转弯直行,或者是一段加速度序列[12],以上HMM输出结果便可以作为输入控制下层控制器进行轨迹规划或者轨迹追踪[13]。Ning Ye 等人在[14]中首先利用外部车辆的一段历史轨迹信息更新HMM的参数,然后利用Viterbi算法结合这段历史轨迹信息以及HMM模型,解码得到HMM的两组隐状态,其中一组隐状态便是所预测的轨迹。
为了提高HMM预测的准确性,Fang Li等人[15]对HMM模型进行了一点修改,提出了Auto-regression (AR) based HMM,目的是将所预测车辆过去的驾驶信息纳入考虑,其Observable states之间也出现关系,其余不变,其结构如图5所示,随后通过普通换道场景与紧急换道场景的仿真证明了AR-based HMM的预测准确性要高于一般的HMM。
在对HMM的结构进行变化的方向上,[15]从考虑历史信息的出发点进行修改,除此之外,同样是为了提高预测准确性,以及更好的增加各辆车之间的interaction能力,还可以从将各辆车之间可能出现的互动,即某辆车对其他辆车的反应纳入考虑,而拥有上述这一属性的方法则是基于DBN的方法,DBN通过允许状态空间以被分解的形式表达而推广了HMM,从表现形式上来看,可以理解为用DBN模型进行预测时,状态空间中可出现多辆车[16],也可以将本车驾驶员的状态纳入考虑[17],其结构形式与HMM的异同点如图5所示。
但是本质上其实不论是AR-based HMM或者是DBN都与HMM是类似的,在使用形式上乃至注意事项上也是类似的,DBN由于能够更好的表达环境事物之间的interaction,其准确性一般也要高一点,但是这也提高了求解难度
图5 HMM与DBN以及改良版HMM在结构上的变化
在基于概率的方法中,基于HMM、DBN的方法对于intention prediction更加稳定准确,但是其模型的复杂度高,在线求解更困难,并且应用在DMAP中时也需要与下层控制器或者路径规划模块结合,Physics based approaches虽然可以直接预测出轨迹,但是出于对安全性的要求,该方法通常作为下层路径规划模块与其他intention prediction算法结合使用,例如下文会提到的LSTM以及BP网络等等。

2.2 Learning based approaches

Learning-based的方法与前文所提到的HMM-based的方法相比,该方法同样需要根据外部车辆的状态数据,或者其他环境物体的状态数据进行参数确定,一般只用来判断驾驶意图,要想进行轨迹预测则需要配合其他算法,但是该方法可以通过调节网络结构深度以及网络类型来适应不同的环境,获得更长的预测时域以及更高的准确度。关于使用Learning-based的方法进行轨迹规划,其形式上基本上大同小异,区别主要在选取的网络结构的特点,具体情况见下文。
## 2.2.1 LSTM based approaches
Long Short-term Memory Network(LSTM)属于Recurrent Neural Network(RNN)的其中一种,在解决包含时间序列特性的问题上有很好的效果,比如语音分析等等,近年来LSTM应用到DAMP上之后也有很好的效果。相比于一般的RNN来说,LSTM解决了gratitude loss的问题并且还增加了网络的深度,在结构上核心的区别在于cell的不同,关于其具体的结构特点可以阅读文献[18]。
Alex Zyner等人在[19]利用LSTM进行intersection处的车辆意图识别,其使用的数据集为Naturalistic Intersection Driving Dataset[20],该数据集包含着外部车辆的速度、位置和heading等状态信息,诸如此类的更常用数据集为Next Generation Simulation (NGSIM)[21],这些信息通过extended Kalman filter进行滤波后进入一个三层的LSTM网络,最后通过softmax classifier输出预测的行为结果。
利用LSTM进行行为预测的方法大部分都是上面的模式,Long Xin等人在[22]中利用两个单层的LSTM进行意图识别与轨迹规划,第一层LSTM进行车辆意图识别,其大致模式与[19]中相同,第一层LSTM输出的预测结果如换道等等直接输入到第二层LSTM,随后输出的结果便是大致的预测轨迹,该大致的轨迹还会通过一个fully-connected曾进行优化输出最终的确定结果。
与[22]的轨迹预测模式类似的还有[23],但是在[23]中,Wenchao Ding等人将第二层LSTM替换为基于最优化的轨迹预测模块,在轨迹预测过程中不仅考虑了速度跟道路形状约束,还考虑了交通规则以及动态障碍物的约束,这样虽然可读性更好,但是仿真结果证明,算法的大部分时间都消耗在以上的约束确定上。
## 2.2.2 Other network based approaches
本节所指的网络主要是那些基于Deep neural network(DNN)做适当结构调整的网络。
例如:Chen Chen等人在[24]中利用一层input layer、一层output layer以及一层hidden layer构建Back Propagation(BP) Network,该BP Network会输出ego-vehicle的行为,并且通过V2I技术获取的附近车辆的状态、驾驶意图信息,并将数据作为协方差矩阵输入给下层的kalman filter模块进行轨迹预测,并且通过对预测的轨迹进行分析来获取风险估计。
但是该方法的结果并不是很好,主要表现为在交叉路口实施此算法要求路口的车辆速度必须低,我认为导致这一问题的主要原因还是其建立的DNN不够多样化,其hidden layer所能表现的特征太少,但是其利用V2I技术获取信息并且融合和以信息进行轨迹规划以及风险估计的方法属于这类方法的一个发展趋势,因为这样可以很便捷地提高ego-vehicle与other-vehicles的interactive能力,为了提高这类方法的鲁棒性,之后的研究中还应将V2I传播的packet-loss问题以及communication delay纳入考虑。
同样是为了提高算法“interactive”能力,Wenchao Ding等人在[25]中也使用了fully-connected层做最后输出,但是该层之前,首先使用RNN对两辆互为“neighborhood“的车运行轨迹进行encoding,此处“neighbourhood”可以简单理解为离得最近的两辆车,随后RNN输出结果至neighborhood interaction unit,其输出的两辆车之间的interaction情况将会与RNN输出的轨迹encoding结果一起被输送至fully-connected层,随后得到的结果便是外部车辆的行为预测。
该方法并没有采取直接通过neural network分析外部车辆的轨迹得到所预测的行为,而是考虑了车辆之间的互相影响,并且在fully-connected layer之前单独分析车辆之间的interaction情况,其方式结果与之前所用的考虑车辆之前的互相影响关系的方法,比如Social LSTM[26]、Convolutional social pooling LSTM(a modification of SLSTM)[27]相比,在预测准确性上有所提高,并且属于一种全新的方法。这种类似于“解耦”的方法既提高了算法的可解释性,又提高了算法的效果,也是一个很好的研究方向

2.3 V2X based approaches

这一阶段的智能车通过V2X技术获取外部信息,配合Probability-based或者Learning-based的方法进行控制决策,但是一般只考虑了V2V或者V2I其中一种技术,前者的亮点主要是通过V2X技术改变信息获取的渠道,使得前文的方法可以应用在更多地方,并且改进这些方法。
在前文中提到的方法使用大致过程是先识别驾驶意图,再根据意图规划路径,例如[23]中通过LSTM预测车辆驾驶意图,然后通过基于最优化的规划路径,而在V2X技术引进之后,完全可以通过V2X获取外部车辆的驾驶意图,并进一步进行路径规划[28][29]。例如:Chen Chen 等人[24]通过V2I获取外部车辆的速度、加速度、驾驶意图等信息,结合Back Propagation Network对ego-vehicle进行驾驶意图预测,随后利用Kalman Filter进行轨迹预测并且根据轨迹进行碰撞风险估计。
Laleh Makarem等人在[28]中同样是针对十字路口时的路径规划,通过V2V获取通信范围内所有车辆的位置、速度等信息然后将其作为约束条件纳入模型,随后通过linear quadratic optimal方法进行求解,既保证了求解效率,使得算法可以在线运行,又保证了运行的安全性,各辆车碰撞概率最低。
以上对V2X技术的应用,即车辆状态或驾驶意图的获取,还并没有到完全可以取代传统方法的地步,在对安全性要求更高的场景,如车辆跟随场景等,这时的驾驶意图若通过传统的方法如LSTM或HMM获取,其车辆只能低速运行并且车间安全距离还要大才能保证安全,这时V2X技术的应用便有着不可比拟的优势。
Jean-Nicola Russo等人在[17]针对车辆跟随时的rear-end collision问题提出了结合V2V技术的基于Bayesian Network(BN)的碰撞概率分析方法,该方法通过V2V获取前车的状态信息以及刹车意图,配合rain sensor、eye tracking sensor等环境、驾驶员传感器的数据一同输入BN进行碰撞概率预估,而在没有通过V2V获取刹车意图这一步时,通常所预测的概率偏高[32]。
前文所提到的驾驶意图识别的方法如LSTM、HMM等,虽然也可以比较好的识别出刹车意图,但是其预测结果可能不准,最关键的是,其算法运行时间较长,对于跟车工况时的安全性问题来说无法使用。而利用V2V获取前车的刹车意图这一步直接并且简洁的解决了这一问题。

3.待解决的问题

日后需要考虑的问题除了一直都存在的算法的效率与建模的完备性以外,还有对驾驶安全的考虑,具体如下:
(1) 本文提到的Maneuver based approaches与Learning based approaches均需要从驾驶数据集中学习转移概率值或参数,因此如何使得算法对于不同的场景可以保持较高的泛化能力尤为重要
(2) 多智能体之间的特性需要被反映在算法中,例如:合流路口相遇的车辆在决定谁先进道时,两辆车可能会同时刹车又同时加速,即表现出互相影响的交互特性。
(3) 若用V2X技术,丢包问题与传输延迟问题对预测结果影响巨大,若联合V2X通信与传统的预测方法,则如何数据融合才能获得最高的结果置信度。
(4) 亘古存在的效率问题,目前直接从算法本身做效率优化需要较大创新力,更常见的是针对某一问题用不同复杂度的预测、规划方法结合解决

写在最后

自动驾驶行为预测与路径规划涵盖了大量专业知识(但是同类别的方法相似性很强,也就是说学明白HMM那么离DBN也就不远了),例如隐马尔可夫、长短期记忆网络等等,网上的学习资源很多但是水平参差不齐。
建议大家在了解这方面内容时,可以通过CSDN等博客上的介绍对这些方法有个感性认知,但是要想深入了解诸如HMM等方法的底层细节,**不要将学习面只停留在博客博主的感性讲解上,多看看老师讲的底层数学细节**。

版权声明:本文为知Ismiracle」的原创文章,已获作者发表许可。

阅读原文,关注作者知乎,获取文中提到的文献!

分享不易,恳请点个【👍】和【在看】

汽车ECU开发 专注于汽车电子ECU软件开发,技术分享。
评论
  • 电竞鼠标应用环境与客户需求电竞行业近年来发展迅速,「鼠标延迟」已成为决定游戏体验与比赛结果的关键因素。从技术角度来看,传统鼠标的延迟大约为20毫秒,入门级电竞鼠标通常为5毫秒,而高阶电竞鼠标的延迟可降低至仅2毫秒。这些差异看似微小,但在竞技激烈的游戏中,尤其在对反应和速度要求极高的场景中,每一毫秒的优化都可能带来致胜的优势。电竞比赛的普及促使玩家更加渴望降低鼠标延迟以提升竞技表现。他们希望通过精确的测试,了解不同操作系统与设定对延迟的具体影响,并寻求最佳配置方案来获得竞技优势。这样的需求推动市场
    百佳泰测试实验室 2025-01-16 15:45 302浏览
  • 百佳泰特为您整理2025年1月各大Logo的最新规格信息,本月有更新信息的logo有HDMI、Wi-Fi、Bluetooth、DisplayHDR、ClearMR、Intel EVO。HDMI®▶ 2025年1月6日,HDMI Forum, Inc. 宣布即将发布HDMI规范2.2版本。新规范将支持更高的分辨率和刷新率,并提供更多高质量选项。更快的96Gbps 带宽可满足数据密集型沉浸式和虚拟应用对传输的要求,如 AR/VR/MR、空间现实和光场显示,以及各种商业应用,如大型数字标牌、医疗成像和
    百佳泰测试实验室 2025-01-16 15:41 189浏览
  • 现在为止,我们已经完成了Purple Pi OH主板的串口调试和部分配件的连接,接下来,让我们趁热打铁,完成剩余配件的连接!注:配件连接前请断开主板所有供电,避免敏感电路损坏!1.1 耳机接口主板有一路OTMP 标准四节耳机座J6,具备进行音频输出及录音功能,接入耳机后声音将优先从耳机输出,如下图所示:1.21.2 相机接口MIPI CSI 接口如上图所示,支持OV5648 和OV8858 摄像头模组。接入摄像头模组后,使用系统相机软件打开相机拍照和录像,如下图所示:1.3 以太网接口主板有一路
    Industio_触觉智能 2025-01-20 11:04 114浏览
  • 80,000人到访的国际大展上,艾迈斯欧司朗有哪些亮点?感未来,光无限。近日,在慕尼黑electronica 2024现场,ams OSRAM通过多款创新DEMO展示,以及数场前瞻洞察分享,全面展示自身融合传感器、发射器及集成电路技术,精准捕捉并呈现环境信息的卓越能力。同时,ams OSRAM通过展会期间与客户、用户等行业人士,以及媒体朋友的深度交流,向业界传达其以光电技术为笔、以创新为墨,书写智能未来的深度思考。electronica 2024electronica 2024构建了一个高度国际
    艾迈斯欧司朗 2025-01-16 20:45 184浏览
  • Ubuntu20.04默认情况下为root账号自动登录,本文介绍如何取消root账号自动登录,改为通过输入账号密码登录,使用触觉智能EVB3568鸿蒙开发板演示,搭载瑞芯微RK3568,四核A55处理器,主频2.0Ghz,1T算力NPU;支持OpenHarmony5.0及Linux、Android等操作系统,接口丰富,开发评估快人一步!添加新账号1、使用adduser命令来添加新用户,用户名以industio为例,系统会提示设置密码以及其他信息,您可以根据需要填写或跳过,命令如下:root@id
    Industio_触觉智能 2025-01-17 14:14 81浏览
  • 随着智慧科技的快速发展,智能显示器的生态圈应用变得越来越丰富多元,智能显示器不仅仅是传统的显示设备,透过结合人工智能(AI)和语音助理,它还可以成为家庭、办公室和商业环境中的核心互动接口。提供多元且个性化的服务,如智能家居控制、影音串流拨放、实时信息显示等,极大提升了使用体验。此外,智能家居系统的整合能力也不容小觑,透过智能装置之间的无缝连接,形成了强大的多元应用生态圈。企业也利用智能显示器进行会议展示和多方远程合作,大大提高效率和互动性。Smart Display Ecosystem示意图,作
    百佳泰测试实验室 2025-01-16 15:37 194浏览
  • 本文介绍瑞芯微开发板/主板Android配置APK默认开启性能模式方法,开启性能模式后,APK的CPU使用优先级会有所提高。触觉智能RK3562开发板演示,搭载4核A53处理器,主频高达2.0GHz;内置独立1Tops算力NPU,可应用于物联网网关、平板电脑、智能家居、教育电子、工业显示与控制等行业。源码修改修改源码根目录下文件device/rockchip/rk3562/package_performance.xml并添加以下内容,注意"+"号为添加内容,"com.tencent.mm"为AP
    Industio_触觉智能 2025-01-17 14:09 117浏览
  • 2024年是很平淡的一年,能保住饭碗就是万幸了,公司业绩不好,跳槽又不敢跳,还有一个原因就是老板对我们这些员工还是很好的,碍于人情也不能在公司困难时去雪上加霜。在工作其间遇到的大问题没有,小问题还是有不少,这里就举一两个来说一下。第一个就是,先看下下面的这个封装,你能猜出它的引脚间距是多少吗?这种排线座比较常规的是0.6mm间距(即排线是0.3mm间距)的,而这个规格也是我们用得最多的,所以我们按惯性思维来看的话,就会认为这个座子就是0.6mm间距的,这样往往就不会去细看规格书了,所以这次的运气
    wuliangu 2025-01-21 00:15 49浏览
  • 随着消费者对汽车驾乘体验的要求不断攀升,汽车照明系统作为确保道路安全、提升驾驶体验以及实现车辆与环境交互的重要组成,日益受到业界的高度重视。近日,2024 DVN(上海)国际汽车照明研讨会圆满落幕。作为照明与传感创新的全球领导者,艾迈斯欧司朗受邀参与主题演讲,并现场展示了其多项前沿技术。本届研讨会汇聚来自全球各地400余名汽车、照明、光源及Tier 2供应商的专业人士及专家共聚一堂。在研讨会第一环节中,艾迈斯欧司朗系统解决方案工程副总裁 Joachim Reill以深厚的专业素养,主持该环节多位
    艾迈斯欧司朗 2025-01-16 20:51 146浏览
  • 日前,商务部等部门办公厅印发《手机、平板、智能手表(手环)购新补贴实施方案》明确,个人消费者购买手机、平板、智能手表(手环)3类数码产品(单件销售价格不超过6000元),可享受购新补贴。每人每类可补贴1件,每件补贴比例为减去生产、流通环节及移动运营商所有优惠后最终销售价格的15%,每件最高不超过500元。目前,京东已经做好了承接手机、平板等数码产品国补优惠的落地准备工作,未来随着各省市关于手机、平板等品类的国补开启,京东将第一时间率先上线,满足消费者的换新升级需求。为保障国补的真实有效发放,基于
    华尔街科技眼 2025-01-17 10:44 203浏览
  •  光伏及击穿,都可视之为 复合的逆过程,但是,复合、光伏与击穿,不单是进程的方向相反,偏置状态也不一样,复合的工况,是正偏,光伏是零偏,击穿与漂移则是反偏,光伏的能源是外来的,而击穿消耗的是结区自身和电源的能量,漂移的载流子是 客席载流子,须借外延层才能引入,客席载流子 不受反偏PN结的空乏区阻碍,能漂不能漂,只取决于反偏PN结是否处于外延层的「射程」范围,而穿通的成因,则是因耗尽层的过度扩张,致使跟 端子、外延层或其他空乏区 碰触,当耗尽层融通,耐压 (反向阻断能力) 即告彻底丧失,
    MrCU204 2025-01-17 11:30 147浏览
我要评论
0
点击右上角,分享到朋友圈 我知道啦
请使用浏览器分享功能 我知道啦