网联汽车避障换道轨迹规划方法及系统

1.本发明涉及，具体地，涉及一种基于改进双五次多项式的网联汽车避障换道轨迹规划方法及系统。


背景技术：

2.车辆换道行为在日常生活中相当常见，同时车辆换道轨迹规划在adas(高级驾驶辅助系统，advanced driving assistance system)以及无人驾驶汽车研究中也是一个重要的组成部分。随着当前社会对自动驾驶汽车的广泛关注，以及自动驾驶研究的逐渐深入，车辆换道轨迹规划研究对行业以及社会的发展起到强大的推动作用。
3.多项式换道轨迹规划是目前研究车辆换道轨迹的常用手段，大量的研究表明，以五次多项式作为换道轨迹是相对合理的。然而面对避障换道的情况，普遍采用升高阶次的方法，此类方法的缺点是，计算过程更加复杂，解算时间提高，不利于实时规划。


技术实现要素：

4.针对现有技术中的缺陷，本发明的目的是提供一种基于改进双五次多项式的网联汽车避障换道轨迹规划方法及系统，采用双五次多项式的避障换道轨迹规划，不仅可以避免升高阶次的方法，并且将人工安全势场理论与其相结合，同时以侧向加速度边界确定中转状态，可以使得规划出的轨迹更加安全、舒适。
5.根据本发明提供的网联汽车避障换道轨迹规划方法，包括如下步骤：
6.步骤s1：获取主车的初始状态以及周围车辆的状态信息，根据所述状态信息确定换道主车的中转状态；
7.步骤s2：将主车的初始状态和中转状态作为输入，进行第一次轨迹规划；
8.步骤s3：判断所述第一次轨迹规划是否满足安全性和舒适性约束，且在满足所述安全性和舒适性约束时，根据所述第一次轨迹规划确定换道结束状态，否则返回步骤s2；
9.步骤s4：将主车的中转状态和所述换道结束状态作为输入，进行第二次轨迹规划；
10.步骤s5：判断所述第二次轨迹规划该轨迹是否满足安全性及舒适性约束，且在满足所述安全性和舒适性约束时，将第二次轨迹规划作为目标换道轨迹，否则返回步骤s4。
11.优选地，所述周围车辆的状态信息包括周围车辆的位置，航向角，速度以及加速度。
12.优选地，确定所述中转状态的方法包括：
13.首先根据前车的状态信息计算横向位移；
14.然后根据主车的侧向加速度边界以及主车的速度计算纵向位移，同时计算出初始换道时间。
15.优选地，所述第一次轨迹规划方法包括根据：
16.根据五次多项式时间矩阵和所述初始换道时间求得系数矩阵；
17.根据所述系数矩阵求出初始换道时间内任意时刻的五次多项式矩阵。
18.优选地，在判断所述第一次轨迹规划是否满足安全性和舒适性约束时的方法包括：
19.判断中转点是否满足以下不等式：
[0020][0021]
其中，δx表示主车与前车的距离，表示前车lv在临界势场取值下的后倾距离，表示主车fv在临界势场取值下的前倾距离；
[0022]
以及轨迹中任一点的侧向加速度以及侧向加加速度是否满足以下不等式：
[0023][0024][0025]
其中表示侧向加速度边界，表示侧向加加速度边界。
[0026]
优选地，所述的确定换道结束状态包括：
[0027]
在进入目标车道后无前方障碍车影响，则可将结束时的速度调整至理想速度使轨迹规划更加合理。
[0028]
优选地，所述的生成目标换道轨迹的方法包括：
[0029]
将所述第一次轨迹规划和所述第二次轨迹规划得到的状态向量序列拼接在一起，并对所述状态向量序列的速度突变点进行平滑处理，保证轨迹的安全性和可靠性。
[0030]
本发明提供的网联汽车避障换道轨迹规划系统，包括如下模块：
[0031]
中转状态确定模块，用于获取主车的初始状态以及周围车辆的状态信息，根据所述状态信息确定换道主车的中转状态；
[0032]
第一轨迹规划模块，用于将主车的初始状态和中转状态作为输入，进行第一次轨迹规划；
[0033]
第一规划判断模块，用于判断所述第一次轨迹规划是否满足安全性和舒适性约束，且在满足所述安全性和舒适性约束时，根据所述第一次轨迹规划确定换道结束状态，否则返回第一轨迹规划模块；
[0034]
第二轨迹规划模块：将主车的中转状态和所述换道结束状态作为输入，进行第二次轨迹规划；
[0035]
第二规划判断模块：判断所述第二次轨迹规划该轨迹是否满足安全性及舒适性约束，且在满足所述安全性和舒适性约束时，将第二次轨迹规划作为目标换道轨迹，否则返回第二轨迹规划模块。
[0036]
与现有技术相比，本发明具有如下的有益效果：
[0037]
本发明采用双五次多项式的避障换道轨迹规划，不仅可以避免升高阶次的方法，并且将人工安全势场理论与其相结合，同时以侧向加速度边界确定中转状态，可以使得规划出的轨迹更加安全、舒适；
[0038]
本发明计算得出的汽车轨迹规划可以有效地进行避障换道，并且曲线平滑，同时满足汽车换道的舒适性约束。
附图说明
[0039]
通过阅读参照以下附图对非限制性实施例所作的详细描述，本发明的其它特征、目的和优点将会变得更明显：
[0040]
图1为本发明一实施例中避障换道中转状态的示意图；
[0041]
图2为本发明一实施例中避障换道结束状态的示意图；
[0042]
图3为本发明一实施例中避障换道轨迹规划的流程图；
[0043]
图4为本发明一实施例中换道轨迹图；
[0044]
图5为本发明一实施例中规划轨迹横向速度随时间的变化图；
[0045]
图6为本发明一实施例中规划轨迹横向加速度随时间的变化图；以及
[0046]
图7为本发明一实施例中规划轨迹横向加加速度随时间的变化图。
具体实施方式
[0047]
下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明，但不以任何形式限制本发明。应当指出的是，对本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进。这些都属于本发明的保护范围。
[0048]
如图1所示，本发明提供一种网联汽车避障换道轨迹规划方法，包括如下步骤：
[0049]
步骤s1：获取主车的初始状态以及周围车辆的状态信息，根据状态信息确定换道主车的中转状态；
[0050]
所述周围车辆的状态信息包括周围车辆的位置，航向角，速度以及加速度。
[0051]
所述状态信息通过v2x技术获取，所述状态信息包括主车状态向量所述状态信息通过v2x技术获取，所述状态信息包括主车状态向量以及前车状态向量其中其中分别表示主车初始时刻的纵向位置、速度及加速度，分别表示主车初始时刻的横向位置、速度及加速度，分别表示前车初始时刻的纵向位置、速度及加速度，分别表示前车初始时刻的横向位置、速度及加速度。
[0052]
确定所述中转状态的方法包括：
[0053]
首先根据前车的状态信息计算横向位移；
[0054]
然后根据主车的侧向加速度边界以及主车的速度计算纵向位移，同时计算出初始换道时间。
[0055]
所述侧向加速度为垂直于主车航向方向的加速度
[0056]
利用汽车动力学原理，主车一次换道规划后的中转纵向位置的相应约束边界xr可由下式给出：
[0057][0058]
其中yf表示目标横向位移，其值可取汽车宽度；ui表示初始速度；表示侧向加速度边界。
[0059]
故主车中转状态向量可表示为
[0060]
第一次规划时间t1可根据下式计算：
[0061][0062]
步骤s2：将主车的初始状态和中转状态作为输入，进行第一次轨迹规划；
[0063]
所述第一次轨迹规划方法包括：
[0064]
根据五次多项式时间矩阵和所述初始换道时间求得系数矩阵；
[0065]
根据所述系数矩阵求出初始换道时间内任意时刻的五次多项式时间参数矩阵t。
[0066]
将主车初始状态向量和中转状态向量拼接得到纵向状态向量将主车初始状态向量和中转状态向量拼接得到纵向状态向量和横向状态向量五次多项式时间参数矩阵t表示如下：
[0067][0068]
系数矩阵a、b由下式计算：
[0069]
a＝t-1
x
[0070]
b＝t-1y[0071]
在求得系数矩阵a、b后，则任意时刻主车的状态向量都可求出，从而得到主车的轨迹。
[0072]
步骤s3：判断所述第一次轨迹规划是否满足安全性和舒适性约束，且在满足所述安全性和舒适性约束时，根据所述第一次轨迹规划确定换道结束状态，否则返回步骤s2；
[0073]
在判断所述第一次轨迹规划是否满足安全性和舒适性约束时的方法包括：
[0074]
利用基于人工安全势场理论的前倾距离和后倾距离判断中转点是否满足以下不等式：
[0075][0076]
其中，δx表示主车与前车的距离，表示前车lv在临界势场取值下的后倾距离，表示主车fv在临界势场取值下的前倾距离；
[0077]
在临界势场取值的主车前倾距离前车后倾距离为，
[0078][0079][0080]
其中，λ、β为待定参数，α为与速度相关的待定参数，τ为安全距离的临界阈值，目标
车辆i的等效质量mi由下式给出：
[0081]
mi＝mi(1.566
×
10-14v6.687
+0.3345)
[0082]
以及轨迹中任一点的侧向加速度以及侧向加加速度是否满足以下不等式：
[0083][0084][0085]
其中表示侧向加速度边界，表示侧向加加速度边界。
[0086]
所述的确定换道结束状态包括：
[0087]
在进入目标车道后无前方障碍车影响，则可将结束时的速度调整至理想速度使轨迹规划更加合理。
[0088]
由于完成第一次规划后无前方障碍车影响，则可根据具体情况考虑将结束时的速度调整至理想速度使轨迹规划更加合理，其中第二次换道完成时间t2由下式计算：
[0089][0090]
步骤s4：将主车的中转状态和所述结束状态作为输入，进行第二次轨迹规划；
[0091]
步骤s5：判断所述第二次轨迹规划该轨迹是否满足安全性及舒适性约束，且在满足所述安全性和舒适性约束时，将第二次轨迹规划作为目标换道轨迹，否则返回步骤s4。
[0092]
所述的生成目标换道轨迹的方法包括：
[0093]
将所述第一次轨迹规划和所述第二次轨迹规划得到的状态向量序列拼接在一起，并对所述状态向量序列的速度突变点进行平滑处理，保证轨迹的安全性和可靠性。
[0094]
以上对本发明的具体实施例进行了描述。需要理解的是，本发明并不局限于上述特定实施方式，本领域技术人员可以在权利要求的范围内做出各种变形或修改，这并不影响本发明的实质内容。