首页 / 专利库 / 信号处理 / 观测矩阵 / 一种考虑不确定性的自动驾驶风险评估方法

一种考虑不确定性的自动驾驶险评估方法

阅读:905发布:2020-05-11

专利汇可以提供一种考虑不确定性的自动驾驶险评估方法专利检索,专利查询,专利分析的服务。并且本 发明 涉及一种考虑不确定性的自动驾驶 风 险评估方法,本发明方法包括先验环境地图构建步骤、交通参与车辆状态观测步骤、自车执行轨迹调取步骤、基于先验知识的自适应多目标追踪步骤,通过驾驶行为似然估计、轨形匹配、轨迹预测,利用多安全裕度对行车碰撞风险估计,最后输出 时空 行车风险态势图进行评估,可以实现自动驾驶的多安全裕度风险估计,提高自动驾驶对环境的适应能 力 ,使自动驾驶过程更加平稳可靠。,下面是一种考虑不确定性的自动驾驶险评估方法专利的具体信息内容。

1.一种考虑不确定性的自动驾驶险评估方法,其特征在于,该方法包括以下步骤:
1)构建先验环境地图,并获取道路信息;
2)观测交通参与车辆状态,获取状态数据;
3)获取自车执行轨迹,将状态数据与自车执行轨迹融合至构建的先验环境地图,获取实时环境地图;
4)构建基于扩展卡尔曼滤波的自适应交互式多模型数据关联为框架的多目标追踪预测模型,将交通知识、道路知识、车辆知识和驾驶员知识输入模型中,输出交通参与车辆状态的多目标追踪估计结果,所述的多目标追踪估计结果包括多目标追踪轨迹及轨迹状态信息;
5)结合先验知识和多目标追踪估计结果对交通参与车辆进行行为识别与分类;
6)根据道路信息获取道路曲率,根据多目标追踪轨迹的状态信息获取曲率变化,对曲率变化和道路曲率做差分,获取驾驶行为似然估计的结果,根据驾驶行为似然估计的结果调取对应行为的路径库,并结合多目标追踪估计结果匹配对应的路径作为轨形;
7)将匹配的轨形与多目标追踪估计结果作为输入,基于模型预测控制获取交通参与车辆预测轨迹;
8)基于多裕度安全机制,计算碰撞联合概率,输出包含时空碰撞风险的概率地图,根据包含时空碰撞风险的概率地图对自动驾驶风险进行评估。
2.根据权利要求1所述的一种考虑不确定性的自动驾驶风险评估方法,其特征在于,步骤2)中,所述的观测交通参与车辆状态包括空间观测和时间观测,所述的空间观测获取车辆平面内的位置和朝向,所述的时间观测获取车辆的速度、加速度和横摆角速度
3.根据权利要求1所述的一种考虑不确定性的自动驾驶风险评估方法,其特征在于,步骤4)具体包括以下步骤:
41)根据道路信息的道路曲率先验知识和模型概率进行模型转移概率的自适应调整,获取交互后的模型输入状态和协方差矩阵;对于模型i的转移概率调整内容为:
411)模型i在时刻k模型转移概率调整因子为:
412)模型i在时刻k的模型转移概率的表达式为:
Pii,k=max{1,αi,k·Pii,k-1}
413)其他模型在时刻k模型转移概率的表达式为:
j=1,...M且j≠i
其中,ui,k为模型i在k时刻的模型概率,ui,k-1为模型i在k-1时刻的模型概率,M为总的模型数量;
42)利用无偏直线匀速模型、无偏直线匀加速模型、无偏匀角速度模型和无偏匀角加速度模型的扩展卡尔曼滤波进行下一步的状态预测和协方差预测;
43)根据道路曲率先验知识和车辆动学约束的先验知识,计算关联波的上下限和波门的形状,并自适应调整关联波门;
44)利用无偏直线匀速模型、无偏直线匀加速模型、无偏匀角速度模型和无偏匀角加速度模型的扩展卡尔曼滤波进行下一步的状态、协方差、新息和新息的协方差更新;
45)结合新息和新息的协方差进行模型似然估计,并更新模型概率;
46)输出交通参与车辆状态的估计结果。
4.根据权利要求3所述的一种考虑不确定性的自动驾驶风险评估方法,其特征在于,无偏直线匀速模型、无偏直线匀加速模型、无偏匀角速度模型和无偏匀角加速度模型的输入为测量的障碍物的距离rm和方位角θm,其中:
无偏直线匀速模型的系统方程的表达式为:
无偏直线匀加速模型系统方程的表达式为:
无偏匀角速度模型系统方程的表达式为:
无偏匀角加速度模型系统方程的表达式为:
式中:x(t)、y(t)分别为t时刻目标的纵向位置与横向位置, 分别为t时刻目标的纵向速度与横向速度, 分别为t时刻目标的纵向加速度与横向加速度,ω为目标的横摆角速度,α为机动频率,wc(t)为系统噪声。
5.根据权利要求4所述的一种考虑不确定性的自动驾驶风险评估方法,其特征在于,采用道路曲率、车速以及车辆转弯半径计算波门的上下限和波门的形状,具体内容为:
波门总体由三段圆弧组成,分别标记为 其长度的表达式为:
其中,Rρ为波门切圆弧半径,lv为波门长度,θρ为波门切圆弧半径与波门长度lv的夹角,θv为波门长度lv的夹角,各参数的表达式为:
lv=αego·vego·Tego
θv=π-2·θρ
式中:ρroad为当前道路的曲率,ρego为自车当前的转弯曲率,βego为波门半径系数,αego为波门长度系数,vego为自车当前车速,Tego为自车感知系统采样周期。
6.根据权利要求5所述的一种考虑不确定性的自动驾驶风险评估方法,其特征在于,自适应调整关联波门具体包括下列步骤:
431)对当前波门进行判断,若当前波门内有交通参与车辆的量测值,则跳转至步骤
44),若无,则执行步骤432);
432)将波门沿纵向放大,并在放大后的波门内检测是否有量测值落入,若有,则跳转至步骤44),若无,则执行步骤433);
433)将步骤432)中放大的波门沿纵向再次放大,并在放大后的波门内检测是否有量测值落入,若有,则跳转到步骤44)若无,则执行步骤434);
434)将波门沿横向放大,并在在放大后的波门内检测是否有量测值落入,若有或者横向未执行到波门边缘,则跳转到步骤44),否则,执行步骤431)。
7.根据权利要求6所述的一种考虑不确定性的自动驾驶风险评估方法,其特征在于,步骤8)具体包括以下步骤:
81)将车辆碰撞分为两级,第一级为以车辆纵向最短安全距离为长半轴,侧面最短安全距离为短半轴构造的椭圆区,该区域内若出现存在障碍物的点,则认为100%发生碰撞,第二级为满足舒适性为前提的椭圆区,该区域为以车辆纵向舒适安全距离为长半轴,侧面舒适安全距离为短半轴构造的椭圆区域,该区域为正态分布的碰撞区,第二级椭圆区位于第一级椭圆区外;碰撞联合概率由障碍物的点靠近第一级椭圆区的距离的远近决定,其数值范围为0%~100%;
82)沿障碍物的预测轨迹以及自车执行轨迹,按照执行时间步长,对每一个节点的碰撞联合概率进行估计;
83)根据步骤82)的估计结果,输出包含每个节点在每一时刻的碰撞联合概率的时空行车风险态势图。
8.根据权利要求7所述的一种考虑不确定性的自动驾驶风险评估方法,其特征在于,碰撞联合概率的计算内容为:
若障碍物的点落在第一级椭圆区内,则碰撞联合概率为:
Pcollision=100%
若障碍物的点落在第二级椭圆区外,则碰撞联合概率为:
Pcollision=0%
若障碍物的点落在第一级椭圆区外,第二级椭圆区内,则碰撞联合概率为:
Pcollision=max{Pcollisionx,Pcollisiony}
其中:
式中:x、y为障碍物点在地图中的坐标位置,σx、σy分别为纵、横向的安全距离的均方差,μx、μy分别为纵、横向的安全距离的期望。
9.根据权利要求8所述的一种考虑不确定性的自动驾驶风险评估方法,其特征在于,若车辆纵向最短安全距离为Δa,侧面最短安全距离为Δb,则车辆纵向舒适安全距离为max{Δa,Δa+(vego-vcar)2/aego},侧面舒适安全距离为max{Δb,Δb+(vego-vcar)2/aego}。
10.根据权利要求9所述的一种考虑不确定性的自动驾驶风险评估方法,其特征在于,所述的包含时空碰撞风险的概率地图为包含障碍物车辆预测的轨迹、与该轨迹对应的碰撞联合概率的栅格地图。

