本发明公开了用于自动驾驶虚拟测试的交通车换道决策规划方法，具体过程包括：确定强制换道目标车道；判断自由换道动机；确定自由换道潜在目标车道；预判换道动机协调性；判定当前是否处于强制换道目标车道；判定强制换道紧迫性；判定换道时机；规划换道轨迹。本发明所述交通车换道决策规划方法能够让交通车根据当前的交通环境和预先设定的驾驶偏好，规划出一条连续的换道轨迹，以提高自动驾驶虚拟测试中交通车的随机性和逼真度，使仿真车辆间形成动态有效的互动。
1.用于自动驾驶虚拟测试的交通车换道决策规划方法，其特征在于：所述交通车换道决策规划方法具体过程如下：步骤S1：确定强制换道目标车道；
所述步骤S1中，确定强制换道目标车道的公式具体如下：上述确定强制换道目标车道的公式中：j j j j
MRP为车道l是否符合宏观的路径规划的判断结果，如果MRP为1，车道l能驶向下一个j j路段；如果MRP为0，车道l不能驶向下一路段；
一个路段内包含多个符合路径规划的目标车道 Lm是当前交通车Veh 所在路段内所有强制换道目标车道lm的集合；
步骤S2：判断自由换道动机，若需要自由换道，则进入步骤S3，若不需要自由换道，则进入步骤S5；
所述步骤S2中，判断自由换道动机的公式具体如下：上述判断自由换道动机的公式中：o
当p(t)超过预设的焦虑指数阈值pth时，DLCI为1，判断需要自由换道；
当p(t)小于预设的焦虑指数阈值pth时，DLCI为0，判断不需要自由换道；
步骤S3：确定自由换道潜在目标车道，若自由换道潜在目标车道不存在，则返回步骤S2，若自由换道潜在目标车道存在，则进入步骤S4；
所述步骤S3中，当自由换道的动机产生后，查看当前路段是否存在车道ld，使交通车o oVeh的焦虑指数降低，并根据交通车Veh对车道k的预估焦虑指数筛选潜在目标车道；
所述交通车对车道的预估焦虑指数的计算公式如下：上述确定交通车对车道的预估焦虑指数的公式中：o
筛选潜在目标车道的公式如下：上述筛选潜在目标车道的公式中：k o
DLCL为交通车Veh对车道k是否符合自由换道潜在目标车道的判断结果；
当交通车Veh 对车道k的预估焦虑指数 大于焦虑指数阈值pth，DLCL值为0，该车道不符合自由换道潜在目标车道的判定条件，判断不存在自由换道潜在目标车道；
当交通车Veh 对车道k的预估焦虑指数 小于焦虑指数阈值pth，DLCL值为1，该车道符合自由换道潜在目标车道的判定条件，判断存在自由换道潜在目标车道；
步骤S4：预判换道动机协调性，若换道动机协调，则进入步骤S7，若换道动机不协调，则进入步骤S5；
首先，计算交通车从当前车道l向自由换道潜在目标车道 执行换道的紧迫指数urg ，具体公式如下：k
是从当前车道换到自由换道潜在目标车道 的预估纵向行驶距离；
是从自由换道潜在目标车道 换到最临近的强制换道目标车道 的预估纵向行驶距离；
所述从当前车道换到自由换道潜在目标车道 的预估纵向行驶距离 与从自由换道潜在目标车道 换到最临近的强制换道目标车道 的预估纵向行驶距离 的计算公式具体如下：上述 与 的计算公式中：为车道i的平均车速；
预估等待时间 是通过以目标车道的密度作为横坐标，预估等待时间作为纵坐标，并结合驾驶员的换道驾驶风格的意图表征时窗确定的，所述意图表征时窗是驾驶员首次关注后视镜至方向盘转动的时间；
然后，根据交通车从当前车道向自由换道潜在目标车道执行换道的紧迫指数，判断是否可以执行自由换道，具体判断公式如下：上述判断是否可以执行自由换道的公式中：k o
urg为交通车从当前车道l向自由换道潜在目标车道 执行换道的紧迫指数；
urgmin为交通车从当前车道l 向自由换道潜在目标车道 执行换道的紧迫指数中的最小紧迫指数；
如果最小紧迫指数urgmin小于预设紧迫性阈值urgth，DLCF为1，强制换道与自由换道之间具有协调性，判断换道动机协调；
如果最小紧迫指数urgmin大于预设紧迫性阈值urgth，DLCF为0，强制换道与自由换道之间不具有协调性，判断换道动机不协调；
步骤S5：判定当前是否处于强制换道目标车道，若当前不处于强制换道目标车道，则进入步骤S6，若当前处于强制换道目标车道，则返回步骤S2；
当步骤S3中判定不需要自由换道或步骤S4中判定当前车道条件不允许自由换道时，交o通车Veh需要对当前所处车道作出判定，当前所处车道的判定公式如下：上述前所处车道的判定公式中：MLJ为当前所处车道的判定结果；
如果当前车道l是强制换道目标车道lm，MLJ＝1；
如果当前车道l不是强制换道目标车道lm，MLJ＝0；
步骤S6：判定强制换道紧迫性，若需要紧急强制换道，则进入步骤S7，若不需要紧急强制换道，则返回步骤S2；
当交通车当前车道不属于强制换道目标车道时，计算从交通车所在车道l 到最近的强J制换道目标车道 的换道紧迫指数urg ，计算公式具体如下：J
是从当前车道l换到最临近的强制换道目标车道 的预估纵向行驶距离；
本步骤S6中，根据换道紧迫指数urg判定强制换道紧迫性；
判定强制换道紧迫性的公式具体如下：上述判定强制换道紧迫性的公式中：MLCF为强制换道紧迫性的判定结果；
如果强制换道紧迫指数urg 大于预设紧迫性阈值urgth，MLCF＝1，判定需要紧急强制换道；
如果强制换道紧迫指数urg 小于紧迫性阈值urgth，MLCF＝0，判定不需要紧急强制换道；
步骤S7：判定换道时机，若当前能执行换道，则进入步骤S8，若当前不能执行换道，则等待换道时机，直至能执行换道；
步骤S71：确定所述交通车Veh的紧迫指数urg的公式如下：o t
确定所述交通车Veh的目标车道l的公式如下：步骤S72中：确定时机评估指数的公式为：上述时机评估指数LCIC的计算公式中：LCIC是时机评估指数；
是在交通车Veh换到新车道时交通车Veh的预期纵向加速度；
交通车Veh的礼貌系数与其初始设定的驾驶风格，以及换道紧迫性相关；其中：谨慎型驾驶员初始礼貌系数、普通型驾驶员初始礼貌系数和冲动型驾驶员初始礼貌系数一次与降低；
换道紧迫指数urg 越低，交通车Veh 驾驶员越表现出让车的行为，亦越顾及目标车道的n后方交通车Veh的速度变化；
换道紧迫指数urg 越高，交通车Veh 驾驶员越表现出换道的行为，亦越无法顾及目标车n道的后方交通车Veh的速度变化；
步骤S73：换道时机判定公式具体如下：上述换道时机判定公式中：LCMP为换道时机判定结果；
当时机评估指数LCIC大于预设时机阈值LCICth时，LCMP为1，判定交通车Veh 当前能执行换道；
当时机评估指数LCIC小于预设时机阈值LCICth时，LCMP为0，判定交通车Veh 当前不能换道；
2.如权利要求1所述用于自动驾驶虚拟测试的交通车换道决策规划方法，其特征在于：所述步骤S8中，规划换道轨迹的具体过程如下：步骤S81:将换道轨迹分为三个阶段：P0P1为换道准备阶段、P1P2为换道执行阶段和P2P3为换道结束阶段，并按阶段规划目标轨迹点P0、P1、P2和P3；
步骤S82：将已确定的目标点P0、P1、P2和P3平滑地连接起来形成轨迹，其中：P1P2与P0P1间的夹角为α，P1P2与P2P3间的夹角为β，并在P1P2的中点增加一点Pm；
记z0＝0，P0P1间距离为z1＝|P0P1|，P1Pm间距离为z2＝|P1Pm|，PmP2间距离为z3＝|PmP2|，P2P3间距离为z4＝|P2P3|；
记φ0＝0，P1处相对航向角为 Pm处相对航向角为φ2＝α，P2处相对航向角为P3处相对航向角为φ4＝α‑β；
P0点时间t0＝0，P1点时间t1＝1，Pm点时间t2＝2，P2点时间t3＝3，P3点时间t4＝4；
规定P0点的速度z′0为当前交通车Veh的实际车速z′0＝v ，P0点的角速度φ′0＝0，P3点o′ f′ f′的速度z′4为新车道l 的前车Veh 的预估车速z′4＝v ，P3点的角速度φ′4＝0；
对(t,z)用三次样条曲线进行插值，固定边界分别为(t0,z′0)及(t4,z′4)；
对(t,φ)用三次样条曲线进行插值，固定边界分别为(t0,φ′0)及(t4,φ′4)；
3.如权利要求2所述用于自动驾驶虚拟测试的交通车换道决策规划方法，其特征在于：所述步骤S81中，按阶段规划目标轨迹点的具体过程如下：(1)准备阶段
准备阶段持续时间为1秒，P0是交通车Veh当前的位置，P1是当前车道驶离点；
P1点在Frenet坐标系内纵坐标s1的位置随机，其取样的区间为 其中：r o
为纵坐标s1的下边界，由当前车道后车Veh相对于交通车Veh的安全位置o
为s1的上边界，由交通车Veh加速行驶位置 及交通车Veh 相对于当前车f
驶离点P1纵坐标s1的预取样点 符合均值为μ1，标准差为σ1的标准正态分布其中：对取样后的结果 加以变化，确定P1点在Frenet坐标系内纵坐标s1的公式如下：(2)执行阶段
执行阶段持续时间为2秒，P1为原车道l的驶离点，P2为新车道l 的驶入点；
P2点在Frenet坐标系内纵坐标s2的位置随机，其取样的区间为 其中：o′ r′ o
为纵坐标s2的下边界，由新车道l 后车Veh 相对于交通车Veh的安全位置o及交通车Veh最大横摆极限位置 二者间的最大值确定；
为纵坐标s2的上边界，由交通车Veh加速行驶位置 及交通车Veh 相对o′ f′
于新车道l 前车Veh 的安全位置 二者间的最小值确定；
驶离点P2纵坐标s2的预取样点 符合均值为μ2，标准差为σ2的标准正态分布其中：对取样后的结果加以变化，确定P2点在Frenet坐标系内纵坐标s2的公式如下：(3)结束阶段
结束阶段持续时间为1秒，P2为新车道l 的驶入点，P3是从车道l 至车道l 整个换道过程的结束位置；
交通车Veh在达到P3点时车速与前车Veh 一致，或达到当前车道的最高限速。
用于自动驾驶虚拟测试的交通车换道决策规划方法
技术领域
[0001] 本发明属于自动驾驶车辆换道控制技术领域，具体涉及用于自动驾驶虚拟测试的交通车换道决策规划方法。
背景技术
[0002] 当前汽车行业普遍的共识是，虚拟仿真是自动驾驶测试的重要手段。作为替代真实驾驶人的虚拟测试交通车辆，其任务重点在于体现出多样的驾驶风格，能够与其他交通参与者，尤其是与被测车辆进行有效的交互。然而，目前用于自动驾驶虚拟测试中的交通车运动不够真实，与现实中交通车辆的行为相差较大，难以用于自动驾驶汽车的虚拟开发和验证。
[0003] 现有技术中，自动驾驶仿真测试的交通车模型大致分为两种，一种是预设轨迹跟随模型，另一种是微观交通流模型。其中：
[0004] 以预设轨迹跟随方式运行的交通车主要出现在自动驾驶开发测试工具中，如VTD，CARLA等。预设轨迹跟随方式是指：交通车按照仿真前预先设定的轨迹或仿真过程中随机生成的轨迹移动，与他车的互动仅限于保持一定的安全距离防止发生碰撞。这种预设轨迹跟随方式中，运动轨迹需要人工设计，而现有技术中，能够提供的测试场景不够丰富，且交通车辆与被测试主体难以形成完全闭环的交互。
[0005] 以微观交通流方式运行的交通车主要用于宏观交通的管控、交通拥堵分析及疏导等研究的微观交通仿真工具，如SUMO，微观交通流方式最近正逐渐应用于自动驾驶仿真中，为自动驾驶测试提供随机的动态环境。但是，尽管微观交通流模型相比预设轨迹跟随模型，建立了相对复杂的跟驰模型和换道模型，但仍然难以复现现实中发生的换道过程，其主要体现在：
[0006] 1.当前的微观交通流模型将换道动机分成了战略换道、战术换道和合作换道。而这些动机大多是从客观条件上考虑的，即“能不能”换道，而驾驶员主观上做出“要不要”换道的判断在这一类模型中并未有明显的体现。
[0007] 2.交通车运动是基于车道的一维行为仿真，没有建立或建全侧向运动的模型，不能模拟出真实车辆的运动轨迹。SUMO中常用的模型，其换道过程是瞬间完成的。而相对精细的sublane model本质上是侧向的元胞自动机，虽然看似存在侧向的运动，但纵侧向运动完全脱离，未能考虑实际车辆整体的运动能力。
发明内容
[0008] 针对上述现有技术中存在的缺陷，本发明公开了用于自动驾驶虚拟测试的交通车换道决策规划方法，本发明所述方法能够让交通车根据当前的交通环境和预先设定的驾驶偏好，规划出一条连续的换道轨迹，以提高自动驾驶虚拟测试中交通车的随机性和逼真度，使仿真车辆间形成动态有效的互动。
[0009] 结合说明书附图，本发明的技术方案如下：
[0010] 用于自动驾驶虚拟测试的交通车换道决策规划方法，所述交通车换道决策规划方法具体过程如下：
[0011] 步骤S1：确定强制换道目标车道；
[0012] 步骤S2：判断自由换道动机，若需要自由换道，则进入步骤S3，若不需要自由换道，则进入步骤S5；
[0013] 步骤S3：确定自由换道潜在目标车道，若自由换道潜在目标车道不存在，则返回步骤S2，若自由换道潜在目标车道存在，则进入步骤S4；
[0014] 步骤S4：预判换道动机协调性，若换道动机协调，则进入步骤S7，若换道动机不协调，则进入步骤S5；
[0015] 步骤S5：判定当前是否处于强制换道目标车道，若当前不处于强制换道目标车道，则进入步骤S6，若当前处于强制换道目标车道，则返回步骤S2；
[0016] 步骤S6：判定强制换道紧迫性，若需要紧急强制换道，则进入步骤S7，若不需要紧急强制换道，则返回步骤S2；
[0017] 步骤S7：判定换道时机，若当前能执行换道，则进入步骤S8，若当前不能执行换道，则等待换道时机，直至能执行换道；
[0018] 步骤S8：规划换道轨迹。
[0019] 所述步骤S1中，确定强制换道目标车道的公式具体如下：
[0020]
[0021]
[0022] 上述确定强制换道目标车道的公式中：
[0023] MRPj为车道lj是否符合宏观的路径规划的判断结果，如果MRPj为1，车道lj能驶向j j下一个路段；如果MRP为0，车道l不能驶向下一路段；
[0024] 一个路段内包含多个符合路径规划的目标车道 Lm是当前交通车Veho所在路段内所有强制换道目标车道lm的集合。
[0025] 所述步骤S2中，判断自由换道动机的公式具体如下：
[0026]
[0027]
[0028]
[0029] 上述判断自由换道动机的公式中：o
[0030] 为当前时刻交通车Veh的期望速度；
[0031] 为出发前做出路径规划时的推荐车速；
[0032] 为了按时到达目的地，当前需要达到的期望速度；
[0033] 为当前所在车道的平均车速；
[0034] po(t)为焦虑指数；
[0035] DLCI为自由换道动机判定结果；
[0036] 当po(t)超过预设的焦虑指数阈值pth时，DLCI为1，判断需要自由换道；
[0037] 当po(t)小于预设的焦虑指数阈值pth时，DLCI为0，判断不需要自由换道。
[0038] 所述步骤S3中，当自由换道的动机产生后，查看当前路段是否存在车道ld，使交通o o车Veh的焦虑指数降低，并根据交通车Veh对车道k的预估焦虑指数筛选潜在目标车道；
[0039] 所述交通车对车道的预估焦虑指数的计算公式如下：
[0040]
[0041] 上述确定交通车对车道的预估焦虑指数的公式中：
[0042] 为交通车Veho对车道k的预估焦虑指数；
[0043] 为车道k的平均车速；
[0044] 为当前时刻交通车Veho的期望速度；
[0045] 筛选潜在目标车道的公式如下：
[0046]
[0047]
[0048] 上述筛选潜在目标车道的公式中：
[0049] DLCLk为交通车Veho对车道k是否符合自由换道潜在目标车道的判断结果；o k
[0050] 当交通车Veh 对车道k的预估焦虑指数 大于焦虑指数阈值pth，DLCL值为0，该车道不符合自由换道潜在目标车道的判定条件，判断不存在自由换道潜在目标车道；o k
[0051] 当交通车Veh 对车道k的预估焦虑指数 小于焦虑指数阈值pth，DLCL值为1，该车道符合自由换道潜在目标车道的判定条件，判断存在自由换道潜在目标车道。
[0052] 所述步骤S4中：
[0053] 首先，计算交通车从当前车道lo向自由换道潜在目标车道 执行换道的紧迫指数kurg，具体公式如下：
[0054]
[0055] 上述紧迫指数urgk的计算公式中：
[0056] s0是交通车Veho所在路段的剩余长度；
[0057] 是从当前车道换到自由换道潜在目标车道 的预估纵向行驶距离；
[0058] 是从自由换道潜在目标车道 换到最临近的强制换道目标车道 的预估纵向行驶距离；
[0059] 所述从当前车道换到自由换道潜在目标车道 的预估纵向行驶距离 与从自由换道潜在目标车道 换到最临近的强制换道目标车道 的预估纵向行驶距离 的计算公式具体如下：
[0060]
[0061]
[0062] 上述 与 的计算公式中：
[0063] 为车道i的平均车速；
[0064] 是在车道i等待向车道i+1换道时的预估等待时间；
[0065] 是预估换道执行时间；
[0066] 预估等待时间 是通过以目标车道的密度作为横坐标，预估等待时间作为纵坐标，并结合驾驶员的换道驾驶风格的意图表征时窗确定的，所述意图表征时窗是驾驶员首次关注后视镜至方向盘转动的时间；
[0067] 然后，根据交通车从当前车道向自由换道潜在目标车道执行换道的紧迫指数，判断是否可以执行自由换道，具体判断公式如下：
[0068]
[0069]
[0070] 上述判断是否可以执行自由换道的公式中：
[0071] urgk为交通车从当前车道lo向自由换道潜在目标车道 执行换道的紧迫指数；o
[0072] urgmin为交通车从当前车道l向自由换道潜在目标车道 执行换道的紧迫指数中的最小紧迫指数；
[0073] DLCF为自由换道可行性判断结果；
[0074] 如果最小紧迫指数urgmin小于预设紧迫性阈值urgth，DLCF为1，强制换道与自由换道之间具有协调性，判断换道动机协调；
[0075] 如果最小紧迫指数urgmin大于预设紧迫性阈值urgth，DLCF为0，强制换道与自由换道之间不具有协调性，判断换道动机不协调。
[0076] 所述步骤S5中：
[0077] 当步骤S3中判定不需要自由换道或步骤S4中判定当前车道条件不允许自由换道o时，交通车Veh需要对当前所处车道作出判定，当前所处车道的判定公式如下：
[0078]
[0079] 上述前所处车道的判定公式中：
[0080] MLJ为当前所处车道的判定结果；
[0081] 如果当前车道lo是强制换道目标车道lm，MLJ＝1；
[0082] 如果当前车道lo不是强制换道目标车道lm，MLJ＝0。
[0083] 所述步骤S6中：
[0084] 当交通车当前车道不属于强制换道目标车道时，计算从交通车所在车道lo到最近J的强制换道目标车道 的换道紧迫指数urg，计算公式具体如下：
[0085]
[0086]
[0087] 上述计算换道紧迫指数urgJ的公式中：
[0088] 是从当前车道lo换到最临近的强制换道目标车道 的预估纵向行驶距离；
[0089] s0是交通车Veho所在路段的剩余长度；
[0090] 为车道i的平均车速；
[0091] 是在车道i等待向车道i+1换道时的预估等待时间；
[0092] 是预估换道执行时间；
[0093] 本步骤S6中，根据换道紧迫指数urgJ判定强制换道紧迫性；
[0094] 判定强制换道紧迫性的公式具体如下：
[0095]
[0096] 上述判定强制换道紧迫性的公式中：
[0097] MLCF为强制换道紧迫性的判定结果；
[0098] 如果强制换道紧迫指数urgJ大于预设紧迫性阈值urgth，MLCF＝1，判定需要紧急强制换道；
[0099] 如果强制换道紧迫指数urgJ小于紧迫性阈值urgth，MLCF＝0，判定不需要紧急强制换道。
[0100] 所述步骤S7中，判定换道时机的过程包括：
[0101] 步骤S71：确定所述交通车Veho的紧迫指数urgo的公式如下：
[0102]
[0103] 确定所述交通车Veho的目标车道lt的公式如下：
[0104]
[0105] 步骤S72中：确定所述时机评估指数的公式为：
[0106]
[0107]
[0108] 上述时机评估指数LCIC的计算公式中：
[0109] LCIC是时机评估指数；o
[0110] 是交通车Veh换到新车道的预期纵向加速度；
[0111] ao是当前交通车Veho的纵向加速度；
[0112] 交通车Vehn为交通车Veho将要汇入车道的后车；
[0113] 是在交通车Veho换到新车道时交通车Vehn的预期纵向加速度；
[0114] an是当前交通车Vehn的纵向加速度；
[0115] δo是交通车Veho的礼貌系数；
[0116] 是交通车Veho初始礼貌系数；
[0117] urg是当前换道行为的紧迫指数；
[0118] 交通车Veho的礼貌系数与其初始设定的驾驶风格，以及换道紧迫性相关；其中：
[0119] 谨慎型驾驶员初始礼貌系数、普通型驾驶员初始礼貌系数和冲动型驾驶员初始礼貌系数一次与降低；
[0120] 换道紧迫指数urgo越低，交通车Veho驾驶员越表现出让车的行为，亦越顾及目标车n道的后方交通车Veh的速度变化；
[0121] 换道紧迫指数urgo越高，交通车Veho驾驶员越表现出换道的行为，亦越无法顾及目n标车道的后方交通车Veh的速度变化。
[0122] 步骤S73：换道时机判定公式具体如下：
[0123]
[0124] 上述换道时机判定公式中：
[0125] LCMP为换道时机判定结果；
[0126] LCIC为时机评估指数；
[0127] 当时机评估指数LCIC大于预设时机阈值LCICth时，LCMP为1，判定交通车Veho当前能执行换道；
[0128] 当时机评估指数LCIC小于预设时机阈值LCICth时，LCMP为0，判定交通车Veho当前不能换道。
[0129] 所述步骤S8中，规划换道轨迹的具体过程如下：
[0130] 步骤S81:将换道轨迹分为三个阶段：P0P1为换道准备阶段、P1P2为换道执行阶段和P2P3为换道结束阶段，并按阶段规划目标轨迹点P0、P1、P2和P3；
[0131] 步骤S82：将已确定的目标点P0、P1、P2和P3平滑地连接起来形成轨迹，其中：
[0132] P1P2与P0P1间的夹角为α，P1P2与P2P3间的夹角为β，并在P1P2的中点增加一点Pm；
[0133] 记z0＝0，P0P1间距离为z1＝|P0P1|，P1Pm间距离为z2＝|P1Pm|，PmP2间距离为z3＝|PmP2|，P2P3间距离为z4＝|P2P3|；
[0134] 记φ0＝0，P1处相对航向角为 Pm处相对航向角为φ2＝α，P2处相对航向角为 P3处相对航向角为φ4＝α‑β；
[0135] P0点时间t0＝0，P1点时间t1＝1，Pm点时间t2＝2，P2点时间t3＝3，P3点时间t4＝4；
[0136] 规定P0点的速度z′0为当前交通车Veho的实际车速z′0＝vo，P0点的角速度φ′0＝0，o′ f′ f′P3点的速度z′4为新车道l 的前车Veh 的预估车速z′4＝v ，P3点的角速度φ′4＝0；
[0137] 对(t,z)用三次样条曲线进行插值，固定边界分别为(t0,z′0)及(t4,z′4)；
[0138] 对(t,φ)用三次样条曲线进行插值，固定边界分别为(t0,φ′0)及(t4,φ′4)；
[0139] 至此，交通车Veho换道轨迹完成规划。
[0140] 所述步骤S81中，按阶段规划目标轨迹点的具体过程如下：
[0141] (1)准备阶段
[0142] 准备阶段持续时间为1秒，P0是交通车Veho当前的位置，P1是当前车道驶离点；
[0143] P1点在Frenet坐标系内纵坐标s1的位置随机，其取样的区间为 其中：
r o
[0144] 为纵坐标s1的下边界，由当前车道后车Veh 相对于交通车Veh 的安全位置o及交通车Veh 减速行驶位置 二者间的最大值确定；
o o
[0145] 为s1的上边界，由交通车Veh加速行驶位置 及交通车Veh相对于f
当前车道前车Veh的安全位置 二者间的最小值确定；
[0146] 驶离点P1纵坐标s1的预取样点 符合均值为μ1，标准差为σ1的标准正态分布其中：
[0147]
[0148]
[0149]
[0150] 对取样后的结果 加以变化，确定P1点在Frenet坐标系内纵坐标s1的公式如下：
[0151]
[0152] (2)执行阶段
[0153] 执行阶段持续时间为2秒，P1为原车道lo的驶离点，P2为新车道lo′的驶入点；
[0154] P2点在Frenet坐标系内纵坐标s2的位置随机，其取样的区间为 其中：
o′ r′ o
[0155] 为纵坐标s2的下边界，由新车道l 后车Veh 相对于交通车Veh的安全位置o及交通车Veh最大横摆极限位置 二者间的最大值确定；
[0156] 为纵坐标s2的上边界，由交通车Veho加速行驶位置 及交通车Vehoo′ f′
相对于新车道l 前车Veh 的安全位置 二者间的最小值确定；
[0157] 驶离点P2纵坐标s2的预取样点 符合均值为μ2，标准差为σ2的标准正态分布其中：
[0158]
[0159]
[0160]
[0161] 对取样后的结果加以变化，确定P2点在Frenet坐标系内纵坐标s2的公式如下：
[0162]
[0163] (3)结束阶段
[0164] 结束阶段持续时间为1秒，P2为新车道lo′的驶入点，P3是从车道lo至车道lo′整个换道过程的结束位置；
[0165] 交通车Veho在达到P3点时车速与前车Vehf′一致，或达到当前车道的最高限速。
[0166] 与现有技术相比，本发明的有益效果在于：
[0167] 1、本发明所述交通车换道决策规划方法提出了一种将换道动机与换道时机相分离的决策结构，其中，换道动机是由于驾驶员认为当前车道的现状不满足个人预期产生的，而所述的“现状不满足个人预期”可能是因为当前车道不能通往路径规划中的下一路段；也可能是因为当前车道的车速过慢，想要提高车速。而换道的时机则是依据对预期车道的预测作出的换道机会的判断。
[0168] 2、本发明所述交通车换道决策规划方法随机生成换道轨迹，且所述换道轨迹是在一个安全的区间内随机生成的，增加了交通车运动的随机性。
[0169] 3、本发明所述交通车换道决策规划方法实现了对驾驶员心理的模拟，其中，驾驶员的心理包括：1)欲速则不达，即处于交通堵则中的驾驶员往往不能达到预期车速，越被阻挡，提高车速的的意愿就越强烈，这一驾驶员心理在本专利提出的方法中可以得到很好的模拟；2)换道紧迫性，即距离目标车道越远，目标车道越拥挤，驾驶员换道紧迫性越强烈；3)动机间协调，自由换道需要时刻评估是否符合宏观的强制换道目标，强制换道在协调过程中也隐含判断了是否需要再执行自由换道。
附图说明
[0170] 图1为本发明所述用于自动驾驶虚拟测试的交通车换道决策规划方法的流程框图；
[0171] 图2为本发明所述交通车换道决策规划方法中，换道动机协调性预判过程中用于根据驾驶风格确定预估等待时间的意图表征时窗的示意图；
[0172] 图3为本发明所述交通车换道决策规划方法中，换道轨迹规划过程中车辆行驶轨迹模拟示意图；
[0173] 图4为本发明所述交通车换道决策规划方法中，换道轨迹规划过程中准备阶段交通车当前车道驶离点P1在Frenet坐标系内纵坐标s1的位置示意图；
[0174] 图5为本发明所述交通车换道决策规划方法中，换道轨迹规划过程中执行阶段交通车新车道驶入点P2在Frenet坐标系内纵坐标s2的位置示意图；
[0175] 图6为本发明所述交通车换道决策规划方法中，换道轨迹规划过程中，基于规划的目标轨迹点所形成的连续轨迹示意图。
具体实施方式
[0176] 为清楚、完整地描述本发明所述技术方案及其具体工作过程，结合说明书附图，本发明的具体实施方式如下：
[0177] 本发明公开了一种用于自动驾驶虚拟测试的交通车换道决策规划方法，所述方法的具体过程如下：
[0178] 步骤S1：确定强制换道目标车道；
[0179] 本步骤S1中，每个路段的强制换道目标车道Lm是依据宏观规划确定的，当一辆交通车设定了起始点Po和起止点Pd后，路径规划会根据当前的交通环境以及预先设定的偏好，规划出一条由多个路段组成的行驶路线，交通车当前所在路段的强制换道目标车道就是可以通往下一路段的车道；
[0180] 本步骤S1中，确定强制换道目标车道的公式具体如下：
[0181]
[0182]
[0183] 上述确定强制换道目标车道的公式中：
[0184] MRPj(MRP，即Mandatory Route Planning)为车道lj是否符合宏观的路径规划的判j j断结果：如果该值为1，表明车道l是可以驶向下一个路段的；该值为0，表明车道l 不能驶向下一路段；
o
[0185] 一个路段内可以包含多个符合路径规划的目标车道 而Lm是当前交通车Veh 所在路段内所有强制换道目标车道lm的集合；
[0186] 步骤S2：判断自由换道动机；
[0187] 本步骤S2中，战术换道是由于交通车Veho期望车速高于当前车道的平均车速，认o为当前所在车道l的车速过慢，想要提高车速所产生的动机；
[0188] 本步骤S2中，判断自由换道动机的公式具体如下：
[0189]
[0190]
[0191]
[0192] 上述判断自由换道动机的公式中：o
[0193] 为当前时刻交通车Veh的期望速度；
[0194] 为出发前做出路径规划时的推荐车速；
[0195] 为了按时到达目的地，当前需要达到的期望速度；
[0196] 为当前所在车道的平均车速；
[0197] po(t)为焦虑指数；
[0198] 上述判断自由换道动机的公式中，体现了交通车越被阻挡，越希望提高车速的意愿；
[0199] 当交通状况良好时， 相比于 几乎不会发生变化， 与 基本o
一致，交通车Veh的焦虑指数为0，可以按照计划按时到达目的地；
o
[0200] 当交通状况恶化时，交通车Veh被阻挡，不能达到预期车速 为了能按计划按时到达目的地， 必须提高；
[0201] 的增加必然导致 的增加，进而使得焦虑指数po(t)逐渐升高；
[0202] DLCI为自由换道动机判定结果；
[0203] 当po(t)超过预设的焦虑指数阈值pth时，DLCI为1，自由换道动机产生，需要自由换道，则接下来进入下述步骤S3，确定自由换道潜在目标车道；
[0204] 当po(t)小于预设的焦虑指数阈值pth时，DLCI为0，不需要自由换道，则接下来进入下述步骤S5，判定当前是否处于强制换道目标车道；
[0205] 步骤S3：确定自由换道潜在目标车道；
[0206] 本步骤S3中，当自由换道的动机产生后，需要查看当前路段是否存在车道ld，可以o o使交通车Veh的焦虑指数降低，并根据交通车Veh对车道k的预估焦虑指数筛选潜在目标车道；
[0207] 所述交通车对车道的预估焦虑指数的计算公式如下：
[0208]
[0209] 上述确定交通车对车道的预估焦虑指数的公式中：
[0210] 为交通车Veho对车道k的预估焦虑指数；
[0211] 为车道k的平均车速；o
[0212] 为当前时刻交通车Veh的期望速度；
[0213] 筛选潜在目标车道的公式如下：
[0214]
[0215]
[0216] 上述筛选潜在目标车道的公式中：
[0217] DLCLk(DLCL，即Discretionary Lane Changing Lane)为交通车Veho对车道k是否符合自由换道潜在目标车道的判断结果；
[0218] 当交通车Veho对车道k的预估焦虑指数 大于焦虑指数阈值pth，DLCLk值为0，该车道不符合自由换道潜在目标车道的判定条件，即此时不存在自由换道潜在目标车道，则返回上述步骤S2，重新判断自由换道动机；
[0219] 当交通车Veho对车道k的预估焦虑指数 小于焦虑指数阈值pth，DLCLk值为1，该车道符合自由换道潜在目标车道的判定条件，将该车道列入自由换道潜在目标车道集合Ld，则接下来进入下述步骤S4，预判换道动机的协调性；
[0220] 步骤S4：预判换道动机协调性；
[0221] 本步骤S4中，强制换道是保证交通车Veho能够完成从起始点Po到起止点Pd整个行程的必要条件，自由换道不能违背该前提，所以当自由换道的决策作出之后，需要检查强制换道与自由换道之间的协调性；
[0222] 本步骤S4中，根据交通车从当前车道向自由换道潜在目标车道执行换道的紧迫指数，判断是否可以执行自由换道，具体判断公式如下：
[0223]
[0224]
[0225] 上述判断是否可以执行自由换道的公式中：
[0226] urgk为交通车从当前车道lo向自由换道潜在目标车道 执行换道的紧迫指数；o
[0227] urgmin为交通车从当前车道l向自由换道潜在目标车道 执行换道的紧迫指数中的最小紧迫指数；
[0228] DLCF(即Discretionary Lane Changing Feasibility)为自由换道可行性判断结果；
[0229] 如果最小紧迫指数urgmin小于预设紧迫性阈值urgth，DLCF为1，判断强制换道与自由换道之间具有协调性，即换道动机协调，可以自由换道执行，则接下来进入下述步骤S7，进行具有最小紧迫指数urgmin的车道 的换道时机判断过程；
[0230] 如果最小紧迫指数urgmin大于预设紧迫性阈值urgth，DLCF为0，判断强制换道与自由换道之间不具有协调性，即换道动机不协调，当前不能执行自由换道，则接下来进入下述步骤S5，判定当前是否处于强制换道目标车道，并实现尽快汇入强制换道目标车道Lm；
[0231] 所述交通车从当前车道lo向自由换道潜在目标车道 执行换道的紧迫指数urgk的计算公式具体如下：
[0232]
[0233] 上述urgk的计算公式中：
[0234] s0是交通车Veho所在路段的剩余长度；
[0235] 是从当前车道换到自由换道潜在目标车道 的预估纵向行驶距离；
[0236] 是从自由换道潜在目标车道 换到最临近的强制换道目标车道 的预估纵向行驶距离；
[0237] 所述从当前车道换到自由换道潜在目标车道 的预估纵向行驶距离 与从自由换道潜在目标车道 换到最临近的强制换道目标车道 的预估纵向行驶距离 的计算公式具体如下：
[0238]
[0239]
[0240] 上述 与 的计算公式中：
[0241] 为车道i的平均车速；
[0242] 是在车道i等待向车道i+1换道时的预估等待时间；
[0243] 是预估换道执行时间；
[0244] 如图2所示，根据现有技术文件《基于驾驶员行为的变道车辆行驶特征研究》中指出存在的三类换道驾驶风格，分别为冲动型、普通型和谨慎型，其对应的预估等待时间都是通过意图表征时窗确定的，此外，所述预估等待时间除了与驾驶员的驾驶风格相关以外，还有目标车道的密度相关，目标车道的密度越大，换道时机越难发现；
[0245] 故，预估等待时间 是通过以目标车道的密度作为横坐标，预估等待时间作为纵坐标，并结合驾驶员的换道驾驶风格的意图表征时窗确定的，所述意图表征时窗是驾驶员首次关注后视镜至方向盘转动的这段时间；
[0246] 步骤S5：判定当前是否处于强制换道目标车道；
[0247] 本步骤S5中，当前述步骤S2中判定DLCI为0，即不需要自由换道，或前述步骤S4中o判定DLCF为0，即换道动机不协调，当前车道条件不允许自由换道时，交通车Veh 需要对当前所处车道作出判定，当前所处车道的判定公式如下：
[0248]
[0249] 上述前所处车道的判定公式中：
[0250] MLJ(即Mandatory Lane Judge)为当前所处车道的判定结果；
[0251] 如果当前车道lo是强制换道目标车道lm，即MLJ＝1，则继续保持在当前车道不换道，并重新回到上述步骤S2，判断自由换道动机；
[0252] 如果当前车道lo不是强制换道目标车道lm，即MLJ＝0，则接下来进入下述步骤S6，通过计算换道紧迫指数，判定强制换道的紧迫性，进而判断是否需要做强制换道；
[0253] 步骤S6：判定强制换道紧迫性；
[0254] 本步骤S6中，当交通车Veho当前车道不属于强制换道目标车道时，需计算从交通o o J车Veh 所在车道l 到最近的强制换道目标车道 的换道紧迫指数urg ，计算公式具体如下：
[0255]
[0256]
[0257] 上述计算换道紧迫指数urgJ的公式中：
[0258] 是从当前车道lo换到最临近的强制换道目标车道 的预估纵向行驶距离；
[0259] s0是交通车Veho所在路段的剩余长度；
[0260] 为车道i的平均车速；
[0261] 是在车道i等待向车道i+1换道时的预估等待时间；
[0262] 是预估换道执行时间；
[0263] 本步骤S6中，根据换道紧迫指数urgJ判定强制换道紧迫性；
[0264] 判定强制换道紧迫性的公式具体如下：
[0265]
[0266] 上述判定强制换道紧迫性的公式中：
[0267] MLCF为强制换道紧迫性的判定结果；
[0268] 如果强制换道紧迫指数urgJ大于预设紧迫性阈值urgth，即MLCF＝1，此时判定需要紧急强制换道，则接下来进入下述步骤S7，，判定换道时机，以实现应尽快汇入强制换道目标车道
[0269] 如果强制换道紧迫指数urgJ小于紧迫性阈值urgth，即MLCF＝0，此时判定当前并非o紧急情况，不需要紧急强制换道，则此时可以继续保持在当前车道l不换道，接下来返回至上述步骤S2，重新判断自由换道动机；
[0270] 步骤S7：判定换道时机；
[0271] S71：确定所述交通车Veho的紧迫指数urgo和所述交通车Veho的目标车道lt；
[0272] 无论是自由换道，还是强制换道，当DLCF或MLCF判定为可以换道时，交通车Veho的o o t紧迫指数urg应该等于相应动机计算出的紧迫指数，交通车Veh的目标车道l 应该是相应动机所确定的目标车道；
[0273] 确定所述交通车Veho的紧迫指数urgo的公式如下：
[0274]
[0275] 交通车Veho的目标车道lt与当前车道lo可能是相邻车道，也可能隔着多个车道，交o t通车Veh每向l方向并入一个车道时，都需要找到合适的换道时机；
[0276] 所述确定所述交通车Veho的目标车道lt的公式如下：
[0277]
[0278] S72：确定时机评估指数；
[0279] 确定所述时机评估指数的公式为：
[0280]
[0281]
[0282] 上述时机评估指数LCIC的计算公式中：
[0283] LCIC是时机评估指数；
[0284] 是交通车Veho换到新车道的预期纵向加速度；
[0285] ao是当前交通车Veho的纵向加速度；
[0286] 交通车Vehn为交通车Veho将要汇入车道的后车；
[0287] 是在交通车Veho换到新车道时交通车Vehn的预期纵向加速度；
[0288] an是当前交通车Vehn的纵向加速度；
[0289] δo是交通车Veho的礼貌系数；o
[0290] 是交通车Veh初始礼貌系数；
[0291] urg是当前换道行为的紧迫指数；
[0292] 其中：
[0293] 交通车Veho的礼貌系数与其初始设定的驾驶风格，以及换道紧迫性有关；
[0294] 冲动型驾驶员初始礼貌系数 相对低一些，谨慎型驾驶员初始礼貌系数 相对高一些，而普通型驾驶员初始礼貌系数 介于二者之间；
[0295] 当换道紧迫指数urgo较低时，Veho驾驶员表现出谦让礼貌的行为，在换道时机的选n择上会顾及目标车道的后方交通车Veh的速度变化；
[0296] 当换道紧迫指数urgo较高时，交通车Veho执行换道的意愿更强烈，甚至可能无法顾n及后车Veh；
[0297] S73：作出换道时机的判定；
[0298] 机评估指数综合交通车、交通车换道前后的加速度变化，以及交通车自身的礼貌系数，作出换道时机的判定，换道时机判定公式具体如下：
[0299]
[0300] 上述换道时机判定公式中：
[0301] LCMP(Lane Changing Motion Planning)为换道时机判定结果；
[0302] LCIC(Lane Changing Incentive Criterion)为时机评估指数；
[0303] 当时机评估指数LCIC大于预设时机阈值LCICth时，LCMP为1，判定交通车Veho在这一时刻可以执行换道，则接下来进入下述步骤S8，规划换道轨迹；
[0304] 当时机评估指数LCIC小于预设时机阈值LCICth时，LCMP为0，判定交通车Veho当前还不能换道，需要继续等待换道时机；
[0305] 步骤S8：规划换道轨迹；
[0306] 当换道时机确定以后，交通车Veho需要规划换道轨迹，如图3所示，换道轨迹分为三个阶段：P0P1为换道准备阶段，P1P2为换道执行阶段，P2P3为换道结束阶段；
[0307] 此外，真实车辆的行驶轨迹并不总是沿着车道中心线，为了模拟这一现象，每辆交i i通车Veh都设置一个中心偏移均值 及标准差 且换道阶段点横向位置d满足均值为μofs，标准差为σofs的标准正态分布
[0308] S81:规划目标轨迹点；
[0309] (1)准备阶段
[0310] 准备阶段持续时间为1秒，交通车Veho通过调整车速以及与同车道前后车间的距o离，保证驶离时足够安全，不发生碰撞，如图3所示，P0是交通车Veh当前的位置，P1是当前车道驶离点；
[0311] 如图4所示，P1点在Frenet坐标系内纵坐标s1的位置是随机的，其取样的区间为其中：
[0312] 为纵坐标s1的下边界，它是由当前车道后车Vehr相对于交通车Veho的安全位o置 及交通车Veh减速行驶位置 二者间的最大值确定的；
o o
[0313] 为s1的上边界，它是由交通车Veh 加速行驶位置 及交通车Veh 相f
对于当前车道前车Veh的安全位置 二者间的最小值确定的；
[0314] 驶离点P1纵坐标s1的预取样点 符合均值为μ1，标准差为σ1的标准正态分布其中：
[0315]
[0316]
[0317]
[0318] 为了使s1的取值全部落在区间 内，还需要对取样后的结果 加以变化，确定P1点在Frenet坐标系内纵坐标s1的公式如下：
[0319]
[0320] 此外，需要说明的是：
[0321] 在本准备阶段，如果点P1的取样区间如果不存在，需要退出轨迹规划，重新返回换道时机判定，如果换道时机判断超时，应立刻结束并重新执行潜在自由换道目标车道判定；
[0322] (2)执行阶段
[0323] 执行阶段持续时间为2秒，执行阶段交通车Veho需要考虑自身的纵侧向运动能力，o′ f′ r′ o以及与新车道l 上前车Veh 和后车Veh 的安全距离，如图3所示，P1为原车道l的驶离点，o′
P2为新车道l 的驶入点；
[0324] 如图5所示，P2点在Frenet坐标系内纵坐标s2的位置是随机的，其取样的区间为其中：
[0325] 为纵坐标s2的下边界，它是由新车道lo′后车Vehr′相对于交通车Veho的安全o位置 及交通车Veh最大横摆极限位置 二者间的最大值确定的；
o
[0326] 为纵坐标s2的上边界，它是由交通车Veh 加速行驶位置 及交通车o o′ f′
Veh相对于新车道l 前车Veh 的安全位置 二者间的最小值确定的；
[0327] 驶离点P2纵坐标s2的预取样点 符合均值为μ2，标准差为σ2的标准正态分布其中：
[0328]
[0329]
[0330]
[0331] 为了使s2的取值全部落在区间 内，还需要对取样后的结果加以变化，确定P2点在Frenet坐标系内纵坐标s2的公式如下：
[0332]
[0333] 此外，需要说明的是：
[0334] 在本执行阶段，如果点P2的取样区间如果不存在，需要退出轨迹规划，重新返回换道时机判定，如果换道时机判断超时，应立刻结束并重新执行潜在自由换道目标车道判定；
[0335] (3)结束阶段
[0336] 结束阶段持续时间为1秒，结束阶段交通车Veho需要稳定车身姿态，调整车速以及o′ o o′与前后车的安全距离。如图3所示，P2为新车道l 的驶入点，P3是从车道l 至车道l 整个换道过程的结束位置；
[0337] 交通车Veho在达到P3点时车速应该与前车Vehf′一致，或达到当前车道的最高限速；
[0338] S82：生成连续轨迹；
[0339] 为了将前述步骤S81中已确定的目标点P0、P1、P2和P3平滑地连接起来形成轨迹，需o要计算目标点间的距离，以及相对于交通车Veh在起始点P0的航向角偏移；
[0340] 如图6所示，P1P2与P0P1间的夹角为α，P1P2与P2P3间的夹角为β，为了让规划的轨迹曲线更接近原始线型，在P1P2的中点增加一点Pm；
[0341] 记z0＝0，P0P1间距离为z1＝|P0P1|，P1Pm间距离为z2＝|P1Pm|，PmP2间距离为z3＝|PmP2|，P2P3间距离为z4＝|P2P3|；
[0342] 记φ0＝0，P1处相对航向角为 Pm处相对航向角为φ2＝α，P2处相对航向角为 P3处相对航向角为φ4＝α‑β；
[0343] 相应的P0点时间t0＝0，P1点时间t1＝1，Pm点时间t2＝2，P2点时间t3＝3，P3点时间t4＝4；
[0344] 规定P0点的速度z′0为当前交通车Veho的实际车速z′0＝vo，P0点的角速度φ′0＝0，o′ f′ f′P3点的速度z′4为新车道l 的前车Veh 的预估车速z′4＝v ，P3点的角速度φ′4＝0，[0345] 对(t,z)用三次样条曲线进行插值，固定边界分别为(t0,z′0)及(t4,z′4)；
[0346] 对(t,φ)用三次样条曲线进行插值，固定边界分别为(t0,φ′0)及(t4,φ′4)；
[0347] 至此，交通车Veho换道轨迹完成规划。
[0348] 尽管上面已经示出和描述了本发明的实施例，可以理解的是，上述实施例是示例性的，不能理解为对本发明的限制，本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
[0349] 以上所述本发明的具体实施方式，并不构成对本发明保护范围的限定。任何根据本发明的技术构思所作出的各种其他相应的改变与变形，均应包含在本发明权利要求的保护范围内。
