一种电静液作动器的控制方法及系统转让专利

申请号 : CN202010025405.6

文献号 : CN111240196B

文献日 :

基本信息:

PDF:

法律信息:

相似专利:

发明人 : 王兴坚沈友昊王少萍张育玮张超

申请人 : 北京航空航天大学

摘要 :

本发明公开了一种电静液作动器的控制方法及系统。该方法包括:构建电静液作动器的动力学模型;按照能量转换过程对电静液作动器进行系统划分,得到多个子系统;基于动力学模型确定各个子系统的控制律;按照各个子系统的控制律对电静液作动器进行控制。本发明的电静液作动器的控制方法及系统能够提高电静液作动器的控制精度。

权利要求 :

1.一种电静液作动器的控制方法,其特征在于,包括:构建电静液作动器的动力学模型;

按照能量转换过程对电静液作动器进行系统划分,得到多个子系统;

基于所述动力学模型确定各个子系统的控制律;

按照各个所述子系统的控制律对所述电静液作动器进行控制;

所述按照能量转换过程对电静液作动器进行系统划分,得到多个子系统,具体包括:将电静液作动器中执行将来自液压缸内部的液压能转化为作动筒的机械能的子系统作为第一子系统;

将电静液作动器中执行将来自泵的机械能转化为液压缸内部的液压能的子系统作为第二子系统;

将电静液作动器中执行将电机电磁能转换为电机转子的机械能的子系统作为第三子系统;

将电静液作动器中执行将电机的电能转化为电机的电磁能的子系统作为第四子系统;

所述基于所述动力学模型确定各个子系统的控制律,具体包括:基于所述液压缸的力平衡方程创建在已知参数下所述第一子系统的控制律:式中,Ped为液压缸的需求压力, 为需求加速度, 为需求速度,k1>0为本地反馈增益,Y1为回归向量, θ1为参数向量,基于所述液压缸的流量连续方程创建在已知参数下所述第二子系统的控制律:式中,ωed为泵的需求转速, 为Ped的一阶导数,k2>0为本地反馈增益,k3为稳定反馈增益,Y2为回归向量, θ2为参数向量,基于所述电机的转矩平衡方程创建在已知参数下所述第三子系统的控制律:式中,ied为电机的需求电流, 为ωed的一阶导数,k4为本地反馈增益,k5为稳定反馈增益,Y3为回归向量, θ3为参数向量,基于所述电机的电势平衡方程创建在已知参数下所述第四子系统的控制律:式中,ued为电机的需求电压, 为ied的一阶导数,k6为本地反馈增益,k7为稳定反馈增益,Y4为回归向量, θ4为参数向量,在未知参数下所述第一子系统的控制律为:式中, 为θ1的参数估计值;采用自适应算法实时更新;

在未知参数下所述第二子系统的控制律为:式中, 为θ2的参数估计值; 采用自适应算法实时更新;

在未知参数下所述第三子系统的控制律为:式中, 为θ3的参数估计值; 采用自适应算法实时更新;

在未知参数下所述第四子系统的控制律为:式中, 为θ4的参数估计值; 采用自适应算法实时更新。

2.根据权利要求1所述的一种电静液作动器的控制方法,其特征在于,所述电静液作动器包括电机、泵和作动筒;所述电机用于驱动所述泵从而改变液压缸的压力,进而驱动所述作动筒;

所述构建电静液作动器的动力学模型,具体包括:以无刷直流电机作为所述电静液作动器的电机,建立电机的电势平衡方程:式中,ue为电机控制电压;ie为电机电流;Ke为电机反电动势系数;ωe为电机转速;Re为电机电枢电阻;Le为电机电枢电感, 为ie的一阶导数;

建立电机的转矩平衡方程:

式中,Km为电机电磁力矩常数; 为ωe的一阶导数;Bm=Be+Bp为电机与泵的总负载阻尼系数,Be为电机负载阻尼系数,Bp为泵负载阻尼系数;Jm=Je+Jp为电机与泵的总转动惯量,Je为电机转动惯量,Jp为泵转动惯量;Te为电机输出转矩;

建立液压缸的流量连续方程:

式中,VP=V/(2π),V为泵的排量,Ae为液压缸活塞的有效面积;xe为液压缸活塞的位移;

为xe的一阶导数;Ve为液压缸的总容积;Cel为液压缸的总泄露系数,且Cel=Celi+0.5Cele,Celi、Cele分别为液压缸的内泄漏系数和外泄漏系数;Ee为有效体积弹性模量;Pe为负载压力,为Pe的一阶导数;

建立液压缸的力平衡方程:

式中,me为负载质量, 为xe的二阶导数;Be为负载阻尼系数,Fe为外负载,即活塞杆的输出力。

3.一种电静液作动器的控制系统,其特征在于,包括:动力学模型构建模块,用于构建电静液作动器的动力学模型;

系统划分模块,用于按照能量转换过程对电静液作动器进行系统划分,得到多个子系统;

控制律确定模块,用于基于所述动力学模型确定各个子系统的控制律;

控制模块,用于按照各个所述子系统的控制律对所述电静液作动器进行控制;

所述系统划分模块包括:

第一子系统划分单元,用于将电静液作动器中执行将来自液压缸内部的液压能转化为作动筒的机械能的子系统作为第一子系统;

第二子系统划分单元,用于将电静液作动器中执行将来自泵的机械能转化为液压缸内部的液压能的子系统作为第二子系统;

第三子系统划分单元,用于将电静液作动器中执行将电机电磁能转换为电机转子的机械能的子系统作为第三子系统;

第四子系统划分单元,用于将电静液作动器中执行将电机的电能转化为电机的电磁能的子系统作为第四子系统;

所述控制律确定模块包括:

第一控制律确定单元,用于基于所述液压缸的力平衡方程创建在已知参数下所述第一子系统的控制律:

