本发明涉及电液位置伺服控制技术领域,具体涉及一种电液位置伺服控制系统、计算机终端、存储介质。
背景技术
电液位置跟踪控制系统中存在阀的死区,流量压力、摩擦力、控制器饱和等非线性,系统内部参数和负载的不确定性,特别是缸的结构非对称性,必将导致正、负行程开环增益和动态特性的非对称性,上述特性给高性能电液位置伺服控制带了巨大挑战。而提高系统的抗扰能力,实现电液位置伺服系统高精度、快响应一直是工程控制所追求的目标。
许多学者,基于精确数学模型的扰动观测器控制方法利用系统的输入、输出及系统特性来设计扰动观测器,实时估计并动态补偿施加于系统的外部扰动,以降低非线性扰动给系统带来的不利影响。但是受机械结构、体积和成本等因素的制约,往往仅活塞位移可直接测量,从而增加了扰动观测器的设计难度。针对系统存在的不确定性,众多专家学者又提出了反馈线性化、自适应控制、鲁棒控制、变结构控制等控制方法,且对控制器参数进行了严谨的数学理论推演,某种程度上提高了系统的鲁棒性和控制精度。然而,这些系统的控制性能依赖于数学模型的精度,当系统力学性能发生变化时极易造成模型不匹配等问题,引起控制性能下降,甚至不稳定。
鉴于模型依赖的脆弱性和系统状态的不易获取性,使得基于误差负反馈的传统pid控制在工业控制领域一直占据主导地位,如图1所示,传统pid控制是由电液位置伺服系统2输出位移量y,将获得的位移量y输入系统的控制器1,在控制器1中位移量y与系统输入的期望位移值v1作比较,得到的误差值e1分别乘以比例系数kp、积分系数ki和微分系数kd,则获得基于位移偏差的pid控制律
技术实现要素:
针对高精度电液位置伺服系统的实际需求,本发明提出一种电液位置伺服控制系统、计算机终端、存储介质。本发明利用系统输入输出设计线性扩张状态观测器(linearextendedstateobserver,leso),实现对总扰动的实时动态补偿。
本发明采用以下技术方案实现,一种电液位置伺服控制系统包括比例阀、液压缸、线性自抗扰控制器(linearactivedisturbancerejectioncontrol,ladrc);比例阀根据动态主动补偿控制律控制液压缸的活塞位移;线性自抗扰控制器根据液压缸的当前活塞位移y和比例阀输入的当前动态主动补偿控制律u进行数据处理,得到期望状态反馈控制律u′,u′实现电液位置伺服控制系统的闭环负反馈控制,所述线性自抗扰控制器包括采样模块、线性扩张状态观测器构建模块、反馈控制器构建模块;
所述采样模块用于采样y和u;
所述线性扩张状态观测器构建模块用于构建线性扩张状态观测器,并参数化所述观测器,其包括步骤:
(i)根据y和u构建线性扩张状态观测器,满足:
(ii)对
(iii)线性扩张观测器状态向量
所述状态反馈控制器构建模块用于构建并参数化状态反馈控制器,其包括步骤:
(i)将
其中,v1为活塞期望位移,v2为活塞期望速度,e1为活塞位移跟踪误差值,e2为活塞运行速度误差值;
(ii)获得具有加速度前馈的状态反馈pd控制律u0:
u0=kpe1+kde2+v3
其中,
(iii)获得u′:
作为上述方案的进一步改进,根据公式b=γβe(r1a1/v1+r2a2/v2)/bp估计b0,为确保控制性能,须满足b0·b>0,且
其中,
其中,v10、v20为无杆腔、有杆腔初始容积;a1为无杆腔活塞面积,a2为有杆腔活塞面积;kv>0为比例阀增益;cd为阀口流量系数;ω为比例阀面积梯度;ρ为油液密度;βe为油液弹性模量;bp为黏性摩擦系数,ps为供油压力,pr为回油压力;p1为无杆腔压力,p2为有杆腔压力。
进一步地,在已知b0的条件下,确定最优线性扩张状态观测器带宽ωo;最优线性扩张状态观测器带宽ωo的确定方式为:根据动态响应要求,特别是输入给定信号的稳定时间,初步确定状态反馈控制器带宽ωc并保持不变;在测量噪声和采样速率允许范围之内,选取线性扩张状态观测器带宽ωo初值ωo=ωc,逐步增大ωo的取值,ωo越大线性扩张状态观测器对包含总扰动的状态跟踪速度越快,但抵达某一上界值后,线性扩张状态观测器随着ωo继续增加对传感器的高频测量噪声滤波能力下降,状态跟踪精度反而降低,此时需回调ωo取值,ωo的取值在(5~10)ωc范围内变化,直至
再进一步地,确定最优状态反馈控制器带宽ωc:在已知b0且
作为上述方案的进一步改进,在构建状态反馈控制器时,采用跟踪信号发生器根据给定输入信号v和电液位置伺服控制系统的动、静态性能指标获得v1、v2、v3。
作为上述方案的进一步改进,线性自抗扰控制器还包括跟踪信号发生器;跟踪信号发生器用于将其微分信号作为控制系统的前馈信号输入系统。
作为上述方案的进一步改进,所述电液位置伺服控制系统还包括:过滤器、电机、液压泵、溢流阀、负载、直线位移传感器、模数转换器和数模转换器;
液压泵的进油端与过滤器的出油端连通;电机与液压泵传动连接;比例阀的进油端与液压泵的出油端连通;溢流阀的进油口连通在液压泵与比例阀的通路上;液压缸与比例阀的出油端连通;负载安装在液压缸活塞杆远离活塞的一端;直线位移传感器安装在负载的一侧,用来检测负载的位移量;控制器分别与直线位移传感器和比例阀连接,在控制器与直线位移传感器之间设置模数转换器,在控制器与比例阀之间设置数模转换器。
本发明还提供一种计算机终端,其包括存储器、处理器以及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述程序时实现如下步骤:
步骤一,采样y和u;
步骤二,构建线性扩张状态观测器,并参数化所述观测器,其包括步骤:
(i)根据y和u构建线形扩张状态观测器,满足:
(ii)对
(iii)线性扩张观测器状态向量
步骤三,构建并参数化状态反馈控制器,其包括步骤:
(i)将
其中,v1为活塞期望位移,v2为活塞期望运行速度,e1为活塞位移跟踪误差值,e2为活塞运行速度误差值;
(ii)获得具有加速度前馈的状态反馈pd控制律u0:
u0=kpe1+kde2+v3
其中,
(iii)获得u′:
本发明还提供一种计算机可读存储介质,其上存储有计算机程序,所述程序被处理器执行时,实现如下步骤:
步骤一,采样y和u;
步骤二,构建线性扩张状态观测器,并参数化所述观测器,其包括步骤:
(i)根据y和u构建线性扩张状态观测器,满足:
(ii)对
(iii)线性扩张观测器状态向量
步骤三,构建并参数化状态反馈控制器,其包括步骤:
(i)将
其中,v1为活塞期望位移,v2为活塞期望运行速度,e1为活塞位移跟踪误差值,e2为活塞运行速度误差值;
(ii)获得具有加速度前馈的状态反馈pd控制律u0:
u0=kpe1+kde2+v3
其中,
(iii)获得u′:
作为上述方案的进一步改进,在已知b0的条件下,确定最优线性扩张状态观测器带宽ωo;最优线性扩张状态观测器带宽ωo的确定方式为:根据动态响应要求,特别是输入给定信号的稳定时间,初步确定状态反馈控制器带宽ωc并保持不变;在测量噪声和采样速率允许范围之内,选取线性扩张状态观测器带宽ωo初值ωo=ωc,逐步增大ωo的取值,ωo越大线性扩张状态观测器对包含总扰动的状态跟踪速度越快,但抵达某一上界值后,线性扩张状态观测器随着ωo继续增加对高频信号滤波能力下降,传感器的高频测量噪声将被引入,状态跟踪精度反而降低,此时需回调ωo取值,ωo的取值在(5~10)ωc范围内变化,直至
本发明将现代控制理论状态空间方法与古典控制理论的零极点配置方法相结合,将系统建模不确定性和未建模不确定性归集为“综合扰动”,利用系统输入输出设计线性扩张状态观测器,实现对总扰动的实时动态补偿。该控制方法摆脱了对精确数学模型的依赖,继承了pid控制技术的精髓,解决了微分参数整定困难,克服了非线性、不确定性对控制系统性能的影响。
附图说明
图1为常规pid控制器结构图。
图2为本发明一种电液位置伺服控制系统结构图。
图3为线性自抗扰控制器结构图。
图4为图1与图3系统中输入0.14·sin(2·π·0.27*t)正弦信号时活塞位移响应仿真结果。
图5为图1与图3系统中输入0.14·sin(2·π·0.27*t)正弦信号时活塞位移跟踪误差仿真结果。
图6为图1与图3系统输入0.14·sin(2·π·0.27*t)正弦信号时施加于系统的综合扰动。
图7为图3系统输入给定0.14m的固定信号时活塞位移仿真结果。
图8为图1系统输入给定0.14m的固定信号时活塞位移仿真结果。
图9为图3系统输入给定0.14m的固定信号时活塞位移跟踪误差仿真结果。
图10为图1系统输入给定0.14m的固定信号时活塞位移跟踪误差仿真结果。
图11为图1与图3系统输入给定0.14m的固定信号时施加于系统的综合扰动。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合具体实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
实施例1
请参阅图2及图3,本实施例提供一种电液位置伺服控制系统的线性自抗扰控制方法。所述电液位置伺服控制系统包括比例阀4、液压缸6。比例阀4根据动态主动补偿控制律控制的液压缸6活塞位移,所述线性自抗扰控制(linearactivedisturbancerejectioncontrol,ladrc)方法根据液压缸6的当前活塞位移y和比例阀4输入的当前动态主动补偿控制律u进行数据处理,得到期望状态反馈控制律u′,u′实现电液位置伺服控制系统的闭环负反馈控制.
本实施例的线性自抗扰控制方法包括以下步骤。
(i)根据电液位置伺服系统数学模型,获得如下线性扩张状态观测器(linearextendedstateobserver,leso)13方程,
其中,
(ii)对
(iii)将
其中,v1、v2和v3均由跟踪信号发生器12产生的,v1代表活塞位移y的期望值,v2代表活塞运行的期望速度,e1代表活塞位移跟踪误差值,e2代表活塞运行速度的误差值。
(iv)根据上述步骤,获得具有加速度前馈的pd控制律u0:
u0=kpe1+kde2+v3
其中,
(v)将
其中,b0为控制增益的估计值。
令
其中,
v10、v20为无杆腔、有杆腔初始容积;a1为无杆腔活塞面积,a2为有杆腔活塞面积;y为活塞位移;kv>0为比例阀4增益;cd为阀口流量系数;ω为比例阀4面积梯度;ρ为油液密度;βe为油液弹性模量;bp为黏性摩擦系数,ps为供油压力,pr为回油压力;p1为无杆腔压力,p2为有杆腔压力。
(vii)令u=u′,重复步骤(i)到(vii)的步骤。
在上述步骤中,在已知b0的条件下,根据动态响应要求,特别是输入给定信号的稳定时间,初步确定状态反馈控制器14带宽ωc并保持不变;在测量噪声允许范围之内,同时考虑到采样时延对控制性能的影响,为确保leso13能快速跟踪系统扰动的变化,实现对施加于系统的综合扰动的抑制,选取leso13带宽ωo初值ωo=ωc,逐步增大leso13带宽ωo,ωo越大leso对包含综合扰动的状态跟踪速度越快,但抵达某一临界值后,leso13随着带宽ωo继续增加,leso13对高频信号滤波能力降低,传感器的高频测量噪声将被引入,状态跟踪精度反而降低,此时需回调leso13带宽ωo的取值,通常ωo的取值在(5~10)ωc范围内变化,直至
在已知b0,且leso13状态向量
实施例2
本实施例公开一种电液位置伺服控制系统的线性自抗扰控制方法,所述电液位置伺服控制系统包括比例阀、液压缸、控制器。
控制器输出动态主动补偿控制律给比例阀,比例阀根据所述动态主动补偿控制律控制液压缸的活塞位移。所述线性自抗扰控制方法根据液压缸的当前活塞位移y和控制器输出的当前动态主动补偿控制律u进行数据处理,得到控制器输出的期望动态主动补偿控制律u′,u′实现对电液位置伺服系统的闭环负反馈控制,所述线性自抗扰控制方法包括步骤。
步骤一,采样y和u。
步骤二,构建线性扩张状态观测器(linearextendedstateobserver,leso),其包括以下步骤。
(i)根据y和u构建线并参数化性扩张状态观测器
其中,
根据公式b=γβe(r1a1/v1+r2a2/v2)/bp估计出b0,为确保控制性能,须满足b0·b>0,且
其中,
v10、v20为无杆腔、有杆腔初始容积;a1为无杆腔活塞面积,a2为有杆腔活塞面积;y为负载位移;kv>0为比例阀4的增益;cd为阀口流量系数;ω为比例阀4的面积梯度;ρ为油液密度;βe为油液弹性模量;bp为黏性摩擦系数,ps为供油压力,pr为回油压力;p1为无杆腔压力,p2为有杆腔压力。
系统参数b0、ωc、ωo的整定规律按如下步骤进行:
①根据实际系统参数的物理含义和取值,根据公式(2)中b=γβe(r1a1/v1+r2a2/v2)/bp估计出控制增益b0,b0取值须满足b0·b>0,
②确定线性扩张状态观测器带宽ωo。在①的基础上,根据动态响应要求,特别是输入给定信号的稳定时间,初步确定状态反馈控制器带宽ωc并保持不变;在测量噪声和采样速率允许范围之内,同时考虑到采样时延对控制性能的影响,为确保leso能快速跟踪系统总扰动的变化,实现对系统综合扰动的抑制,选取leso带宽ωo初值ωo=ωc,逐渐增大ωo的取值,ωo越大leso对包含总扰动的状态跟踪速度越快,但抵达某一临界值后,leso随着ωo继续增加对高频信号滤波能力降低,传感器的高频测量噪声将被引入,状态跟踪精度反而降低,此时需回调ωo取值,通常ωo的取值在(5~10)ωc范围内变化,直至
③确定状态反馈控制器带宽ωc。在①②基础上保持b0、ωo不变,逐渐增大状态反馈控制器带宽ωc,ωc取值越大系统的响应速度将会越快,稳态误差越小,但稳定裕度会降低。因此ωc的取值需要在快速性和稳定性之间进行必要的折衷。
(ii)对
(iii)对
步骤三,构建状态反馈控制器,其包括步骤。
(i)将
其中,v1为活塞期望位移,v2为活塞期望运行速度,e1为活塞位移跟踪误差值,e2为活塞运行速度的误差值。
(ii)获得具有加速度前馈的pd控制律u0:
u0=kpe1+kde2+v3
其中,
(iii)获得u′:
实施例3
请参阅图2及图3本实施例提供了一种阀控非对称缸电液位置伺服控制系统,该控制系统利用实施例1中所述的一种电液位置伺服控制系统的线性自抗扰控制方法,使自身达到精度高、稳定性好、抗扰能力强的效果。
一种阀控非对称缸电液位置伺服控制系统,其包括:过滤器1、电机2、液压泵3、比例阀4、溢流阀5、液压缸6、负载7、直线位移传感器9、线性自抗扰控制器8、模数转换器10和数模转换器11。
过滤器1用来对液压油进行过滤,液压泵3的进油端与过滤器1的出油端连通。电机2通过联轴器与液压泵3传动连接。比例阀4的进油端与液压泵3的出油端连通,比例阀4通过参数设定可以控制自身的出油量。溢流阀5的进油口连通在液压泵3与比例阀4的通路上,当液压泵3输出的液压油压力过大时,通过溢流阀5排油泄压,以此来保证比例阀4进油端满足设定的油压值。液压缸6与比例阀4连通,由比例阀4控制液压缸6内活塞杆的运动。负载7安装在液压缸6活塞杆远离活塞的一端,直线位移传感器9安装在负载7的一侧,用来检测负载7的位移量。
线性自抗扰控制器8分别与直线位移传感器9和比例阀4连接,在线性自抗扰控制器8与直线位移传感器9之间可设置模数转换器10,在线性自抗扰控制器8与比例阀4之间可设置数模转换器11。
线性自抗扰控制器8包括跟踪信号发生器12、leso13和状态反馈控制器14。跟踪信号发生器12用于“柔化”给定位移参考信号,将其微分信号(速度、加速度)作为控制系统的前馈信号加入系统,增大控制器参数的选择范围。leso13,一方面用来实现对施加于控制系统总扰动的实时动态补偿,同时实现滤波器功能,并实时观测系统状态,避免直接采用传感器测量所引起的高频噪声污染问题。状态反馈器14是依据跟踪信号发生器12和leso13的输出结果,获得控制系统的动态主动补偿控制律并输出给比例阀4。
工作时,经过过滤器1过滤后的液压油,经过液压泵3的加压后,按照设定的油压参数输入给比例阀4,比例阀4再通过前一刻获取的当前动态主动补偿控制律来控制对液压缸6内液压油输出,液压缸6在液压油的作用下,发生了腔体体积的改变,从而带动负载7运动。可通过直线位移传感器9获取当前位移量,并将该位移量经模数转换器10的转换值输入给线性自抗扰控制器8。同时将上一刻获取的当前动态主动补偿控制律作为当前时刻线性自抗扰控制器8的一路输入信号。在线性自抗扰控制器8内,经过跟踪信号发生器12、leso13和状态反馈器14的共同作用,将输入的当前位移量与当前动态主动补偿控制律通过实施例1中所述的方法,最终获得下一时刻的动态主动补偿控制律,并将该数值输入给比例阀4,如此周期循环,实现比例阀4每一时刻的动态主动控制。
实施例4
本实施例提供一种电液位置伺服控制系统的线性自抗扰控制方法,包括以下步骤。
步骤1:根据图2,通过机理分析,忽略比例阀4的动态特性和液压缸6的外部泄露问题,
定义:
其中,u为比例阀4的有界输入电压,kv>0为比例阀4的增益,xv为比例阀4的阀芯位移,m为负载7的等效质量,bp为黏性摩擦系数,c为负载7的刚度,d为包含非线性摩擦、外部干扰以及未建模动态等扰动,p1为无杆腔压力,p2为有杆腔压力,
在式(1)的基础上进行变换,得到公式(2),
式(2)中f(y,d,p1,p2,u)为施加于系统总扰动,b0为控制增益b的估计值,
步骤2:根据步骤(1)建立的阀控非对称缸电液位置伺服控制系统数学模型,设计线性自抗扰控制器8,主要包括跟踪信号发生器12的设计、leso13的设计和状态反馈器14的设计。
(1)阀控非对称缸电液位置伺服控制系统数学模型的变换。
定义x1=y,
其中,
(2)根据控制性能指标(上升时间、超调、稳态误差等)设计跟踪信号发生器12,可以采用“三阶最速非线性跟踪微分器”或者其它实用方法进行生成,其目的在于“柔化”给定位移参考信号,将其微分信号(速度、加速度)作为系统的前馈信号加入系统,增大控制器参数的选择范围。
(3)设计线性扩张状态观测器13,根据式(3)构建线性扩张状态观测器状态空间方程,
其中,
(4)确定阀控非对称缸电液位置伺服控制系统控制律,完成线性自抗扰控制实施过程,
其中,u为动态扰动主动补偿控制律,u0为具有加速度前馈的状态反馈pd控制律,v1,v2,v3分别是跟踪信号发生器产生的位移、速度及加速度,kp、kd代表参数化增益系数,且
(5)根据上述方法步骤,搭建成一个阀控非对称缸的电液位置伺服控制系统,其结构如图2所示。
(6)系统参数b0、ωc、ωo的整定规律按如下步骤进行,
①根据实际系统参数的物理含义和取值,根据公式(2)中b=γβe(r1a1/v1+r2a2/v2)/bp估计出控制增益b0,b0取值须满足b0·b>0,
②确定线性扩张状态观测器带宽ωo。在①的基础上,根据动态响应要求,特别是输入给定信号的稳定时间,初步确定状态反馈控制器带宽ωc并保持不变;在测量噪声和采样速率允许范围之内,同时考虑到采样时延对控制性能的影响,为确保leso能快速跟踪系统总扰动的变化,实现对系统综合扰动的抑制,选取leso带宽ωo初值ωo=ωc,逐渐增大ωo的取值,ωo越大leso对包含总扰动的状态跟踪速度越快,但抵达某一临界值后,leso随着ωo继续增加对传感器的高频测量噪声滤波能力降低,状态跟踪精度反而降低,此时需回调ωo取值,通常ωo的取值在(5~10)ωc范围内变化,直至
③确定状态反馈控制器带宽ωc。在①②基础上保持b0、ωo不变,逐渐增大状态反馈控制器带宽ωc,ωc取值越大系统的响应速度将会越快,稳态误差越小,但稳定裕度会降低。因此ωc的取值需要在快速性和稳定性之间进行必要的折衷。
请一并参阅图4、图5和图6,对系统输入0.14·sin(2·π·0.27*t)正弦信号,可以明显看到,当施加于系统的综合扰动相同时,本控制方法ladrc控制的输出位移值与传统pid的位移输出值和系统的期望值基本重合。
比较本控制方法与传统pid方法的跟踪误差值,当施加于系统的综合扰动相同时,明显可见本控制方法的跟踪误差更小,抗扰能力更好。
请一并参阅图7、图8、图11,对系统输入0.14m的固定信号,要求1.5秒内抵达稳态值,当施加于系统总扰动相同时,本方法与传统pid方法的位移输出值抵达稳态所需时间可代表系统的响应速度。由图可见,两种方法活塞位移抵达期望值所需时间基本重合,则代表两种方法的系统的响应速度基本一致。
请一并参阅图9、图10、图11,对系统输入0.14m固定信号,要求1.5秒内抵达稳态值,当施加于系统综合扰动相同时,本方法与传统pid方法的跟踪误差值,由图可见,本实施例中,传统pid方法的跟踪误差最大绝对值约为3.5×10-3m,而本方法的跟踪误差值最大绝对值约为0.5×10-3m,可见本方法的跟踪误差更小。
进一步地,进入稳态后,随着施加于系统的综合扰动逐步增加,本方法的跟踪误差的最大绝对值维持不变,传统pid控制方法的跟踪误差的幅值逐渐增加并出现高频震荡,可见本方法鲁棒性强。
请一并参阅图4至图11发现,本方法adrc控制相对于pid控制,有效的提高了系统的响应速度,降低了跟踪误差,提高系统的控制性能。
实施例5
本实施例提供了一种计算机终端,其包括存储器、处理器以及存储在所述存储器上并可在所述处理器上运行的计算机程序。所述处理器执行所述程序时实现如实施例1描述的一种电液位置伺服控制系统的线性自抗扰控制方法的步骤。
实施例6
本实施例提供了一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述程序被处理器执行时,实现如实施例1描述的一种电液位置伺服控制系统的线性自抗扰控制方法的步骤。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。