自动驾驶决策规划 - 基于模型的预测方法

作者 | 胖胖橙 编辑 | 自动驾驶之心

原文链接:https://zhuanlan.zhihu.com/p/12939525225

点击下方卡片,关注“自动驾驶之心”公众号

戳我-> 领取自动驾驶近15个方向学习路线

>>点击进入→自动驾驶之心规划控制技术交流群

本文只做学术分享,如有侵权,联系删文

1. 预测系统概述

通过已有的感知信息及常识,推理出目标一段时间后的行为,来决定自己当前的动作。

67f6c738bfa0c4eb0bd119635691b14b.png
自动驾驶系统架构

1.1 预测系统的必要性

8907286a05ff93e0437bc76c976952d3.png
Cut In 场景

对于隔壁车道目标 cut in 场景,如何平衡召回率(Recall)和准确率(Accuracy),对决策规划分别有何影响?

如果recall过低,隔壁车辆切入,会存在误检,存在碰撞风险。
如果Accuracy过低,可能存在误识别隔壁车切入,存在误制动问题。

召回率(Recall) 和 准确率(Accuracy)

召回率(Recall) 和 准确率(Accuracy) 都是用于评估分类模型性能的重要指标,但它们侧重点不同,适用于不同的场景。

  1. 召回率(Recall)

召回率主要衡量的是模型能够识别出多少实际存在的目标(正样本)。它的核心关注点是减少漏报,即确保尽可能多的目标被正确识别,特别是在自动驾驶场景中,涉及检测行人、车辆、障碍物等时尤为关键。

6b8cd1de04fa5dd2a4f2baa77af54d80.png
  • 其中,TP(True Positive):正确预测为目标的数量,FN(False Negative):漏掉的实际目标的数量。

  • 召回率高意味着系统漏掉的目标较少,减少了碰撞或事故的风险,但它可能会增加误报的风险。

  1. 准确率(Accuracy)

准确率衡量的是所有预测中,模型预测正确的比例。它包括正确的正样本(TP)和负样本(TN)。

abc7d6a921bab580cddcad3085e28ccc.png
  • 其中,TN(True Negative):正确预测的负样本,FP(False Positive):误报的负样本。

  • 准确率高并不总是意味着模型好,特别是在数据不平衡的情况下。

预测结果的的多模态性、不确定性。

意图多模态,预测不可能百分百准确。预测系统主要考虑一下几个问题:

  • 如何基于环境信息进行建模?

  • 模型应该输出哪些信息?

  • 对于长时间的预测应该怎么做?

d259eb961841b1dd2c13bfe07dda1318.png
预测结果多模态、不确定

1.2 预测系统的架构

输入表征:agent feature、map、其他辅助信息.

输出表征:trajectory\intention、object、scenarios.

392a6e28d2d015be35fff5dca81e5de0.png
预测系统架构
9b545953925c1841b8576b029cd63cff.png
轨迹预测的输入输出

1.3 预测系统的发展

6209255a1dc500635988b4766d60e7e8.png
预测系统的发展

2. 定速度预测

一维匀速运动模型:感知信息不确定,道路结构缺失等情况,适用CV 模型。

目标做匀速直线运动,加速度为0。现实中速度会有轻微扰动变化,可视为具有高斯分布的噪声。

一维运动:仅沿着 x 轴或 y 轴方向运动,因此状态向量只需要描述位置和速度。

一维状态向量:

623bbc360e7d071984c22d3009fa3395.png 1a9e5a1a4e8514ea50baf57efd928f22.png

局限:与感知耦合密切, 目标的yaw 与 velocity会影响预测的轨迹。感知系统存在的误差,会直接影响到预测。

二维匀速运动模型

二维模型:在 x-y 平面上运动,状态向量需要同时描述 x 和 y 两个方向的位置和速度。

056b60be75536c0c92d48725ba06303b.png
二维连续模型
22ecac14f59e9aaf668b47964fe087f4.png
二维离散模型

3.定曲率预测

