CN113791615A - 一种混合车辆队列分布式模型预测控制方法 - Google Patents

一种混合车辆队列分布式模型预测控制方法 Download PDF

Info

Publication number
CN113791615A
CN113791615A CN202110958481.7A CN202110958481A CN113791615A CN 113791615 A CN113791615 A CN 113791615A CN 202110958481 A CN202110958481 A CN 202110958481A CN 113791615 A CN113791615 A CN 113791615A
Authority
CN
China
Prior art keywords
vehicle
queue
hybrid
local
automatic driving
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202110958481.7A
Other languages
English (en)
Inventor
张利国
花桢
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing University of Technology
Original Assignee
Beijing University of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing University of Technology filed Critical Beijing University of Technology
Priority to CN202110958481.7A priority Critical patent/CN113791615A/zh
Publication of CN113791615A publication Critical patent/CN113791615A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
    • G05D1/0291—Fleet control
    • G05D1/0295—Fleet control by at least one leading vehicle of the fleet
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/09—Arrangements for giving variable traffic instructions
    • G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0967—Systems involving transmission of highway information, e.g. weather, speed limits
    • G08G1/096708—Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control
    • G08G1/096725—Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control where the received information generates an automatic action on the vehicle control
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/20—Monitoring the location of vehicles belonging to a group, e.g. fleet of vehicles, countable or determined number of vehicles
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/22—Platooning, i.e. convoy of communicating vehicles

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Atmospheric Sciences (AREA)
  • Hybrid Electric Vehicles (AREA)

Abstract

本发明公开了一种混合车辆队列分布式模型预测控制方法，首先将混合车辆队列划分为多个相互关联的局部混合车辆队列；然后基于网联自动驾驶车辆和人类驾驶车辆的跟驰模型，建立各个局部混合队列的模型；其次，基于局部混合队列模型，根据模型预测控制算法，建立混合车辆队列整体的控制问题；最后，结合交替方向乘子法，为各个局部混合队列构建分布式模型预测控制器，实现混合车辆队列整体的编队控制。通过在MATLAB仿真平台上进行实验，验证了所提方法的有效性。实验结果表明，本发明可以保证混合车辆队列中网联自动驾驶车辆和人类驾驶车辆达到良好的编队效果，同时网联自动驾驶车辆能以较小的车间距离编队行驶，有效提高了交通容量。

Description

