一种基于社会力模型的交互式自动驾驶速度规划方法与流程

1.本发明属于汽车自动驾驶的技术领域，具体涉及一种基于社会力模型的交互式自动驾驶速度规划方法。


背景技术：

2.随着汽车智能化的快速发展，越来越多汽车上搭载了自动驾驶系统，速度规划是自动驾驶技术中非常重要的一步。
3.常见的速度规划方法是考虑目标当前状态、运动趋势、未来轨迹等信息，并基于此计算自动驾驶车辆的期望速度。但在交互式的场景中(如车辆-行人交互)，情况往往相对复杂，常见的速度规划方法并未考虑目标对车辆未来行为的反应，因此所得结果往往过于保守；如中国专利cn201811061563.6一种车辆纵向速度规划方法和纵向速度规划装置，根据自动驾驶车辆与前方目标之间的相对速度、相对距离计算得到安全距离，继而进行速度规划，但此方法假设目标在未来一段时间内按照当前的状态进行运动，且忽略了本车与目标之间的交互，若车辆面对的是行人等运动模式相对自由的目标，则此方法难以获得最合适的规划速度。
4.社会力模型常用于混合交通流仿真、风险预警、轨迹预测等应用。如中国专利cn201910257859.3一种基于社会力的混合交通仿真方法，使用社会力模型对行人、自行车、汽车以及道路等四种元素进行混合仿真，实现了模拟不同个体在交通场景中的动态交互行为，此类交互行为的仿真仅仅用于场景分析，并未直接用于自动驾驶技术中。中国专利cn114371707a提出使用考虑交互的行人轨迹预测结果来进行横纵向避撞决策的生成，但此方法仅仅是在行人轨迹预测部分考虑了交互模式，在决策部分尚未使用交互模型来生成自动驾驶车辆的行为，此外，该方法仅考虑了人-车交互，并不适用于需要同时考虑人-人交互的多行人的场景。
5.因此，需要提出一种基于社会力模型的自动驾驶速度规划方法，来解决目前的速度规划方法因忽略人与人之间的交互而导致规划速度的合理性较差的问题。


技术实现要素：