目标车过去按照某一曲率运动,假设会继续按照该曲率运动。

  • 定曲率意味着物体的运动轨迹具有恒定的曲率,即轨迹为一个圆弧或圆的一部分。

  • 在物体运动时,转向角速度(yaw rate)保持不变,因此物体会沿着一个固定半径的圆弧运动。

167124fc238c54251eb5fb1a3ad61f04.png
定曲率预测模型

缺点:曲率估计不准确时,误差会比较大。

7fd124734ad7c9da0a2e8a187591bbc1.png
定曲率预测的bad case

共同局限:长时间区间会失准!

ff652e77f9212c8c80b92869c33b25c6.png
定速度、定曲率预测对比

4. 短时预测与长时预测

预测不确定性随着预测时间变长显著增大。

  • 短期预测:基于运动学模型或者预测网络,完成短时推演,一般为 3s。

  • 长期预测:结合意图预测,稳定长时预测,避免远端发散,符合道路结构一般为 8s+。

如何解决 预测时间越长,预测越不准确的问题?引入 意图预测。

c496fdca60c660b97146fa16c066598b.png

5. 基于手工特征的意图预测

  • 意图:预先定义的车流行为,如变道,左右转等。意图一般会绑定到车道、路口两个信息上。

  • 分类:基于车辆的行为特征,对车辆的意图进行分类。意图转变为分类问题。

c51416acdcdaccf7fa57e805e77b2fbd.png
常见预测场景

5.1基于SVM的意图分类

支持向量机Support Vector Machine(SVM)

653acb6e88be81b0da5b59a13efc36aa.png
支持向量机Support Vector Machine

以预测目标车是否会变道为例,二分类问题。

手工特征标记:距离目标车道的横向距离、距离目标车道的横向速度、道路实线、虚线 、目标车与前车的距离或者速度等等 。

  • 特征如何选取?选择哪些维度?拓展特征维度有什么意义?

  • 变道前一段时间,预测出其变道行为,需要提前多久?(超参,变道趋势不一样。如果较早,缓慢变道与Lane keep不易区分,较晚,较低预测性能)

2a1463f6a8865d2193172b2cdcd28e03.png
预测目标车是否会变道
53ed4e5742c7bf0280c14249cdd6e87e.png
SVM 输入输出案例

5.2 基于神经网络的意图预测

将原始信息进行编码,使用高维向量进行输入,通过多层感知机预测障碍车会选择哪一条车道行驶,输出每个车道线的概率。DNN + Rule兜底。

d6b762fe47cd29d8f77118d33e3ff8a5.png
Apollo 5.0

5.3 其他的输出建模方法

将路口进行扇区划分进行交通路口的变道意图预测

  • 输入:障碍物自身运动历史,路口车道信息,周围其他障碍物信息。

  • 模型:以障碍物车朝向为参考方向,划分为12个扇形区域;记录每个扇形区域内是否有离开该路口的车道;将问题转化为12元分类问题。

  • 输出:每一个扇形区域行驶的概率,然后对扇形区域内的所有lane segment赋上概率。

d7c818b78ba6e64a2709015587e65e00.png
Apollo 5.0 对路口的处理

5.4 其他的输入建模方法

人工构造的输入特征有天然局限性

输入:语义地图渲染的方式,将障碍车的历史运动状态、车道的形状与连接关系,以及其他车的运动状态和历史,都转化为图像信息。(看图说话,根据图像信息,预测目标轨迹)

a357e2873abbebf7d86bf7e755e105ef.png
Multimodal Trajectory Predictions for Autonomous Driving using Deep Convolutional Networks

5.5 其他的分类模型建模

基于隐马尔可夫模型的意图估计

09b8077a451584b15db8f1c63ae7aa0a.png
马尔可夫模型

6.基于模型的轨迹预测

6.1 如何将短时轨迹结合长时意图,生成长时轨迹?

长时轨迹生成 -> 轻量化的planner

d67ddbbd9da3f402d3766722bd4ae876.png

