一种基于Frenet坐标系的CACC跟驰车流控制系统

一种基于frenet坐标系的cacc跟驰车流控制系统
技术领域
1.本发明涉及的是无人驾驶控制、车路协同技术领域，特别是涉及一种基于frenet坐标系的cacc跟驰车流控制系统。

背景技术：

2.车路协同环境下协同自适应巡航控制(cooperative adaptivecruise control，cacc)车辆具备信息互通共享、精确感知周围交通状态、稳定迅速的决策控制功能和特点。相比于普通车辆，cacc车辆能够实现以更小的车间时距跟车行驶。
3.目前针对cacc车辆跟驰状态的控制算法，使用的坐标系多是笛卡尔坐标系、里程计坐标系、极坐标系等。然而，这些算法实施的过程中，这些坐标系均有一定弊端：(1)基于全局坐标系的算法，轨迹信息受限于局部地图，采样的时效性和模型的拟合受轨迹长度的影响。(2)基于笛卡尔坐标系的算法，效率制约决策系统优化的瓶颈。(3)基于里程计坐标系的算法计算累计误差较大。
4.frenet坐标系，是使用表示沿道路距离的变量s和表示道路上左右位置的变量d来描述车辆在道路或参考路径上的位置。使用frenet坐标系描述车辆的运动轨迹，与车辆的绝对位置无关，仅与道路参考线的选取有关，模型拟合的计算成本会大幅下降，系统的效率和性能也会大幅提升。

技术实现要素：