说明书全文

一种考虑不确定性的自动驾驶险评估方法

技术领域

[0001] 本发明涉及智能汽车风险评估技术领域,尤其是涉及一种考虑不确定性的自动驾驶风险评估方法。

背景技术

[0002] 随着社会经济的高速发展,道路上的机动车辆越来越多,行车安全问题也随之愈显突出,作为有望缓解交通压与行车安全的无人驾驶技术正逐步从实验室走向大众。对行车安全的高要求,需要自动驾驶车辆应具备先于人发现风险、先于人处理的风险的能力,尽可能避免碰撞,将受损度降到最低。然而,由于传感器分辨率、测量精度的限制,交通参与驾驶员的行为不可观测以及交通参与车辆参数难以测量,智能车环境感知结果不可避免的存在高不确定性。因此,如何提供一种能考虑环境感知不确定性的可靠的风险评估策略是本领域技术人员亟待解决的问题。

发明内容

[0003] 本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种考虑不确定性的自动驾驶风险评估方法。
[0004] 本发明的目的可以通过以下技术方案来实现:
[0005] 一种考虑不确定性的自动驾驶风险评估方法,包括以下步骤:
[0006] S1:构建先验环境地图,并获取道路信息。
[0007] 先验环境地图为以路面特征和道路结构要素作为知识、包含行驶方向的有向节点的多粒度地图,所述的实时的环境地图为以自车质心为地图核心,以传感器探测视距为上限构造的栅格地图,该栅格地图中每一个栅格点的碰撞联合概率被初始化为0。
[0008] S2:观测交通参与车辆状态,获取状态数据。所述的观测交通参与车辆状态包括空间观测和时间观测,所述的空间观测获取车辆平面内的位置和朝向,所述的时间观测获取车辆的速度、加速度和横摆角速度
[0009] S3:调取自车执行轨迹,将状态数据与自车执行轨迹融合至构建的先验环境地图,获取实时环境地图。
[0010] S4:构建基于扩展卡尔曼滤波的自适应交互式多模型数据关联为框架的多目标追踪预测模型,将交通知识、道路知识、车辆知识、驾驶员知识输入模型中,输出交通参与车辆状态的多目标追踪估计结果,所述的多目标追踪结果包括多目标追踪轨迹及轨迹状态信息。具体包括以下步骤:
[0011] 41)根据道路信息的道路曲率先验知识和模型概率进行模型转移概率的自适应调整,获取交互后的模型输入状态和协方差矩阵。
[0012] 对于模型i的转移概率调整策略为:
[0013] 411)模型i在时刻k模型转移概率调整因子
[0014]
[0015] 412)模型i在时刻k模型转移概率
[0016] Pii,k=max{1,αi,k·Pii,k-1}
[0017] 413)其他模型在时刻k模型转移概率
[0018]
[0019] 其中,ui,k表示模型i在k时刻的模型概率,ui,k-1表示模型i在k-1时刻的模型概率,M表示总的模型数量(此处M=4)。
[0020] 42)利用无偏直线匀速模型、无偏直线匀加速模型、无偏匀角速度模型、无偏匀角加速度模型的扩展卡尔曼滤波进行下一步的状态预测和协方差预测。
[0021] 无偏直线匀速模型、无偏直线匀加速模型、无偏匀角速度模型、无偏匀角加速度模型中的无偏指的是目标的无偏观测模型:
[0022]
[0023]
[0024] 其中,车辆坐标系——x表示自车纵向(向前为正),y表示自车横向(向右为正),分别表示纵横向的速度;传感器坐标系——rm、θm分别表示传感器返回的障碍物距离和方向角测量值, 分别表示传感器返回的障碍物距离和方向角速率测量值,σθ表示角度的均方差;μa表示传感器坐标系测量值误差转换到下的车辆坐标系的误差;分别表示位置和速度测量误差。
[0025] 无偏直线匀速模型的系统方程为:
[0026]
[0027] 无偏直线匀加速模型系统方程为:
[0028]
[0029] 无偏匀角速度模型系统方程为:
[0030]
[0031] 无偏匀角加速度模型系统方程为:
[0032]
[0033] 其中,x(t)、y(t)表示t时刻目标的纵向与横向位置, 表示t时刻目标的纵向与横向速度, 表示t时刻目标的纵向与横向加速度,ω表示目标的横摆角速
度,α表示机动频率,wc(t)表示系统噪声。
[0034] 四种模型的输入是所测量的障碍物的距离rm和方位角θm。
[0035] 43)根据道路曲率先验知识和车辆动力学约束的先验知识,计算关联波的上下限和波门的形状,并自适应调整关联波门。
[0036] 优选地,采用道路曲率、车速以及车辆转弯半径计算波门的上下限和波门的形状。波门总体由三段圆弧组成,分别标记为 则三段圆弧的长度计算公式为:
[0037]
[0038]
[0039]
[0040] 中间参数满足:
[0041]
[0042] lv=αego·vego·Tego
[0043]
[0044] θv=π-2·θρ
[0045] 其中,Rρ为波门切圆弧半径,lv为波门长度,θρ为波门切圆弧半径Rρ与波门长度lv的夹角,θv为波门长度lv的夹角,ρroad为当前道路的曲率,ρego为自车当前的转弯曲率,βego为波门半径系数,αego为波门长度系数,vego为自车当前车速,Tego为自车感知系统采样周期。
[0046] 对关联波门的调整过程具体包括下列步骤:
[0047] 1)对当前波门进行判断,若当前波门内有交通参与车辆的量测值,跳转至步骤44),若无,则执行下一步;
[0048] 2)将波门沿纵向放大,并在放大后的波门内检测是否有量测值落入,若有,则跳转至步骤44),若无,则执行下一步;
[0049] 3)将波门沿纵向放大,并在放大后的波门内检测是否有量测值落入,有则跳转到步骤44),若无,则执行下一步;
[0050] 4)将波门沿横向放大,并在在放大后的波门内检测是否有量测值落入,若有或者横向未执行到波门边缘,则跳转到步骤44),否则,执行步骤1);
[0051] 44)利用无偏直线匀速模型、无偏直线匀加速模型、无偏匀角速度模型、无偏匀角加速度模型的扩展卡尔曼滤波进行下一步的状态、协方差、新息、新息的协方差更新;
[0052] 45)结合新息和新息的协方差进行模型似然估计,并更新模型概率;
[0053] 46)输出交通参与车辆状态的估计结果;
[0054] S5:结合先验知识和多目标追踪估计结果对交通参与车辆进行行为识别与分类。
[0055] S6:根据道路信息获取道路曲率,根据多目标追踪轨迹的状态信息获取曲率变化,对曲率变化和道路曲率做差分,获取驾驶行为似然估计的结果,根据驾驶行为似然估计的结果调取对应行为的路径库,并结合多目标追踪估计结果匹配对应的路径作为轨形。
[0056] S7:将匹配的轨形与多目标追踪估计结果作为输入,基于模型预测控制获取交通参与车辆预测轨迹。
[0057] S8:基于多裕度安全机制,计算碰撞联合概率,输出包含时空碰撞风险的概率地图,根据包含时空碰撞风险的概率地图对自动驾驶风险进行评估。具体内容为:
[0058] 将车辆碰撞分为两级,第一级为以车辆纵向最短安全距离Δa为长半轴,侧面最短安全距离Δb为短半轴构造的椭圆区域,该区域内若出现存在障碍物的点,则认为100%发生碰撞;第二级为满足舒适性为前提的椭圆区,以车辆纵向舒适安全距离max{Δa,Δa+(vego-vcar)2/aego}为长半轴,侧面舒适安全距离max{Δb,Δb+(vego-vcar)2/aego}为短半轴构造的椭圆区域,该区域为正态分布的碰撞区。
[0059] 碰撞联合概率以障碍物的点靠近第一级椭圆的距离由近及远来判断,数值在100%~0%之间,其中,vego为自车车速,vcar为他车车速,aego为自车舒适的减速度,一般取小于2m/s2。
[0060] 沿障碍物的预测轨迹以及自车执行轨迹,按照执行时间步长,对每一个节点的碰撞联合概率进行估计;根据估计结果,输出包含每个节点在每一时刻的碰撞联合概率的时空行车风险态势图。
[0061] 其中,基于多裕度安全机制的碰撞联合概率计算方法为:
[0062] a)若障碍物的点落在第一级椭圆区内,碰撞联合概率为:
[0063] Pcollision=100%
[0064] b)若障碍物的点落在第二级椭圆区外,碰撞联合概率为:
[0065] Pcollision=0%
[0066] c)若障碍物的点落在第一级椭圆区外,第二级椭圆区内,碰撞联合概率为:
[0067] Pcollision=max{Pcollisionx,Pcollisiony}
[0068]
[0069]
[0070] 其中,x、y表示障碍物点在地图中的坐标位置,σx、σx纵横向的安全距离的均方差,μx、μy纵横向的安全距离的期望。计算概率的模型输入为障碍物点在地图中的坐标位置x、y。
[0071] 将态势图的输入(包括自车当前的车速、加速度、横摆角速度、航向、转弯半径、规划的轨迹和障碍车的位置、方向角、速度、横摆角速度、大小)经由以上步骤的多目标跟踪和碰撞联合概率计算,输出包含障碍物车辆预测的轨迹(位置和速度)与该轨迹对应的碰撞联合概率的栅格地图,即获取时空风险态势图。
[0072] 与现有技术相比,本发明具有以下优点:
[0073] 一、本发明考虑了测量不精确、交通参与车辆模型不精确等导致的环境感知不确定性,风险评估结果对环境的适应能力强,结果更可靠;
[0074] 二、本发明利用基于先验知识的自适应多目标追踪、驾驶行为似然估计和轨迹预测,进行行车碰撞风险估计,最终输出时空行车风险态势图,可以实现自动驾驶的多安全裕度风险估计,提高自动驾驶对环境的适应能力,使自动驾驶过程更加平稳可靠与安全;
[0075] 三、本发明结合先验知识构建了先验环境地图,辅助风险评估,使评估过程耗时降低,结果更加精确;
[0076] 四、本发明使用驾驶行为似然估计、轨形匹配和模型预测控制的轨迹预测对交通参与车辆的运动轨迹进行预测,预测过程简单,收敛速度快,结果可靠;
[0077] 五、本发明设计了自适应多目标追踪,多目标追踪能力强。附图说明
[0078] 图1为本发明方法的流程图
[0079] 图2为本发明方法中基于先验知识的自适应多目标追踪的流程图;
[0080] 图3为本发明的纵向自适应波门示意图;
[0081] 图4为本发明的横向自适应波门示意图;
[0082] 图5为本发明的自适应波门计算方法示意图;
[0083] 图6为本发明的直行轨形示意图;
[0084] 图7为本发明的换道轨形示意图;
[0085] 图8为本发明的转弯轨形示意图;
[0086] 图9为本发明的调头轨形示意图;
[0087] 图10为本发明实施例中多安全裕度行车碰撞风险椭圆示意图;
[0088] 图11为本发明实施例中一种十字交叉路口场景示意图;
[0089] 图12为本发明实施例中一种十字交叉路口场景的时空碰撞风险态势图示意图。

