一种基于通信延迟的智能车队纵向跟随控制方法与流程

技术特征：
1.一种基于通信延迟的智能车队纵向跟随控制方法，其特征在于，具体步骤如下：建立基于模型预测控制原理的上层控制运动学方程；建立卡尔曼滤波模型，采用延迟误差补偿方法对通信延迟影响下车辆状态空间模型进行优化，得到优化后的车辆状态空间模型；基于优化后的车辆状态空间模型进行mpc算法求解，得到期望控制输入，并建立下层控制器，将控制输入反馈到被控车辆，实现车辆的加速或制动。2.如权利要求1所述的一种基于通信延迟的智能车队纵向跟随控制方法，其特征在于，建立基于模型预测控制原理的上层控制运动学方程的步骤如下：将车队中智能车辆的纵向运动过程当成一个非线性的三阶模型，由以下微分方程来描述：述：述：其中s为智能车辆从惯性参考位置测量得到的纵向位置，v、a分别为车辆的速度和加速度，η为发动机的控制输入；将原有的非线性模型反馈线性化得：η＝ma
des
c
d
v2 d
m
2τc
d
va；其中a
des
即为上层控制器所决定的期望加速度，c
d
代表了气动阻力系数，d
m
为车辆的机械阻力，τ为车辆发动机的时间常数；考虑在直道上行驶的车队中的其中三辆紧密跟随的相同配置的智能车辆，s
i
代表第i辆车与惯性参考点的距离，v
i
、a
i
分别代表第i辆车的速度和加速度，l代表车身的长度，则第i辆车与前车的车间间距误差为：e
s
＝s
i
‑1‑
s
i
‑
d
i，des
‑
l；其中d
i，aes
是第i辆车与前车的期望车间距，如何选取该期望距离取决于安全距离算法即车间距策略，不同的车间距策略有不同的效果；考虑到车队及交通流的稳定性，采用可变车头时距的安全距离算法作为控制研究方法，则对于第i辆车而言，它与前车的间距误差如上式所示，式中的期望距离为：d
i，des
＝d0 h
i
(v
i
)*v
i
；其中，d0表示最小安全距离，h
i
为车头时距；它与前车的速度差为：e
v
＝v
i
‑1‑
v
i
；其中，v
i
‑1表示第i
‑
1辆车的速度；经推导得出本发明所提出的一种基于通信延迟的智能车队纵向跟随控制系统内车辆的状态空间模型为：上式中，
x＝[e
s e
v a
i v
i
]
t
u＝a
des
ω＝a
i
‑1；其中x、u和ω分别为状态、控制输入以及干扰输入。3.如权利要求1所述的一种基于通信延迟的智能车队纵向跟随控制方法，其特征在于，建立卡尔曼滤波模型，采用延迟误差补偿方法对通信延迟影响下车辆状态空间模型进行优化，得到优化后的车辆状态空间模型的具体步骤如下：假设跟随车的位移为s
i
，车速为v
i
，纵向加速度为a
i
，前车的位移为s
i
‑1，车速为v
i
‑1，纵向加速度为a
i
‑1；假设两车在某个k时刻与k 1时刻之间作匀变速行驶，即纵向加速度值在该时刻之间为一定值，时间间隔设定为t，依据两车的相对位置关系，可以列出纵向参数在k时刻与k 1时刻之间的关系方程，如下式所示：v
i
‑1(k 1)＝v
i
‑1(k) a
i
‑1(k)t；a
i
‑1(k 1)＝a
i
‑1(k)；选取前车位移s
i
‑1，前车车速v
i
‑1，前车纵向加速度a
i
‑1为系统的状态变量x(k)和观测变量z(k)，即x(k)＝z(k)＝[s
i
‑1(k)，v
i
‑1(k)，a
i
‑1(k)]
t
；设系统的过程噪声矩阵和测量噪声矩阵分别为w和v，其方差为q和r，则将上式整理后得：x(k 1)＝dx(k) w；z(k)＝hx(k) v；得出系统的状态空间方程后，即可得到采用卡尔曼滤波方法对前车状态进行估计的递推方程组，新的预测方程如下：状态预测：协方差预测：p(k 1|k)＝dp(k|k)d
t
q；滤波增益：k(k 1)＝p(k 1|k)h
t
[hp(k 1|k)h
t
r]
‑1；状态更新：协方差更新：p(k 1|k 1)＝[i
n
‑
k(k 1)h]p(k 1|k)；利用滤波计算原型，所有跟随车辆就能够对接收到的前车信息进行一步状态预测；假设在k时刻前车s时刻的状态信息被跟随车辆观测器接收到，且k时刻与s时刻相差n个滤波周期时长t；通过递推的方式得到s时刻
→
k时刻实际的一步状态预测递推序列，令n＝k
‑
s有：
设为无延时的系统一步状态预测，则一步状态预测误差为：对s时刻之前的状态进行估计，令：则有包含了s
→
k时刻n
‑
1个滤波周期的系统状态转移矩阵d和s时刻系统的信息；设最终求得状态预测诶差的值为：得到补偿后的前车位移和前车速度目.目.将和替换掉间距误差公式和速度差公式里的s
i
‑1和v
i
‑1，得到补偿后的间距误差e
s
和速度差e
v
：：4.如权利要求1所述的一种基于通信延迟的智能车队纵向跟随控制方法，其特征在于，基于优化后的车辆状态空间模型进行mpc算法求解，得到期望控制输入，并建立下层控制器，将控制输入反馈到被控车辆，实现车辆的加速或制动的具体步骤如下：转化后得到以下离散线性状态空间模型：y(k)＝cx(k)；
其中表示系统的状态，表示系统可测量的输出，为控制输入而为干扰输入；假定状态向量与干扰向量在每一个采样周期t
s
内可测，且k时刻对未来时刻的干扰预测为其本身，即ω(k j|k)＝ω(k)；则可以通过以下迭代模型来实现对未来n个采样时刻的预测：其中，n被称为预测时域；定义性能指标函数为：其中y
ref
(k j|k)为参考轨迹，它与当前时刻为止的输出测量值有关，或者是预先设定的轨迹，符号代表二次型函数，q、r分别为误差和输入加权矩阵；上式表明性能指标主要考虑了输出与参考的误差大小以及输入的能量大小两个方面，它可以改写成以下向量形式：定义向量e(k)为系统自由响应与未来目标轨迹的偏差：e(k)＝y
ref
(k)
‑
m
x
x(k)
‑
m
u
u(k
‑
1)
‑
m
ω
ω(k)；可得二次规划的标准形式：建立下层控制器，控制汽车的加速和制动：汽车加速时，需要根据逆纵向动力学模型由期望加速度计算出发动机期望转矩，再结合发动机转速信息通过反查表法求得期望油门开度；加速控制过程发动机期望扭矩与期望加速度之间的关系为：根据车辆的发动机扭矩特性，可以在已知发动机转速ω
e
以及期望扭矩t
e，des
的条件下得到相应的期望油门开度，即：a
des
＝f(t
e，des
，ω
e
)；汽车制动时，需要根据期望加速度求得期望制动力，再由期望制动力求出期望制动压力，汽车在制动时没有油门输入，可以写出制动过程的车辆动力学方程如下：ma
des
＝
‑
f
bdes
‑
f
areo
‑
r
x
；可求得期望制动压力为：

技术总结
本发明涉及智能车队纵向跟随控制技术领域，具体涉及一种基于通信延迟的车队纵向跟随控制方法。采用模型预测控制(MPC)设计编队的控制律，实现理想通信情况下的编队保持。然后引入通信延迟，利用卡尔曼滤波算法(KF)对领航车实际状态信息进行预测，并将状态预测误差作为对通信延迟的补偿，既考虑了编队的稳定性，同时又兼顾了车辆编队的控制效果。同时又兼顾了车辆编队的控制效果。同时又兼顾了车辆编队的控制效果。


技术研发人员：雷利利 王梓
受保护的技术使用者：江苏大学
技术研发日：2021.06.30
技术公布日：2021/9/21