CN112148001B - 一种基于模糊模型预测控制的智能车队纵向跟随控制方法 - Google Patents

一种基于模糊模型预测控制的智能车队纵向跟随控制方法 Download PDF

Info

Publication number
CN112148001B
CN112148001B CN202010893725.3A CN202010893725A CN112148001B CN 112148001 B CN112148001 B CN 112148001B CN 202010893725 A CN202010893725 A CN 202010893725A CN 112148001 B CN112148001 B CN 112148001B
Authority
CN
China
Prior art keywords
vehicle
control
acceleration
error
speed
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.)
Active
Application number
CN202010893725.3A
Other languages
English (en)
Other versions
CN112148001A (zh
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.)
Jiangsu University
Original Assignee
Jiangsu University
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 Jiangsu University filed Critical Jiangsu University
Priority to CN202010893725.3A priority Critical patent/CN112148001B/zh
Publication of CN112148001A publication Critical patent/CN112148001A/zh
Application granted granted Critical
Publication of CN112148001B publication Critical patent/CN112148001B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0287Control 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/0291Fleet control
    • G05D1/0295Fleet control by at least one leading vehicle of the fleet
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Artificial Intelligence (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Health & Medical Sciences (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Control Of Vehicle Engines Or Engines For Specific Uses (AREA)
  • Electrical Control Of Air Or Fuel Supplied To Internal-Combustion Engine (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

本发明涉及车辆编队控制领域,特别是指一种基于模糊模型预测控制的智能车队纵向跟随控制方法,目的是提高模型预测控制算法应用于车队纵向跟随控制***的灵活性,保证车队中的跟随车辆能够快速并平稳的实现纵向跟随。其包括以下步骤:建立车队动力学模型、基于模糊模型预测控制建立上层控制***、基于车辆逆动力学模型建立下层控制***。本发明在上层控制***设计中,引入模糊控制策略,根据间距误差和速度误差的大小调整目标函数中的误差权重系数,加快车队进入稳定状态的响应时间并在接近稳定状态时提高车辆的跟随平稳性。本发明能够在满足多约束的条件下保证上层控制***能够输出更加精确合理的期望加速度,提高车队行驶的稳定性和乘坐舒适性。

Description

一种基于模糊模型预测控制的智能车队纵向跟随控制方法
技术领域
本发明涉及车辆编队控制领域,特别是指一种基于模糊模型预测控制的智能车队纵向跟随控制方法。
背景技术
近年来,随着智能网联汽车、无人驾驶汽车、车联网等相关技术的迅速发展,车辆编队控制也在朝着更加复杂、更加综合性的方向发展。从简单的PID控制到在单输入单输出***中表现优异的LQR控制,再到适用于多约束非线性***的模型预测控制(MPC)等,更多先进的控制理论方法正在逐步应用到车队纵向跟随控制中。
模型预测控制方法的主要优点是***的在线优化,以渐进式的方式实施闭环控制,从而在每个时间步长内解决优化问题,保证控制***的稳定性和可行性。这使模型预测控制方法能够适应更加符合现实情况的复杂多约束***。
目前很多将模型预测控制应用到车队控制的研究中,建立的模型复杂度高,因此也获得了较为精确的控制目标。但在目标函数的求解中,权重系数均设置为固定值,导致无法适应多变的驾驶环境,不能满足无人车队纵向跟随性和平稳性的目标。因此,有必要对现有的模型预测控制算法进行改进。
发明内容
本发明的目的在于克服现有方案的不足,提供一种基于模糊模型预测控制的智能车队纵向跟随控制方法。
本发明的技术方案是这样实现的:
第一步,建立车队纵向动力学模型。
单轨纵向车辆模型运动过程可以由以下微分方程描述:
Figure BDA0002657755610000011
Figure BDA0002657755610000012
Figure BDA0002657755610000013
s、v、a分别代表车辆的纵向位移、车速和加速度。m为车辆总质量,Cd代表气动阻力系数,τ为车辆发动机时间常数,dm为车辆机械阻力。η为发动机控制输入:η=mades+Cdv2+dm+2τCdva。
ades表示控制***输出的期望加速度,车辆实际加速度与期望加速度的关系为:
Figure BDA0002657755610000021
根据运动学模型建立状态空间方程:
Figure BDA0002657755610000022
y(t)=Cx(t)
其中,u=ades表示***控制输入为理想加速度,ω代表***测量的干扰,在本***中为前车加速度,即ω=ai-1。x(t)=[es,ev,ai,vi]为***状态量es、ev分别表示车队中第i辆车与前车的间距误差和速度误差,ai、vi表示第i辆车的加速度和速度,车队纵向运动学方程为:
es=si-1-si-th*vi-l-d0
ev=vi-1-vi
Figure BDA0002657755610000023
vi=vi
th为固定车头时距,l为车辆长度,d0为最小安全距离,一般取2~6m,A、B、C分别为状态系数矩阵、输入系数矩阵和输出系数矩阵,通过泰勒展开求雅克比矩阵得到:
Figure BDA0002657755610000024
设定周期T,则离散化状态空间方程:
x(k+1)=Akx(k)+Buku{k)+Bwk(k)
y(k)=Ckx(k)
其中:Ak=I+AT,Buk=BuT,Bωk=BωT,Ck=diag(1,1,1,1)
第二步,建立基于模糊模型预测控制方法的纵向跟随控制***。
为了保证舒适性,即加速度变化率不会发生突变,用控制量增量加速度变化率Δu代替控制输入量u,整个控制过程通过控制增量Δu来实现,Δu和u的关系式为:
u(k+j|k)=u(k+j-1|k)+Δu(k+j|k)
模型预测控制器根据离散化模型对预测时域Np内的***输出状态进行预测:
Y(k)=ψx(k)+θΔU(k)+Fu(k-1)+Gω(k)
其中,Yk表示控制器在时刻k对未来个Np时域的预测输出,Nc为控制时域,ω(k)代表测量干扰且ω(k)=ω(k+1)=…=ω(k+Np)=ai-1
Figure BDA0002657755610000031
Figure BDA0002657755610000032
建立带有松弛因子ε的性能指标函数:
Figure BDA0002657755610000033
其中,Q、R为各控制目标的权重系数矩阵,ρ松弛因子的权重系数。
设定***偏差:
E(k)=Yref(k)-Wxx(k)-Wuu(k-1)-Wω(k)
性能指标函数可转化为标准二次规划函数:
Figure BDA0002657755610000034
其中,
Figure BDA0002657755610000035
这里的Wx、Wu、Wω为系数矩阵,
Figure BDA0002657755610000041
为了保证车队纵向跟随***的稳定性和舒适性,需要构建加入松弛因子的状态量、控制输入和控制输入增量的约束条件:
Figure BDA0002657755610000042
其中,ymin/max、umin/max、Δumin/max表示状态输出量,控制输入量以及控制量增量的最值。
Figure BDA0002657755610000043
表示输出量、控制量、控制量增量的上下边界松弛系数。
根据以上步骤,***求解带有约束的目标函数,得到k时刻***的控制量增量即理想加速度变化量Δuk,上层控制器输出期望加速度:
ak,des=ak-1+Δuk
期望加速度又作为下一步的控制输入量反馈到控制器中,形成闭环控制。
第三步,在上层控制器引入模糊策略,对模型预测控制目标函数中的误差权重系数比例因子进行模糊化处理。
根据驾驶经验,以及车队纵向跟随控制***对跟随性和平稳性的要求,当车辆间距误差es和速度误差ev较大时,需要加快响应速度,模糊控制***通过增加误差权重系数Q的值,使***更加侧重目标函数的纵向跟随性目标;当车辆间距误差es较小和速度误差ev较小时,***已经接近稳定,模糊控制***通过取较小的误差权重系数Q,使***侧重目标函数的平稳性目标。
传统模型预测控制器的误差权重系数为固定值,本发明设置可变误差权重系数矩阵,Qj表示误差权重系数的比例因子:
Q=QjE
根据以上分析建立模糊规则库,由于本发明中的速度误差定义为本车速度与前车速度的差值,速度误差会出现负值,因此,在模糊控制器中选择以速度误差绝对值衡量速度误差的大小。模糊控制器的两个输入量为间距误差es和速度误差绝对值ev,输出量为误差权重系数比例因子Qj。三个变量的模糊集都设为{NB(负大),NM(负中),NS(负小),ZO(零),PS(正小),PM(正中),PB(正大)}。间距误差es论域设置为[0,40],速度误差绝对值|ev|论域设置为[0,15],误差权重系数比例因子Qj论域设置为[1,10]。隶属度函数均采用具有良好光滑性和对称性的gaussmf隶属函数,得到模糊控制器的输入和输出关系,模糊控制器输出可变的误差权重系数比例因子Qj进而调整模型预测控制器中误差权重系数。
第四步,建立下层控制器,控制车辆的加速和制动。
由逆动力学模型分别建立加速控制模型和制动控制模型,根据上层控制器输出的期望加速度正负值切换加速和制动逻辑。需要本车加速时,加速控制模型将期望加速度转化为发动机节气门开度;制动时,制动控制模型将期望加速度转化为制动压力,进而实现对车辆的纵向跟随控制。
与现有技术相比,本发明的有益效果:
在上层控制***设计中,引入模糊控制策略,根据当前状态量偏差的大小调整模型预测目标函数中的误差权重系数,加快车队进入稳定状态的响应时间。本发明能够在满足多约束的条件下保证上层控制***能够输出更加精确合理的期望加速度,提高车队行驶的纵向跟随性和乘坐舒适性。
附图说明
图1为一种基于模糊模型预测控制的智能车队纵向跟随控制方法的控制框架图。
图2为本发明所述方法中由车间距误差、速度误差和误差权重的关系建立的模糊规则表。
图3为实施例中上层控制器的模糊控制器输入量和输出量的关系图。
图4为实施例中下层控制器选用的发动机扭矩特性曲线图。
图5为实施例中采用传统模型预测控制方法的车队车辆间距变化。
图6为实施例中采用本发明提出的模糊模型预测控制方法的车队车辆间距变化。
图7为实施例中采用传统模型预测控制方法的车队车速变化。
图8为实施例中采用本发明提出的模糊模型预测控制方法的车队车速变化。
具体实施方式
如图1所示,一种基于模糊模型预测控制的智能车队纵向跟随控制***采用上下分层结构,上层控制器包括模糊控制器和模型预测控制器,模糊控制器的输入为车间距误差和前后车辆速度误差,输出的误差权重系数比例因子Qj作为模型预测控制器的输入。模型预测控制器根据车辆信息和可变的误差权重系数Q,在线滚动优化求解理想加速度。下层控制器负责将上层控制器输出的理想加速度转化为节气门开度或制动压力并传输给车辆的执行机构,控制车辆平稳且快速的实现纵向跟随。
本发明具体实施例及实施步骤如下:
第一步,建立纵向动力学模型。
单轨纵向车辆模型运动过程可以由以下微分方程描述:
Figure BDA0002657755610000061
Figure BDA0002657755610000062
Figure BDA0002657755610000063
s、v、a分别代表车辆的纵向位移、车速和加速度。m为车辆总质量,Cd代表气动阻力系数,τ为车辆发动机时间常数,dm为车辆机械阻力。η为发动机控制输入:η=mades+Cdv2+dm+2τCdva。
Figure BDA0002657755610000071
y(t)=Cx(t)
其中,u=ades表示***控制输入为理想加速度,ω代表***测量的干扰,在本***中为前车加速度,即ω=ai-1。x(t)=[es,ev,ai,vi]为***状态量es、ev分别表示车队中第i辆车与前车的间距误差和速度误差,ai、vi表示第i辆车的加速度和速度。设置合理的车队安全间距是车队纵向控制安全性的前提,目前间距策略一般选用固定车间距和可变车间距,本发明中采取固定车头时距策略,取th=1.2s,即前后车辆连续通过同一观测点的时间间隔为1.2s。根据以上分析,得到车队纵向运动方程:
es=si-1-si-th*vi-l-d0
ev=vi-1-vi
Figure BDA0002657755610000072
vi=vi
其中,l为车辆长度,本实施例中为4.15m,d0为最小安全距离,一般取2~6m,实施例中取5m,A、B、C分别为状态系数矩阵、输入系数矩阵和输出系数矩阵,通过泰勒展开求雅克比矩阵得到:
Figure BDA0002657755610000073
实施例设定周期T=0.2s,则离散化状态空间方程:
x(k+1)=Akx(k)+Buku{k)+Bwk(k)
y(k)=Ckx(k)
其中:Ak=I+AT,Buk=BuT,Bωk=BωT,Ck=diag(1,1,1,1),即:
Figure BDA0002657755610000074
第二步,建立基于模糊模型预测控制方法的纵向跟随控制***。
为了保证舒适性,即加速度变化率不会发生突变,用加速度变化率Δu代替控制输入量加速度u,整个控制过程通过控制输入量增量Δu来实现,Δu和u的关系式为:
u(k+j|k)=u(k+j-1|k)+Δu(k+j|k)
模型预测控制器根据离散化模型对预测时域内的***输出状态进行预测:
Y(k)=ψx(k)+θΔU(k)+Fu(k-1)+Gω(k)
其中,Yk表示控制器在时刻k对未来Np个时域的预测输出,本发明实施例设置预测时域Np为20,控制时域Nc为5。
ω(k)为测量干扰且ω(k)=ω(k+1)=…=ω(k+Np)=ai-1,其他系数矩阵如下:
Figure BDA0002657755610000081
Figure BDA0002657755610000082
为了避免***出现无解,建立带有松弛因子ε的性能指标函数:
Figure BDA0002657755610000083
其中,第一项为***输出量与参考值的偏差,表示车队的跟随性能;第二项为控制量增量,代表车队对控制量增量平稳变化的要求;第三项为松弛变量,保证***在极端约束下能够输出理想加速度。Q、R分别为误差权重系数矩阵和控制量增量权重系数矩阵。本发明采用模糊模型预测控制,实施例中设置可变误差权重系数Q=QjE,R=5E,ρ为松弛因子的权重系数,实施例中设为1。
为了将目标函数转化为计算机可解的标准二次规划函数,设定***偏差:
E(k)=Yref(k)-Wxx(k)-Wuu(k-1)-Wω(k)
性能指标函数可转化为:
Figure BDA0002657755610000091
其中,
Figure BDA0002657755610000092
这里的Wx、Wu、Wω为系数矩阵,
Figure BDA0002657755610000093
为了保证车队纵向跟随***的稳定性和舒适性,需要构建加入松弛因子的状态量、控制输入和控制输入增量的约束条件:
Figure BDA0002657755610000094
其中,ymin/max、umin/max、Δumin/max表示状态输出量,控制输入量以及控制量增量的最值。实施例中,设置状态输出量(包括间距误差,速度误差,本车加速度,本车速度)的最小值ymin(esmin,evmin,aimin,vimin)=[0m,-15m/s,-6m/s2,0m/s],输出量最大值ymax(esmax,evmax,aimax,vimax)=[40m,15m/s,6m/s2,40m/s]。控制量期望加速度最小值umin=-6m/s2,控制量期望加速度最大值umax=6m/s2。控制量增量加速度变化率最小值Δumin=-0.35m/s3,控制量增量加速度变化率最大值Δumax=0.35m/s3
Figure BDA0002657755610000095
表示输出量、控制量、控制量增量的上下边界松弛系数。
根据以上步骤,***求解带有约束的目标函数,得到k时刻***的控制量增量即理想加速度变化量Δuk,上层控制器输出期望加速度:
ak,des=ak-1+Δuk
期望加速度又作为下一步的控制输入量反馈到控制器中,形成闭环控制。
第三步,在上层控制器引入模糊策略,对于模型预测控制目标函数中的权重系数进行模糊化处理。
在上层控制器设计中引入模糊策略,对目标函数中的权重系数比例因子进行模糊化处理。根据驾驶经验,以及车队纵向跟随控制***对跟随性和平稳性的要求,当车辆间距误差es和速度误差ev较大时,需要加快响应速度,模糊控制***通过增加误差权重系数Q的值,使***更加侧重目标函数的纵向跟随性目标;当车辆间距误差es较小和速度误差ev较小时,***已经接近稳定,模糊控制***通过取较小的误差权重系数Q,使***侧重目标函数的平稳性目标。
传统模型预测控制器的误差权重系数为固定值,本发明实施例中设置为Q=5E,R=5E,E为单位矩阵。在模糊模型预测控制器中,Qj表示误差权重系数的比例因子,设置可变误差权重系数矩阵:
Q=QjE
根据以上分析建立模糊规则库,如图2。由于本发明中速度误差定义为本车速度与前车速度的差值,速度误差会出现负值,因此。在模糊控制器中选择以速度误差绝对值衡量速度误差的大小。模糊控制器的两个输入量为间距误差es和速度误差绝对值|ev|,输出量为误差权重系数比例因子Qj。三个变量的模糊集都设为{NB(负大),NM(负中),NS(负小),ZO(零),PS(正小),PM(正中),PB(正大)}。间距误差es论域设置为[0,40],速度误差绝对值|ev|论域设置为[0,15],误差权重系数比例因子Qj论域设置为[1,10]。隶属度函数均采用具有良好光滑性和对称性的gaussmf函数,得到模糊控制器的输入和输出关系。如图3,模糊控制器输出可变的误差权重系数比例因子Qj进而调整模型预测控制器中的误差权重系数。
第四步,建立下层控制器,对车辆的加速和制动进行控制。
由逆动力学模型分别建立加速控制模型和制动控制模型,根据上层控制器输出的期望加速度正负值切换加速和制动逻辑。
当期望加速度为正值,即需要本车加速时,加速控制模型将上层控制器输出的期望加速度转化为发动机节气门开度,车辆在加速过程中的纵向运动方程式如下:
ma=Ft-Fw-Fd-Fi
这里Fw为空气阻力,Fd为滚动阻力,Fi为坡道阻力,本实施例不考虑坡道情况,故Fi=0。在良好路面,滚动阻力系数一般取值为0.01~0.04,故滚动阻力Fd很小,本文假设为0,Ft表示驱动力:
Figure BDA0002657755610000111
其中,Ttq为发动机转矩,ig,i0分别为变速器传动比和主减速器传动比。联立以上两式,得到发动机转矩Ttq和车辆加速度a之间的函数关系:
Figure BDA0002657755610000112
vr为汽车相对于空气的速度,本文假设无风或微风,即vr=v。
车速与发动机曲轴转速之间的关系为:
Figure BDA0002657755610000113
根据以上分析,可以得到每一组车速和加速度下对应的发动机转矩和发动机曲轴转速,实施例中的车辆模型采用软件Carsim中的C级前驱车辆和125KW的发动机总成,其扭矩特性曲线图如图4所示。根据图4,通过反查表法可得期望节气门开度,即:
αdes=map(Ttq,des,we)。
制动时,制动控制模型将期望加速度转化为制动压力。车辆在制动过程中的纵向运动方程式如下:
ma=Fb-Fw-Fd-Fi
Fb为制动力,在制动力不超过行驶地面所能达到的制动力极限时,可认为制动力与制动压力成线性关系,Kb为制动力和制动压力的比值,即:
Fb=KbPb
经Carsim软件多次仿真实验测得本实施例中,Kb=2196。由以上两式,得到制动压力:
Figure BDA0002657755610000121
由此,可以由当前时刻的汽车速度和上层控制器输出的期望加速度求得理想制动压力。下层控制器将期望节气门开度和期望制动压力输出到车辆的执行机构,进而达到控制车辆纵向加速和制动的目标。
在实施例中,分别采用传统模型预测控制器和本发明提出的模糊模型预测控制器搭建Carsim和Simulink联合仿真平台,模拟在紧急制动场景下车队的纵向控制,车队由同车道行驶的一辆领航车和两辆跟随车组成,三辆车的初始速度设置为110km/h,车辆初始车间距离设为46m,车队匀速行驶10s后,领航车以-4.5m·s-2的加速度紧急制动5s之后匀速行驶,总仿真时间设为30s。采用传统模型预测控制器的车队车辆间距变化和速度变化参见图5和图7,采用本发明提出的模糊模型预测控制器的车队车辆间距变化和车辆速度变化参见图6和图8。
如图5和图6所示,实线表示第一辆跟随车与领航车的间距变化,虚线表示第二辆跟随车与第一辆跟随车的间距变化,在第10s,领航车开始以-4.5m·s-2的加速度紧急制动,后方车辆跟随制动,车间距开始减小。传统模型预测控制器和模糊模型预测控制器都能够将车间距保持在在安全车距范围,但是采用本发明提出的模糊模型预测控制器的车队车辆间距变化曲线更为平缓,且在第26s达到稳定状态。
比较图7和图8,实线表示领航车速度变化,虚线表示第一辆跟随车的速度变化,点线表示第二辆跟随车的速度变化。在10s时,领航车速度开始急剧下降,采用传统模型预测控制器的跟随车辆和采用模糊模型预测控制器的车辆虽然都能够及时跟随前方车辆速度变化,但采用模糊模型预测控制器的车队跟随效率更高。在15s后,领航车速度不再变化,间距误差和速度误差逐渐减小,基于模糊模型预测控制器的车队车速变化曲线更为平滑,在后半段跟随车的乘坐舒适性得到了提高。而采用传统模型预测控制器的车队,速度变化曲线较为激烈,后车速度在与前车速度达到相同时继续制动,出现超调现象。
从实验结果可得,本发明提出的模糊模型预测控制方法能够根据驾驶场景的需要调整模型预测控制目标函数的权重,在保证***稳定的同时提高车队纵向跟随控制的跟随性和平稳性。
上述实例并非是对于本发明的限制,本发明并非仅限于上述实施例,只要符合本发明要求,均属于本发明的保护范围。

Claims (4)

1.一种基于模糊模型预测控制的智能车队纵向跟随控制方法,其特征在于,具体步骤如下:
第一步,建立车队纵向动力学模型
单轨纵向车辆模型运动过程可以由以下微分方程描述:
Figure FDA0003880241700000011
Figure FDA0003880241700000012
Figure FDA0003880241700000013
s、v、a分别代表车辆的纵向位移、车速和加速度;m为车辆总质量,Cd代表气动阻力系数,τ为车辆发动机时间常数,dm为车辆机械阻力;η为发动机控制输入:η=mades+Cdv2+dm+2τCdva;
ades表示控制***输出的期望加速度,车辆实际加速度与期望加速度的关系为:
Figure FDA0003880241700000014
根据运动学模型建立状态空间方程:
Figure FDA0003880241700000015
y(t)=Cx(t);
其中,u=ades表示***控制输入为理想加速度,ω代表***测量的干扰,为前车加速度,即ω=ai-1;x(t)=[es,ev,ai,vi]为***状态量es、ev分别表示车队中第i辆车与前车的间距误差和速度误差,ai、vi表示第i辆车的加速度和速度,车队纵向运动学方程为:
es=si-1-si-th*vi-l-d0
ev=vi-1-vi
Figure FDA0003880241700000016
vi=vi
th为固定车头时距,l为车辆长度,d0为最小安全距离,A、B、C分别为状态系数矩阵、输入系数矩阵和输出系数矩阵,通过泰勒展开求雅克比矩阵得到:
Figure FDA0003880241700000021
设定周期T,则离散化状态空间方程:
x(k+1)=Akx(k)+Buku( k)+Bωk(k)
y(k)=Ckx(k);
其中:Ak=I+AT,Buk=BuT,Bωk=BωT,Ck=diag(1,1,1,1);
第二步,建立基于模糊模型预测控制方法的纵向跟随控制***
为了保证舒适性,即加速度变化率不会发生突变,用控制量增量加速度变化率Δu代替控制输入量u,整个控制过程通过控制增量Δu来实现,Δu和u的关系式为:
u(k+j|k)=u(k+j-1|k)+Δu(k+j|k);
模型预测控制器根据离散化模型对预测时域Np内的***输出状态进行预测:
Y(k)=ψx(k)+θΔU(k)+Fu(k-1)+Gω(k);
其中,Yk表示控制器在时刻k对未来个Np时域的预测输出,Nc为控制时域,ω(k)代表测量干扰且ω(k)=ω(k+1)=…=ω(k+Np)=ai-1
Figure FDA0003880241700000022
Figure FDA0003880241700000023
建立带有松弛因子ε的性能指标函数:
Figure FDA0003880241700000024
其中,Q、R为各控制目标的权重系数矩阵,ρ松弛因子的权重系数;
设定***偏差:
E(k)=Yref(k)-Wxx(k)-Wuu(k-1)-Wω(k);
性能指标函数可转化为标准二次规划函数:
Figure FDA0003880241700000031
其中,
Figure FDA0003880241700000032
这里的Wx、Wu、Wω为系数矩阵,
Figure FDA0003880241700000033
为了保证车队纵向跟随***的稳定性和舒适性,需要构建加入松弛因子的状态量、控制输入和控制输入增量的约束条件:
Figure FDA0003880241700000034
其中,ymin/max、umin/max、Δumin/max表示状态输出量,控制输入量以及控制量增量的最值;
Figure FDA0003880241700000035
表示输出量、控制量、控制量增量的上下边界松弛系数;
根据以上步骤,***求解带有约束的目标函数,得到k时刻***的控制量增量即理想加速度变化量Δuk,上层控制器输出期望加速度:
ak,des=ak-1+Δuk
期望加速度又作为下一步的控制输入量反馈到控制器中,形成闭环控制;
第三步,在上层控制器引入模糊策略,对模型预测控制目标函数中的误差权重系数比例因子进行模糊化处理;
根据驾驶经验,以及车队纵向跟随控制***对跟随性和平稳性的要求,当车辆间距误差es和速度误差ev较大时,需要加快响应速度,模糊控制***通过增加误差权重系数Q的值,使***更加侧重目标函数的纵向跟随性目标;当车辆间距误差es较小和速度误差ev较小时,***已经接近稳定,模糊控制***通过取较小的误差权重系数Q,使***侧重目标函数的平稳性目标;
设置可变误差权重系数矩阵,Qj表示误差权重系数的比例因子:
Q=QjE;
根据以上分析建立模糊规则库,由于速度误差定义为本车速度与前车速度的差值,速度误差会出现负值,因此,在模糊控制器中选择以速度误差绝对值衡量速度误差的大小;模糊控制器的两个输入量为间距误差es和速度误差绝对值|ev|,输出量为误差权重系数比例因子Qj;三个变量的模糊集都设为{NB(负大),NM(负中),NS(负小),ZO(零),PS(正小),PM(正中),PB(正大)};隶属度函数均采用具有良好光滑性和对称性的gaussmf隶属函数,得到模糊控制器的输入和输出关系,模糊控制器输出可变的误差权重系数比例因子Qj进而调整模型预测控制器中误差权重系数;
第四步,建立下层控制器,控制车辆的加速和制动
由逆动力学模型分别建立加速控制模型和制动控制模型,根据上层控制器输出的期望加速度正负值切换加速和制动逻辑;需要本车加速时,加速控制模型将期望加速度转化为发动机节气门开度;制动时,制动控制模型将期望加速度转化为制动压力,进而实现对车辆的纵向跟随控制。
2.如权利要求1所述的一种基于模糊模型预测控制的智能车队纵向跟随控制方法,其特征在于,第一步中,最小安全距离d0取2~6m;固定车头时距th=1.2s;
Figure FDA0003880241700000041
3.如权利要求1所述的一种基于模糊模型预测控制的智能车队纵向跟随控制方法,其特征在于,第三步中,间距误差es论域设置为[0,40],速度误差绝对值|ev|论域设置为[0,15],误差权重系数比例因子Qj论域设置为[1,10]。
4.如权利要求1所述的一种基于模糊模型预测控制的智能车队纵向跟随控制方法,其特征在于,第四步中,车辆在加速过程中的纵向运动方程式如下:
ma=Ft-Fw-Fd-Fi
这里Fw为空气阻力,Fd为滚动阻力,Fi为坡道阻力,不考虑坡道情况,故Fi=0;在良好路面,滚动阻力系数取值为0.01~0.04,故滚动阻力Fd很小,假设为0,Ft表示驱动力:
Figure FDA0003880241700000051
其中,Ttq为发动机转矩,ig,i0分别为变速器传动比和主减速器传动比;联立以上两式,得到发动机转矩Ttq和车辆加速度a之间的函数关系:
Figure FDA0003880241700000052
vr为汽车相对于空气的速度,假设无风或微风,即vr=v;
车速与发动机曲轴转速之间的关系为:
Figure FDA0003880241700000053
根据以上分析,可以得到每一组车速和加速度下对应的发动机转矩和发动机曲轴转速,根据扭矩特性曲线图,通过反查表法可得期望节气门开度,即:
αdes=map(Ttq,des,we);
制动时,制动控制模型将期望加速度转化为制动压力,车辆在制动过程中的纵向运动方程式如下:
ma=Fb-Fw-Fd-Fi
Fb为制动力,在制动力不超过行驶地面所能达到的制动力极限时,可认为制动力与制动压力成线性关系,Kb为制动力和制动压力的比值,即:
Fb=KbPb
Kb的取值与车辆制动参数相关,由实验测得,由以上两式,得到制动压力:
Figure FDA0003880241700000054
由此,可以由当前时刻的汽车速度和上层控制器输出的期望加速度求得理想制动压力;下层控制器将期望节气门开度和期望制动压力输出到车辆的执行机构,进而达到控制车辆纵向加速和制动的目标。
CN202010893725.3A 2020-08-31 2020-08-31 一种基于模糊模型预测控制的智能车队纵向跟随控制方法 Active CN112148001B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010893725.3A CN112148001B (zh) 2020-08-31 2020-08-31 一种基于模糊模型预测控制的智能车队纵向跟随控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010893725.3A CN112148001B (zh) 2020-08-31 2020-08-31 一种基于模糊模型预测控制的智能车队纵向跟随控制方法

Publications (2)

Publication Number Publication Date
CN112148001A CN112148001A (zh) 2020-12-29
CN112148001B true CN112148001B (zh) 2022-12-16

Family

ID=73890345

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010893725.3A Active CN112148001B (zh) 2020-08-31 2020-08-31 一种基于模糊模型预测控制的智能车队纵向跟随控制方法

Country Status (1)

Country Link
CN (1) CN112148001B (zh)

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112758105B (zh) * 2020-12-30 2022-03-22 上海汽车集团股份有限公司 一种自动驾驶车队跟车行驶控制方法、装置及***
CN112660126B (zh) * 2021-01-05 2023-06-20 北京汽车研究总院有限公司 用于自适应巡航的车辆协同控制方法、装置及车辆
CN113788018A (zh) * 2021-04-27 2021-12-14 济南大学 通信时延影响下纵向队列关联车辆***及其模糊控制方法
CN113547930B (zh) * 2021-07-30 2022-06-14 重庆长安新能源汽车科技有限公司 一种纯电动汽车跟车行驶的智能节能控制方法、装置及汽车
CN113525461B (zh) * 2021-08-06 2022-04-22 北京交通大学 面向虚拟编队的列车运行控制方法
CN113928339A (zh) * 2021-10-21 2022-01-14 东风悦享科技有限公司 一种基于状态判断和误差反馈的车辆纵向运动控制***及方法
CN114200835B (zh) * 2021-12-03 2023-04-25 广东工业大学 一种基于Tube MPC的异构车队稳定性分布式控制方法
CN114973676B (zh) * 2022-05-27 2023-08-29 重庆大学 一种快速路车道缩减区的混合交通众从牵制控制方法
CN115031088B (zh) * 2022-06-27 2023-07-25 合肥工业大学 一种管道检测器的速度和加速度控制方法
CN115285120B (zh) * 2022-07-07 2023-08-18 东南大学 一种基于模型预测控制的车辆跟随分层式控制***及方法
CN115346366B (zh) * 2022-07-22 2023-11-28 武汉理工大学 一种考虑路面附着系数的智能网联车队控制方法及***

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09327101A (ja) * 1996-06-06 1997-12-16 Denso Corp 電気自動車の制御装置
CN106476806B (zh) * 2016-10-26 2019-01-15 上海理工大学 基于交通信息的协同式自适应巡航***算法
CN108248605A (zh) * 2018-01-23 2018-07-06 重庆邮电大学 一种智能车辆轨迹跟随的横纵向协调控制方法
CN109969183A (zh) * 2019-04-09 2019-07-05 台州学院 基于安全可控域的弯道跟车控制方法
CN110949366B (zh) * 2019-11-08 2022-04-26 江苏大学 应用智能车辆纵向速度控制的rbf神经网络的终端滑模控制方法
CN110687797B (zh) * 2019-11-11 2022-04-19 湖南大学 一种基于位置和姿态的自适应mpc泊车横向控制方法

Also Published As

Publication number Publication date
CN112148001A (zh) 2020-12-29

Similar Documents

Publication Publication Date Title
CN112148001B (zh) 一种基于模糊模型预测控制的智能车队纵向跟随控制方法
CN110949366B (zh) 应用智能车辆纵向速度控制的rbf神经网络的终端滑模控制方法
CN111284489B (zh) 智能网联汽车随机预测巡航控制***
CN106154831B (zh) 一种基于学习法的智能汽车纵向神经滑模控制方法
CN110985651B (zh) 一种基于预测的自动变速器多参数融合换挡策略
SE1050667A1 (sv) Metod och modul för att styra ett fordons hastighet baserat på kostnad
CN110615003A (zh) 基于策略梯度在线学习算法的巡航控制***及设计方法
SE535356C2 (sv) Metod och modul för att styra ett fordons hastighet baserat på regler
CN113741199B (zh) 一种基于智能网联信息的整车经济性速度规划方法
CN109910863A (zh) 一种基于插电式混合动力轿车专用变速器的控制方法
CN113104023A (zh) 分布式mpc的网联混合动力汽车能量管理***及方法
CN108749816B (zh) 运用能量耗散理论进行智能车辆速度调控的方法
CN114670828A (zh) 一种采用复合模型预测控制器的自适应巡航控制方法
Shen et al. Energy-efficient cruise control using optimal control for a hybrid electric vehicle
Németh et al. LPV-based control design of vehicle platoon considering road inclinations⋆
Feng et al. Pseudo-spectral optimization and data-driven control of vehicle start process with dual-clutch transmission
CN113561976B (zh) 基于反馈优化的车辆节能预测自适应巡航控制方法和装置
CN114475600B (zh) 全速域acc跟车控制方法和***
CN112477880B (zh) 一种无人驾驶汽车纵向控制方法
Ryan Model Predictive Adaptive Cruise Control with Consideration of Comfort and Energy Savings
Xie et al. Research on longitudinal control algorithm for intelligent automatic driving
Gasper et al. Flatness based control of a parallel hybrid drivetrain
Ma et al. Hierarchical control of starting process for wet dual clutch transmission based on direct-drive pump-controlled hydraulic actuator
Li et al. Hierarchical based model predictive control for automatic vehicles brake
CN116513214B (zh) 一种基于滑模控制的车辆纵向跟随分层式控制***及方法

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
GR01 Patent grant
GR01 Patent grant