5.本发明的目的在于使cacc车辆持续且高效地保持安全舒适的跟车状态，提供了一种基于frenet坐标系的cacc跟驰车流控制系统。
6.本发明的目的通过以下技术方案实现：一种基于frenet坐标系的cacc跟驰车流控制系统，包括如下步骤：
7.一种基于frenet坐标系的cacc跟驰车流控制系统，所述系统包括：
8.信息采集模块，所述信息采集模块采集前车和自身车辆的轨迹信息，所述信息采集模块将采集到的信息传输至轨迹变换模块；
9.轨迹变换模块，所述轨迹变换模块将轨迹信息根据笛卡尔坐标系向frenet坐标系转换，得到frenet坐标系下得轨迹信息；
10.控制模块，所述控制模块根据frenet坐标系下得轨迹信息控制调整自身车辆的运行状态，调整后的运行状态信息被信息采集模块不断循环采集，使自身车辆保持安全且舒适的跟驰状态。
11.进一步地，所述控制模块包括决策单元、上层控制器和下层控制器；所述决策单元根据安全距离模型，计算分析出自身车辆当前要保持安全且舒适的跟驰状态与前车所需维持的最小安全距离，并将此信息输入上层控制器；
12.所述上层控制器计算出自身车辆当前所需保持的速度、加速度轨迹信息，同时将所需保持的速度、加速度轨迹信息发送给下层控制器，所述下层控制器控制调整自身车辆
的运行状态。
13.进一步地，所述轨迹变换模块将轨迹信息根据笛卡尔坐标系向frenet坐标系转换具体为：
14.车辆轨迹在frenet坐标系和笛卡尔坐标系下的关系变换，在笛卡尔坐标系下，设p(x
p
，y
p
)是离轨迹点x(x
x
，yy)最近的点；则在frenet坐标系下，点p与点x的纵坐标相等；
15.cacc车辆的位置、速度轨迹信息输入轨迹转换模块，由笛卡尔坐标系向frenet坐标系转换通过下式表示：
16.s＝s
p
ꢀꢀꢀꢀ
(1)
[0017][0018][0019]d′
＝(1-dk
p
)tan(θ
x-θ
p
)
ꢀꢀꢀꢀ
(4)
[0020][0021]
其中，s为frenet坐标系下轨迹点x的纵向坐标，s
p
是frenet坐标系距离轨迹点x最近的一个点p的纵向坐标，为frenet坐标系下轨迹点x纵向坐标对时间的导数，表示车辆沿参考线方向的速度，为frenet坐标系下轨迹点x纵向坐标对时间的二阶导数，表示车辆沿参考线方向的加速度，d为frenet坐标系下轨迹点x的横向坐标，d
′
为frenet坐标系下轨迹点x横向坐标对纵向坐标的一阶导数，d
″
为frenet坐标系下轨迹点x横向坐标对纵向坐标的二阶导数，θ
x
是笛卡尔坐标系下轨迹点x的方位角，θ
p
是笛卡尔坐标系下点p的方位角，k
x
是笛卡尔坐标系下轨迹点x的曲率，k
p
是frenet坐标系下点p的曲率，υ
x
是笛卡尔坐标系下轨迹点x的速度，a
x
是笛卡尔坐标系下点x的加速度,k
p
′
是笛卡尔坐标系下点p的曲率k
p
的导数。
[0022]
进一步地，所述安全距离模型具体为：
[0023]
当前车静止时，最小安全距离sd表示为：
[0024][0025]
当前车运动时，最小安全距离sd表示为：
[0026][0027]
其中，分别表示frenet坐标系下当前自身车辆和前车纵向的速度，d
自身
、d
前车
分别表示frenet坐标系下当前自身车辆和前车的横向坐标，d
′
自身
表示frenet坐标系下当前自身车辆的横向坐标对纵向坐标的一阶导数；s
′
前车
表示frenet坐标系下当前前车
的横向坐标对纵向坐标的一阶导数；分别表示frenet坐标系下当前自身车辆和前车的曲率。
[0028]
进一步地，上层控制器利用输入的前车位置、距离、车速、以及加速度轨迹信息，通过决策算法得到车辆的目标速度及加速度；
[0029]
下层控制器根据上层控制器得出的目标速度及加速度控制轮毂电机扭矩及轮速以实现自身车辆的驱动和制动控制，从而达到上层控制期望的目标控制。
[0030]
有益效果：
[0031]
本发明提出了一种基于frenet坐标系的cacc跟驰车流控制系统。本发明将车辆轨迹的frenet坐标系转换模块嵌套进cacc跟驰控制系统。本发明适用于cacc车辆在人机混合交通流、人工驾驶交通流等多种交通条件下的跟驰状态控制情景，能提高计算效率和减少道路曲率的影响，使cacc车辆持续且高效地保持安全舒适的跟车状态。
附图说明
[0032]
图1为本发明系统整体结构示意图；
[0033]
图2为系统启动流程示意图；
[0034]
图3为车辆轨迹在frenet坐标系和笛卡尔坐标系下的关系示意图；
[0035]
图4为控制模块运行流程示意图。
具体实施方式
[0036]
下面将结合本发明实施例中的附图对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
[0037]
结合图1至图4，本发明提供一种基于frenet坐标系的cacc跟驰车流控制系统，所述系统包括：
[0038]
信息采集模块，所述信息采集模块采集前车和自身车辆的轨迹信息，所述信息采集模块将采集到的信息传输至轨迹变换模块；
[0039]
轨迹变换模块，所述轨迹变换模块将轨迹信息根据笛卡尔坐标系向frenet坐标系转换，得到frenet坐标系下得轨迹信息；
[0040]
控制模块，所述控制模块根据frenet坐标系下得轨迹信息控制调整自身车辆的运行状态，调整后的运行状态信息被信息采集模块不断循环采集，使自身车辆保持安全且舒适的跟驰状态。
[0041]
本发明提出了一种基于frenet坐标系的cacc跟驰车流控制系统，该系统能准确且高效的解决cacc车辆在多种交通场景和条件下跟车状态的控制决策问题，帮助cacc车辆自动安全的完成驾驶任务；
[0042]
本发明采用frenet坐标系作为工作坐标系，在驾驶行为模型的计算中，显著优越于其他坐标系。其减少了道路曲率对轨迹运算优化的影响，简化决策模型的计算过程，提高了模型效率，最终得到的决策结果更加安全、舒适、高效。
[0043]
本发明的跟驰策略基于cacc控制系统，能显著提高人机混合车队队列的稳定性和安全性，降低追尾碰撞的风险、车辆油耗和排放水平。
[0044]
所述控制模块包括决策单元、上层控制器和下层控制器；所述决策单元根据安全距离模型，计算分析出自身车辆当前要保持安全且舒适的跟驰状态与前车所需维持的最小安全距离，并将此信息输入上层控制器；
[0045]
所述上层控制器计算出自身车辆当前所需保持的速度、加速度轨迹信息，同时将所需保持的速度、加速度轨迹信息发送给下层控制器，所述下层控制器控制调整自身车辆的运行状态。
[0046]
所述轨迹变换模块将轨迹信息根据笛卡尔坐标系向frenet坐标系转换具体为：
[0047]
车辆轨迹在frenet坐标系和笛卡尔坐标系下的关系变换，在笛卡尔坐标系下，设p(x
p
，y
p
)是离轨迹点x(x
x
，xy)最近的点；则在frenet坐标系下，点p与点x的纵坐标相等；
[0048]
cacc车辆的位置、速度轨迹信息输入轨迹转换模块，由笛卡尔坐标系向frenet坐标系转换通过下式表示：
[0049]
s＝s
p
ꢀꢀꢀꢀ
(1)
[0050][0051][0052]d′
＝(1-dk
p
)tan(θ
x-θ
p
)
ꢀꢀꢀ
(4)
[0053][0054]
其中，s为frenet坐标系下轨迹点x的纵向坐标，s
p
是frenet坐标系距离轨迹点x最近的一个点p的纵向坐标，为frenet坐标系下轨迹点x纵向坐标对时间的导数，表示车辆沿参考线方向的速度，为frenet坐标系下轨迹点x纵向坐标对时间的二阶导数，表示车辆沿参考线方向的加速度，d为frenet坐标系下轨迹点x的横向坐标，d
′
为frenet坐标系下轨迹点x横向坐标对纵向坐标的一阶导数，d
″
为frenet坐标系下轨迹点x横向坐标对纵向坐标的二阶导数，θ
x
是笛卡尔坐标系下轨迹点x的方位角，θ
p
是笛卡尔坐标系下点p的方位角，k
x
是笛卡尔坐标系下轨迹点x的曲率，k
p
是frenet坐标系下点p的曲率，υ
x
是笛卡尔坐标系下轨迹点x的速度，a
x
是笛卡尔坐标系下点x的加速度,k
p
是笛卡尔坐标系下点p的曲率k
p
的导数。
[0055]
所述安全距离模型具体为：
[0056]
当前车静止时，最小安全距离sd表示为：
[0057][0058]
当前车运动时，最小安全距离sd表示为：
[0059][0060]
其中，分别表示frenet坐标系下当前自身车辆和前车纵向的速度，d
自身
、d
前车
分别表示frenet坐标系下当前自身车辆和前车的横向坐标，d
′
自身
表示frenet坐标系下当前自身车辆的横向坐标对纵向坐标的一阶导数；d
′
前车
表示frenet坐标系下当前前车的横向坐标对纵向坐标的一阶导数；分别表示frenet坐标系下当前自身车辆和前车的曲率。
[0061]
上层控制器利用输入的前车位置、距离、车速、以及加速度轨迹信息，通过决策算法得到车辆的目标速度及加速度；
[0062]
下层控制器根据上层控制器得出的目标速度及加速度控制轮毂电机扭矩及轮速以实现自身车辆的驱动和制动控制，从而达到上层控制期望的目标控制。
[0063]
具体实施例二：
[0064]
本发明系统的整体结构如图1所示。首先，由各种各样的传感器组成的信息采集模块不断地采集自身车辆和前车的位置、距离、车速、加速度等轨迹信息，并将这些信息传入轨迹变换模块。轨迹变换模块根据笛卡尔坐标系向frenet坐标系转换的公式，将这些笛卡尔坐标系下的轨迹信息转换为frenet坐标系下的轨迹信息。同时，转换后的轨迹信息将输入控制模块的决策单元。决策单元根据安全距离模型，计算分析出自身车辆当前要保持安全且舒适的跟驰状态与前车所需维持的最小安全距离，并将此信息输入上层控制器。然后，上层控制器计算出自身车辆当前所需保持的速度、加速度等轨迹信息，同时将此轨迹信息发送给下层控制器。下层控制器据此控制调整自身车辆的运行状态。调整后的运行状态信息又将被信息采集模块采集，照此模式不断循环。最终使自身车辆一直保持安全且舒适的跟驰状态。
[0065]
本发明系统由cacc控制系统控制启动，启动流程如图2所示。首先车辆启动，初始状态信息将输入该系统，同时系统将检查车辆的自适应巡航控制(adaptive cruise control,acc)功能是否正常，如果正常，继续检查cacc系统，否则进入人工驾驶状态。当cacc系统功能正常时，车辆将进入cacc控制状态。此时意味着前车识别功能正常，基于frenet坐标系的cacc跟驰车流控制系统各模块将能正常运行，于是启动该系统。否则车辆进入acc控制状态，不启动该系统。
[0066]
本发明系统控制模块中的决策单元是计算出，当前自身车辆想维持安全且舒适的跟驰状态，与前车需保持的最小安全距离。考虑因素包括：前方出现紧急情况时,自身车辆与前车保持的距离要足够驾驶员识别和反应的时间；自身车辆与前车保持的距离要足够驾驶员根据自身期望减速度消除自身车辆车与前车间相对速度的时间；相对速度消除后，自身车辆与前车间仍要保持一定的距离。
[0067]
以上对本发明所提供的一种基于frenet坐标系的cacc跟驰车流控制系统，进行了详细介绍，本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依
据本发明的思想，在具体实施方式及应用范围上均会有改变之处，综上所述，本说明书内容不应理解为对本发明的限制。

技术特征：

1.一种基于frenet坐标系的cacc跟驰车流控制系统，其特征在于，所述系统包括：信息采集模块，所述信息采集模块采集前车和自身车辆的轨迹信息，所述信息采集模块将采集到的信息传输至轨迹变换模块；轨迹变换模块，所述轨迹变换模块将轨迹信息根据笛卡尔坐标系向frenet坐标系转换，得到frenet坐标系下得轨迹信息；控制模块，所述控制模块根据frenet坐标系下得轨迹信息控制调整自身车辆的运行状态，调整后的运行状态信息被信息采集模块不断循环采集，使自身车辆保持安全且舒适的跟驰状态。2.根据权利要求1所述的一种基于frenet坐标系的cacc跟驰车流控制系统，其特征在于，所述控制模块包括决策单元、上层控制器和下层控制器；所述决策单元根据安全距离模型，计算分析出自身车辆当前要保持安全且舒适的跟驰状态与前车所需维持的最小安全距离，并将此信息输入上层控制器；所述上层控制器计算出自身车辆当前所需保持的速度、加速度轨迹信息，同时将所需保持的速度、加速度轨迹信息发送给下层控制器，所述下层控制器控制调整自身车辆的运行状态。3.根据权利要求2所述的一种基于frenet坐标系的cacc跟驰车流控制系统，其特征在于，所述轨迹变换模块将轨迹信息根据笛卡尔坐标系向frenet坐标系转换具体为：车辆轨迹在frenet坐标系和笛卡尔坐标系下的关系变换，在笛卡尔坐标系下，设p(x
p
，y
p
)是离轨迹点x(x
x
，y
y
)最近的点；则在frenet坐标系下，点p与点x的纵坐标相等；cacc车辆的位置、速度轨迹信息输入轨迹转换模块，由笛卡尔坐标系向frenet坐标系转换通过下式表示：s＝s
p
ꢀꢀꢀꢀ
(1)(1)d
′
＝(1-dk
p
)tan(θ
x-θ
p
)
ꢀꢀ
(4)其中，s为frenet坐标系下轨迹点x的纵向坐标，s
p
是frenet坐标系距离轨迹点x最近的一个点p的纵向坐标，为frenet坐标系下轨迹点x纵向坐标对时间的导数，表示车辆沿参考线方向的速度，为frenet坐标系下轨迹点x纵向坐标对时间的二阶导数，表示车辆沿参考线方向的加速度，d为frenet坐标系下轨迹点x的横向坐标，d
′
为frenet坐标系下轨迹点x横向坐标对纵向坐标的一阶导数，d
″
为frenet坐标系下轨迹点x横向坐标对纵向坐标的二阶导数，θ
x
是笛卡尔坐标系下轨迹点x的方位角，θ
p
是笛卡尔坐标系下点p的方位角，k
x
是笛卡尔坐标系下轨迹点x的曲率，k
p
是frenet坐标系下点p的曲率，υ
x
是笛卡尔坐标系下轨迹点x的速度，a
x
是笛卡尔坐标系下点x的加速度，k
p
是笛卡尔坐标系下点p的曲率k
p
的导数。
4.根据权利要求2或3所述的一种基于frenet坐标系的cacc跟驰车流控制系统，其特征在于，所述安全距离模型具体为：当前车静止时，最小安全距离s
d
表示为：当前车运动时，最小安全距离s
d
表示为：其中，分别表示frenet坐标系下当前自身车辆和前车纵向的速度，d
自身
、d
前车
分别表示frenet坐标系下当前自身车辆和前车的横向坐标，d
′
自身
表示frenet坐标系下当前自身车辆的横向坐标对纵向坐标的一阶导数；d
′
前车
表示frenet坐标系下当前前车的横向坐标对纵向坐标的一阶导数；分别表示frenet坐标系下当前自身车辆和前车的曲率。5.根据权利要求4所述的一种基于frenet坐标系的cacc跟驰车流控制系统，其特征在于，上层控制器利用输入的前车位置、距离、车速、以及加速度轨迹信息，通过决策算法得到车辆的目标速度及加速度；下层控制器根据上层控制器得出的目标速度及加速度控制轮毂电机扭矩及轮速以实现自身车辆的驱动和制动控制，从而达到上层控制期望的目标控制。

技术总结

本发明提供一种基于Frenet坐标系的CACC跟驰车流控制系统，本发明涉及的是无人驾驶控制、车路协同技术领域，本发明不断地采集自身车辆和前车的位置、距离、车速、加速度等轨迹信息，轨迹变换模块根据笛卡尔坐标系向Frenet坐标系转换，转换后的轨迹信息将输入控制模块的决策单元计算分析出自身车辆当前要保持安全且舒适的跟驰状态与前车所需维持的最小安全距离，下层控制器据此控制调整自身车辆的运行状态。调整后的运行状态信息又将被信息采集模块采集，使自身车辆一直保持安全且舒适的跟驰状态。本发明能准确且高效的解决CACC车辆在多种交通场景和条件下跟车状态的控制决策问题，帮助CACC车辆自动安全的完成驾驶任务。帮助CACC车辆自动安全的完成驾驶任务。帮助CACC车辆自动安全的完成驾驶任务。