一种混合车辆队列分布式模型预测控制方法
技术领域
本发明涉及自动驾驶领域、混合车辆编队领域、车联网领域，具体涉及一种基于交替方向乘子法的混合车辆队列分布式模型预测控制方法。用于实现包含了人类驾驶车辆和网联自动驾驶车辆的混合车辆队列的编队控制，提高交通容量、降低资源消耗。
背景技术
随着自动驾驶技术的发展，网联自动驾驶车辆在高速公路上编队行驶引起了研究人员的广泛关注。多车协同编队控制为保证出行安全、提高交通容量和减少燃料消耗提供了一个新的解决思路和途径。车辆编队旨在确保同一组中的所有车辆以一个共同速度行进，同时保证相邻车辆之间保持期望的车间距离。然而在真实的交通环境中，完全采用网联自动驾驶车辆进行编队控制是不现实的，因为当今世界由人类驾驶员控制的传统汽车的保有量仍然在不断攀升。在未来较长一段时间内，将会出现人类驾驶车辆和网联自动驾驶车辆共存的混合车辆队列系统。虽然随着车联网技术的发展，未来混合车辆队列中的人类驾驶车辆可以利用车辆到车辆(V2V)等无线通信技术向队列中的网联自动驾驶车辆共享自身的状态信息，并且混合车辆队列中的网联自动驾驶车辆既是信息接收端，也能向其他网联自动驾驶车辆发送信息。但是，这种人类驾驶车辆和网联自动驾驶车辆随机混合的交通环境仍然给车辆队列的建模和控制带来了巨大挑战。
针对上述问题，国内外学者已经开展了大量的研究。Ge等人通过分析混合车辆队列中人类驾驶车辆和网联自动驾驶车辆在非紧急状态下的跟车行为，针对一个只有一辆网联自动驾驶车辆在队尾跟驰的混合车辆队列进行建模。而Huang等人则考虑了混合车辆队列中存在多辆网联自动驾驶车辆的情况，同时考虑了人类驾驶车辆和网联自动驾驶车辆的跟驰动态差异性，并分别采用最优速度模型和简化的运动学模型描述人类驾驶车辆和网联自动驾驶车辆的行为，在此基础上建立了一个适用于固定车辆数目和车辆排序的混合车辆队列模型。在上述研究中，混合车辆队列中的人类驾驶车辆和网联自动驾驶车辆均采用了不同的跟驰模型，这能够很好地反映混合车辆队列中不同车辆的动态。但是，上述模型仅适用于固定车辆排序或者同时固定车辆数目和车辆排序的混合车辆队列,而不是人类驾驶车辆和网联自动驾驶车辆随机混合的车辆队列。
混合车辆队列编队控制的目的是通过设计车辆队列纵向运动控制系统，使队列中的车辆在保持设定的车间距离的同时以一个共同的速度行驶。常见的控制方法包括PID控制、滑模控制、模糊控制以及结合了强化学习、人工神经网络等方法的智能控制方法等。Chirs等人基于网联自动驾驶车辆在队列中行驶的状态设计了油门及制动的非线性PID控制器，对车辆加速和制动进行控制。然而，控制过程中PID参数的选取十分依赖已有的跟驰数据。Gao等人针对网联自动驾驶车辆的编队控制问题，提出了一种基于数据的自适应动态规划最优控制算法。该算法虽然不依赖于具体的车辆动力学模型，但是也需要大量的车辆运动数据。更重要的是，上述提到的控制方法均无法处理车辆运动过程中的控制量约束和状态量约束。为此，部分学者将模型预测控制应用于网联自动驾驶车辆的巡航控制。
模型预测控制通过预测系统动态，优化给定的目标，处理执行器、状态约束以及扰动，从而实现对网联自动驾驶车辆的有效控制。Wu等人设计了一个包含制动和加速延迟的模型预测控制器，保证了自动驾驶车辆即使在有限的传感器范围下，也能达到良好的编队效果。Maxim等人在车辆间能够进行无延迟通信的情况下，采用分布式模型预测控制算法保证车队中的每辆车都能遵循预设的位置轨迹，并且比较了通过求解无约束优化问题和通过求解增加了控制变量增量约束的优化问题的控制器的控制效果，结果表明后者有明显的性能改进。Lan等人在存在车辆间通信延迟和现实约束的情况下，提出了一种分布式的最小-最大模型预测控制算法，保证了领导者-跟随者的串稳定性。所提出的控制算法还减少了通信负担，因为队列中的每辆车仅需要将其当前加速度传输给相邻的跟随车辆。尽管上述的分布式模型预测控制器在改善交通流编队控制效果、提高道路安全性等方面取得了一定的成果，但是都是利用车辆队列中部分的车辆信息进行设计，而不是从车辆队列整体的控制目标出发进行设计。混合车辆队列是一个复杂系统，车辆间存在着密切地相互作用关系，所以有必要开发一种考虑了混合车辆队列整体的控制指标的分布式模型预测控制器。
考虑以上因素，本发明做出了以下改进：首先，提出了一种新型的混合车辆队列模型，与Ge等人和Huang等人提出的模型不同，这种新型的混合车辆队列模型可以用来描述网联自动驾驶车辆和人类驾驶车辆随机混合的情况，而不需要预先定义混合车辆队列的车辆数目或车辆排序；其次，通过引入交替方向乘子法，在混合车辆队列整体的控制目标而不是各局部混合队列的控制目标下，完成了各局部混合队列的分布式模型预测控制器的设计，实现了混合车辆队列整体的编队控制。
发明内容
本发明提出了一种混合车辆队列分布式模型预测控制方法。该方法基于交替方向乘子法和模型预测控制算法，通过为混合车辆队列中的网联自动驾驶车辆设计分布式模型预测控制器，在混合车辆队列整体的控制目标下，有效地实现了混合车辆队列的分布式编队控制，提高了交通容量。具体实现步骤如下：
步骤1、划分混合车辆队列为多个相互关联的局部混合车辆队列
在真实的交通环境下，混合车辆队列中网联自动驾驶车辆和人类驾驶车辆随机混合。根据网联自动驾驶车辆在混合车辆队列中的位置，可以将混合车辆队列划分为多个相互关联的局部混合车辆队列。每一个局部混合车辆队列中最多包含两辆网联自动驾驶车辆，它们分别是局部混合队列的头车和尾车。但是，如果混合车辆队列的头车和尾车是人类驾驶车辆，那么混合车辆队列头部和尾部的局部混合队列中就只包含一辆网联自动驾驶车辆。局部混合队列的相互关联性体现在，相邻的两个局部混合队列会覆盖同一辆网联自动驾驶车辆。
步骤2、建立局部混合队列模型
在混合车辆队列中，人类驾驶车辆是驾驶员依据驾驶经验对车辆进行控制，而网联自动驾驶车辆则由本发明所设计的分布式模型预测控制器控制。所以在建立局部混合队列模型之前，需要先建立非紧急情况下的网联自动驾驶车辆和人类驾驶车辆的跟驰动态模型。
(1)建立人类驾驶车辆跟驰动态模型
在本发明中，人类驾驶车辆跟驰动态行为可由智能驾驶员模型进行描述，该模型表达式为：
Figure BDA0003221244300000031
Figure BDA0003221244300000032
其中，vj表示车辆#j的当前速度；hj表示车辆#j的当前跟车间距；a表示车辆的最大加速度，b表示车辆的舒适减速度；v0表示自由流速度；s0表示最小跟车间距；Tj表示车辆#j的最小跟车时距；l表示车辆#(j-1)的车长。通过调节上述参数可以表示不同人类驾驶车辆跟驰动态的差异性。
当混合车辆队列达到平衡状态时，所有车辆的速度应该都趋于期望速度v*，结合式(1)，可得到人类驾驶车辆的平衡跟车间距
Figure BDA0003221244300000041
所述的
Figure BDA0003221244300000042
的表达式为：
Figure BDA0003221244300000043
在系统平衡点
Figure BDA0003221244300000044
附近，定义关于跟车间距和跟车速度的微小误差Δhj和Δvj，其中，Δvj＝vj-v*，
Figure BDA0003221244300000045
进一步，在
Figure BDA0003221244300000046
附近对式(1)进行泰勒展开，忽略高阶项，可以得到人类驾驶车辆关于误差的线性跟驰动态模型，其表达式如下式所示：
Figure BDA0003221244300000047
其中，
Figure BDA0003221244300000048
(2)建立网联自动驾驶车辆跟驰动态模型
在本发明中，网联自动驾驶车辆的跟驰动态模型表达式为：
Figure BDA0003221244300000049
Figure BDA00032212443000000410
其中，uj表示网联自动驾驶车辆#j的控制输入。
为了提高网联自动驾驶车辆以不同速度行驶时的安全性，本发明中的网联自动驾驶车辆采用了恒定车头时距的间距政策，所以网联自动驾驶车辆的期望跟车间距
Figure BDA00032212443000000411
的表达式为：
Figure BDA00032212443000000412
其中，τj表示网联自动驾驶车辆#j的固定车头时距；
Figure BDA00032212443000000413
表示其最小跟车间距。不同网联自动驾驶车辆的模型参数也可以不相同，这样设定更加符合实际混合车辆队列中车辆随机混合的情况。
参考人类驾驶车辆跟驰动态模型的线性化过程，可以得到网联自动驾驶车辆关于误差的线性跟驰动态模型，其表达式如下式所示：
Figure BDA0003221244300000051
(3)建立局部混合队列模型
假设混合车辆队列中第i个局部混合队列的覆盖范围是从车辆#(j+1)到#(j+n)，令xj＝[Δhj Δvj]T，基于公式(3)和(6)，可以建立该局部混合队列模型，其表达式如下式所示：
Figure BDA0003221244300000052
这里j∈HDV意味着车辆#j是人类驾驶车辆，j∈CAV意味着车辆#j是网联自动驾驶车辆。其中，
Figure BDA0003221244300000053
综上可知，公式(7)的具体表达式和局部混合队列中具体车辆数目，车辆排序以及车辆模型参数有关，所以公式(7)和(8)可用于描述混合车辆队列中任一局部混合队列动态。
步骤3、建立混合车辆队列控制问题
在本发明中，我们期望通过调控网联自动驾驶车辆的驾驶行为来实现混合车辆队列整体的编队控制。所以，混合车辆队列中的车辆至少应该考虑以下性能指标：
①混合车辆队列中每辆车的速度和期望速度v*间的误差尽可能小；
②混合车辆队列中每辆车的跟车间距和期望跟车间距
Figure BDA0003221244300000054
间的误差尽可能小；
③混合车辆队列中的网联自动驾驶车辆在驾驶过程中的燃料消耗尽可能小；
同时还需要考虑以下约束：要时刻保证混合车辆队列中的网联自动驾驶车辆在驾驶过程中的跟车安全性。
在上述性能指标和约束下，下面将使用步骤2所述的局部混合队列模型建立混合车辆队列整体的优化问题。
将公式(7)和(8)离散化，可得到局部混合队列#i的预测模型表达式：
Figure BDA0003221244300000061
其中，A＝TAc+I；Bu＝TBcu；Bd＝TBcd；这里T表示采样间隔；I表示维度为2n的单位矩阵。
根据模型预测控制原理，设定预测时域为p，控制时域为m，并满足m＝p。设定当前时刻为k，以k时刻为预测点基于预测模型(9)建立局部混合队列#i在p时域内的预测输出方程，其表达式如下式所示：
Figure BDA0003221244300000062
其中，
Figure BDA0003221244300000063
假设局部混合队列#i中有q辆网联自动驾驶车辆，每辆网联自动驾驶车辆应该满足控制量约束umin≤uj(k+β|k)≤umax,β＝0,…,m-1和状态量约束ymin≤yj(k+α|k)≤ymax,α＝1,…,p，则
Figure BDA0003221244300000064
应该满足下列关系式：
Figure BDA0003221244300000065
其中，
Figure BDA0003221244300000066
表示克罗内克积，如果A是一个a×b的矩阵，而B是一个c×d的矩阵，
Figure BDA0003221244300000067
则是一个ac×bd的矩阵；ones(qm,1)是一个qm×1的全1矩阵。
为了将状态量约束也转化成可处理的形式，可令局部混合队列#i中的人类驾驶车辆满足状态量约束-inf≤yj(k+α|k)≤inf,α＝1,…,p，其中，-inf和inf分别表示负无穷和正无穷。这是因为人类驾驶车辆行为由智能驾驶员模型模拟，而智能驾驶员模型本身已经确保了车辆自身的跟车安全性。基于局部混合队列#i在p时域内的预测输出方程(10)，参考控制量约束建立的过程，局部混合队列#i的状态量
Figure BDA0003221244300000068
应该满足下列关系式：
Figure BDA0003221244300000071
其中，
Figure BDA0003221244300000072
结合式(10)进一步推导，可将式(12)写成下列不等式：
Figure BDA0003221244300000073
综上所述，若令Ωi为局部混合队列#i在控制过程中应该满足的约束矩阵，则Ωi是控制量约束(11)和状态量约束(13)的交集。
基于上述局部混合队列#i的预测输出方程(10)和约束集合Ωi，假设混合车辆队列中一共有N个局部混合队列，可得到k时刻混合车辆队列在预测时域内的代价函数，其表达式为：
Figure BDA0003221244300000074
其中，Γy和Γu分别是局部混合队列#i的状态量输出和控制量输入的权重矩阵；Ri是参考输出矩阵。
步骤4、基于交替方向乘子法，构建分布式模型预测控制器
在交替方向乘子法的算法框架下，k时刻混合车辆队列的控制问题(14)可以由各局部混合队列控制器并行求解，具体实现过程如下。
(1)引入辅助变量
Figure BDA0003221244300000075
并且设定
Figure BDA0003221244300000076
(2)引入对偶变量λi，构造增广拉格朗日函数，其函数表达式如下式所示：
Figure BDA0003221244300000077
(3)在局部混合队列#i的控制器上交替优化变量
Figure BDA0003221244300000078
和λi。
a.随机初始化
Figure BDA0003221244300000079
和λi，得到
Figure BDA00032212443000000710
和
Figure BDA00032212443000000711
b.更新
Figure BDA00032212443000000712
通过
Figure BDA00032212443000000713
和
Figure BDA00032212443000000714
计算新的
Figure BDA00032212443000000715
的更新规则如下式所示；
Figure BDA00032212443000000716
c.更新
Figure BDA00032212443000000717
通过更新得到的相关
Figure BDA00032212443000000718
的值计算新的
Figure BDA00032212443000000719
Figure BDA0003221244300000081
表示在混合车辆队列控制的全局目标下
Figure BDA0003221244300000082
的取值。为了更直观地表述
Figure BDA0003221244300000083
的更新规则，假设p＝1。此时
Figure BDA0003221244300000084
的两个分量分别是局部混合队列#i的头车和尾车在k时刻的控制输入。根据步骤1中将混合车辆队列划分为局部混合队列的方式可知，局部混合队列#i的尾车和局部混合队列#(i+1)的头车是同一辆网联自动驾驶车辆。同理，局部混合队列#(i-1)的尾车和局部混合队列#i的头车是同一辆网联自动驾驶车辆。所以，当p＝1时，
Figure BDA0003221244300000085
的更新规则如下式所示。P取任意值时，此更新规则仍然适用。
Figure BDA0003221244300000086
其中，
Figure BDA0003221244300000087
表示
Figure BDA0003221244300000088
的第一个分量，
Figure BDA0003221244300000089
表示
Figure BDA00032212443000000810
的第二个分量。
d.更新λi，通过更新得到的相关
Figure BDA00032212443000000811
和
Figure BDA00032212443000000812
的值计算新的λi，λi的更新规则如下式所示；
Figure BDA00032212443000000813
e.判断是否达到预设的最大迭代计算次数，若满足，则停止迭代，并且各局部混合队列分布式控制器输出相应的k时刻的控制量分量作用于尾部的网联自动驾驶车辆；否则，返回步骤b，继续迭代。
附图说明
图1为本发明实例提供的混合车辆队列头车的速度轨迹
图2为本发明实例提供的混合车辆队列的分布式控制结构
图3为本发明实例提供的混合车辆队列中部分车辆在仿真期间的跟驰速度变化情况
图4为本发明实例提供的混合车辆队列中部分车辆在仿真期间的跟驰间距变化情况
图5为本发明实例提供的混合车辆队列中部分车辆在仿真期间的跟驰加速度变化情况
图6为本发明实例提供的混合车辆队列控制的代价函数值J的变化情况
具体实施方式
以下将结合附图对本发明实例进行详细描述，以便本技术领域的人员更好地理解本发明。以下所描述的实例为本发明的一部分实例，并非全部实例。基于发明中的实例，本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例，都应当在本发明保护的范围之内。
本发明实例是通过MATLAB仿真平台对混合交通场景和其中的人类驾驶车辆的跟驰行为进行模拟，并利用MATLAB相关函数和语句构建了分布式模型预测控制器用于控制网联自动驾驶车辆，最后，将仿真得到的混合车辆队列的数据进行处理和分析，得出实验结果。以下对具体实施步骤进行详细说明。
步骤1、实验场景设计
在本实例中考虑了一个单车道上存在领导车辆的混合车辆队列，其中总共包含20辆车，头车的运动轨迹如图1所示。另外，混合车辆队列中的#5，#8，#11，#14，#17，#20车为网联自动驾驶车辆，其余车辆则为人类驾驶车辆。为了更加符合真实的交通情况，实例中网联自动驾驶车辆和人类驾驶车辆的模型参数设置的并不完全相同。
步骤2、仿真参数配置
首先，在仿真环境方面，初始状态下各车的速度为0m/s，车间距离为6m。
其次，混合车辆队列中网联自动驾驶车辆的车辆参数如表1所示，人类驾驶车辆的共同参数如表2所示，其余有差别的车辆参数见表3。另外，在行驶过程中，6辆网联自动驾驶车辆的控制量应该在[-5m/s2,1m/s2]之间，跟驰速度不能小于0m/s，跟驰间距不能小于2m。
最后，在分布式模型预测控制算法中，采样周期T设为0.1s；预测时域p设为30，控制时域m设为30；由于状态量和控制量的数量级不同，令Γy:Γu＝1:28。
表1网联自动驾驶车辆参数
Figure BDA0003221244300000091
表2人类驾驶车辆共同参数
Figure BDA0003221244300000092
表3人类驾驶车辆其余参数
Figure BDA0003221244300000101
步骤3、分布式模型预测控制器的构建与求解
在本实例中，根据6辆网联自动驾驶车辆的位置，包含了20辆车的混合车辆队列可被划分为6个局部混合车辆队列，即需要为6辆网联自动驾驶车辆构建6个分布式模型预测控制器，其示意图如图2所示。由于6个分布式模型预测控制器在每个离散的控制步长下构建的过程一致，在此仅详细阐述在初始时刻t＝0s时如何构建分布式模型预测控制器C2。
(1)建立局部混合队列#2的模型。
如图2所示，局部混合队列#2包含了#5，#6，#7，#8车，其头车为#4车，可得局部混合队列#2的模型表达式如下式所示：
Figure BDA0003221244300000102
对于存在领导车辆的混合车辆队列，其期望速度v*等于头车的实时速度v1。在初始时刻v*＝v1＝0m/s，结合步骤2中设定的#6，#7车的车辆参数，可以得到k1,6＝k1,7＝1；k2,6＝k2,7＝0；k3,6＝k3,7＝-1.6。同时结合#5，#8车的车辆参数，可以得到τ5＝1s；τ8＝1.2s。综上，可以得到上述模型表达式中的相关矩阵表达式为：
Figure BDA0003221244300000103
b5＝[-1 1]T,b8＝[-1.2 1]T,b6＝b7＝[0 0]T,u5＝u5,u8＝u8,u6＝u7＝0
(2)建立混合车辆队列优化问题
对上述得到的局部混合队列#2的模型进行离散化处理，可得到其预测模型表达式：
Figure BDA0003221244300000111
其中，
A＝TAc+I,Bu＝TBcu,Bd＝TBcd,Cc＝I8×8
进一步，在m＝p＝30时，可以得到初始时刻局部混合队列#2在p时域内的预测输出方程，其表达式如下式所示：
Figure BDA0003221244300000112
其中，
Figure BDA0003221244300000113
同理，在得到其他所有局部混合队列的预测输出方程后，可以写出初始时刻混合车辆队列在预测时域内的代价函数，其表达式如下式所示：
Figure BDA0003221244300000114
(3)确定局部混合队列#2在控制过程中应该满足的约束矩阵Ω2
首先，由图2可知局部混合队列#2中覆盖了2辆网联自动驾驶车辆，结合步骤2设置的相关实验参数，可得
Figure BDA0003221244300000115
应该满足下列关系式：
Figure BDA0003221244300000116
同理，局部混合队列#2的状态量
Figure BDA0003221244300000117
应该满足下列关系式：
Figure BDA0003221244300000118
将步骤2设置的相关实验参数代入式(12)计算，可得：
Figure BDA0003221244300000119
结合式(21)进一步推导，可将式(24)写成下列不等式：
Figure BDA00032212443000001110
综上所述，式(23)和式(25)的交集就是局部混合队列#2在控制过程中应该满足的约束矩阵Ω2。
(4)基于交替方向乘子法，最小化混合车辆队列整体的控制代价
4.1引入辅助变量
Figure BDA0003221244300000121
并且设定
Figure BDA0003221244300000122
4.2引入对偶变量λi，构造增广拉格朗日函数，其函数表达式如下式所示：
Figure BDA0003221244300000123
4.3在局部混合队列#i的控制器上交替优化变量
Figure BDA0003221244300000124
和λi。现仍然以局部混合队列#2为例说明其具体过程。
a.随机初始化
Figure BDA0003221244300000125
和λ2：
Figure BDA0003221244300000126
Figure BDA0003221244300000127
b.根据式(16)更新
Figure BDA0003221244300000128
Figure BDA0003221244300000129
这里令ρ2＝1；
Figure BDA00032212443000001210
求解式(27)可得到
Figure BDA00032212443000001211
的具体值。
c.根据式(17)更新
Figure BDA00032212443000001212
同理，可以计算得到
Figure BDA00032212443000001213
的值，
Figure BDA00032212443000001214
的部分取值如下式所示。
Figure BDA00032212443000001215
根据
Figure BDA00032212443000001216
的取值以及
Figure BDA00032212443000001217
的更新规则式(17)可以对
Figure BDA00032212443000001218
进行更新，
Figure BDA00032212443000001219
的更新如下式所示：
Figure BDA00032212443000001220
d.根据式(18)更新λ2：
Figure BDA0003221244300000131
上述步骤是局部混合队列#2的分布式模型预测控制器C2上一次完整的迭代求解过程。重复上述迭代求解过程，直至达到设置的最大迭代求解次数Nmax＝3，控制器C2输出
Figure BDA0003221244300000132
的第2个分量u8(k)作用于#8车。与此同时，其他局部混合队列的分布式模型预测控制器Ci,i＝1,…,6也输出相应控制量分量作用于该局部混合队列尾部的网联自动驾驶车辆。在下一控制时刻，重复上述步骤，直至仿真结束。
步骤4、实验结果
图3-5显示了本实例中的混合车辆队列中部分车辆在分布式模型预测控制器的作用下的编队效果。图3，图4和图5分别是#1，#4，#5，#19，#20车在编队过程中的跟驰速度变化图，跟驰间距变化图和跟驰加速度变化图。图中虚线绘制的是网联自动驾驶车辆的行为轨迹，实线则是人类驾驶车辆的行为轨迹。图3表明，当#1车的速度达到稳定时，混合车辆队列中的网联自动驾驶车辆也能达到相同的平衡速度；图4表明，在跟驰过程中，网联自动驾驶车辆始终与前车保持合适的跟车间距，并且其跟车间距和跟车间距超调量都远小于人类驾驶车辆，这有利于提高交通容量；而且，图3-5表明，网联自动驾驶车辆在跟驰过程中没有违背预先设定的控制量约束和关于跟车速度和跟车间距的安全约束。图6表示仿真期间混合车辆队列整体的控制代价函数值变化情况，图6表明，当#1车速度逐渐稳定时，J值会逐渐减小至0，这说明本实例中混合车辆队列整体的控制目标得以实现。综上所述，本发明提出的分布式模型预测控制方法实现了混合车辆队列的编队控制，提高了道路交通容量。

