考虑驾驶员差异的自动驾驶车辆换道规划方法
李浩然1,2,3, 鲁云鹏1, 许述财3, 郑四发3, 孙川2    
1. 武汉科技大学 汽车与交通工程学院, 武汉 430063;
2. 清华大学苏州汽车研究院, 苏州, 215299;
3. 清华大学 车辆与运载学院, 北京 100084
摘要:当前自动驾驶技术在决策和规划层面较少考虑驾驶员之间的个体差异, 这在实际道路交通中是一个显著的缺陷。该文针对常见的换道驾驶场景, 提出了一种考虑驾驶员差异的自动驾驶车辆换道规划方法。首先, 基于自然驾驶实验数据, 采用统计学的样本检验方法分析了换道场景下不同驾驶员在各项关键变量指标上的差异, 并提取出最能体现驾驶员个性化风格的特征指标。之后, 根据换道场景的特性, 构建了人工势场模型, 并利用这些个性化指标对模型参数进行差异化标定。采用二次方程和线性平滑方法对原始路径点进行拟合与平滑, 实现了个性化的换道路径规划。最后, 鉴于不同驾驶员在车速控制上的差异, 提出了一种基于五次多项式的换道车速规划策略。仿真实验结果显示, 该规划方法能够生成满足驾驶员个性化需求的路径和车速, 有助于推动自动驾驶技术的进一步发展。
关键词自动驾驶    路径规划    车速规划    驾驶风格    
Lane-changing planning method for autonomous vehicles considering variability among drivers
LI Haoran1,2,3, LU Yunpeng1, XU Shucai3, ZHENG Sifa3, SUN Chuan2    
1. School of Automotive and Transportation Engineering, Wuhan University of Science and Technology, Wuhan 430063, China;
2. Tsinghua University Suzhou Automotive Research Institute, Suzhou 215299, China;
3. School of Vehicle and Mobility, Tsinghua University, Beijing 100084, China
Abstract: [Objective] In the context of the swift progression of autonomous driving technology, the widespread reliance of current systems on uniform behavioral models for decision-making and path planning is a crucial concern. This generalized approach often disregards variations in driving behavior among different drivers, making it challenging to achieve driving behavior that aligns with drivers' expectations in complex and dynamic traffic scenarios. Consequently, a decrease in comfort and trust is observed in autonomous vehicles. This study focuses on lane changing, a common yet critical driving maneuver, aiming to optimize planning strategies by incorporating drivers' characteristics to match individual driving styles. [Methods] This study comprehensively analyzes data derived from naturalistic driving experiments. Kalman filtering is used to detect and eliminate anomalies in raw data, thereby reducing noise interference. The integration of temporal constraints into the fuzzy C-means clustering algorithm ensures the preservation of chronological order in the clustered data, which is essential for analyzing sequential events such as lane change maneuvers. Lane changing requires lateral and longitudinal vehicle control with distinct operational characteristics across different phases of the maneuver. By clustering the entire lane-changing process data into three major categories, C1, C2, and C3, representing the preparation, execution, and completion stages of lane changing, respectively, this study aims to analyze disparities in driver behavior during these distinct phases. According to the characteristics of lane-changing scenarios, relevant variables are selected for in-depth examination. Independent sample t-tests are then conducted among different drivers for each variable, and variables with a high proportion of insignificant t-values are eliminated. This process helps identify personalized indicators that reflect driver-specific traits during lane changing. Subsequently, an artificial potential field (APF) model is established for the lane-changing scenario. The APF method uses virtual attractive and repulsive forces to guide the vehicle toward a path of decreasing potential energy, effectively avoiding obstacles while moving toward the target position. Variations in the APF parameters lead to different planning paths. By leveraging the extracted personalized indicator, the APF model for lane changing is customized, yielding paths that align with individual driving styles. Another pivotal consideration is the planning of lane-changing speeds. Given the notable variations in the speed preferences of drivers, this study proposes a lane-changing speed planning algorithm based on a quintic polynomial function. This ensures that the mean duration of acceleration and the maximum acceleration limit during the execution phase align with each driver's speed control habits and that a smooth velocity profile is maintained throughout the lane-changing maneuver. [Conclusions] This study proposes a lane-changing planning method for autonomous vehicles that considers driver differences. The simulation results confirm that the proposed personalized lane-changing planning approach not only produces paths that align with individual driving styles but also regulates lane-changing velocities in accordance with each driver's operational habits. By quantifying behavioral variations, developing personalized APF models, and implementing customized speed planning strategies, this study exemplifies how to tackle individualization challenges in autonomous driving. This study represents a step forward in advancing autonomous vehicle technology toward a human-centric and intelligent future.
Key words: autonomous driving    path planning    speed planning    driving styles    

随着自动驾驶技术逐渐走向成熟,需要考虑实现个性化自动驾驶系统。车辆的自动驾驶行为与人的预期不一致会导致驾驶员对自动驾驶系统信任程度的下降[1],驾驶风格与驾驶员相似的系统更容易获得驾驶员的信任[2-3];尤其是人在自动驾驶状态下更有可能出现恶心、呕吐等晕动症状[4]。因此,在自动驾驶系统中如何满足人的个性化驾驶需求是一个值得研究的内容。

完整的自动驾驶系统由感知层、规划层和控制层3部分组成[5]。个性化自动驾驶的实现,主要是在规划层中考虑驾驶员的驾驶差异,以实现符合驾驶员习惯的车辆规划。当前,由于全自动驾驶的实现还需要一段时间,更多的个性化自动驾驶研究聚焦于一些高级驾驶辅助功能,如差异化的主动安全预警系统[6]、考虑驾驶风格的自适应巡航控制[7-8]和防碰撞系统[9-10]等。这些研究都为个性化自动驾驶的发展提供了参考,但总体而言依然较少,有待进一步的探索。

不同的驾驶场景下驾驶人会有不同的驾驶行为。换道作为最常见的驾驶场景之一,已经有学者对该场景下驾驶员的个性化特征进行了分析,提出了一些具有驾驶员风格的换道轨迹规划方法[11-14]。这类研究中通常将驾驶员的驾驶风格分为保守型、适中型和激进型等固定的类别,根据该类别下驾驶员的一些行为特征设计相应的规划器。但该类方法难以照顾到不同驾驶员之间更为细致的差异。

除了换道场景下的路径规划,另一个需要考虑的是车辆在换道过程中的速度引导规划。制动和加速带来的速度变化会明显影响到乘客的舒适性[15],显著偏离驾驶员预期的车速和加减速行为会导致驾驶员对自动驾驶系统信任程度的下降[16]。设计符合驾驶员驾驶风格的车速曲线能够提高驾驶员对自动驾驶系统信任度,改善自动驾驶车辆的乘坐体验。目前车速规划引导方面的研究[17-19]主要目的在于提高部分道路交通场景下的通行效率或降低车辆能耗,较少考虑驾驶风格差异带来的影响。在换道场景下考虑驾驶员差异化需求的车速规划研究,有助于发展更加全面和人性化的自动驾驶技术。

本文提出了一种考虑驾驶员差异的自动驾驶车辆换道规划方法。个性化自动驾驶的实现需要一些指标以反映驾驶员的驾驶特征。与传统的基于量表[20]和驾驶模拟器[21]展开的驾驶风格研究不同,本文基于自然驾驶实验采集到的真实驾驶数据展开研究。利用统计学样本检验方法提取出了换道场景下最能反映驾驶员个性化驾驶特征的指标,基于该指标来标定换道势场参数,实现了具有驾驶员特征差异的换道路径规划。根据驾驶员在该场景下的车速一般表现,规划换道车速,从而实现换道场景下的个性化自动驾驶。

1 数据处理与分析 1.1 实验说明

本文所用的数据来自自然驾驶实验,实验车配备有RT3000导航设备、摄像头、方向盘传感器等专业的数据采集设备。招募50名职业驾驶员,在G70福银高速公路汉十段,进行50次实验。每次实验的开展均选择能见度和天气良好的时候,尽量减少外在因素的干扰。由于所用的各种传感器时间不同步,因此每次实验中有1名随车人员负责在采集车启停时拍摄同步视频,利用视频后期处理解决数据的时间同步问题。具体的实验条件等信息参见文[22]。

1.2 降噪和聚类

实验车采集到的原始数据存在跳变大、波动剧烈的问题,直接使用无法得到稳定的结果。本节介绍数据的降噪与聚类方法。

Kalman滤波是一种利用估计值和状态值开展状态估计的递推算法,能够较好处理系统中的噪声和不确定性,由于其计算量较小,广泛用于跟踪控制等对精度要求高的领域。其数学表达式如下:

$ \left\{\begin{array}{l} \boldsymbol{X}(t+1)=\boldsymbol{F}_{\mathrm{t}} \boldsymbol{X}(t)+\boldsymbol{V}(t), \\ \boldsymbol{Y}(t)=\boldsymbol{H}_{\mathrm{t}} \boldsymbol{X}(t)+\boldsymbol{W}(t) . \end{array}\right. $ (1)

其中: X(t)为系统的状态变量,Y(t)为观测量即传感器测得的变量值,Ft为状态转移矩阵,Ht为输出矩阵,W(t)和V(t)为白噪声。

后续实验中将根据换道场景的特征,选取出需要展开研究的变量,利用Kalman滤波对换道场景下的实车数据开展降噪处理。

一个完整的换道过程一般包含准备换道、执行换道和结束并线3个阶段[23]。准备换道阶段往往由驾驶员对前车速度不满意或为避开障碍物而引起,执行换道阶段涉及对车辆的转向控制,结束并线阶段则是驾驶员回打方向。这3个阶段虽然有一定的特征差异,但并没有明确的时间分界点,因此模糊聚类方法可以较好地解决这个问题。本文采用模糊C均值聚类来实现数据的分类处理。

传统的模糊C均值聚类算法如式(2)所示,通过不断迭代的方式更新J,直到J小于某一阈值要求时停止迭代。

$ J=\sum\limits_{k=1}^N \sum\limits_{i=1}^C u_{i k}^m d_{i k}^2. $ (2)

其中:N为样本数量,C为聚类中心的数量,uik为数据$ \stackrel{\rightharpoonup}{x}$k属于聚类i的隶属度,dik为数据$ \stackrel{\rightharpoonup}{x}$k与聚类i聚类中心的距离,m为加权指数。聚类中心与隶属度函数的计算方法可参见文[22,24]。

直接用模糊C均值聚类处理的结果在时间上未保留先后顺序,而实际的换道操作是一个前后连贯的过程。因此在传统C均值聚类的基础上增加时序约束:

$ J=\sum\limits_{k=1}^N \sum\limits_{i=1}^C u_{i k}^m d_{i k}^2+\alpha \sum\limits_{k=1}^N \sum\limits_{i=1}^C u_{i k}^m \sum\limits_{\Delta t=-r}^r d_{i k, \Delta t}^2 . $ (3)

其中$ \begin{equation} \sum\limits_{k=1}^N \sum\limits_{i=1}^C u_{i k}^m d_{i k}^2 \end{equation}$表示各个数据到聚类中心的成本值,$ \alpha \sum\limits_{k=1}^N \sum\limits_{i=1}^C u_{i k}^m \sum\limits_{\Delta t=-r}^r d_{i k, \Delta t}^2$表示时间区间[t-r, t+r]内的数据到各个聚类中心的成本值。α为权重值,dik, Δt为数据$ \stackrel{\rightharpoonup}{x}$kt到聚类中心i的距离。

2 换道场景数据分析

基于1.2节的数据处理步骤,观看同步视频并选取出换道场景下的数据。本章说明换道场景的数据处理方法。

车辆运动是横向与纵向运动的耦合,换道场景下驾驶员对车辆的操作更多集中在横向上,因此对换道场景的研究选取的变量包括车道偏移L(t)、纵向车速v(t)、航向角γ(t)、横摆角速度ω(t)、横摆角加速度$ \dot{\omega}$(t)等。

选取一段换道场景下的自然驾驶数据,对每名驾驶员选取10段换道过程数据并进行同步处理。利用kalman滤波和时序约束的模糊C均值聚类的方法对同步后的数据进行除杂平滑和聚类分组。

采用的状态变量和观测量如下:

$ \left\{\begin{array}{l} \boldsymbol{X}(t)=[L(t), v(t), \gamma(t), \omega(t), \dot{\omega}(t)]^{\mathrm{T}}, \\ \boldsymbol{Y}(t)=[L(t), v(t), \gamma(t), \omega(t), \dot{\omega}(t)]^{\mathrm{T}} . \end{array}\right. $ (4)

由物理特性可得对应的差分方程为

$ \left\{\begin{array}{l} L(t+1)=\theta_1(t) v(t)+\theta_2(t) \omega(t)+L(t), \\ \gamma(t+1)=\gamma(t)+\omega(t) T^{\prime}+\frac{1}{2} \dot{\omega}(t) T^{\prime 2}, \\ \omega(t+1)=\omega(t)+\dot{\omega}(t) T^{\prime}, \\ \dot{\omega}(t+1)=\theta_3(t) \dot{\omega}(t) . \end{array}\right. $ (5)

其中: θ1(t)、θ2(t)、θ3(t)为白噪声,T′为时间步长。则状态空间方程为:

$ \left\{\begin{array}{l} \boldsymbol{X}(t+1)=\boldsymbol{F}_{\mathrm{t}} \boldsymbol{X}(t)+\boldsymbol{V}(t), \\ \boldsymbol{Y}(t)=\boldsymbol{H}_{\mathrm{t}} \boldsymbol{X}(t)+\boldsymbol{W}(t), \end{array}\right. $ (6)
$ \boldsymbol{F}_{\mathrm{t}}=\left(\begin{array}{ccccc} 1 & \theta_1(t) & 0 & \theta_2(t) & 0 \\ 0 & 0 & 0 & 0 & 0 \\ 0 & 0 & 1 & T^{\prime} & \frac{1}{2} T^{\prime 2} \\ 0 & 0 & 0 & 1 & T^{\prime} \\ 0 & 0 & 0 & 0 & \theta_3(t) \end{array}\right), $
$ \boldsymbol{H}_{\mathrm{t}}=\left(\begin{array}{lllll} 1 & 0 & 0 & 0 & 0 \\ 0 & 1 & 0 & 0 & 0 \\ 0 & 0 & 1 & 0 & 0 \\ 0 & 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 0 & 1 \end{array}\right). $ (2)

其中V(t)和W(t)为白噪声。

同时基于1.2节提出的考虑时序的模糊C均值聚类算法,对经过同步和预处理的数据进行分类,将每一段换道过程数据分为准备换道阶段、执行换道阶段和结束并线阶段数据。滤波和模糊聚类结果见图 1,其中聚类C1、C2和C3分别对应准备换道、执行换道和结束并线阶段[23]

图 1 换道过程数据处理结果

3 换道场景个性化特征指标的提取 3.1 换道变量的样本检验

本文的路径规划算法采用人工势场法。要实现个性化的换道轨迹规划,需要提取驾驶员在换道场景中的个性化变量指标来标定人工势场参数。独立样本T检验是一种比较2组独立样本的平均数是否存在显著差异的统计方法,可以用于判断2名驾驶员的某一变量均值是否有显著区别。选用驾驶员A和B的换道过程数据进行个性化变量指标的提取。

对3个阶段下驾驶员A和B的车道偏移、纵向车速、航向角、横摆角速度及横摆角加速度展开检验。2名驾驶员换道场景下的变量数据及详细的检验结果参见文[22]。某一变量对应的不显著T值占比越小,表明不同驾驶员换道场景下在该变量指标上所体现的差异越大。检验结果如图 2所示。

图 2 驾驶员A和B换道变量不显著T值占比

图 2可以看出,驾驶员A和B在换道场景中的各个变量数据都存在差异。进一步分析表明,横摆角加速度的不显著T值占比最低,即其最能体现不同驾驶员在换道场景下横向操作行为的个性化差异。

3.2 换道个性化指标验证

为验证所提取的换道个性化指标的有效性,再选用驾驶员C的自然驾驶实验数据进行分析。

对驾驶员A和C、驾驶员B和C在换道场景中的驾驶数据进行分析,结果分别如图 34所示。结果显示换道场景下的横摆角加速度展现出了最小的不显著T值占比,表明换道场景下不同驾驶员间最能反映个性化差异的变量依然是横摆角加速度。因此,后续将选取横摆角加速度来标定人工势场参数,以实现个性化的换道路径规划。

图 3 驾驶员A和C换道变量不显著T的值占比

图 4 驾驶员B和C换道变量不显著T的值占比

4 人工势场建模与参数标定

根据换道场景特征建立人工势场模型,开展个性化的换道路径规划。个性化指标提取与人工势场参数标定的框架如图 5所示。

图 5 人工势场个性化标定框架图

4.1 换道场景下的个性化路径规划

本文主要探讨一般公路上常见的变道行为。由第3章的分析可以发现驾驶员A和B在车道偏移、速度、航向角等多个方面均存在差异,特别是在执行换道阶段的横摆角加速度上,驾驶员A的明显小于驾驶员B的。基于此情况对式(8)中的横向势场衰减系数进行了标定,使其与执行换道阶段横摆角加速度的均值相匹配,从而实现了更接近实际驾驶状态的换道效果。

换道场景势场的构建主要包括2个步骤:1) 建立一个用于描述周围车辆纵向势场衰减的数学模型;2) 依据自动驾驶车辆与同车道邻近车辆的相对位置等数据,划定出车辆的安全距离。完成上述步骤后便建立了一个适用于换道场景的人工势场模型。当自动驾驶车辆逼近同车道的其他车辆时,周围车辆的排斥势场将逐步增大,而当自动驾驶车辆感受到的引力与排斥势场在纵向方向达到均衡状态时,车辆将执行换道动作。

环境车纵向势场为

$ U_{\mathrm{lo}}=A_{\mathrm{lo}} \frac{\mathrm{e}^{-\lambda D}}{D}. $ (7)

其中:Alo为设定的纵向势场最大值; λ为势场参数,由不同驾驶员的车头时距统计数据标定获得; D表示自动驾驶车辆与环境车的纵向距离。

环境车横向势场为

$ U_{\mathrm{la}}=U_{\mathrm{lo}} \exp \left(\frac{-d^2}{2 \sigma^2}\right) $ (8)

其中:d为环境车与自动驾驶车辆的横向距离;σ为横向势场参数。σ使用要开展个性化规划的驾驶员在执行换道阶段的横摆角加速度均值μ$ \dot{\omega}$, C2标定得到:

$ U_{\text {lo }} \exp \left(\frac{-\left(\frac{w_{\text {lane }}}{2}\right)^2}{2 \sigma^2}\right)=\mu_{\dot{w}, C 2} . $ (9)

其中wlane为车道的宽度。自然驾驶实验中驾驶员A和B执行换道阶段的横摆角加速度的统计规律如表 1所示。

表 1 不同驾驶员执行换道阶段横摆角加速度均值和方差 
(°)/s2
驾驶员 均值 方差
A 0.431 0.01
B 1.378 0.15

场景建模完成后即可计算获得所有的人工势场。根据式(10)对纵向和横向的势场进行矢量和计算得到总势场Uall。基于总势场Uall,对本车进行换道路径规划。

$ \begin{equation} \boldsymbol{U}_{\mathrm{all}}=\left(\begin{array}{ll} \mathbf{A P F}_x & \mathbf{A P F}_y \end{array}\right) . \end{equation} $ (10)

其中APFxAPFy分别为横向和纵向的总势场。

结合驾驶员A、B的自然驾驶实验数据,标定参数后得到的横向斥力势场如图 6所示。

图 6 标定参数后的横向斥力势场

图 6可看出,基于个性化特征标定后的规划器产生了不同的横向人工势场值。利用该组规划器开展路径规划,即可获得驾驶员A和B在换道场景下的个性化路径规划结果。

4.2 路径平滑方法

由于人工势场直接生成的路径比较曲折,需要用一些曲线优化的方法来生成平滑的路径。本文采用二次方程来拟合换道过程路径点,并使用线性优化的方法来平滑拟合路径与前后路径的连接。

如果将车辆从与车道中心线刚发生偏离的路径点开始进行二次多项式拟合,则前段的直行路径与后段的换道路径之间的连接会很突兀。因此,当车辆与车道中心线的横向偏移达到车道宽度的10%时,对该路径点到目标车道中心线之间的路径点开展二次多项式拟合,拟合的多项式如下:

$ \begin{equation} y=a x^2+b x+c . \end{equation} $ (11)

其中:abc为拟合系数,(x, y)为拟合后路径点的坐标。

人工势场有着“局部最优”的问题,即局部区域处可能引力场与斥力场的作用正好相等,导致规划器陷在原地,无法获得到达目标点的路径。二次多项式的拟合不仅可以平滑路径波动,也可以避免在极端情况下因人工势场参数调整而导致规划器无法规划得到完整路径。以驾驶员B风格的规划路径为例,换道原始路径点与二次多项式拟合结果如图 7所示。

图 7 换道原始路径点的二次多项式拟合

拟合后的换道路径与前后路径点之间的连接并不是光滑的,需要采用一定的路径平滑方法来优化路径。二次多项式拟合后的路径点坐标记为(x, y), 线性平滑后的路径点坐标则记为(x′, y′)。平滑的目的是要将原始路径中一些过于突兀和曲折的点拉平,从而满足车辆的正常行驶要求。路径线性平滑可视为以下优化问题:

$ \left\{\begin{aligned} A= & f\left[\left(x_k^{\prime}-x_k\right)^2+\left(y_k^{\prime}-y_k\right)^2\right], \\ B= & g\left[\left(x_k^{\prime}-x_{k-1}^{\prime}\right)^2+\left(y_k^{\prime}-y_{k-1}^{\prime}\right)^2+\right. \\ & \left.\left(x_k^{\prime}-x_{k+1}^{\prime}\right)^2+\left(y_k^{\prime}-y_{k+1}^{\prime}\right)^2\right], \\ A+ & B \rightarrow r . \end{aligned}\right. $ (12)

其中:A表示平滑前后路径点的偏移程度,B表示路径的平滑程度,r表示判断阈值。

在线性平滑的实际应用中,存在着路径平滑度与路径保真度之间的固有矛盾:平滑力度过大往往会引起较大偏移,导致处理后的路径偏离原始路径显著,甚至过优化为直线,丢失关键路径特征;反之,则无法有效优化路径。为解决此矛盾,需要调节权重参数fg,其中f控制路径点偏移幅度,g负责界定平滑强度。通过两者协同作用,在保持路径原有特征的同时实现适度平滑。该线性平滑算法迭代执行,直至平滑前后路径点的变化量小于预设阈值r,标志路径平滑达到理想状态。基于所述方法,对拟合后的换道全过程路径点进行平滑,平滑前后的路径局部差异如图 8所示。

图 8 平滑前后局部路径对比

4.3 考虑驾驶员个性化的车速规划方法

不同的驾驶员对车速有不同的需求,与驾驶员预期不相符的加速度会造成驾驶员的不适应,影响乘坐的舒适性。因此,有必要在车辆的加减速控制上考虑驾驶员之间的差异。

换道场景有其独有的特点,在正常道路上行驶时,驾驶员选择换道往往是对前车的行驶速度感到不满。由于实际道路的行驶过程中,两车并排行驶是一种不安全的行为,因此驾驶员在结束跟驰后需要提速换道以尽快超越前方车辆。同时,加速过程应该尽可能平滑并与驾驶员的风格相契合。因此,本文提出一种五次多项式方法以实现换道车速的个性化规划:

$ v(t)=A_0+A_1 t+A_2 t^2+A_3 t^3+A_4 t^4+A_5 t^5 . $ (13)

其中v(t)为时刻t车速,A0~A5为多项式的系数。

从式(13)中可看出其有6个需要求解的变量,也即需要解6个方程才可以得到速度规划曲线,因此结合实际进行一些约束,以方便获得个性化的车速规划曲线。对式(13)进行求导获得加速度公式:

$ \begin{equation} a(t)=A_1+2 A_2 t+3 A_3 t^2+4 A_4 t^3+5 A_5 t^4 . \end{equation} $ (14)

在实际驾驶过程中,当驾驶员决定加速后,油门踏板被踩下,车辆加速度逐渐增加。随着车速接近驾驶员预期,油门踏板逐渐松开,加速度减小至0,车辆按驾驶员预期车速匀速向前行驶。对一个具体的驾驶员而言,其在换道场景下所习惯的加速时长和该过程中的最大加速度均有规律。为了方便多项式的求解和确保速度与加速度曲线的平滑,假设加速过程中加速度的最大值出现在加速过程的中间时刻,且此时速度也达到预期车速的中值,则车速规划的五次多项式满足以下条件:

$ \left\{\begin{array}{l} v(0)=v_0, \\ v(\varepsilon / 2)=\frac{v_0+v_{\mathrm{e}}}{2}, \\ v(\varepsilon)=v_{\mathrm{e}}, \\ a(0)=0, \\ a(\varepsilon / 2)=a_{\max }, \\ a(\varepsilon)=0 . \end{array}\right. $ (15)

其中:v0为初始时刻的车速;ve为期望的车速;ε为加速时长,amax为驾驶员在加速过程中达到的最大加速度,这2个值可以通过统计分析驾驶数据获得。将以上各值代入式(13)和(14),即可求得各项系数的值。整个换道场景下的车速满足以下要求:

$ v(t)=\left\{\begin{array}{l} A_0+A_1 t+A_2 t^2+A_3 t^3+A_4 t^4+A_5 t^5, \\ \quad t <\varepsilon ; \\ v_{\mathrm{e}}, t \geqslant \varepsilon . \end{array}\right. $ (16)
5 实验结果展示

基于第4章所述方法,在MATLAB/Simulink和Carsim中开展联合仿真实验,以下展示个性化路径规划和车速规划的仿真实验结果。

5.1 个性化换道路径规划结果

2名驾驶员的个性化原始换道路径规划结果如图 9所示。其中的圆角矩形部分表示前方环境车辆的防碰撞安全区域,可以看出驾驶员A在距离环境车19 m处开始换道,驾驶员B在距离环境车11 m处开始执行换道。驾驶员A由于更早达到纵向势场平衡进入执行换道阶段,换道过程中与环境车的横向距离也更大一些。

图 9 2位驾驶员的个性化原始换道路径规划结果

5.2 个性化换道车速规划结果

4.3节中说明了车速的规划方法,自然驾驶实验中驾驶员A和B在执行换道阶段的平均加速时间分别为10和7 s,加速度最大值均值分别为1.77和2.41 m/s2。仿真实验中假设换道过程驾驶员需要将车速由10 m/s提升至20 m/s,参考2名驾驶员特征规划得到的2条车速曲线和车辆加速度曲线分别如图 1011所示。

图 10 驾驶员A和B个性化车速规划曲线

图 11 驾驶员A和B个性化加速度规划曲线

第3章的分析表明,换道过程中驾驶员在横摆角加速度上的差别最大。为验证本文个性化路径规划与车速规划方法的有效性,开展仿真实验以分析2种路径和车速下车辆的横摆角加速度情况。

真实的车辆模型是非线性的,要想获得可靠的仿真结果,需要考虑较多的自由度。Carsim是一款专业的车辆动力学仿真软件,其内置了高精度的车辆动力学模型,可以实现较为准确的车辆动力学参数估计。此处使用Simlink和Carsim开展联合仿真,以验证2种个性化轨迹下的横摆角加速度值。车辆的动力学模型采用软件自带的C级车模型,控制使用默认的预瞄控制。对图 9中的路径按4.2节中的方法进行拟合和平滑处理,再导入carsim中开展仿真,最终得到的参考2名驾驶员风格的换道轨迹和横摆角加速度值如图 1213所示。

图 12 驾驶员A和B个性化换道路径规划结果

图 13 驾驶员A和B个性化横摆角加速度结果

仿真实验里的前10 s主要是车辆执行转向操作的时间,对应于前文的执行换道阶段。为了进一步量化这一过程中的个性化差异,统计2名驾驶员仿真实验前10 s内的横摆角加速度数据,如表 2所示。其中均值与方差采用数据绝对值来计算以便更好地体现数据特征。

表 2 仿真实验得到的换道执行阶段横摆角加速度统计值 
(°)/s2
驾驶员 均值 方差 最大值
A 1.570 1.848 4.521
B 2.024 3.922 6.102

在第2和3章中,本文基于自然驾驶实验数据对驾驶员A、B的驾驶行为进行了深入探讨。分析表明,与驾驶员A相比,驾驶员B表现出更加激进的驾驶行为模式。特别是在换道行为的情境下,通过横摆角加速度这一关键变量的分析,可以显著观察到两者之间的风格差异,这种差异在换道执行阶段表现得尤为突出。4.1节的表 1中展示了驾驶员A和B在换道执行阶段的横摆角加速度特征。统计数据表明,驾驶员B的横摆角加速度均值和方差均显著高于驾驶员A的。

图 13中可以看出,参考驾驶员A风格的车辆横摆角加速度的最大值、最小值提前出现,这是因为其驾驶风格更为谨慎,比B提前开始执行换道。从表 2可以看出,驾驶员B个性化换道规划的横摆角加速度的变化幅度明显高于驾驶员A的。在表 1中,由于执行换道阶段的选取时间更长,有更多的数据在零附近波动,拉低了方差和均值。总的来看,表 2的仿真数据特征与表 1的实际驾驶数据的趋势是相似的,表明了本文所提出的方法在进行换道规划的同时可以反映不同驾驶员的驾驶风格特征。

6 结论

本文提出了一种考虑驾驶员差异的自动驾驶车辆换道规划方法。首先,通过对自然驾驶实验中的实车数据进行分析,筛选出换道场景下能够最显著反映驾驶员操作差异的指标变量。之后,利用人工势场对换道场景进行建模,根据提取的个性化指标对人工势场参数进行标定,得到了差异化的换道路径规划结果。最后,利用驾驶员在执行换道过程中的平均加速时长和最大加速度约束,确定了五次多项式系数的取值,规划出与驾驶员风格相契合的换道车速。仿真实验证明了本文所提出的方法的有效性,最终的换道路径和车速规划结果符合驾驶员的个性化需求。这一研究成果可以帮助自动驾驶车辆实现考虑驾驶员驾驶风格的个性化换道,改善乘坐体验。

需要说明的是,本文分析所使用的自然驾驶实验数据主要采集于高速公路,在其他道路场景下,本文方法的适用性和效果可能会受到一定的限制。此项研究也没有覆盖换道场景下所有可能的驾驶行为和交通情况,这些不足仍需在下一步的研究中加以改进和完善。

参考文献
[1]
高在峰, 李文敏, 梁佳文, 等. 自动驾驶车中的人机信任[J]. 心理科学进展, 2021, 29(12): 2172-2183.
GAO Z F, LI W M, LIANG J W, et al. Trust in automated vehicles[J]. Advances in Psychological Science, 2021, 29(12): 2172-2183. (in Chinese)
[2]
HARTWICH F, BEGGIATO M, KREMS J F. Driving comfort, enjoyment and acceptance of automated driving-effects of drivers'age and driving style familiarity[J]. Ergonomics, 2018, 61(8): 1017-1032. DOI:10.1080/00140139.2018.1441448
[3]
NATARAJAN M, AKASH K, MISU T. Toward adaptive driving styles for automated driving with users'trust and preferences[C]//Proceedings of the 2022 17th ACM/IEEE International Conference on Human-Robot Interaction (HRI). Sapporo, Japan: ACM/IEEE, 2022: 940-944.
[4]
赵蕾蕾, 李翀, 季林红, 等. 基于虚拟现实的自动驾驶模式中晕动受试者的脑电特征[J]. 清华大学学报(自然科学版), 2020, 60(12): 993-998.
ZHAO L L, LI C, JI L H, et al. EEG characteristics of motion sickness subjects in automatic driving mode based on virtual reality tests[J]. Journal of Tsinghua University (Science and Technology), 2020, 60(12): 993-998. DOI:10.16511/j.cnki.qhdxxb.2020.25.001 (in Chinese)
[5]
朱冰, 贾士政, 赵健, 等. 自动驾驶车辆决策与规划研究综述[J]. 中国公路学报, 2024, 37(1): 215-240.
ZHU B, JIA S Z, ZHAO J, et al. Review of research on decision-making and planning for automated vehicles[J]. China Journal of Highway and Transport, 2024, 37(1): 215-240. (in Chinese)
[6]
刘通, 付锐, 马勇, 等. 考虑驾驶人风格的跟车预警规则研究[J]. 中国公路学报, 2020, 33(2): 170-180.
LIU T, FU R, MA Y, et al. Car-following warning rules considering driving styles[J]. China Journal of Highway and Transport, 2020, 33(2): 170-180. (in Chinese)
[7]
胡春燕, 曲大义, 赵梓旭, 等. 考虑前车驾驶风格的改进自适应巡航控制跟驰模型及仿真[J]. 济南大学学报(自然科学版), 2023, 37(3): 331-338.
HU C Y, QU D Y, ZHAO Z X, et al. Improved adaptive cruise control car-following model and simulation considering driving styles of leading car[J]. Journal of University of Jinan (Science and Technology), 2023, 37(3): 331-338. (in Chinese)
[8]
OZKAN M F, MA Y. Personalized adaptive cruise control and impacts on mixed traffic[C]//Proceedings of the 2021 American Control Conference (ACC). New Orleans, LA, USA: IEEE, 2021: 412-417.
[9]
LI G F, YANG Y F, ZHANG T R, et al. Risk assessment based collision avoidance decision-making for autonomous vehicles in multi-scenarios[J]. Transportation Research Part C: Emerging Technologies, 2021, 122: 102820. DOI:10.1016/j.trc.2020.102820
[10]
吕凯光, 李旋, 韩天园, 等. 基于驾驶风格识别的AEB控制策略[J]. 汽车技术, 2021(5): 16-21.
LV K G, LI X, HAN T Y, et al. AEB control strategy based on driving style recognition[J]. Automobile Technology, 2021(5): 16-21. (in Chinese)
[11]
黄晶, 蓟仲勋, 彭晓燕, 等. 考虑驾驶人风格的换道轨迹规划与控制[J]. 中国公路学报, 2019, 32(6): 226-239, 247.
HUANG J, JI Z X, PENG X Y, et al. Driving style adaptive lane-changing trajectory planning and control[J]. China Journal of Highway and Transport, 2019, 32(6): 226-239, 247. (in Chinese)
[12]
张新锋, 汪亚君, 张浩杰, 等. 考虑驾驶风格的高速行驶工况自动换道决策规划研究. 汽车技术. (2024-01-19). https://doi.org/10.19620/j.cnki.1000-3703.20230357.
ZHANG X F, WANG Y J, ZHANG H J, et al. Research on high-speed automatic lane change decision-making and planning considering driving style. Automobile Technology. (2024-01-19). https://doi.org/10.19620/j.cnki.1000-3703.20230357. (in Chinese)
[13]
NIE Z F, FARZANEH H. Energy-efficient lane-change motion planning for personalized autonomous driving[J]. Applied Energy, 2023, 338: 120926. DOI:10.1016/j.apenergy.2023.120926
[14]
YANG W, LI C, ZHOU Y P. A path planning method for autonomous vehicles based on risk assessment[J]. World Electric Vehicle Journal, 2022, 13(12): 234. DOI:10.3390/wevj13120234
[15]
ELBANHAWI M, SIMIC M, JAZAR R. In the passenger seat: Investigating ride comfort measures in autonomous cars[J]. IEEE Intelligent Transportation Systems Magazine, 2015, 7(3): 4-17. DOI:10.1109/MITS.2015.2405571
[16]
MA Z, ZHANG Y Q. Drivers trust, acceptance, and takeover behaviors in fully automated vehicles: Effects of automated driving styles and driver's driving styles[J]. Accident Analysis&Prevention, 2021, 159: 106238.
[17]
方鸣. 考虑个性化驾驶员的信号口车速引导研究[J]. 建模与仿真, 2023, 12(3): 3162-3173.
FANG M. A Study of speed guidance at signal gates considering individualized drivers[J]. Modeling and Simulation, 2023, 12(3): 3162-3173. (in Chinese)
[18]
陈峥, 张玉果, 沈世全, 等. 城市郊区道路跟车条件下智能网联汽车速度规划[J]. 中国公路学报, 2023, 36(6): 298-310.
CHEN Z, ZHANG Y G, SHEN S Q, et al. Speed planning of intelligent and connected vehicle under following conditions of suburban road scenarios[J]. China Journal of Highway and Transport, 2023, 36(6): 298-310. (in Chinese)
[19]
刘平, 李振鹏, 蒋平, 等. 一种新的V2I下车速规划与模型预测控制方法[J]. 重庆交通大学学报(自然科学版), 2022, 41(7): 27-33.
LIU P, LI Z P, JIANG P, et al. A new method for vehicle speed planning and model prediction control under V2I[J]. Journal of Chongqing Jiaotong University (Natural Science), 2022, 41(7): 27-33. (in Chinese)
[20]
ISHIBASHI M, OKUWA M, DOIS, et al. Indices for characterizing driving style and their relevance to car following behavior[C]//Proceedings of the SICE Annual Conference 2007. Takamatsu, Japan: IEEE, 2007: 1132-1137.
[21]
侯海晶, 金立生, 关志伟, 等. 驾驶风格对驾驶行为的影响[J]. 中国公路学报, 2018, 31(4): 18-27.
HOU H J, JIN L S, GUAN Z W, et al. Effects of driving style on driver behavior[J]. China Journal of Highway and Transport, 2018, 31(4): 18-27. (in Chinese)
[22]
李浩然. 智能汽车个性化驾驶行为决策与运动控制方法研究[D]. 武汉: 武汉理工大学, 2021.
LI H R. Personalized driving decision-making and motion control[D]. Wuhan: Wuhan University of Technology, 2021. (in Chinese)
[23]
LI H R, LU Y P, ZHENG H T, et al. Analysis of naturalistic driving behavior for personalized autonomous vehicle[C]//Proceedings of the 2023 IEEE 26th International Conference on Intelligent Transportation Systems (ITSC). Bilbao, Spain: IEEE, 2023: 2106-2111.
[24]
柏海舰, 申剑峰, 卫立阳. 无人车"三阶段"换道轨迹规划过程分析[J]. 合肥工业大学学报(自然科学版), 2019, 42(5): 577-584, 676.
BAI H J, SHEN J F, WEI L Y. Three-stage lane-changing trajectory planning method for automated vehicles[J]. Journal of Hefei University of Technology (Natural Science), 2019, 42(5): 577-584, 676. (in Chinese)