1.一种基于分布式模型预测控制的多车队列协同控制方法,其特征在于,包括如下步骤:构建多车队列系统及动力学模型,所述动力学模型包括系统状态向量、单个车辆的运动状态方程以及队列长度状态方程,多车队列系统包括由个车辆队列组成的多队列系统,每个车辆队列k包含辆车,队列k的车辆集合为:,系统中所有车辆的集合为,可表示为:;定义系统的状态向量为,其中、、和分别表示第k个队列的第i辆车在时刻t的位置、速度、加速度和驱动力或制动转矩;第k个队列的第i辆车的运动状态方程包括:;
,
;
其中,,分别表示第k个队列的第i辆车的状态和控制输入的权重矩阵,,,,分别表示第k个队列的第i辆车t时刻的状态,车辆质量,t时刻控制输入,纵向动力学的惯性滞后,表示轮胎半径、为传动系机械效率;
;
其中,表示领航车到队尾车辆之间的距离,,分别表示第k个队列的领航车、尾车的位置;
建立单向的通信拓扑结构,所述通信拓扑结构包括队列内部通信拓扑和队列间通信拓扑,队列内部通信拓扑包括以领航车为根节点的有向生成树,队列间通信拓扑包括以系统首队列领航车为根节点的有向生成树;
基于所述通信拓扑结构,定义车辆和队列的耦合约束,构建分布式模型预测控制优化问题及代价函数,所述分布式模型预测控制优化问题包括车辆节点局部优化问题、队列全局优化问题,以及整合所述车辆节点局部优化问题和所述队列全局优化问题的多目标优化问题;所述车辆节点局部优化问题用于对每一车辆节点,求解局部最优控制输入,所述队列全局优化问题用于对每一队列节点,利用所述多目标优化问题,求解队列间的协调控制输入;
为每个车辆节点求解优化控制问题,根据优化结果调整各车辆的控制输入和运动状态,以实现队列内部及队列间的协同控制。
2.如权利要求1所述的基于分布式模型预测控制的多车队列协同控制方法,其特征在于,所述构建多车队列系统及动力学模型,所述动力学模型包括系统状态向量、单个车辆的运动状态方程以及队列长度状态方程的步骤包括:定义车辆状态和车辆状态变量的更新规则,所述车辆状态变量包括位置、速度、加速度和扭矩,利用离散时间模型构建单个车辆的动力学方程;
定义队列长度为领航车与尾车之间的距离,并建立队列长度的动态变化方程。
3.如权利要求1所述的基于分布式模型预测控制的多车队列协同控制方法,其特征在于,所述车辆节点局部优化问题包括车辆局部代价函数和车辆约束条件,所述车辆约束条件包括车辆预测模型约束、初始预测状态等于时刻t实际状态约束、车辆状态约束、车辆控制输入约束、车辆位置约束和递归可行性和稳定性的约束。
4.如权利要求3所述的基于分布式模型预测控制的多车队列协同控制方法,其特征在于,所述车辆局部代价函数包括:;
式中:和分别表示车辆节点i在t时刻的预测状态和预测控制输入序列,表示车辆节点i在t时刻的假设状态;表示车辆节点i在t时刻的期望状态;表示车辆节点i的前车在t时刻的假设状态,表示车辆节点i和前车之间的距离;权重矩阵被设定为对称的非负定矩阵,分别表示控制状态误差、控制输入、假设状态误差和前车距离误差。
5.如权利要求1所述的基于分布式模型预测控制的多车队列协同控制方法,其特征在于,所述队列全局优化问题包括队列全局代价函数和队列约束条件,所述队列约束条件包括通信拓扑约束,队列位置约束和队列长度变化约束,所述通信拓扑约束用于约束领航车的状态更新依赖于通信拓扑定义的其他领航车的状态信息,确保领航车的行为受到通信图结构的限制,只能从通信拓扑中的邻居获取信息,所述队列位置约束用于针对队列领航车与尾车的位置轨迹设置,以确保满足队列间的空间约束。
6.如权利要求5所述的基于分布式模型预测控制的多车队列协同控制方法,其特征在于,所述队列全局代价函数包括:;
式中,表示领航车的预测状态序列;表示领航车的预测控制输入序列,表示k队列领航车的假设状态,表示k-1队列领航车的假设状态,表示k-1队列尾车的假设状态,表示k-1队列长度;表示车辆节点i在t时刻的期望状态,表示k队列领航车t时刻的期望状态;表示队列k领航车与前队列尾车的距离;被设定为对称的非负定矩阵,分别控制状态误差、控制输入、假设状态误差和前车距离误差,以确保车辆在队列中的稳定性与协调性。
7.如权利要求1所述的基于分布式模型预测控制的多车队列协同控制方法,其特征在于,所述根据优化结果调整各车辆的运动状态,运动状态包括位置、速度和加速度,以实现队列内部及队列间的协同控制的步骤包括:车辆状态、输入状态和队列长度初始化;
对每个队列,在预测时域内生成领航车的期望轨迹;
在每个时刻,为每个车辆节点求解优化控制问题,根据优化结果,获得最优控制输入序列,以实现队列内部及队列间的协同控制。
8.如权利要求1所述的基于分布式模型预测控制的多车队列协同控制方法,其特征在于,根据在每个时刻,为每个车辆节点求解优化控制问题,获得最优控制输入序列,以实现队列内部及队列间的协同控制的步骤,包括:在每个时刻不断循环的的队列状态更新步骤、节点状态更新步骤和信息交换与同步步骤,逐步更新所有队列和车辆节点的控制输入和状态,实现队列内部及队列间的协同控制;
所述队列状态更新步骤包括:更新领航车的状态序列以确保跟随期望轨迹;在预测时域内,根据最优控制输入序列,更新每个车辆的状态,并计算领航车的下一步假设输入序列并更新假设状态序列;
所述节点状态更新步骤包括:使用最优控制输入更新当前节点状态,在预测时域内,计算最优状态序列并更新节点状态,更新车辆的假设输入序列,基于假设输入序列预测假设状态序列;
信息交换与同步步骤包括:将队列领航车节点假设状态序列和假设输入序列发送给邻近领航车节点,将节点假设状态序列和假设输入序列发送给邻近跟随车节点,以实现信息共享。
9.如权利要求1所述的基于分布式模型预测控制的多车队列协同控制方法,其特征在于,所述建立单向的通信拓扑结构,所述通信拓扑结构包括队列内部通信拓扑和队列间通信拓扑,队列内部通信拓扑包括以领航车为根节点的有向生成树,队列间通信拓扑包括以系统首队列领航车为根节点的有向生成树的步骤之后,包括如下步骤:建立多个通信策略,所述通信策略包括领航车到领航车策略、领航车到尾车策略和领航车到尾车策略;所述领航车到领航车策略包括信息逐级通过队列领航车传递的通信方式,所述领航车到尾车策略包括领航车直接接收前一队列尾车的信息的通信方式,所述领航车到尾车策略包括允许领航车同时接收前一队列的领航车和尾车的信息的通信方式;
根据队列长度、响应速度和动态环境选择不同的通信策略。
10.一种基于分布式模型预测控制的多车队列协同控制介质,其特征在于,存储有可执行指令,所述可执行指令包含用于被执行时执行权利要求1-9中任一项所述的基于分布式模型预测控制的多车队列协同控制方法的程序代码。