式中,Ped为液压缸的需求压力, 为需求加速度, 为需求速度,k1>0为本地反馈增益,Y1为回归向量, θ1为参数向量,第二控制律确定单元,用于基于所述液压缸的流量连续方程创建在已知参数下所述第二子系统的控制律:

式中,ωed为泵的需求转速, 为Ped的一阶导数,k2>0为本地反馈增益,k3为稳定反馈增益,Y2为回归向量, θ2为参数向量,第三控制律确定单元,用于基于所述电机的转矩平衡方程创建在已知参数下所述第三子系统的控制律:

式中,ied为电机的需求电流, 为ωed的一阶导数,k4为本地反馈增益,k5为稳定反馈增益,Y3为回归向量, θ3为参数向量,第四控制律确定单元,用于基于所述电机的电势平衡方程创建在已知参数下所述第四子系统的控制律:

式中,ued为电机的需求电压, 为ied的一阶导数,k6为本地反馈增益,k7为稳定反馈增益,Y4为回归向量, θ4为参数向量,第五控制律确定单元,用于在未知参数下所述第一子系统的控制律为:式中, 为θ1的参数估计值; 采用自适应算法实时更新;

第六控制律确定单元,用于在未知参数下所述第二子系统的控制律为:式中, 为θ2的参数估计值; 采用自适应算法实时更新;

第七控制律确定单元,用于在未知参数下所述第三子系统的控制律为:式中, 为θ3的参数估计值; 采用自适应算法实时更新;

第八控制律确定单元,用于在未知参数下所述第四子系统的控制律为:式中, 为θ4的参数估计值; 采用自适应算法实时更新。

4.根据权利要求3所述的一种电静液作动器的控制系统,其特征在于,所述电静液作动器包括电机、泵和作动筒;所述电机用于驱动所述泵从而改变液压缸的压力,进而驱动所述作动筒;

所述动力学模型构建模块包括:电势平衡方程建立单元,用于以无刷直流电机作为所述电静液作动器的电机,建立电机的电势平衡方程:

式中,ue为电机控制电压;ie为电机电流;Ke为电机反电动势系数;ωe为电机转速;Re为电机电枢电阻;Le为电机电枢电感, 为ie的一阶导数;

转矩平衡方程建立单元,用于建立电机的转矩平衡方程:式中,Km为电机电磁力矩常数; 为ωe的一阶导数;Bm=Be+Bp为电机与泵的总负载阻尼系数,Be为电机负载阻尼系数,Bp为泵负载阻尼系数;Jm=Je+Jp为电机与泵的总转动惯量,Je为电机转动惯量,Jp为泵转动惯量;Te为电机输出转矩;

流量连续方程建立单元,用于建立液压缸的流量连续方程:式中,VP=V/(2π),V为泵的排量,Ae为液压缸活塞的有效面积;xe为液压缸活塞的位移;

为xe的一阶导数;Ve为液压缸的总容积;Cel为液压缸的总泄露系数,且Cel=Celi+0.5Cele,Celi、Cele分别为液压缸的内泄漏系数和外泄漏系数;Ee为有效体积弹性模量;Pe为负载压力,为Pe的一阶导数;

力平衡方程建立单元,用于建立液压缸的力平衡方程:式中,me为负载质量, 为xe的二阶导数;Be为负载阻尼系数,Fe为外负载,即活塞杆的输出力。

说明书 :

一种电静液作动器的控制方法及系统

技术领域

[0001] 本发明涉及电静液作动器领域,特别是涉及一种电静液作动器的控制方法及系统。

背景技术

[0002] 电静液作动器(Electro‑HydrostaticActuator,EHA)是一种先进的功率电传作动器,具有密度大、重量轻、体积小等优点,代表着未来高性能、高可靠性、高功率密度的航空
航天伺服作动技术的重要发展方向。EHA一般由电机、液压泵、作动筒及一些液压附件构成,
但是由于电机自身惯量较大,电静液作动器的响应速度、频宽等指标提升依赖于先进控制
方法的有效利用。此外,EHA模型复杂、阶数高,受多种非线性和不确定性影响,给EHA的控制
带来挑战。
[0003] EHA的不确定性主要包括内不确定性和外不确定性。内不确定性主要包括参数不确定性和非线性不确定性,这是由于油液的可压缩性、管道压力损失、未知的粘滞阻尼、外
载荷力、阀的物理特性、体积弹性模型和油液温度变化等引起的。外不确定性则是由于驱动
机械设备而受到来自外部的未知负载引起的。此外,EHA控制性能还受输入饱和、白噪声干
扰等问题的影响。
[0004] 随着非线性控制理论的发展,自适应控制、鲁棒控制、反步控制、滑膜控制、神经网络控制等以及这些控制算法的融合使得控制性能被用于EHA的控制中,虽然这些控制方法
使得控制性能得到极大提升,但还存在很多缺陷。例如反步控制可以给非线性解耦提供便
利,但是对于像EHA这样超过三阶的系统,在微小白噪声影响下很容易产生微分爆炸使得控
制精度较低。

发明内容

