本发明属于车辆制动控制领域,具体涉及一种抗扰动的车辆主动制动控制系统及方法
背景技术:
主动制动是指车辆无需驾驶员操作,通过分析外部信息,控制制动装置对部分或全部车轮实现制动,广泛应用于自适应巡航控制(acc,adaptivecruisecontrol)、自动紧急制动(aeb,autonomousemergencybraking)、先进驾驶员辅助系统(adas,advanceddriver-assistancesystems)和自动驾驶中。主动制动可凭借电控制动系统实现:传动机构将伺服电机的电磁转矩转化为制动主缸的压力。现应用于主动制动系统的控制方法如滑模控制、定量反馈控制、几何控制等虽然可以解决内在的系统非线性,但未能很好地处理负载波动以及参数变化等未知扰动。这些系统中实际存在的扰动会导致系统动态响应迟滞、制动压力跟踪误差增大甚至发散,严重影响制动可靠性以及驾乘体验。
技术实现要素:
有鉴于此,本发明提供了一种抗扰动的车辆主动制动控制系统及方法,可以保证制动系统在有未知扰动的情况下仍然能达到预定的制动力动态跟踪性能。
为了实现上述目的,本发明采用如下技术方案:
本发明的其中一个目的在于提供一种抗扰动的车辆主动制动控制系统,包括:
伺服电机及传动机构,用于执行控制器指令,输出位移量xser,推动制动主缸活塞在制动主缸内建立压力;
制动主缸p-v特性转换模块,用于将伺服电机及传动机构的输出位移量xser转换为输出压力fp,并反馈至压力控制单元;
压力控制单元,用于根据目标制动压力fp_ref与制动主缸输出压力fp,得到传动机构的目标位移量xser_d,所述的目标位移量由前馈项分量和pi控制器输出的反馈项分量叠加得到;所述的前馈项分量根据目标制动压力fp_ref及制动主缸p-v特性得到;所述的pi控制器用于消除目标制动压力fp_ref与制动主缸输出压力fp的静态误差,得到反馈项分量;
非线性控制单元,包括扩张状态观测器和反步控制模块两部分;所述的扩张状态观测器用于估计系统扰动以及未知的状态变量,得到状态估计量
限幅器,用于根据实际工况对非线性控制单元的输出电压进行限幅;
带宽计算单元,用于计算非线性控制单元中的扩张状态观测器的带宽值ω0的取值范围;
pwm换流器,用于调制参考电压输入,触发换流器开关管动作,驱动伺服电机及传动机构;
压力控制单元接收目标制动压力fp_ref与制动主缸输出压力fp后,输出目标位移xser_d至非线性控制单元中的反步控制模块;反步控制模块同时接收扩张状态观测器输出的状态估计量
作为本发明的优选,所述的状态变量表示为
作为本发明的优选,所述的扰动项包括制动系统方程中的伺服电机电压方程中参数的变化量、电机交直轴耦合项、以及逆变器死区非线性。
作为本发明的优选,所述非线性控制单元中的反步控制模块的控制输出如下:
其中,xi_des,i=1,2,3为虚拟控制量,xser_d为传动机构的目标位移量,
本发明的另一个目的在于提供一种基于上述控制系统的抗扰动的车辆主动制动控制方法,包括以下步骤:
(1)根据车辆制动需求获取制动主缸的目标制动压力fp_ref;利用制动主缸p-v特性关系fp_ref=fp(xser_d)得到伺服电机及传动机构目标位移量的前馈项分量;将前馈项分量与pi控制器输出的反馈项分量叠加得到xser_d;
(2)基于制动系统方程设计抗扰动非线性控制单元,得到伺服电机电压给定值:首先采用扩张状态观测器估计系统扰动以及未知的状态变量,得到状态估计量
(3)将步骤(2)中的伺服电机电压给定值uref输入至限幅器,经过限幅之后作为参考电压输出至pwm换流器,经过pwm调制后通过换流器驱动伺服电机输出制动转矩,从而推动输出推杆在制动主缸跟踪目标压力。
进一步的,所述步骤(2)中的抗扰动非线性控制单元利用扩张状态观测器的状态估计量,通过反步法得到伺服电机电压给定值;所述的扩张状态观测器如下:
式中,a为制动系统的系统矩阵,φ(x)为状态变量间的函数关系,
进一步的,所述带宽ω0的取值约束包括:
第一条件:
第二条件:
第三条件:
其中,|zs|为伺服电机与传动机构的输出位移量与目标位移量的稳态跟踪误差;p,bi,i=2,3分别为正定矩阵与向量;g,ci,i=1,2,3均为与制动系统模型相关的常数;umax为限幅器限值的绝对值;λmin(λ)表示闭环系统矩阵λ的最小特征值,·表示取模。
与现有技术相比,本发明带来了以下有益效果:
(1)本发明提供的抗扰动的车辆主动制动控制系统通过非线性控制单元,在状态变量中引入了扰动项,在模型中加入了有界的未知扰动,通过扩张状态观测器获得状态估计量,再通过反步控制进一步得到伺服电机电压给定值,能够处理负载波动以及参数变化等未知扰动。采用本发明的控制方法可以保证未知的如负载刚度、油温变化、粘滞阻尼等扰动存在时,车辆制动系统的制动主缸仍能实现良好的压力跟踪性能和精度,具有实现简单,鲁棒性强的特点。该方法可以有效提升车辆主动制动功能的可靠性,改善驾乘体验。
(2)本发明采用宽带计算单元分析扩张状态观测器及闭环系统的稳定性来得到带宽值,并给出了带宽值的取值约束条件,在该条件下,制动系统的状态误差能够在有限时间内将一直减小直至收敛,实现了输出推杆位移量对目标量的准确跟踪。
附图说明
图1为电控制动系统的结构示意图;
图2为本发明提供的抗扰动主动制动控制方法示意图;
图3为本发明中非线性控制单元的结构框图;
附图标记:
1-伺服电机(直流电机或永磁同步电机);2-齿轮;3-丝杆螺母;4-输出推杆;5-制动主缸。
具体实施方式
为了更为具体地描述本发明,下面结合附图及具体实施方式对本发明的技术方案进行详细说明。
如图1所示,电控制动系统利用丝杆螺母等传动机构将伺服电机的输出转矩转化为水平方向的推力,带动输出推杆推动制动主缸活塞产生制动压力。其中输出推杆与丝杆为刚性连接,其位移量xser可由伺服电机角度传感器测得。
建立该制动系统方程:
其中:me为制动系统等效质量,ki为传动系数,kt为转矩系数,ke为反电势系数,fp(xser)为拟合制动主缸p-v特性曲线得到的模型;l,r分别为伺服电机电枢的电感和电阻;fl(t),d(t)代表有界的未知扰动,如参数的变化量、负载刚度、油温变化、粘滞阻尼、电机交直轴耦合项、以及逆变器死区非线性等扰动。本实施例中的上述模型参数均选用标称值,并将参数标称值与实际值的偏差归算至扰动项中。
定义状态变量
其中
如图2所示,本发明车辆主动制动的抗扰动控制系统,包括:
伺服电机及传动机构,用于执行控制器指令,输出位移量xser,推动制动主缸活塞在制动主缸内建立压力;
制动主缸p-v特性转换模块,用于将伺服电机及传动机构的输出位移量xser转换为输出压力fp,并反馈至压力控制单元;
压力控制单元,用于根据目标制动压力fp_ref与制动主缸输出压力fp,得到传动机构的目标位移量xser_d,所述的目标位移量由前馈项分量和pi控制器输出的反馈项分量叠加得到;所述的前馈项分量根据目标制动压力fp_ref及制动主缸p-v特性得到;所述的pi控制器用于消除目标制动压力fp_ref与制动主缸输出压力fp的静态误差,得到反馈项分量;
非线性控制单元,包括扩张状态观测器和反步控制模块两部分;所述的扩张状态观测器用于估计系统扰动以及未知的状态变量,得到状态估计量
限幅器,用于根据实际工况对非线性控制单元的输出电压进行限幅;
带宽计算单元,用于计算非线性控制单元中的扩张状态观测器的带宽值ω0的取值范围;
pwm换流器,用于调制参考电压输入,触发换流器开关管动作,驱动伺服电机及传动机构;
压力控制单元接收目标制动压力fp_ref与制动主缸输出压力fp后,输出目标位移xser_d至非线性控制单元中的反步控制模块;反步控制模块同时接收扩张状态观测器输出的状态估计量
在本发明的一项具体实施中,采用图2所述的车辆主动制动的抗扰动控制系统实现主动制动的过程,包括:
(1)根据车辆制动需求获取制动主缸的制动压力参考值fp_ref;利用拟合的p-v特性关系fp_ref=fp(xser_d)求解输出推杆目标位移xser_d的前馈项分量;叠加前馈分量与pi控制器输出的反馈项分量得到xser_d;
(2)基于上述电控制动系统模型设计抗扰动非线性控制单元获得伺服电机的电压给定uref;
具体地,如图3所示,本发明的抗扰动非线性控制单元可分为两部分,扩张状态观测器及非线性控制器。由扩张状态观测器估算未知扰动以及不可测量的状态变量;利用估算的状态量与输出推杆目标位移xser_d通过反步法设计非线性控制器;通过分析系统稳定性确定扩张状态观测器带宽ω0取值的三个条件约束。下面分别进行详细论述:
将扰动q(t)定义为x4,其对时间的导数表示为h(t),并将状态变量x扩张为[x1,x2,x3,x4]t,则原系统方程可改写为:
其中,
定义
其中,
由扩张状态观测器表达式可以得到系统状态偏差:
定义
其中
aηp+paη=-2i
此外,f1(x1)与f2(x2,x3)满足lipschitz条件,则有:
定义李亚普诺夫函数
由上式可确定扩张状态观测器带宽ω0需满足的第一条件,即:
当扩张状态观测器带宽ω0的取值满足上述第一条件时,没有扰动的制动系统状态偏差渐进稳定。
进一步地,未知扰动d(t)由控制输入u来抑制,忽略电流环中的扰动q(t),则:
由于扰动d(t)有界且控制输入u在实际应用中被饱和环节限幅,则有:
|d(t)|≤dmax,|u|≤umax
当满足||pb3||gumax-ω0||pb2||dmax>0时,控制输入u可以有效抑制扰动d(t)。以此确定扩张状态观测器带宽ω0需要满足的第二条件。
仅考虑电流环扰动项h(t)时:
求解上式可得:
令
为确定上式有界,详细分析上述不等式中的组成:首先
通过以上分析可以得到:
令
由上式可以看出状态变量的估计偏差有界且随带宽ω0的增大而减小,因此选取合理的ω0,应在满足约束的情况下尽量选择较大的带宽取值。
设xi_des,i=1,2,3为虚拟控制量,zi,i=1,2,3表示状态变量与虚拟控制量间的误差,即zi=xi-xi_des,则可以得到控制率如下:
其中k1,k2,k3为取值为正的常数。据上述控制量,可求得状态误差模型系统方程:
为了验证制动系统的稳定性,选取李亚普诺夫函数
将上述不等式中常数表示为:
进一步化简该式可得:
其中
设λmin(λ)为矩阵λ的最小特征值,则有:
求解上式可得:
当t>t0+t1时(t1为有限时刻),李亚普诺夫函数有界,表明制动系统在此控制率u作用下稳定。
接下来分析
结合扩张状态观测器ω0的第二条件
综上,当扩张状态观测器的带宽ω0满足第一、二、三条件后,制动系统的状态误差在有限时间内将一直减小直至收敛至|z|s。此时z1=xser-xser_d≤|z1s|,即实现了输出推杆位移量对目标量的准确跟踪。
(3)步骤(2)中的uref经过pwm调整后通过换流器驱动伺服电机输出制动转矩。需要补充的是,本发明中的伺服电机可以为直流电机或者永磁同步电机。因为步骤(1)中建立的制动系统状态方程可以理解为直流电机电压方程或永磁同步电机q轴电压方程。其中将永磁同步电机q轴电压方程中与d轴电流的耦合项认为扰动项,通过扩张状态观测器解耦。
上述的对实施例的描述是为便于本技术领域的普通技术人员能理解和应用本发明。熟悉本领域技术的人员显然可以容易地对上述实施例做出各种修改,并把在此说明的一般原理应用到其他实施例中而不必经过创造性的劳动。因此,本发明不限于上述实施例,本领域技术人员根据本发明的揭示,对于本发明做出的改进和修改都应该在本发明的保护范围之内。