通过意图估计得到目标车要驶入某个车道,并根据运动趋势等得到短时的运动轨迹,如何构造出长时预测轨迹?

优化目标:贴合短时轨迹、符合常识意图

约束条件:满足运动学约束 、与地图等信息匹配

寻找一个规划器,得到未来的轨迹点,并且要做到轻量化。

Planner 三把斧:搜索、采样、优化,对该问题,不适用。使用现有的轨迹生成方式,如贝塞尔曲线、样条曲线等。

9c04be05b23d58666106f4f7b8cd9d10.png
曲线生成方式

控制点的生成策略 --> 决定曲线的生成。意图预测判断出车道后,可以灵活基于地图抽取控制点。

Bezier曲线基本原理

34eea5f49c3f35b460fb6289aa69168a.png
Bezier曲线基本原理

Bezier曲线的数学方法

83d8c52ccef6c7025d411218b418da38.png
Bezier曲线的数学方法

基于Bezier曲线的长时轨迹生成过程

  • 意图预测 --> 根据意图查询地图,得到车道信息等 --> 长时控制点

  • 短时预测轨迹 --> 短时控制点

  • 长时控制点+短时控制点 --> 短时控制点与长时控制点衔接、插值去重拟合 --> 长时轨迹

96a82537becf6970412de04faeca5b49.png
基于Bezier曲线的长时轨迹生成过程

6.2 EPSILON: Intention Prediction Network

arxiv.org/pdf/2108.07993.pdf

6fca406a98869c2383a3fd57c9ef9c5d.png
Intention Prediction Network Pipline

Agent历史轨迹 --> 特征抽取 --> 坐标转换/编码 --> 拼接/解码/归一化 --> 候选路径及概率

思考:全局归一化是否合适?

ec8e7f2fac69d415b5611fc832563d08.png
Intention Prediction Network Structure
a00530d5fa499afee1cfeb0cded24d71.png
Intention Prediction Network Application

意图到轨迹:使用前向仿真,forward simulation,对于交互更加友好些,完成长时轨迹推演。

① 2025中国国际新能源技术展会

自动驾驶之心联合主办中国国际新能源汽车技术、零部件及服务展会。展会将于2025年2月21日至24日在北京新国展二期举行,展览面积达到2万平方米,预计吸引来自世界各地的400多家参展商和2万名专业观众。作为新能源汽车领域的专业展,它将全面展示新能源汽车行业的最新成果和发展趋势,同期围绕个各关键板块举办论坛,欢迎报名参加。

6d833f8be6b92e593b8742f39649ab0e.jpeg

② 国内首个自动驾驶学习社区

『自动驾驶之心知识星球』近4000人的交流社区,已得到大多数自动驾驶公司的认可!涉及30+自动驾驶技术栈学习路线,从0到一带你入门自动驾驶感知端到端自动驾驶世界模型仿真闭环2D/3D检测、语义分割、车道线、BEV感知、Occupancy、多传感器融合、多传感器标定、目标跟踪)、自动驾驶定位建图SLAM、高精地图、局部在线地图)、自动驾驶规划控制/轨迹预测等领域技术方案大模型,更有行业动态和岗位发布!欢迎扫描加入

1c4ae900fa30e82097fe377feb31d708.png

 ③全网独家视频课程

端到端自动驾驶、仿真测试、自动驾驶C++、BEV感知、BEV模型部署、BEV目标跟踪、毫米波雷达视觉融合多传感器标定多传感器融合多模态3D目标检测车道线检测轨迹预测在线高精地图世界模型点云3D目标检测目标跟踪Occupancy、CUDA与TensorRT模型部署大模型与自动驾驶NeRF语义分割自动驾驶仿真、传感器部署、决策规划、轨迹预测等多个方向学习视频(扫码即可学习

ee2ead35dc37f67ce603d7a43c2fc31c.png

网页端官网:www.zdjszx.com

④【自动驾驶之心】全平台矩阵

d25538e845dd88253e65ae357de5276e.png

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值