[0005] 基于此,有必要提供一种电静液作动器的控制方法及系统,提高电静液作动器的控制精度。
[0006] 为实现上述目的,本发明提供了如下方案:
[0007] 一种电静液作动器的控制方法,包括:
[0008] 构建电静液作动器的动力学模型;
[0009] 按照能量转换过程对电静液作动器进行系统划分,得到多个子系统;
[0010] 基于所述动力学模型确定各个子系统的控制律;
[0011] 按照各个所述子系统的控制律对所述电静液作动器进行控制。
[0012] 可选的,所述电静液作动器包括电机、泵和作动筒;所述电机用于驱动所述泵从而改变液压缸的压力,进而驱动所述作动筒;
[0013] 所述构建电静液作动器的动力学模型,具体包括:
[0014] 以无刷直流电机作为所述电静液作动器的电机,建立电机的电势平衡方程:
[0015]
[0016] 式中,ue为电机控制电压;ie为电机电流;Ke为电机反电动势系数;ωe为电机转速;Re为电机电枢电阻;Le为电机电枢电感, 为ie的一阶导数;
[0017] 建立电机的转矩平衡方程:
[0018]
[0019] 式中,Km为电机电磁力矩常数; 为ωe的一阶导数;Bm=Be+Bp为电机与泵的总负载阻尼系数,Be为电机负载阻尼系数,Bp为泵负载阻尼系数;Jm=Je+Jp为电机与泵的总转动
惯量,Je为电机转动惯量,Jp为泵转动惯量;Te为电机输出转矩;
[0020] 建立液压缸的流量连续方程:
[0021]
[0022] 式中,VP=V/(2π),V为泵的排量,Ae为液压缸活塞的有效面积;xe为液压缸活塞的位移; 为xe的一阶导数;Ve为液压缸的总容积;Cel为液压缸的总泄露系数,且Cel=Celi+
0.5Cele,Celi、Cele分别为液压缸的内泄漏系数和外泄漏系数;Ee为有效体积弹性模量;Pe为负
载压力, 为Pe的一阶导数;
[0023] 建立液压缸的力平衡方程:
[0024]
[0025] 式中,me为负载质量, 为 的二阶导数;Be为负载阻尼系数,Fe为外负载,即活塞杆的输出力。
[0026] 可选的,所述按照能量转换过程对电静液作动器进行系统划分,得到多个子系统,具体包括:
[0027] 将电静液作动器中执行将来自液压缸内部的液压能转化为作动筒的机械能的子系统作为第一子系统;
[0028] 将电静液作动器中执行将来自泵的机械能转化为液压缸内部的液压能的子系统作为第二子系统;
[0029] 将电静液作动器中执行将电机电磁能转换为电机转子的机械能的子系统作为第三子系统;
[0030] 将电静液作动器中执行将电机的电能转化为电机的电磁能的子系统作为第四子系统。
[0031] 可选的,所述基于所述动力学模型确定各个子系统的控制律,具体包括:
[0032] 基于所述液压缸的力平衡方程创建在已知参数下所述第一子系统的控制律:
[0033]
[0034] 式中,Ped为液压缸的需求压力, 为需求加速度, 为需求速度,k1>0为本地反馈增益,Y1为回归向量, θ1为参数向量,
[0035] 基于所述液压缸的流量连续方程创建在已知参数下所述第二子系统的控制律:
[0036]
[0037] 式中,ωed为泵的需求转速, 为Ped的一阶导数,k2>0为本地反馈增益,k3为稳定反馈增益,Y2为回归向量, θ2为参数向量,
[0038] 基于所述电机的转矩平衡方程创建在已知参数下所述第三子系统的控制律:
[0039]
[0040] 式中,ied为电机的需求电流, 为ωed的一阶导数,k4为本地反馈增益,k5为稳定反馈增益,Y3为回归向量, θ3为参数向量,
[0041] 基于所述电机的电势平衡方程创建在已知参数下所述第四子系统的控制律:
[0042]
[0043] 式中,ued为电机的需求电压, 为ied的一阶导数,k6为本地反馈增益,k7为稳定反馈增益,Y4为回归向量, θ4为参数向量,
[0044] 在未知参数下所述第一子系统的控制律为:
[0045]
[0046] 式中,为θ1的参数估计值; 采用自适应算法实时更新;
[0047] 在未知参数下所述第二子系统的控制律为:
[0048]
[0049] 式中, 为θ2的参数估计值; 采用自适应算法实时更新;
[0050] 在未知参数下所述第三子系统的控制律为:
[0051]
[0052] 式中, 为θ3的参数估计值; 采用自适应算法实时更新;
[0053] 在未知参数下所述第四子系统的控制律为:
[0054]
[0055] 式中, 为θ4的参数估计值; 采用自适应算法实时更新。
[0056] 本发明还公开一种电静液作动器的控制系统,包括:
[0057] 动力学模型构建模块,用于构建电静液作动器的动力学模型;
[0058] 系统划分模块,用于按照能量转换过程对电静液作动器进行系统划分,得到多个子系统;
[0059] 控制律确定模块,用于基于所述动力学模型确定各个子系统的控制律;
[0060] 控制模块,用于按照各个所述子系统的控制律对所述电静液作动器进行控制。
[0061] 可选的,所述电静液作动器包括电机、泵和作动筒;所述电机用于驱动所述泵从而改变液压缸的压力,进而驱动所述作动筒;
[0062] 所述动力学模型构建模块包括:
[0063] 电势平衡方程建立单元,用于以无刷直流电机作为所述电静液作动器的电机,建立电机的电势平衡方程:
[0064]
[0065] 式中,ue为电机控制电压;ie为电机电流;Ke为电机反电动势系数;ωe为电机转速;Re为电机电枢电阻;Le为电机电枢电感, 为ie的一阶导数;
[0066] 转矩平衡方程建立单元,用于建立电机的转矩平衡方程:
[0067]
[0068] 式中,Km为电机电磁力矩常数; 为ωe的一阶导数;Bm=Be+Bp为电机与泵的总负载阻尼系数,Be为电机负载阻尼系数,Bp为泵负载阻尼系数;Jm=Je+Jp为电机与泵的总转动
惯量,Je为电机转动惯量,Jp为泵转动惯量;Te为电机输出转矩;
[0069] 流量连续方程建立单元,用于建立液压缸的流量连续方程:
[0070]
[0071] 式中,VP=V/(2π),V为泵的排量,Ae为液压缸活塞的有效面积;xe为液压缸活塞的位移; 为xe的一阶导数;Ve为液压缸的总容积;Cel为液压缸的总泄露系数,且Cel=Celi+
0.5Cele,Celi、Cele分别为液压缸的内泄漏系数和外泄漏系数;Ee为有效体积弹性模量;Pe为负
载压力, 为Pe的一阶导数;
[0072] 力平衡方程建立单元,用于建立液压缸的力平衡方程:
[0073]
[0074] 式中,me为负载质量, 为xe的二阶导数;Be为负载阻尼系数,几为外负载,即活塞杆的输出力。
[0075] 可选的,所述系统划分模块包括:
[0076] 第一子系统划分单元,用于将电静液作动器中执行将来自液压缸内部的液压能转化为作动筒的机械能的子系统作为第一子系统;
[0077] 第二子系统划分单元,用于将电静液作动器中执行将来自泵的机械能转化为液压缸内部的液压能的子系统作为第二子系统;
[0078] 第三子系统划分单元,用于将电静液作动器中执行将电机电磁能转换为电机转子的机械能的子系统作为第三子系统;
[0079] 第四子系统划分单元,用于将电静液作动器中执行将电机的电能转化为电机的电磁能的子系统作为第四子系统。
[0080] 可选的,所述控制律确定模块包括:
[0081] 第一控制律确定单元,用于基于所述液压缸的力平衡方程创建在已知参数下所述第一子系统的控制律:
[0082]
[0083] 式中,Ped为液压缸的需求压力, 为需求加速度, 为需求速度,k1>0为本地反馈增益,Y1为回归向量, θ1为参数向量,
[0084] 第二控制律确定单元,用于基于所述液压缸的流量连续方程创建在已知参数下所述第二子系统的控制律:
[0085]
[0086] 式中,ωed为泵的需求转速, 为Ped的一阶导数,k2>0为本地反馈增益,k3为稳定反馈增益,Y2为回归向量, θ2为参数向量,
[0087] 第三控制律确定单元,用于基于所述电机的转矩平衡方程创建在已知参数下所述第三子系统的控制律:
[0088]
[0089] 式中,ied为电机的需求电流, 为ωed的一阶导数,k4为本地反馈增益,k5为稳定反馈增益,Y3为回归向量, θ3为参数向量,
[0090] 第四控制律确定单元,用于基于所述电机的电势平衡方程创建在已知参数下所述第四子系统的控制律:
[0091]
[0092] 式中,ued为电机的需求电压, 为ied的一阶导数,k6为本地反馈增益,k2为稳定反馈增益,Y4为回归向量, θ4为参数向量,
[0093] 第五控制律确定单元,用于在未知参数下所述第一子系统的控制律为:
[0094]
[0095] 式中, 为θ1的参数估计值; 采用自适应算法实时更新;
[0096] 第六控制律确定单元,用于在未知参数下所述第二子系统的控制律为:
[0097]
[0098] 式中, 为θ2的参数估计值; 采用自适应算法实时更新;
[0099] 第七控制律确定单元,用于在未知参数下所述第三子系统的控制律为:
[0100]
[0101] 式中, 为θ3的参数估计值; 采用自适应算法实时更新;
[0102] 第八控制律确定单元,用于在未知参数下所述第四子系统的控制律为:
[0103]
[0104] 式中, 为θ4的参数估计值; 采用自适应算法实时更新。
[0105] 与现有技术相比,本发明的有益效果是:
[0106] 本发明提出的电静液作动器的控制方法及系统,采用虚拟分解的方法,将EHA分解为多个子系统,在子系统级别上确定控制律,能够避免产生微分爆炸,提高控制精度。