Claims (8)

1.一种混合车辆队列分布式模型预测控制方法，其特征在于：该方法由四部分组成：第一、根据混合车辆队列中网联自动驾驶车辆的位置，将混合车辆队列划分为多个相互关联的局部混合车辆队列；第二、基于智能网联车辆和人类驾驶车辆的运动学模型，建立每个局部混合队列模型，该模型由统一的形式表达；第三、基于多个局部混合队列模型，根据模型预测控制算法，建立混合车辆队列整体控制问题；第四、基于交替方向乘子法，为混合车辆队列中的各个局部混合队列构建分布式模型预测控制器，实现混合车辆队列整体的编队控制。
2.根据权利要求1所述的一种混合车辆队列分布式模型预测控制方法，其特征在于：混合车辆队列中网联自动驾驶车辆和人类驾驶车辆随机混合，其中人类驾驶车辆也能通过自身的无线车联设备向网联自动驾驶车辆共享自身的运动信息；每一个根据网联自动驾驶车辆的空间位置划分而得到的局部混合车辆队列中最多包含两辆网联自动驾驶车辆，分别是局部混合队列的头车和尾车；如果混合车辆队列的头车和尾车是人类驾驶车辆，那么混合车辆队列头部和尾部的局部混合队列中就只包含一辆网联自动驾驶车辆；混合车辆队列中局部混合队列的相互关联性体现在，相邻的两个局部混合队列会覆盖同一辆网联自动驾驶车辆。
3.根据权利要求1所述的一种混合车辆队列分布式模型预测控制方法，其特征在于：所述的局部混合队列模型设计为如下形式：首先，混合车辆队列中人类驾驶车辆的跟驰行为可选择由智能驾驶员模型进行描述，该模型表达式为：
Figure FDA0003221244290000011
其中，vj表示车辆#j的当前速度；hj表示车辆#j的当前跟车间距；a表示车辆的最大加速度，b表示车辆的舒适减速度；v0表示自由流速度；s0表示最小跟车间距；Tj表示车辆#j的最小跟车时距；l表示车辆#(j-1)的车长；通过调节上述参数可以反映不同人类驾驶车辆跟驰动态的差异性；
在系统平衡点
Figure FDA0003221244290000012
附近，定义Δvj＝vj-v*，
Figure FDA0003221244290000013
并对式(1)进行线性化处理，得到人类驾驶车辆关于误差的线性跟驰动态模型，其表达式如下式所示：
Figure FDA0003221244290000014
其中，
Figure FDA0003221244290000021
其次，设计混合车辆队列中网联自动驾驶车辆的跟驰动态模型表达式为：
Figure FDA0003221244290000022
Figure FDA0003221244290000023
其中，uj表示网联自动驾驶车辆#j的控制输入；由于网联自动驾驶车辆采用了恒定车头时距的间距政策，所以其期望跟车间距
Figure FDA0003221244290000024
的表达式为：
Figure FDA0003221244290000025
其中，τj表示网联自动驾驶车辆#j的固定车头时距；
Figure FDA0003221244290000026
表示其最小跟车间距；不同网联自动驾驶车辆的模型参数也可以不相同；
参考人类驾驶车辆跟驰动态模型的线性化过程，可得到网联自动驾驶车辆关于误差的线性跟驰动态模型，其表达式如下式所示：
Figure FDA0003221244290000027
最终，假设局部混合队列#i覆盖了混合车辆队列中的车辆#(j+1)到车辆#(j+n)，令xj＝[Δhj Δvj]T，基于公式(2)和(5)，可以设计该局部混合队列#i的模型表达式为：
Figure FDA0003221244290000028
Yi＝CcXi (7)
其中，j∈HDV表示车辆#j是人类驾驶车辆，j∈CAV表示车辆#j是网联自动驾驶车辆，且
Figure FDA0003221244290000029
4.根据权利要求3所述的局部混合队列#i的模型，其特征在于：局部混合队列#i模型的建立是基于局部混合队列#i中网联自动驾驶车辆和人类驾驶车辆的线性跟驰动态模型，也就是说，局部混合队列#i模型的具体表达式需要根据局部混合队列#i中的具体车辆数目，车辆排序以及相关车辆模型参数确定。
5.根据权利要求1所述的一种混合车辆队列分布式模型预测控制方法，其特征在于：假设混合车辆队列中一共有N个局部混合队列，所述的混合车辆队列在k时刻的控制问题设计为如下形式：首先，离散化公式(6)和(7)，可得到局部混合队列#i的预测模型表达式：
Figure FDA0003221244290000031
其中，A＝TAc+I；Bu＝TBcu；Bd＝TBcd；这里T表示采样间隔；I表示维度为2n的单位矩阵；
其次，设预测时域p等于控制时域m，根据模型预测控制算法，以k时刻为预测点基于预测模型(8)建立局部混合队列#i在p时域内的预测输出方程，其表达式如下式所示：
Figure FDA0003221244290000032
其中，
Figure FDA0003221244290000033
最终，基于局部混合队列#i的预测输出方程(9)，可以写出混合车辆队列在k时刻的控制问题，如下式所示：
Figure FDA0003221244290000034
其中，Γy和Γu分别是局部混合队列#i的状态量输出和控制量输入的权重矩阵；Ri是参考输出矩阵；Ωi为局部混合队列#i在控制过程中应该满足的约束矩阵。
6.根据权利要求5所述的局部混合队列#i在控制过程中应该满足的约束矩阵，其特征在于：假设局部混合队列#i中有q辆网联自动驾驶车辆，约束矩阵Ωi设计为如下形式：首先，设计局部混合队列#i的控制量约束如下式所示：
Figure FDA0003221244290000035
其中，
Figure FDA0003221244290000036
表示克罗内克积，如果A是一个a×b的矩阵，而B是一个c×d的矩阵，
Figure FDA0003221244290000037
则是一个ac×bd的矩阵；ones(qm，1)是一个qm×1的全1矩阵；umin和umax分别是网联自动驾驶车辆在每个控制步长下的控制量约束范围的上下界；
其次，设计局部混合队列#i的状态量约束如下式所示：
Figure FDA0003221244290000041
其中，ymin和ymax是网联自动驾驶车辆和人类驾驶车辆在每个控制步长下的关于跟车速度误差和跟车间距误差的状态量约束范围的上下界，并且：
Figure FDA0003221244290000042
结合式(9)进一步推导，可将式(12)写成下列不等式：
Figure FDA0003221244290000043
最终，取控制量约束(11)和状态量约束(13)的交集，可得到局部混合队列#i在控制过程中应该满足的约束矩阵Ωi。
7.根据权利要求1所述的一种混合车辆队列分布式模型预测控制方法，其特征在于：所述的基于交替方向乘子法，为局部混合队列构建分布式模型预测控制器的过程如下：
a.引入辅助变量
Figure FDA0003221244290000044
并且设定
Figure FDA0003221244290000045
b.引入对偶变量λi，构造增广拉格朗日函数，其函数表达式如下式所示：
Figure FDA0003221244290000046
c.在各个局部混合队列的分布式模型预测控制器上交替优化变量
Figure FDA0003221244290000047
和λi，直至达到预设的最大迭代计算次数，各局部混合队列分布式控制器输出相应的k时刻的控制量分量作用于尾部的网联自动驾驶车辆。
8.根据权利要求7所述的在各个局部混合队列的分布式模型预测控制器上同时交替优化变量
Figure FDA0003221244290000048
和λi，其特征在于：在局部混合队列#i的控制器上交替优化变量
Figure FDA0003221244290000049
和λi的过程如下：
a.随机初始化
Figure FDA00032212442900000410
和λi，得到
Figure FDA00032212442900000411
和
Figure FDA00032212442900000412
b.更新
Figure FDA00032212442900000413
通过
Figure FDA00032212442900000414
和
Figure FDA00032212442900000415
计算新的
Figure FDA00032212442900000416
的更新规则如下式所示：
Figure FDA00032212442900000417
c.更新
Figure FDA00032212442900000418
通过更新得到的相关
Figure FDA00032212442900000419
的值计算新的
Figure FDA00032212442900000420
根据混合车辆队列划分为局部混合队列的方式可知，局部混合队列#i的头车和尾车也分别是局部混合队列#(i-1)的尾车和局部混合队列#(i+1)的头车；为了更直观地表述
Figure FDA0003221244290000051
的更新规则，假设预测时域p＝1，此时
Figure FDA0003221244290000052
的两个分量分别是局部混合队列#i的头车和尾车在k时刻的控制输入；所以，当p＝1时，
Figure FDA0003221244290000053
的更新规则如下式所示；P取任意值时，此更新规则仍然适用；
Figure FDA0003221244290000054
其中，
Figure FDA0003221244290000055
表示
Figure FDA0003221244290000056
的第一个分量，
Figure FDA0003221244290000057
表示
Figure FDA0003221244290000058
的第二个分量；
d.更新λi，通过更新得到的相关
Figure FDA0003221244290000059
和
Figure FDA00032212442900000510
的值计算新的λi，λi的更新规则如下式所示：
Figure FDA00032212442900000511
e.判断是否达到预设的最大迭代计算次数，若满足，则停止迭代，各局部混合队列分布式控制器输出相应的k时刻的控制量分量作用于尾部的网联自动驾驶车辆；否则，返回步骤b，继续迭代。
CN202110958481.7A 2021-08-20 2021-08-20 一种混合车辆队列分布式模型预测控制方法 Pending CN113791615A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110958481.7A CN113791615A (zh) 2021-08-20 2021-08-20 一种混合车辆队列分布式模型预测控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110958481.7A CN113791615A (zh) 2021-08-20 2021-08-20 一种混合车辆队列分布式模型预测控制方法