6.针对现有技术的上述不足，本发明要解决的技术问题是提供一种基于社会力模型的交互式自动驾驶速度规划方法，解决目前速度规划方法规划速度的合理性较差的问题，取得提高自动驾驶舒适性和用户体验的效果。
7.为解决上述技术问题，本发明采用如下技术方案：
8.一种基于社会力模型的交互式自动驾驶速度规划方法，包括如下步骤：
9.1)获取本车运动状态、本车所属道路环境、当前道路环境中所有行人的行人状态和行人意图；
10.2)基于当前道路环境生成交互场景，以行人状态、行人意图和本车运动状态作为交互对象的初始状态进行场景分析，规划出n个候选速度；
11.3)将n个候选速度分别代入社会力模型的车辆-行人交互中进行前向仿真，得到n个交互仿真结果；
12.4)对n个交互仿真结果进行评估，选出最优的候选速度作为本车自动驾驶的规划速度。
13.进一步地，步骤1)中，所述行人状态包括行人当前的位置和速度；所述行人意图指行人当前的短时目的地；道路环境包括车道、人行道、人行横道。
14.进一步地，步骤1)中，将当前道路环境中所有行人的行人状态用集合表示为s＝{s1，s2，...，sn}；其中，角标1～n表示行人的序号，s1＝[x1，y1，v
x1
，v
y1
]表示行人1的行人状态，x1和y1分别表示行人1的横纵坐标，v
x1
和v
y1
分别表示行人1的横向速度和纵向速度；
[0015]
将当前道路环境中所有行人的行人意图表示为d＝{d1，d2，...，dn}；将当前道路环境表示为e，根据当前道路环境e获取本车可行驶区域，根据本车可行驶区域更新所有行人意图，更新后的行人意图表示为d
′
＝update(d，e)且d
′
在本车可行驶区域外。
[0016]
进一步地，步骤2)中，将n个候选速度表示为v＝{v1，v2，...，vn}。
[0017]
进一步地，步骤3)中，将与n个候选速度一一对应的n个交互仿真结果表示为r＝{r1，r2，...，rn}，r1＝sim(c，v1，s，d
′
)表示一组仿真结果；
[0018]
其中，c表示本车自动驾驶的控制策略，v1表示对应的候选速度，s表示所有行人状态，d
′
表示基于当前道路环境更新后的行人意图。
[0019]
进一步地，步骤3)中进行前向仿真时，行人状态的更新采用基于牛顿二阶质点模型改进的社会力模型，更新方程如下：
[0020]s′1＝sfm(s1，s1，d
′1，sv)
[0021]
其中，s1′
表示行人1在下一时刻的行人状态，s1为除行人1以外所有行人状态的集合，d1′
为行人1更新后的行人意图，sv＝[x，y，v，yaw]为本车运动状态，x和y表示本车当前位置的横纵坐标，v和yaw分别表示本车的速度和航向角。
[0022]
进一步地，步骤3)中进行前向仿真时，将行人受到周围车辆和周围行人的影响表示为社会力f
sfm
，然后根据f
sfm
更新行人下一时刻的位置，f
sfm
的计算公式如下：
[0023]fsfm
＝∑f
p
+∑fv[0024]
其中，f
p
＝a
p
exp(-b
p
·dp
)为周围一个行人对受影响行人的社会力，fv＝avexp(-bv·dv
)为周围一车辆对受影响行人的社会力，a
p
，b
p
，av，bv为社会力模型参数，d
p
为受影响行人与周围一行人的相对距离，dv为受影响行人与周围一车辆的影响区域ev的垂直距离，车辆的影响区域ev呈椭圆且焦点分别为车辆的当前位置和车辆前进方向上某一点的位置，焦距的长度与车辆的速度成正比。
[0025]
进一步地，步骤3)中进行前向仿真的时间为2～10s。
[0026]
进一步地，步骤4)中基于损失函数对交互仿真结果进行评估，损失函数考虑的指标包括自动驾驶车辆与行人的安全距离和车辆行驶的平顺程度。
[0027]
进一步地，步骤4)中基于损失函数j(r)从n个候选速度中最优的候选速度的过程表示为：
[0028]v*
＝argmin(j(ri))，i∈{1，2，...，n}。
[0029]
相比现有技术，本发明的有益效果如下：
[0030]
1、本发明所述一种基于社会力模型的交互式自动驾驶速度规划方法，相比于传统
的行人避让算法，考虑了自动驾驶车辆在速度规划时候与行人的交互，并通过仿真计算，在进行速度规划时对行人的行为进行了预判，避免过于保守的速度规划策略，实现更加合理的速度规划，从而实现更高效、舒适的自动驾驶。
[0031]
2、本发明所述一种基于社会力模型的交互式自动驾驶速度规划方法，可解释性强，可通过仿真、实车试验对算法参数进行快速、有效地标定。
[0032]
3、本发明所述一种基于社会力模型的交互式自动驾驶速度规划方法，可拓展性强，能适应不同城市道路场景的自动驾驶，可拓展至自动驾驶车辆与其他类型交通参与者的交互；本发明所述的规划方法考虑了除自车外的交通参与者之间的交互关系，尤其适用于多个行人同时存在的场景。
附图说明
[0033]
图1为实施例的一种基于社会力模型的交互式自动驾驶速度规划方法的流程图；
[0034]
图2为实施例所述社会力模型中车辆-行人的交互示意图；
[0035]
图3为实施例的一种基于社会力模型的交互式自动驾驶速度规划方法的应用场景示意图；
[0036]
图4为实施例的一种基于社会力模型的交互式自动驾驶速度规划方法的应用场景示意图；
具体实施方式
[0037]
下面结合附图对本发明的具体实施方式作进一步的详细说明。
[0038]
实施例：
[0039]
请参见图1，一种基于社会力模型的交互式自动驾驶速度规划方法，包括如下步骤：
[0040]
1)当自动驾驶车辆遇到行人时，由感知系统识别行人目标，并输出当前道路环境中所有行人的行人状态和行人意图，感知系统或定位系统输出本车所属道路环境，车载传感器输出本车运动状态；所述行人状态包括行人当前的位置和速度；所述行人意图指行人当前的短时目的地；道路环境包括车道、人行道、人行横道；
[0041]
本实施例中，将当前道路环境中所有行人的行人状态用集合表示为s＝{s1，s2，...，sn}；其中，角标1～n表示行人的序号，s1＝[x1，y1，v
x1
，v
y1
]表示行人1的行人状态，x1和y1分别表示行人1在车辆坐标系下的横纵坐标，v
x1
和v
y1
分别表示行人1在车辆坐标系下的横向速度和纵向速度；
[0042]
将当前道路环境中所有行人的行人意图表示为d＝{d1，d2，...，dn}；将当前道路环境表示为e，根据当前道路环境e获取本车可行驶区域，根据本车可行驶区域更新所有行人意图，更新后的行人意图表示为d
′
＝update(d，e)且d
′
在本车可行驶区域外。
[0043]
2)基于当前道路环境生成交互场景，以行人状态、行人意图和本车运动状态作为交互对象的初始状态进行场景分析，规划出n个候选速度；将n个候选速度表示为v＝{v1，v2，...，vn}；实施时，候选速度规划可以采用等距离采样模式，即如果当前道路限速为40km/h，采样距离为5km/h，则基于采样的候选速度规划结果为v＝{5，10，15，20，25，30，35，40}。
[0044]
3)将n个候选速度分别代入社会力模型的车辆-行人交互中进行前向仿真，进行前
向仿真的时间为2～10s，得到n个交互仿真结果；表示为r＝{r1，r2，...，rn}，r1＝sim(c，v1，s，d
′
)表示一组仿真结果；r1的具体定义为仿真过程中，每一个行人与自车的最小距离、行人改变运动方向的平均次数、车辆一定距离范围内行人的密度等。
[0045]
其中，c表示本车自动驾驶的控制策略，如pid算法速度跟踪，v1表示对应的候选速度，s表示所有行人状态，d
′
表示基于当前道路环境更新后的行人意图；
[0046]
请参见图2，进行前向仿真时，行人状态的更新采用基于牛顿二阶质点模型的改进社会力模型，更新方程如下：
[0047]s′1＝sfm(s1，s1，d
′1，sv)
[0048]
其中，s1′
表示行人1在下一时刻的行人状态，s1为除行人1以外所有行人状态的集合，d1′
为行人1更新后的行人意图，sv＝[x，y，v，yaw]为本车运动状态，x和y表示本车当前位置的横纵坐标，v和yaw分别表示本车的速度和航向角；
[0049]
将行人受到周围车辆和周围行人的影响表示为社会力f
sfm
，然后根据f
sfm
更新行人下一时刻的位置，f
sfm
的计算公式如下：
[0050]fsfm
＝∑f
p
+∑fv[0051]
其中，f
p
＝a
p
exp(-b
p
·dp
)为周围一个行人对受影响行人的社会力，fv＝avexp(-bv·dv
)为周围一车辆对受影响行人的社会力，a
p
，b
p
，av，bv为社会力模型参数，d
p
为受影响行人与周围一行人的相对距离，dv为受影响行人与周围一车辆的影响区域ev的垂直距离，车辆的影响区域ev呈椭圆且焦点f1和f2分别为车辆的当前位置和车辆前进方向上某一点的位置，焦距的长度与车辆的速度成正比。
[0052]
4)对n个交互仿真结果进行评估，选出最优的候选速度作为本车自动驾驶的规划速度；
[0053]
本实施例中，基于损失函数对交互仿真结果进行评估，损失函数考虑的指标包括自动驾驶车辆与行人的安全距离和车辆行驶的平顺程度，基于损失函数j(r)从n个候选速度中最优的候选速度v
*
的过程表示为：
[0054]v*
＝argmin(j(ri))，i∈{1，2，...，n}；
[0055]
损失函数j(ri)将会对ri中包含的自车的最小距离、行人改变运动方向的平均次数、车辆一定距离范围内行人的密度进行考虑，通过实车实验调节和标定每种因素的损失函数权重，最终获取最优的候选速度，作为最终速度规划结果。
[0056]
图3为没有交通信号灯控制的行人横穿场景，在此场景中，车辆与行人存在“谁先通行”的沟通或博弈，如果自动驾驶车辆的规划速度不同，则博弈的结果将会不同，最终影响车辆的行驶，本发明可以有效解决此类场景中规划效率不高的问题；
[0057]
图4为大量行人交互场景，在此场景中，自动驾驶车辆通常选择保守策略，例如停车等待，但现实情况中，人类驾驶员往往会以一个合适的速度驾驶车辆前进，并预判行人会相应地避让前进的车辆，本发明所述方法同时考虑人-人交互、人-车交互，可以有效地实现上述行为，并大幅度提高自动驾驶车辆的行驶效率。
[0058]
本发明所述一种基于社会力模型的交互式自动驾驶速度规划方法，对社会力模型进行改造并设计了一种在线交互仿真评估的框架以用于自动驾驶技术的速度规划；融合了社会力模型的速度规划方法较为充分地考虑自动驾驶车辆与目标之间的交互情况，并最终生成更加合理、舒适的规划速度。
[0059]
最后说明的是，以上实施例仅用以说明本发明的技术方案而非限制，尽管参照较佳实施例对本发明进行了详细说明，本领域的普通技术人员应当理解，可以对本发明的技术方案进行修改或者等同替换，而不脱离本发明技术方案的宗旨和范围，其均应涵盖在本发明的权利要求范围当中。