具体实施方式

[0090] 下面结合附图和具体实施例对本发明进行详细说明。
[0091] 实施例
[0092] 本发明涉及一种考虑不确定性的自动驾驶风险评估方法,如图1所示,该方法包括下列步骤:
[0093] 步骤一、构建先验环境地图;
[0094] 先验环境地图包含行驶方向的有向节点的多粒度地图,将路面特征(主要是道路曲率、坡度等)和道路结构要素(减速带、路桩、路沿等)等固定的信息作为知识。
[0095] 步骤二、观测交通参与车辆状态,获取状态数据;
[0096] 车辆状态观测分为空间观测和时间观测。其中,空间观测主要获取的是车辆水平面内的位置和朝向角;时间观测主要获取的是车辆的速度、加速度和横摆角速度。
[0097] 步骤三、调取自车执行轨迹;
[0098] 步骤四、基于步骤一构建的先验环境地图,将步骤二和步骤三的数据融合,得到一幅实时的环境地图,融合得到的实时环境地图是以自车质心为地图核心,以传感器探测视距为上限构造的一幅栅格地图,地图中每一个栅格点的碰撞联合概率被初始化为0%(安全,无碰撞风险)。
[0099] 步骤五、基于先验知识的自适应多目标追踪,将交通知识、道路知识、车辆知识、驾驶员知识融合到以基于扩展卡尔曼滤波的自适应交互式多模型快速数据关联为框架的多目标追踪中,实现交通参与车辆(动态障碍物)状态的精确估计与状态分布确定,并输出。具体步骤如图2所示,包括:
[0100] 步骤51、输入交互:模型转移概率根据道路曲率先验知识和跟踪效果进行自适应调整,计算交互后的模型输入状态和协方差矩阵;
[0101] 步骤52、状态预测:利用无偏直线匀速模型、无偏直线匀加速模型、无偏匀角速度模型、无偏匀角加速度模型的扩展卡尔曼滤波进行下一步的状态和协方差预测;
[0102] 步骤53、量测预测:根据道路曲率先验知识和车辆动力学约束的先验知识,自适应调整关联波门,且关联波门是一种结合车辆转弯半径的新型波门,如图3和图4所示,其中,道路曲率、车速以及车辆转弯半径用于计算波门的上下限和形状波门的形状。调整策略包括如下步骤:
[0103] 步骤531:假设此时当前波门为OA1B1(如图3所示),若波门内有交通参与车辆的量测值,跳转到步骤54,若无,则执行步骤532;
[0104] 步骤532:将波门沿纵向放大(如图3所示),并在A1A2B2B1波门内检测是否有量测值落入,有则跳转到步骤54,若无,则执行步骤533;
[0105] 步骤533:将波门沿纵向放大(如图3所示),并在A2A3B3B2波门内检测是否有量测值落入,有则跳转到步骤54,若无,则执行步骤534;
[0106] 步骤534:将波门沿横向放大(如图4所示),并在OA2B2波门内检测是否有量测值落入,有或者横向未执行到波门OA3B3,则跳转到步骤54,反之无则执行步骤531。
[0107] 波门总体由三段圆弧组成(如图5所示),分别标记为 三段圆弧的长度计算如下:
[0108]
[0109]
[0110]
[0111] 中间参数满足:
[0112]
[0113] lv=αego·vego·Tego
[0114]
[0115] θv=π-2·θρ
[0116] 其中,Rρ为波门切圆弧半径,lv为波门长度,θρ为波门切圆弧半径Rρ与波门长度lv的夹角,θv为波门长度lv的夹角,ρroad为当前道路的曲率,ρroad为当前道路的曲率,ρego为自车当前的转弯曲率,βego为波门半径系数(当前设置为1,2,3共三个档次),αego为波门长度系数(当前设置为1,2,3共三个档次),vego为自车当前车速,Tego为自车感知系统采样周期。
[0117] 步骤54、利用无偏直线匀速、无偏直线匀加速、无偏匀角速度、无偏匀角加速度模型的扩展卡尔曼滤波进行下一步的状态、协方差、新息、新息的协方差更新。
[0118] 步骤55、结合新息和新息的协方差进行模型似然估计,并更新模型概率。
[0119] 步骤56、输出交互。最终输出交通参与车辆状态的估计结果。
[0120] 步骤六、结合先验知识和多目标追踪估计的结果对交通参与车辆进行行为识别与分类,将交通参与车辆的驾驶行为分类为直行(如图6所示)、换道(如图7所示)、转弯(如图8所示)和调头四大类(如图9所示),其中直行是广义上的直行,并不只有在行驶路径为直线时才是直行,对于弯道上的车道保持动作,也对应于直行,因为此时驾驶员并无主观的更改当前行驶车道的意图。
[0121] 步骤七、根据驾驶行为似然估计的结果,调取对应行为的路径库,然后结合目标状态估计结果匹配对应的路径作为轨形。行为路径库,主要包含直行、换道、转弯和调头四大类轨形模板,轨形的坐标系是车辆的SAE坐标系(车头方向为纵向,即x坐标轴正轴,右侧为横向,即y坐标轴正轴),各轨形模板中的子轨形是以车辆的质心为起点(也是坐标系的原点),以横向间距、纵向间距、航向间距为变量进行离散,采集自然驾驶数据后处理得到的。
[0122] 步骤八、将匹配的轨形和多目标追踪的结果作为输入,基于模型预测控制得到完整的交通参与车辆预测轨迹。轨迹预测是通过将匹配的轨形和目标多目标追踪估计的结果作为输入,基于模型预测控制得到轨形的速度曲线,之后将轨形的路径与速度曲线合并得到完整的交通参与车辆预测轨迹。
[0123] 步骤九、基于多裕度安全机制,计算碰撞联合概率,并输出一幅包含时空碰撞风险的概率地图。步骤主要包括:
[0124] 步骤91、将车辆碰撞分为两级(如图10所示),第一级是以车辆纵向最短安全距离为长半轴,侧面最短安全距离为短半轴,构造的一个椭圆区域,该区域内一旦出现存在障碍物的点,则认为100%发生碰撞,第二级为满足舒适性为前提的椭圆区,以车辆纵向舒适安全距离max{Δa,Δa+(vego-vcar)2/aego}为长半轴,侧面舒适安全距离max{Δb,Δb+(vego-vcar)2/aego}为短半轴构造的椭圆区域,该区域为正态分布的碰撞区,碰撞联合概率的数值以障碍物的点靠近第一级椭圆区的距离由近及远来判断,数值为100%~0%,其中,vego为自车车速,vcar为他车车速,aego为自车舒适的减速度,一般取小于2m/s2;碰撞联合概率的计算如下:
[0125] 若障碍物的点落在第一级椭圆区内,则碰撞联合概率为:
[0126] Pcollision=100%
[0127] 若障碍物的点落在第二级椭圆区外,则碰撞联合概率为:
[0128] Pcollision=0%
[0129] 若障碍物的点落在第一级椭圆区外,第二级椭圆区内,则碰撞联合概率为:
[0130] Pcollision=max{Pcollisionx,Pcollisiony}
[0131] 其中:
[0132]
[0133]
[0134] 式中:x、y为障碍物点在地图中的坐标位置,σx、σy分别为纵、横向的安全距离的均方差,μx、μy分别为纵、横向的安全距离的期望。
[0135] 步骤92、沿障碍物的预测轨迹以及自车执行轨迹,按照执行时间步长,进行每一个节点的碰撞联合概率估计,如图11和图12所示。
[0136] 步骤93、输出一幅时空行车风险态势图,态势图中包含了每个节点在每一时刻的碰撞联合概率,如图12所示。图中,ego_k表示自车k时刻的规划位姿和碰撞联合概率椭圆,ego_k+n表示自车k+n时刻的规划位姿和碰撞联合概率椭圆,ego_k到ego_k+n的整段轨迹代表自车的规划轨迹和和碰撞联合概率椭圆;car1_k、car2_k、car3_k分别表示障碍车1、2、3号目标的k时刻预测位姿和碰撞联合概率椭圆,car1_k+n、car2_k+n、car3_k+n分别表示障碍车1、2、3号目标的k+n时刻预测位姿和碰撞联合概率椭圆,car1_k到car1_k+n、car2_k到car2_k+n、和car3_k到car3_k+n、的整段轨迹代表障碍车的预测轨迹和和碰撞联合概率椭圆。
[0137] 本发明利用基于先验知识的自适应多目标追踪、驾驶行为似然估计和轨迹预测,进行行车碰撞风险估计,最终输出时空行车风险态势图,可以实现自动驾驶的多安全裕度风险估计,提高自动驾驶对环境的适应能力,使自动驾驶过程更加平稳可靠与安全。
[0138] 以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的工作人员在本发明揭露的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