Publications (1)

Publication Number Publication Date
CN113791615A true CN113791615A (zh) 2021-12-14

Family

ID=79182035

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110958481.7A Pending CN113791615A (zh) 2021-08-20 2021-08-20 一种混合车辆队列分布式模型预测控制方法

Country Status (1)

Country Link
CN (1) CN113791615A (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114387787A (zh) * 2022-03-24 2022-04-22 华砺智行(武汉)科技有限公司 车辆轨迹控制方法、装置、电子设备及存储介质
CN114489067A (zh) * 2022-01-21 2022-05-13 东南大学 智能网联车辆队列协同驾驶模型预测控制方法
CN115116225A (zh) * 2022-06-23 2022-09-27 上海交通大学 一种面向混合交通流的数据驱动随机模型预测控制方法
CN116279475A (zh) * 2023-02-16 2023-06-23 东南大学 网联自动驾驶车辆队列运行速度一致性协同控制方法
CN116403402A (zh) * 2023-04-13 2023-07-07 交通运输部公路科学研究所 一种网联环境下城市交叉口区域的交通状态预测方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105774800A (zh) * 2016-03-28 2016-07-20 清华大学 一种混合车辆队列中车辆间的碰撞缓解方法及装置
CN109829577A (zh) * 2019-01-17 2019-05-31 北京交通大学 基于深度神经网络结构模型的轨道列车运行状态预测方法
CN112162555A (zh) * 2020-09-23 2021-01-01 燕山大学 混合车队中基于强化学习控制策略的车辆控制方法
CN112437412A (zh) * 2020-10-30 2021-03-02 北方工业大学 一种基于车路协同的混行驾驶车辆编队控制方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105774800A (zh) * 2016-03-28 2016-07-20 清华大学 一种混合车辆队列中车辆间的碰撞缓解方法及装置
CN109829577A (zh) * 2019-01-17 2019-05-31 北京交通大学 基于深度神经网络结构模型的轨道列车运行状态预测方法
CN112162555A (zh) * 2020-09-23 2021-01-01 燕山大学 混合车队中基于强化学习控制策略的车辆控制方法
CN112437412A (zh) * 2020-10-30 2021-03-02 北方工业大学 一种基于车路协同的混行驾驶车辆编队控制方法

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114489067A (zh) * 2022-01-21 2022-05-13 东南大学 智能网联车辆队列协同驾驶模型预测控制方法
CN114489067B (zh) * 2022-01-21 2023-09-12 东南大学 智能网联车辆队列协同驾驶模型预测控制方法
CN114387787A (zh) * 2022-03-24 2022-04-22 华砺智行(武汉)科技有限公司 车辆轨迹控制方法、装置、电子设备及存储介质
CN114387787B (zh) * 2022-03-24 2022-08-23 华砺智行(武汉)科技有限公司 车辆轨迹控制方法、装置、电子设备及存储介质
CN115116225A (zh) * 2022-06-23 2022-09-27 上海交通大学 一种面向混合交通流的数据驱动随机模型预测控制方法
CN115116225B (zh) * 2022-06-23 2023-08-04 上海交通大学 一种面向混合交通流的数据驱动随机模型预测控制方法
CN116279475A (zh) * 2023-02-16 2023-06-23 东南大学 网联自动驾驶车辆队列运行速度一致性协同控制方法
CN116279475B (zh) * 2023-02-16 2024-02-23 东南大学 网联自动驾驶车辆队列运行速度一致性协同控制方法
CN116403402A (zh) * 2023-04-13 2023-07-07 交通运输部公路科学研究所 一种网联环境下城市交叉口区域的交通状态预测方法

Similar Documents

Publication Publication Date Title
CN113791615A (zh) 一种混合车辆队列分布式模型预测控制方法
Ye et al. Automated lane change strategy using proximal policy optimization-based deep reinforcement learning
CN110969848B (zh) 一种对向双车道下基于强化学习的自动驾驶超车决策方法
KR102461831B1 (ko) 자율주행 차량 군집 운행을 위한 비신호 교차로에서의 강화학습기반 통행 개선을 위한 장치 및 방법
JP2020015489A (ja) 自車両の将来挙動および関連する軌道を決定することにより、自車両の操作者が当該自車両を制御するのを支援する方法およびシステム
JP2022532972A (ja) 敵対的模倣学習に基づく無人運転車両車線変更決定方法及びシステム
Kamal et al. Efficient vehicle driving on multi-lane roads using model predictive control under a connected vehicle environment
Shen et al. Cooperative comfortable-driving at signalized intersections for connected and automated vehicles
CN113255998B (zh) 基于多智能体强化学习的高速道路无人驾驶车辆编队方法
EP3961598A1 (en) Method and system for enabling cooperative coordination between autonomously acting entities
CN110879595A (zh) 一种基于深度强化学习的无人矿卡循迹控制系统及方法
Zhang et al. Addressing mandatory lane change problem with game theoretic model predictive control and fuzzy Markov chain
Li et al. Game theory-based traffic modeling for calibration of automated driving algorithms
CN112124310B (zh) 一种车辆的路径变换方法和装置
US11579574B2 (en) Control customization system, control customization method, and control customization program
CN114253274B (zh) 基于数据驱动的网联混合车辆编队滚动优化控制方法
CN114802306A (zh) 一种基于人机共驾理念的智能车辆集成式决策系统
Luo Adaptive cruise control design with consideration of humans' driving psychology
CN114987511A (zh) 模拟人类驾驶行为以训练基于神经网络的运动控制器的方法
Guo et al. Modeling, learning and prediction of longitudinal behaviors of human-driven vehicles by incorporating internal human DecisionMaking process using inverse model predictive control
Guo et al. Optimal design of a driver assistance controller based on surrounding vehicle’s social behavior game model
Liu et al. Multi-agent collaborative adaptive cruise control based on reinforcement learning
CN113635900A (zh) 一种预测巡航过程中基于能量管理的换道决策控制方法
Yuan et al. From Naturalistic Traffic Data to Learning-Based Driving Policy: A Sim-to-Real Study
Köprülü et al. Act to reason: A dynamic game theoretical model of driving

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination