[发明专利]基于可变阶数曲线的高速匝道车辆控制方法

说明书

本申请公开了一种基于可变阶数曲线的高速匝道车辆控制方法及系统,是基于实际行车工况中，当驾驶员从匝道向左变道进入主路的过程中的车辆形式轨迹，设计出的基于可变阶数曲线的高速匝道车辆控制方法。本申请通过函数算法减少运算时间和提高性能。

技术领域

本申请涉及车辆控制领域，具体涉及一种基于可变阶数的车辆控制方法。

背景技术

目前各大厂商在不断优化汽车结构和应用高强度材料提高汽车被动安全的同时，依靠技术不断迭代升级的高级驾驶辅助系统(ADAS)正在发挥着强大的作用。ADAS系统可以在紧急情况下警示驾驶员或者主动采取必要的安全措施，这在很大程度上可以降低交通事故发生的机率和严重程度。ADAS系统通过综合利用各种车载传感器获取环境信息，通过对原始传感器信息处理，提取一些有意义的、抽象的、精简的信息，达到环境感知，收集数据、识别跟踪各种动态和静态物体的目的。在获取环境信息后，通过将信息传递到ECU，进而实现下游的决策规划过程，解决复杂交通场景下本车与其他交通参与者的动态博弈问题。

关于合作车队行驶的一个重要研究课题是在高速匝道上将车辆合并成一个车队队列，其需要应对高速主路与本车的初始位置和速度的巨大差异、传感器噪声以及由排长引起的干扰。需要设计相应的算法，控制车队、新车的状态转换，选择合适的控制算法，达到匝道车辆合并进入高速主路车队的目的。匝道上单车与车队的合并控制策略，有基于集中控制和分散控制器。在集中式方法中，单个控制器全局地为所有车辆决定至少一个任务。在分散策略中，每个车辆根据关于其他车辆的沟通信息来确定自己的控制策略。

对于要进入主路，即正在匝道上行驶的车辆，其存在一个重大的问题，即其速度、位姿、道路限速等均与高速主路车辆存在较大差异。对于部分研究者，其将车辆合并进入主路的位置点，一般视为常量，然后将问题转化为：控制车辆在指定的时间点达成指定的车辆状态。解决这个问题的一个流行的方法是模型预测控制(MPC)方法，但其存在预测步长过大时计算复杂度大，无法满足实时规划的要求。

对此，部分研究者放弃将全局时间域离散化的方法，转而使用参数化的曲线进行拟合，虽然此方法得到的曲线一般都是次优的，但可以在一定程度上解决时间复杂度的问题。但是，基于参数化曲线的方法,无法兼顾曲线的性能最优与计算最快的特点。

发明内容

本申请的主要目的在于提供一种基于可变阶数曲线的高速匝道车辆控制方法，以解决现有控制方法计算过于复杂，无法兼顾计算速度以及性能的问题。

为了实现上述目的，本申请提供了一种基于可变阶数曲线的高速匝道车辆控制方法。

根据本申请的基于可变阶数曲线的高速匝道车辆控制方法包括：

步骤1：确定车辆的初始位置q₀，初始速度v₀，初始加速度a₀以及初始加加速度j₀；

步骤2：确定车辆到达的合并点时的位置q_mp，以及到达合并点mp时的速度v_mp，加速度a_mp以及加加速度j_mp；

步骤3：车辆的初始期望状态x₀，到达合并点mp的状态x_mp；根据如下公式1计算得到x₀、x_mp：

步骤4：设初始时刻为t₀，到达合并点mp的时刻为t_mp，按照如下公式2求解函数为f(t)：

步骤5:当选择性能为舒适性时,代价函数为：

舒适性的代价函数为

其中，