附图说明

[0107] 为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施
例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图
获得其他的附图。
[0108] 图1为本发明实施例1的电静液作动器的控制方法的方法流程图;
[0109] 图2为EHA系统结构简图;
[0110] 图3为EHA系统虚拟分解示意图;
[0111] 图4为EHA系统的Simulink仿真模型;
[0112] 图5为本发明的电静液作动器的控制方法在输入正弦位移指令下的跟踪误差曲线图;
[0113] 图6为本发明的电静液作动器的控制方法和传统PID控制器作用下EHA系统位移跟踪曲线对比图;
[0114] 图7为本发明的电静液作动器的控制方法在加入白噪声时的跟踪误差曲线图;
[0115] 图8为本发明的电静液作动器的控制方法作用下参数Be的估计曲线图。

具体实施方式

[0116] 下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于
本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他
实施例,都属于本发明保护的范围。
[0117] 为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
[0118] 实施例1:
[0119] 图1为本发明实施例1的电静液作动器的控制方法的方法流程图。
[0120] 参见图1,该电静液作动器的控制方法,包括:
[0121] 步骤101:构建电静液作动器的动力学模型。
[0122] 电静液作动器包括电机、泵和作动筒;电机用于驱动泵从而改变液压缸的压力,进而驱动作动筒。
[0123] 步骤101具体包括:
[0124] 以无刷直流电机作为电静液作动器的电机,建立电机的电势平衡方程:
[0125]
[0126] 式中,ue为电机控制电压;ie为电机电流;Ke为电机反电动势系数;ωe为电机转速;Re为电机电枢电阻;Le为电机电枢电感, 为ie的一阶导数;
[0127] 建立电机的转矩平衡方程:
[0128]
[0129] 式中,Km为电机电磁力矩常数; 为ωe的一阶导数;Bm二Be+Bp为电机与泵的总负载阻尼系数,Be为电机负载阻尼系数,Bp为泵负载阻尼系数;Jm=Je+Jp为电机与泵的总转动
惯量,Je为电机转动惯量,Jp为泵转动惯量;Te为电机输出转矩;
[0130] 建立液压缸的流量连续方程:
[0131]
[0132] 式中,VP=V/(2π),V为泵的排量,Ae为液压缸活塞的有效面积;xe为液压缸活塞的位移; 为xe的一阶导数;Ve为液压缸的总容积;Cel为液压缸的总泄露系数,且Cel=Celi+
0.5Cele,Celi、Cele分别为液压缸的内泄漏系数和外泄漏系数;Ee为有效体积弹性模量;Pe为负
载压力, 为Pe的一阶导数;
[0133] 建立液压缸的力平衡方程:
[0134]
[0135] 式中,me为负载质量, 为xe的二阶导数;Be为负载阻尼系数,Fe为外负载,即活塞杆的输出力。
[0136] 步骤102:按照能量转换过程对电静液作动器进行系统划分,得到多个子系统。
[0137] 步骤102,具体包括:
[0138] 将电静液作动器中执行将来自液压缸内部的液压能转化为作动筒的机械能的子系统作为第一子系统;
[0139] 将电静液作动器中执行将来自泵的机械能转化为液压缸内部的液压能的子系统作为第二子系统;
[0140] 将电静液作动器中执行将电机电磁能转换为电机转子的机械能的子系统作为第三子系统;
[0141] 将电静液作动器中执行将电机的电能转化为电机的电磁能的子系统作为第四子系统。
[0142] 步骤103:基于动力学模型确定各个子系统的控制律。
[0143] 步骤103具体包括:
[0144] 基于液压缸的力平衡方程创建在已知参数下第一子系统的控制律:
[0145]
[0146] 式中,Ped为液压缸的需求压力, 为需求加速度, 为需求速度,k1>0为本地反馈增益,Y1为回归向量, θ1为参数向量,
[0147] 基于液压缸的流量连续方程创建在已知参数下第二子系统的控制律:
[0148]
[0149] 式中,ωed为泵的需求转速, 为Ped的一阶导数,k2>0为本地反馈增益,k3为稳定反馈增益,Y2为回归向量, θ2为参数向量,
[0150] 基于电机的转矩平衡方程创建在已知参数下第三子系统的控制律:
[0151]
[0152] 式中,ied为电机的需求电流, 为ωed的一阶导数,k4为本地反馈增益,k5为稳定反馈增益,Y3为回归向量, θ3为参数向量,
[0153] 基于电机的电势平衡方程创建在已知参数下第四子系统的控制律:
[0154]
[0155] 式中,ued为电机的需求电压, 为ied的一阶导数,k6为本地反馈增益,k7为稳定反馈增益,Y4为回归向量, θ4为参数向量
[0156] 在未知参数下第一子系统的控制律为:
[0157]
[0158] 式中, 为θ1的参数估计值; 采用自适应算法实时更新;
[0159] 在未知参数下第二子系统的控制律为:
[0160]
[0161] 式中, 为θ2的参数估计值; 采用自适应算法实时更新;
[0162] 在未知参数下第三子系统的控制律为:
[0163]
[0164] 式中, 为θ3的参数估计值; 采用自适应算法实时更新;
[0165] 在未知参数下第四子系统的控制律为:
[0166]
[0167] 式中, 为θ4的参数估计值; 采用自适应算法实时更新。
[0168] 步骤104:按照各个子系统的控制律对电静液作动器进行控制。
[0169] 实施例2:
[0170] 该实施例2为相对实施例1更加具体的实施例。
[0171] 基础理论:
[0172] L2和L∞稳定性理论基础:
[0173] Lebesgue space(勒贝格空间)有以下定义:
[0174] 定义1:Lebesguespace,用Lp表示且p为正整数,其可测可积分的函数f(t)满足:
[0175]
[0176] 考虑两种特殊情况:
[0177] (a)一个Lebesgue可测函数f(t)属于L2当且仅当
[0178] (b)一个Lebesgue可测函数f(t)属于L∞当且仅当
[0179] L2为二阶勒贝格空间,L∞为无穷阶勒贝格空间。
[0180] 以下三个引理可证得L2和L∞稳定性
[0181] 引理1:考虑一个非负可微函数ξ(t)定义为
[0182]
[0183] 其中,ai>0且n≥1。若ξ(t)对时间的微分是Lebesgue可积且
[0184]
[0185] 其中,bj>0且m≥1,则满足ξ(t)∈L∞,xi(t)∈L∞且yj(t)∈L2当 且成立。
[0186] 引理2和3可证得当进行一阶微分后,L2和L∞信号保持其原特性。
[0187] 引理2:考虑以下一阶系统
[0188]
[0189] 其中c>0。对于p=2,∞,如果u(t)∈Lp成立,则x(t)∈Lp和 成立。
[0190] 引理3:如果e(t)∈L2且 则limt→∞e(t)=0。
[0191] 与传统的李雅普诺夫证明稳定性的方法不同,引理1可以允许变量及其微分形式出现。根据引理一,当所有的误差信号属于L2和L∞,则可以通过引理2证明误差的微分属于
L∞,进而由引理3证明误差信号的渐进稳定性。
[0192] 参数自适应理论基础:
[0193] 以下理论用于自适应算法:
[0194] 定义2:射影函数 为二阶可微标量函数且t≥0,其对时间的微分定义为
[0195]
[0196] 其中
[0197]
[0198] 这里,s(t)为标量变量,κ>0和c>0为常数,且a(t)<b(t)。
[0199] 对于任何服从a(t)≤Ρc2≤b(t)的常量Ρc2,得
[0200]
[0201] 通过以上处理,为Ρ2分配上限a(t)和下限b(t)。在参数区间内时,Ρ2将由s(t)及其增益k决定。当参数超出区间时,纠正项将使得Ρ2回到区间[a(t),b(t)],以保证其始终
位于区间内。Ρ2函数可以有效防止参数估计值的漂移,由此来克服模型的不确定性及外部
的干扰项,提高控制器的鲁棒性。
[0202] 基于上述理论基础,本实施例2的具体步骤包括:
[0203] 步骤一:构建电静液作动器的动力学模型
[0204] 如图2所示,EHA一般由电机、泵、作动筒及一些液压附件构成,通过控制电机的电压ue来调节电机转速,电机驱动泵来改变液压缸的压力,进而将转化为作动筒的位移xe。
[0205] 下面对EHA进行动力学模型构建。
[0206] 电机采用无刷直流电机,电势平衡方程为
[0207]
[0208] 式中:ue——电机控制电压;ie——电机电流;Ke——电机反电动势系数;ωe——电机转速;Re——电机电枢电阻;Le——电机电枢电感。
[0209] 电机的转矩平衡方程为
[0210]
[0211] 式中:Km——电机电磁力矩常数;Te——电机输出转矩;Bm=Be+Bp——电机与泵的总负载阻尼系数;Jm=Je+Jp——电机与泵的总转动惯量。
[0212] 基于EHA对速度和负载的要求,选用双向柱塞定量泵,液压缸为对称液压缸。为便于分析,认为泵与电机是刚性连接,两者具有相同的转速,且电机的输出转矩即泵的输入转
矩。假设泵的总效率为1,可得泵的输入转矩:
[0213]
[0214] 其中V为泵的排量,n为电机转动线速度,ω为电机转动角速度,Pa、Pb分别为泵的出口和入口压力,VP=V/(2π)。
[0215] 假设泵的内外泄露系数均为0且不考虑油液容积的变化,泵的流量方程为:
[0216] qa=qb=Vn=VPωe      (11)
[0217] 考虑到EHA的对称性,不考虑泵和作动筒之间的压降,并假设泵和作动筒之间的液压管路的流量损失为零,得:
[0218]
[0219] 其中P1、P2分别为液压缸入口及出口压力,q1、q2分别为液压缸入口及出口的流量;
[0220] 得到EHA的负载压力Pe和负载流量Qe为
[0221]
[0222] 考虑到液体的压缩量以及缸体结构的机械膨胀量,可得液压缸的流量连续方程:
[0223]
[0224] 式中:Ae——液压缸活塞的有效面积;xe——液压缸活塞的位移;Ve——液压缸的总容积;Cel——液压缸的总泄露系数,且Cel=Celi+0.5Cele,Celi、Cele分别为液压缸的内、外
泄漏系数;Ee——有效体积弹性模量。
[0225] 液压缸的力平衡方程为
[0226]
[0227] 式中,me为负载质量,Be为负载阻尼系数,Fe为外负载,也是活塞杆的输出力,xe为液压缸输出位移。
[0228] 步骤二:按照能量转换过程对电静液作动器进行系统划分,得到多个子系统。
[0229] EHA系统是一个模型复杂、阶数高且存在大量耦合的复杂系统,但子系统动力学相对简单,在子系统级别上进行控制器的确定及稳定性分析,可以在不简化系统的情况下使
控制器的确定变得更加简单。同时,改变一个子系统的控制或者动力学不会影响其他子系
统的控制方程。
[0230] 在EHA系统中,能量有以下转化关系:
[0231] 经过电机,电能转化为电磁能,然后转化为电机转子机械能;通过泵,将转子的机械能转化为液压缸内部液压能;通过作动筒,将液压缸内部液压能转化为作动筒机械能,实
现位移输出。
[0232] 从以上角度考虑,将EHA分解为如图3所示:子系统1为作动筒,以液压缸左右腔压差Pe为输入,输出为作动筒位移xe及速度 对应作动筒的力平衡方程,在子系统1中将来
自液压缸内部的液压能转化为作动筒的机械实现位移输出;子系统2为泵控缸部分,以泵的
输入转矩ωe为输入,输出为液压缸左右腔压差Pe,对应液压缸的流量连续方程,在子系统2
中将来自泵的机械能转化为液压缸内部的液压能;子系统3为电机内机械部分,以电机的电
流ie为输入,输出为电机的转速,也为泵的转速,对应电机的转矩平衡方程,在子系统3中将
电机中的电磁能转化为电机转子的机械能;子系统4为电机的电气部分,以电机的控制电压
ue为输入,输出为电机的电流ie,对应电机的电势平衡方程,在子系统4中将输入电机的电能
转化为电机内部的电磁能。
[0233] 将EHA五阶系统分解为如图3所示4个虚拟子系统,在此基础上确定各个子系统的控制律,子系统之间通过虚拟功率流进行交互,通过保证各子系统的L2和L∞稳定性和收敛
性来得到子系统和整个EHA系统的稳定性。
[0234] 步骤三:基于动力学模型确定各个子系统的控制律。
[0235] (一)确定各个子系统在参数已知情况下的控制律。
[0236] 子系统1:
[0237] 控制器最终的控制目标为液压缸输出速度以及位移的轨迹跟踪,基于虚拟分解控制方法,定义需求速度(requiredreference) 来代替传统的期望速度
(desiredreference) 定义如下:
[0238]
[0239] 式中,xed为期望位移,λ>0为输出位移反馈增益。
[0240] 由公式(15),子系统1在已知参数下的控制律为
[0241]
[0242] 式中,Ped为液压缸的需求压力, 为需求加速度,k1>0为本地反馈增益,Y1θ1为基1×3
于模型的前馈补偿项,回归向量 参数向量 R 表示1行
3
3列矩阵,R表示3行1列矩阵。
[0243] 令子系统1的非负伴随矩阵v1为
[0244]
[0245] 由式(15)(17)(18),得v1相对时间的导数为
[0246]
[0247] 子系统2:
[0248] 由公式(14),子系统2在已知参数下控制律为
[0249]
[0250] 式中,ωed为泵的需求转速,k2>0为本地反馈增益,k3为稳定反馈增益,Y2θ2为基于模型的前馈补偿项,回归向量 参数向量
[0251] 令子系统2的非负伴随矩阵v2为
[0252]
[0253] 由式(14)(20)(21),得v2相对时间的导数为
[0254]
[0255] 子系统3:
[0256] 由公式(9),子系统3在已知参数下控制律为
[0257]
[0258] 式中,ied为电机的需求电流,k4为本地反馈增益,k5为稳定反馈增益,Y3θ3为基于模型的前馈补偿项,回归向量 参数向量
[0259] 令子系统3的非负伴随矩阵v3为
[0260]
[0261] 由于(9)(23)(24),得v3相对时间的导数为
[0262]
[0263] 子系统4:
[0264] 由公式(8),子系统4在已知参数下控制律为
[0265]
[0266] 式中,ued为电机的需求电压,k6为本地反馈增益,k7为稳定反馈增益,Y4θ4为基于模型的前馈补偿项,回归向量 参数向量
[0267] 令子系统4的非负伴随矩阵v4为
[0268]
[0269] 由式(8)(26)(27),得v4相对时间的导数为
[0270]
[0271] 由于控制器的输出ued即为系统电机的输入电压ue,因此得(ued‑ue)=0。
[0272] 有
[0273]
[0274] 令EHA系统的非负伴随矩阵为
[0275]
[0276] 其中a1>0,a2>0,a3>0,a4>0。
[0277] v相对时间的导数为
[0278]
[0279] 其中b1>0,b2>0,b3>0,b4>0。
[0280] 由定义1及引理1:
[0281]
[0282] Ped‑Pe∈L2∩L∞        (33)
[0283] ωed‑ωe∈L2∩L∞         (34)
[0284] ied‑ie∈L2∩L∞       (35)
[0285] 由引理2:
[0286]
[0287] 得:
[0288]
[0289] xed‑xe∈L2∩L∞        (38)
[0290] 由引理3证得以上以上所有误差项渐近收敛,证得EHA各子系统及整个系统的稳定性。
[0291] (二)确定各个子系统在参数已知情况下的控制律。
[0292] 由于EHA系统具有非线性强、系统阶数高等特点,且模型及参数有着众多不确定性及干扰因素,已知参数下控制器性能应用到实际的系统中可能使得系统控制性能欠佳,因
此加入自适应算法,确定带有自适应环节的控制器改善系统的控制性能。
[0293] 子系统1:
[0294] 当子系统1的参数未知时,控制器如下:
[0295]
[0296] 式中, 为基于模型的前馈补偿项,其中 为θ1的参数估计值。
[0297] 其中,参数向量的估计值 通过自适应算法进行实时更新:
[0298] 定义
[0299]
[0300] 定义如下Ρ2函数对 中第γ个参数进行更新:
[0301]
[0302] 表示 中第γ个元素,s1γ表示第γ个元素的更新函数,k表示更新增益,c表示校正增益,θ1γ和 分别代表θ1γ的下限和上限。
[0303] 令子系统1的非负伴随矩阵
[0304]
[0305] 对其求导可得:
[0306]
[0307] 子系统2:
[0308] 当子系统2的参数未知时,控制器如下:
[0309]
[0310] 式中, 为基于模型的前馈补偿项,其中 为θ2的参数估计值。
[0311] 其中,参数向量 通过自适应算法进行实时更新:
[0312] 定义
[0313] s2=(Ped‑Pe)Y2T       (45)
[0314] 定义如下Ρ2函数对 中第γ个参数进行更新:
[0315]
[0316] 表示 中第γ个元素,s2γ为表示第γ个元素的更新函数,k表示更新增益,c表示校正增益,θ2γ和 分别代表θ2γ的下限和上限。
[0317] 令子系统2的非负伴随矩阵
[0318]
[0319] 对其求导可得:
[0320]
[0321] 子系统3:
[0322] 当子系统3的参数未知时,控制器如下:
[0323]
[0324] 式中, 为基于模型的前馈补偿项,其中 为θ3的参数估计值。
[0325] 其中,参数向量 通过自适应算法进行实时更新:
[0326] 定义
[0327] s3=(ωed‑ωe)Y3T     (50)
[0328] 定义如下Ρ2函数对 中第γ个参数进行更新:
[0329]
[0330] 表示 中第γ个元素,s3γ为表示第γ个元素的更新函数,k表示更新增益,c表示校正增益,θ3γ和 分别代表θ3γ的下限和上限。
[0331] 令子系统3的非负伴随矩阵
[0332]
[0333] 对其求导可得:
[0334]
[0335] 子系统4:
[0336] 当子系统4的参数未知时,控制器如下:
[0337]
[0338] 式中, 为基于模型的前馈补偿项,其中 为θ4的参数估计值。
[0339] 其中,参数向量 通过自适应算法进行实时更新:
[0340] 定义
[0341] s4=(ied‑ie)Y4T        (55)
[0342] 定义如下Ρ2函数对 中第γ个参数进行更新:
[0343]
[0344] 表示 中第γ个元素,s4γ为表示第γ个元素的更新函数,k表示更新增益,c表示校正增益,θ4γ和 分别代表θ4γ的下限和上限。
[0345] 令子系统4的非负伴随矩阵
[0346]
[0347] 对其求导可得:
[0348]
[0349] 令EHA系统的非负伴随矩阵
[0350]
[0351] 其中a1>0,a2>0,a3>0,a4>0。
[0352] va相对时间的导数为
[0353]
[0354] 其中b1>0,b2>0,b3>0,b4>0。
[0355] 由定义1及引理1:
[0356]
[0357] Ped‑Pe∈L2∩L∞     (62)
[0358] ωed‑ωe∈L2∩L∞        (63)
[0359] ied‑ie∈L2∩L∞        (64)
[0360] 由引理2:
[0361]
[0362] 得:
[0363]
[0364] xed‑xe∈L2∩L∞      (67)
[0365] 由引理3证得以上以上所有误差项渐近收敛,证得EHA各子系统及整个系统的稳定性。
[0366] 下面通过仿真对本发明的方法(即虚拟分解控制方法)进行验证:
[0367] 为了验证上述提出的控制律及自适应控制算法的有效性,在MATLAB/Simulink环境下建立EHA系统动力学仿真模型,如图4所示。
[0368] 输入位置指令为幅值0.05m,频率为1Hz的正弦曲线,跟踪误差如图5所示,最大跟‑5 ‑5
踪误差为±1.8×10 m,且启动后最大跟踪误差为±0.8×10 m。将本发明的控制方法和传
统PID控制器的控制结果作对比分析,跟踪误差对比如图6所示。可以看出,与传统的PID控
制相比,控制精度有较大幅度的提升,有效的克服了非线性和不确定性带来的困难。加入白
噪声后,控制误差如图7所示,可见跟踪误差并没有明显增大,可以很好地解决传统反步控
制中白噪声带来的微分爆炸问题。控制器的参数如表1所示。
[0369] 表1控制器参数
[0370]
[0371] 自适应控制律部分参数如下表所示:
[0372] 表2部分自适应控制律参数表
[0373]
[0374]
[0375] 自适应控制律对参数Be作用效果如图8所示,可见其能更新控制器参数使其接近真实值,且能有效地防止控制器参数漂移现象,从而有效减小不确定性对系统控制性能的
影响。
[0376] 实施例3:
[0377] 该实施例3公开一种电静液作动器的控制系统,包括:
[0378] 动力学模型构建模块,用于构建电静液作动器的动力学模型;
[0379] 系统划分模块,用于按照能量转换过程对电静液作动器进行系统划分,得到多个子系统;
[0380] 控制律确定模块,用于基于动力学模型确定各个子系统的控制律;
[0381] 控制模块,用于按照各个子系统的控制律对电静液作动器进行控制。
[0382] 可选的,电静液作动器包括电机、泵和作动筒;电机用于驱动泵从而改变液压缸的压力,进而驱动作动筒;
[0383] 动力学模型构建模块包括:
[0384] 电势平衡方程建立单元,用于以无刷直流电机作为电静液作动器的电机,建立电机的电势平衡方程:
[0385]
[0386] 式中,ue为电机控制电压;ie为电机电流;Ke为电机反电动势系数;ωe为电机转速;Re为电机电枢电阻;Le为电机电枢电感, 为ie的一阶导数;
[0387] 转矩平衡方程建立单元,用于建立电机的转矩平衡方程:
[0388]
[0389] 式中,Km为电机电磁力矩常数; 为ωe的一阶导数;Bm=Be+Bp为电机与泵的总负载阻尼系数,Be为电机负载阻尼系数,Bp为泵负载阻尼系数;Jm=Je+Jp为电机与泵的总转动
惯量,Je为电机转动惯量,Jp为泵转动惯量;Te为电机输出转矩;
[0390] 流量连续方程建立单元,用于建立液压缸的流量连续方程:
[0391]
[0392] 式中,VP=V/(2π),V为泵的排量,Ae为液压缸活塞的有效面积;xe为液压缸活塞的位移; 为xe的一阶导数;Ve为液压缸的总容积;Cel为液压缸的总泄露系数,且Cel=Celi+
0.5Cele,Celi、Cele分别为液压缸的内泄漏系数和外泄漏系数;Ee为有效体积弹性模量;Pe为负
载压力, 为Pe的一阶导数;
[0393] 力平衡方程建立单元,用于建立液压缸的力平衡方程:
[0394]
[0395] 式中,me为负载质量, 为xe的二阶导数;Be为负载阻尼系数,Fe为外负载,即活塞杆的输出力。
[0396] 可选的,系统划分模块包括:
[0397] 第一子系统划分单元,用于将电静液作动器中执行将来自液压缸内部的液压能转化为作动筒的机械能的子系统作为第一子系统;
[0398] 第二子系统划分单元,用于将电静液作动器中执行将来自泵的机械能转化为液压缸内部的液压能的子系统作为第二子系统;
[0399] 第三子系统划分单元,用于将电静液作动器中执行将电机电磁能转换为电机转子的机械能的子系统作为第三子系统;
[0400] 第四子系统划分单元,用于将电静液作动器中执行将电机的电能转化为电机的电磁能的子系统作为第四子系统。
[0401] 可选的,控制律确定模块包括:
[0402] 第一控制律确定单元,用于基于液压缸的力平衡方程创建在已知参数下第一子系统的控制律:
[0403]
[0404] 式中,Ped为液压缸的需求压力, 为需求加速度, 为需求速度,k1>0为本地反馈增益,Y1为回归向量, θ1为参数向量,
[0405] 第二控制律确定单元,用于基于液压缸的流量连续方程创建在已知参数下第二子系统的控制律:
[0406]
[0407] 式中,ωed为泵的需求转速, 为Ped的一阶导数,k2>0为本地反馈增益,k3为稳定反馈增益,Y2为回归向量, θ2为参数向量,
[0408] 第三控制律确定单元,用于基于电机的转矩平衡方程创建在已知参数下第三子系统的控制律:
[0409]
[0410] 式中,ied为电机的需求电流, 为ωed的一阶导数,k4为本地反馈增益,k5为稳定反馈增益,Y3为回归向量, θ3为参数向量,
[0411] 第四控制律确定单元,用于基于电机的电势平衡方程创建在已知参数下第四子系统的控制律:
[0412]
[0413] 式中,ued为电机的需求电压, 为ied的一阶导数,k6为本地反馈增益,k2为稳定反馈增益,Y4为回归向量, θ4为参数向量,
[0414] 第五控制律确定单元,用于在未知参数下第一子系统的控制律为:
[0415]
[0416] 式中, 为θ1的参数估计值; 采用自适应算法实时更新;
[0417] 第六控制律确定单元,用于在未知参数下第二子系统的控制律为:
[0418]
[0419] 式中, 为θ2的参数估计值; 采用自适应算法实时更新;
[0420] 第七控制律确定单元,用于在未知参数下第三子系统的控制律为:
[0421]
[0422] 式中, 为θ3的参数估计值; 采用自适应算法实时更新;
[0423] 第八控制律确定单元,用于在未知参数下第四子系统的控制律为:
[0424]
[0425] 式中, 为θ4的参数估计值; 采用自适应算法实时更新。
[0426] 基于以上实施例,本发明的技术效果如下:
[0427] 1)采用虚拟分解的方法,将EHA系统分解为多个子系统,在子系统级别上确定控制律,可以解决EHA系统高阶系统模型和传统反步控制微分爆炸的难题。
[0428] 2)加入自适应算法,在线辨识系统参数变化及外界干扰等不确定性,有效克服非线性和不确定性因素带来的困难,防止参数估计值的漂移。
[0429] 本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统
而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说
明即可。
[0430] 本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据
本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不
应理解为对本发明的限制。