[go: up one dir, main page]

CN111577711B - Active-disturbance-rejection robust control method for double-rod hydraulic cylinder position servo system - Google Patents

Active-disturbance-rejection robust control method for double-rod hydraulic cylinder position servo system Download PDF

Info

Publication number
CN111577711B
CN111577711B CN202010366842.4A CN202010366842A CN111577711B CN 111577711 B CN111577711 B CN 111577711B CN 202010366842 A CN202010366842 A CN 202010366842A CN 111577711 B CN111577711 B CN 111577711B
Authority
CN
China
Prior art keywords
hydraulic cylinder
equation
double
formula
rod hydraulic
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
CN202010366842.4A
Other languages
Chinese (zh)
Other versions
CN111577711A (en
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.)
Nanjing University of Science and Technology
Original Assignee
Nanjing University of Science and Technology
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 Nanjing University of Science and Technology filed Critical Nanjing University of Science and Technology
Priority to CN202010366842.4A priority Critical patent/CN111577711B/en
Publication of CN111577711A publication Critical patent/CN111577711A/en
Application granted granted Critical
Publication of CN111577711B publication Critical patent/CN111577711B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B19/00Testing; Calibrating; Fault detection or monitoring; Simulation or modelling of fluid-pressure systems or apparatus not otherwise provided for
    • F15B19/007Simulation or modelling
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B21/00Common features of fluid actuator systems; Fluid-pressure actuator systems or details thereof, not covered by any other group of this subclass
    • F15B21/08Servomotor systems incorporating electrically operated control means
    • F15B21/087Control strategy, e.g. with block diagram
    • 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)
  • Fluid Mechanics (AREA)
  • Mechanical Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Evolutionary Computation (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Health & Medical Sciences (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Chemical & Material Sciences (AREA)
  • Analytical Chemistry (AREA)
  • Servomotors (AREA)
  • Actuator (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种双出杆液压缸位置伺服系统的自抗扰鲁棒(RISEESO)控制方法,该方法将基于扩张状态观测器(ESO)的干扰补偿与误差符号积分鲁棒(RISE)相结合,运用Lyapunov稳定性理论证明了系统渐近稳定的结果。所提策略将干扰抑制方法(RISE)与干扰估计补偿方法有效结合,继承了两种方法所特有的优点同时避免了各自的缺点。所公开的控制方法具有如下优点:相比传统ESO方法,RISE的使用使得ESO的观测负担得以降低,进一步减小了观测器残差;相比于传统的RISE方法,ESO的使用使得RISE的非线性鲁棒增益仅需要与状态观测误差一二阶导数相关、削弱了其原先的严苛条件;所提控制器的跟踪性能在相同条件下均比RISE与ESO更加优秀。

Figure 202010366842

The invention discloses a robust active disturbance rejection (RISEESO) control method for a position servo system of a double-rod hydraulic cylinder. The method combines disturbance compensation based on extended state observer (ESO) with robust error sign integral (RISE) control Combined, Lyapunov stability theory is used to prove that the system is asymptotically stable. The proposed strategy effectively combines the interference suppression method (RISE) with the interference estimation compensation method, inheriting the unique advantages of the two methods and avoiding their respective shortcomings. The disclosed control method has the following advantages: compared with the traditional ESO method, the use of RISE reduces the observation burden of the ESO and further reduces the observer residual; The linear robust gain only needs to be related to the first and second derivatives of the state observation error, which weakens its original strict condition; the tracking performance of the proposed controller is better than that of RISE and ESO under the same conditions.

Figure 202010366842

Description

双出杆液压缸位置伺服系统的自抗扰鲁棒控制方法Active Disturbance Rejection Robust Control Method for Position Servo System of Double Rod Hydraulic Cylinder

技术领域technical field

本发明涉及电液伺服控制技术,具体涉及一种双出杆液压缸位置伺服系统的自抗扰鲁棒控制方法。The invention relates to an electro-hydraulic servo control technology, in particular to an active disturbance rejection robust control method of a position servo system of a double-rod hydraulic cylinder.

背景技术Background technique

液压位置伺服系统凭借其功率密度大,力/转矩输出大,抗负载刚性强等特性,在飞行器、重型机械、高性能旋转测试设备等领域有着举足轻重的地位。然而,液压系统固有的非线性特性及各种建模不确定性使得其控制器的设计复杂化。起初大量研究基于线性控制理论对液压系统进行控制器的设计,如PID控制器,但是线性控制器的设计是基于线性化的液压系统模型,不能反映其非线性的特性,因此不能获得很好的控制效果。反馈线性化控制可在控制器的设计中实时补偿液压系统的非线性特性,但是要求系统模型信息完全已知,与实际应用不符。自抗扰控制(ADRC)由于其需要模型信息较少且可以获得优异的控制性能使其得到了广泛的应用,其特点是采用了一个扩张状态观测器(ESO)将系统的集成扰动扩张为一个新的状态变量,将观测的扰动通过前馈补偿的方式作用于系统以提高控制性能。为了使非线性ESO在实施中得以简化,线性ESO得以提出,在实际控制中,其仅有一个参数需要调节,因此大大方便了控制器设计与设备调试过程,且理论证明表明状态估计误差随着观测器带宽的增大而单调减小。在系统的未建模动态较大时,为了使控制精度提升,必须提高观测器的带宽,然而,过大的带宽会放大系统噪声甚至使系统不稳定。误差符号积分鲁棒(RISE)控制方法也可以有效地处理建模不确定性的问题,其包含一个独特的误差符号积分鲁棒项,可以在系统干扰足够平滑有界的情况下获得渐进稳定的跟踪性能。但是该控制方法所设计的控制器中的非线性鲁棒增益的取值需要满足一定的条件,该条件跟系统的建模不确定性对时间的一阶导数和二阶导数的上界密切相关,当系统未建模动态较大时,为了使得控制性能得以优化,必须取较大的反馈增益,同样,这也会使得系统有震荡的风险。Hydraulic position servo system plays a pivotal role in aircraft, heavy machinery, high-performance rotary test equipment and other fields due to its high power density, large force/torque output, and strong anti-load rigidity. However, the inherent nonlinear characteristics of hydraulic systems and various modeling uncertainties complicate the design of their controllers. At first, a lot of researches were done on the design of the hydraulic system controller based on the linear control theory, such as the PID controller, but the design of the linear controller was based on the linearized hydraulic system model, which could not reflect its nonlinear characteristics, so it could not obtain good results. Control effect. The feedback linearization control can compensate the nonlinear characteristics of the hydraulic system in real time in the design of the controller, but it requires the system model information to be completely known, which is inconsistent with the actual application. Active disturbance rejection control (ADRC) has been widely used because it requires less model information and can obtain excellent control performance. It is characterized by using an extended state observer (ESO) to expand the integrated disturbance of the system into a A new state variable that applies the observed disturbance to the system through feedforward compensation to improve control performance. In order to simplify the implementation of nonlinear ESO, linear ESO is proposed. In actual control, only one parameter needs to be adjusted, which greatly facilitates the process of controller design and equipment debugging. The theoretical proof shows that the state estimation error increases with the The observer bandwidth increases and decreases monotonically. When the unmodeled dynamics of the system are large, in order to improve the control accuracy, the bandwidth of the observer must be increased. However, an excessively large bandwidth will amplify the system noise and even make the system unstable. The Robust Sign Integral Error (RISE) control method can also effectively deal with modeling uncertainty. It contains a unique Sign Integral Error Robust term, which can achieve asymptotically stable system disturbances that are sufficiently smooth and bounded. Track performance. However, the value of the nonlinear robust gain in the controller designed by this control method needs to meet certain conditions, which are closely related to the upper bounds of the first and second derivatives of the modeling uncertainty of the system with respect to time. , when the system is not modeled with large dynamics, in order to optimize the control performance, a larger feedback gain must be taken, which will also cause the system to have the risk of oscillation.

发明内容SUMMARY OF THE INVENTION

本发明的目的在于提供一种强抗扰、跟踪性能高的双出杆液压缸位置伺服系统的自抗扰鲁棒控制方法,可以使得双出杆液压缸位置伺服系统拥有较大干扰时仍然保持优秀的控制性能。The purpose of the present invention is to provide an active disturbance rejection robust control method of a dual-rod hydraulic cylinder position servo system with strong anti-disturbance and high tracking performance, which can make the dual-rod hydraulic cylinder position servo system still maintain the Excellent control performance.

实现本发明目的的技术解决方案为:一种双出杆液压缸位置伺服系统的自抗扰鲁棒控制方法,包括以下步骤:The technical solution for realizing the purpose of the present invention is: a robust control method for active disturbance rejection of a position servo system of a double-rod hydraulic cylinder, comprising the following steps:

步骤1,建立双出杆液压缸位置伺服系统的数学模型;Step 1, establish the mathematical model of the position servo system of the double-rod hydraulic cylinder;

步骤2,根据上述双出杆液压缸位置伺服系统的数学模型设计自抗扰鲁棒控制器;Step 2, designing an ADRC robust controller according to the mathematical model of the above-mentioned dual-rod hydraulic cylinder position servo system;

步骤3,所述运用李雅普诺夫稳定性理论对双出杆液压缸位置伺服系统进行稳定性证明,并运用Barbalat引理得到系统能够达到渐进稳定的结果。Step 3, using the Lyapunov stability theory to prove the stability of the position servo system of the double-rod hydraulic cylinder, and using Barbalat's lemma to obtain the result that the system can achieve asymptotic stability.

本发明与现有技术相比,其显著优点是:将基于干扰抑制(RISE)与干扰估计补偿(ESO)有效结合,RISE的使用进一步减小了ESO的估计残差,使得控制性能得到提升,同时,改进后RISE的非线性鲁棒反馈增益项仅与状态估计误差的导数相关,比原先的条件更容易满足,控制器跟踪性能相比传统RISE与ESO都有了改进。仿真结果验证了其有效性。Compared with the prior art, the present invention has the significant advantages of effectively combining interference suppression (RISE) and interference estimation compensation (ESO), and the use of RISE further reduces the estimation residual error of ESO, so that the control performance is improved, At the same time, the nonlinear robust feedback gain term of the improved RISE is only related to the derivative of the state estimation error, which is easier to satisfy than the original condition, and the tracking performance of the controller is improved compared with the traditional RISE and ESO. Simulation results verify its effectiveness.

附图说明Description of drawings

图1是本发明双出杆液压缸位置伺服系统的原理图。Fig. 1 is the principle diagram of the position servo system of the double-rod hydraulic cylinder of the present invention.

图2是双出杆液压缸位置伺服系统的自抗扰鲁棒控制(RISEESO)方法原理示意图。FIG. 2 is a schematic diagram of the principle of the Robust Active Disturbance Rejection Control (RISEESO) method for the position servo system of the double-rod hydraulic cylinder.

图3是双出杆液压缸位置伺服系统期望跟踪的指令信号随时间变化的曲线图。Fig. 3 is a graph showing the time-dependent change of the command signal expected to be tracked by the position servo system of the double-rod hydraulic cylinder.

图4是Case1中RISEESO控制器、RISE控制器、ESO控制器、PID控制器的跟踪性能对比曲线图。Figure 4 is a comparison curve of the tracking performance of the RISEESO controller, the RISE controller, the ESO controller, and the PID controller in Case1.

图5是Case1中RISEESO控制器作用下系统的控制输入示意图。Figure 5 is a schematic diagram of the control input of the system under the action of the RISEESO controller in Case1.

图6是Case2中RISEESO控制器、RISE控制器、ESO控制器、PID控制器的跟踪性能对比曲线图。Figure 6 is a comparison curve of the tracking performance of the RISEESO controller, the RISE controller, the ESO controller, and the PID controller in Case2.

图7是Case2中RISEESO控制器作用下系统的控制输入示意图。Figure 7 is a schematic diagram of the control input of the system under the action of the RISEESO controller in Case2.

具体实施方式Detailed ways

下面结合附图及具体实施例对本发明作进一步详细说明。The present invention will be further described in detail below with reference to the accompanying drawings and specific embodiments.

本发明基于传统的RISE控制方法,利用ESO估计系统的未建模动态并进行前馈补偿,RISE的使用使得ESO的观测负担得以降低,进一步降低ESO的估计误差,ESO的使用使得RISE的非线性鲁棒增益不需要与系统建模不确定性的一阶导数和二阶导数的上界相关,仅需要与状态观测误差一二阶导数相关,当ESO的状态估计误差通过调节带宽得以保证时,此条件相比前者更容易得到满足。最后运用李雅普诺夫稳定性理论对双出杆液压缸位置伺服系统进行稳定性证明,得到系统可以达到渐进稳定的结果。The invention is based on the traditional RISE control method, uses ESO to estimate the unmodeled dynamics of the system and performs feedforward compensation. The use of RISE reduces the observation burden of ESO and further reduces the estimation error of ESO. The use of ESO makes RISE nonlinear The robust gain does not need to be related to the upper bounds of the first and second derivatives of the system modeling uncertainty, but only needs to be related to the first and second derivatives of the state observation error. When the state estimation error of ESO is guaranteed by adjusting the bandwidth, This condition is easier to satisfy than the former. Finally, the Lyapunov stability theory is used to prove the stability of the position servo system of the double-rod hydraulic cylinder, and the result that the system can achieve asymptotic stability is obtained.

结合图1~2,本发明双出杆液压缸位置伺服系统的自抗扰鲁棒控制方法,包括以下步骤:With reference to Figures 1 to 2, the active disturbance rejection robust control method for the position servo system of the double-rod hydraulic cylinder of the present invention includes the following steps:

步骤1,建立双出杆液压缸位置伺服系统的数学模型;Step 1, establish the mathematical model of the position servo system of the double-rod hydraulic cylinder;

步骤1-1、本发明所考虑的双出杆液压缸位置伺服系统是通过伺服阀控制的双出杆液压缸驱动惯性负载;Step 1-1. The dual-rod hydraulic cylinder position servo system considered in the present invention is a dual-rod hydraulic cylinder controlled by a servo valve to drive an inertial load;

因此,根据牛顿第二定律,惯性负载的运动方程为:Therefore, according to Newton's second law, the equation of motion for an inertial load is:

Figure BDA0002476959180000031
Figure BDA0002476959180000031

式(1)中m为惯性负载参数;PL为液压缸两腔压差;A为液压缸活塞有效截面面积;B为粘性摩擦系数;f(t)是其他未建模干扰;y为惯性负载的位移;t为时间变量;In formula (1), m is the inertial load parameter; PL is the pressure difference between the two chambers of the hydraulic cylinder; A is the effective cross-sectional area of the hydraulic cylinder piston; B is the viscous friction coefficient; f(t) is other unmodeled disturbances; y is the inertial displacement of the load; t is the time variable;

忽略液压缸的外泄漏,则液压缸两腔压差的动态方程为:Ignoring the external leakage of the hydraulic cylinder, the dynamic equation of the pressure difference between the two chambers of the hydraulic cylinder is:

Figure BDA0002476959180000032
Figure BDA0002476959180000032

式(2)中Vt为液压缸两腔总控制容积;βe为有效油液弹性模量;Ct为内泄漏系数;Q(t)为复杂的内泄漏过程、未建模的压力动态等引起的建模误差;QL=(Q1+Q2)/2为负载流量,且Q1和Q2分别为液压缸的进油腔流量和回油腔流量;QL与伺服阀位移xv的关系为:In formula (2), V t is the total control volume of the two chambers of the hydraulic cylinder; β e is the effective elastic modulus of oil; C t is the internal leakage coefficient; Q(t) is the complex internal leakage process and the unmodeled pressure dynamics Modeling error caused by etc ; The relationship of xv is:

Figure BDA0002476959180000033
Figure BDA0002476959180000033

式(3)中伺服阀流量增益系数

Figure BDA0002476959180000034
符号函数sign(xv)的定义为:Servo valve flow gain coefficient in formula (3)
Figure BDA0002476959180000034
The sign function sign(x v ) is defined as:

Figure BDA0002476959180000035
Figure BDA0002476959180000035

式中Cd流量系数;ω为阀芯面积梯度;ρ为油液密度;Ps为供油压力,Pr为回油压力;where C d flow coefficient; ω is the spool area gradient; ρ is the oil density; P s is the oil supply pressure, and P r is the oil return pressure;

由于考虑伺服阀动态需要安装额外的位移传感器来获取伺服阀阀芯的位移,而且对于跟踪性能只有微小的提升。因此大量相关的研究都忽略伺服阀的动态,假设采用的是高响应的伺服阀,阀芯位移与控制输入近似为比例环节即xv=kiu,ki是正的电气常数,u为控制输入电压;故式(3)可以写成Due to the consideration of servo valve dynamics, an additional displacement sensor needs to be installed to obtain the displacement of the servo valve spool, and there is only a slight improvement in tracking performance. Therefore, a large number of related researches ignore the dynamics of the servo valve. Assuming that a high-response servo valve is used, the spool displacement and the control input are approximated as a proportional link, that is, x v = ki u, ki is a positive electrical constant, and u is the control input. input voltage; so equation (3) can be written as

Figure BDA0002476959180000041
Figure BDA0002476959180000041

式(5)中kt=kqki代表总的流量增益;In formula (5), k t = k q k i represents the total flow gain;

步骤1-2、假设未建模动态项f(t)连续可微,定义状态变量:

Figure BDA0002476959180000042
则双出杆液压缸位置伺服系统的状态方程为:Step 1-2, assuming that the unmodeled dynamic term f(t) is continuous and differentiable, define the state variable:
Figure BDA0002476959180000042
Then the state equation of the position servo system of the double-rod hydraulic cylinder is:

Figure BDA0002476959180000043
Figure BDA0002476959180000043

式(6)中In formula (6)

Figure BDA0002476959180000044
Figure BDA0002476959180000044

在式(6)中,我们定义了一个新的变量U来代表系统的控制输入,由于实际系统中安装有压力传感器,因此

Figure BDA0002476959180000045
该项可以实时计算得出,只要U确定,那么实际的控制输入u也能得以计算;因此,以下控制器设计将聚焦于提出一种自抗扰鲁棒控制器U来掌控系统的各种干扰;In Equation (6), we define a new variable U to represent the control input of the system. Since a pressure sensor is installed in the actual system, so
Figure BDA0002476959180000045
This term can be calculated in real time, as long as U is determined, the actual control input u can also be calculated; therefore, the following controller design will focus on proposing an ADRC robust controller U to control various disturbances of the system ;

为了简化双出杆液压缸位置伺服系统系统状态方程显示格式,记θ=[θ1,...,θ3]T为系统参数的已知名义值,θr=[θ1r,...,θ3r]T为系统参数的真实值,其中,

Figure BDA0002476959180000046
则式(6)可写成In order to simplify the display format of the state equation of the dual-rod hydraulic cylinder position servo system, denote θ=[θ 1 ,...,θ 3 ] T is the known nominal value of the system parameters, θ r =[θ 1r ,... ,θ 3r ] T is the real value of the system parameters, where,
Figure BDA0002476959180000046
The formula (6) can be written as

Figure BDA0002476959180000051
Figure BDA0002476959180000051

式(8)中,

Figure BDA0002476959180000052
In formula (8),
Figure BDA0002476959180000052

双出杆液压缸位置伺服系统系统控制器的设计目标为:给定系统参考信号yd(t)=x1d(t),设计一个有界的控制输入U使系统输出y=x1尽可能地跟踪系统的参考信号;The design goal of the system controller of the position servo system of the double-rod hydraulic cylinder is: given the system reference signal y d (t) = x 1d (t), design a bounded control input U to make the system output y = x 1 as much as possible ground tracking system reference signal;

为便于控制器设计,假设如下:To facilitate controller design, the following assumptions are made:

假设1:双出杆液压缸位置伺服系统参考指令信号x1d(t)是三阶连续的,且系统期望位置指令、速度指令、加速度指令及加加速度指令都是有界的;液压系统在正常工况下工作,即P1和P2都小于供油压力Ps,且|PL|也小于Ps;因此可知

Figure BDA0002476959180000053
总是有界的,那么只要所设计的U有界即可以保证真实的控制输入u有界;Assumption 1: The reference command signal x 1d (t) of the position servo system of the double-rod hydraulic cylinder is continuous in third order, and the system expects that the position command, speed command, acceleration command and jerk command are all bounded; working under working conditions, that is, both P 1 and P 2 are less than the oil supply pressure P s , and |P L | is also less than P s ; therefore, it can be seen that
Figure BDA0002476959180000053
is always bounded, then as long as the designed U is bounded, the real control input u can be guaranteed to be bounded;

假设2:双出杆液压缸位置伺服系统总的干扰

Figure BDA0002476959180000054
足够光滑,使得
Figure BDA0002476959180000055
均存在并有界即:Assumption 2: The total disturbance of the position servo system of the double-rod hydraulic cylinder
Figure BDA0002476959180000054
smooth enough that
Figure BDA0002476959180000055
Both exist and are bounded:

Figure BDA0002476959180000056
Figure BDA0002476959180000056

式(9)中δ12均为未知正常数,即

Figure BDA0002476959180000057
具有不确定的上界;In formula (9), δ 1 , δ 2 are unknown constants, namely
Figure BDA0002476959180000057
has an indeterminate upper bound;

步骤2,根据上述双出杆液压缸位置伺服系统的数学模型设计自抗扰鲁棒控制器;Step 2, designing an ADRC robust controller according to the mathematical model of the above-mentioned dual-rod hydraulic cylinder position servo system;

步骤2-1、基于扩张状态观测器的干扰补偿设计:Step 2-1. Disturbance compensation design based on extended state observer:

将集成扰动

Figure BDA0002476959180000058
扩张为一个额外的状态变量,即
Figure BDA0002476959180000059
记h(t)为
Figure BDA00024769591800000510
的一阶导数,则式(8)可以写为:will integrate perturbation
Figure BDA0002476959180000058
is expanded to an additional state variable, i.e.
Figure BDA0002476959180000059
Let h(t) be
Figure BDA00024769591800000510
The first derivative of , then equation (8) can be written as:

Figure BDA00024769591800000511
Figure BDA00024769591800000511

由于h(t)为

Figure BDA00024769591800000512
的一阶导数,由式(9)可得:Since h(t) is
Figure BDA00024769591800000512
The first derivative of , can be obtained from equation (9):

Figure BDA0002476959180000061
Figure BDA0002476959180000061

由式(10)结构可知该系统可观测,为其设计一个线性扩张状态观测器如下所示:From the structure of formula (10), it can be known that the system can be observed, and a linear expansion state observer is designed as follows:

Figure BDA0002476959180000062
Figure BDA0002476959180000062

式中

Figure BDA0002476959180000063
表示状态估计,且wo>0可以视作扩张状态观测器的带宽。in the formula
Figure BDA0002476959180000063
represents the state estimate, and w o > 0 can be regarded as the bandwidth of the extended state observer.

Figure BDA0002476959180000064
i=1,2,3,4,表示状态估计误差,由式(10)和式(12)可得状态估计误差的导数为:remember
Figure BDA0002476959180000064
i=1, 2, 3, 4, representing the state estimation error. The derivative of the state estimation error can be obtained from equation (10) and equation (12) as:

Figure BDA0002476959180000065
Figure BDA0002476959180000065

Figure BDA0002476959180000066
i=1,2,3,4;于是式(12)可以写为:remember
Figure BDA0002476959180000066
i=1,2,3,4; then equation (12) can be written as:

Figure BDA0002476959180000067
Figure BDA0002476959180000067

其中,

Figure BDA0002476959180000068
M=[0 0 0 1]T,D为赫尔维茨矩阵;由于D为赫尔维茨矩阵,因此存在一个对称正定矩阵H使得DTH+HD=-I;in,
Figure BDA0002476959180000068
M=[0 0 0 1] T , D is the Hurwitz matrix; since D is the Hurwitz matrix, there is a symmetric positive definite matrix H such that D T H+HD=-I;

给出如下引理:The following lemma is given:

Figure BDA0002476959180000069
可以得到如下结论:估计状态总是有界的,且任意时间后该界的大小随着观测器带宽wo的增大而减小,存在正常数
Figure BDA00024769591800000610
满足下列关系:Depend on
Figure BDA0002476959180000069
The following conclusions can be drawn: the estimated state is always bounded, and the size of the bound decreases with the increase of the observer bandwidth w o after any time, and there is a constant
Figure BDA00024769591800000610
Satisfy the following relationship:

Figure BDA00024769591800000611
Figure BDA00024769591800000611

该引理证明:This lemma proves:

定义李雅普诺夫函数:Define a Lyapunov function:

Vε=εTHε (16)V ε = ε T Hε (16)

对其求导得:Derive it to get:

Figure BDA0002476959180000071
Figure BDA0002476959180000071

式(17)中,

Figure BDA0002476959180000072
λmax(H)为H的最大特征值。In formula (17),
Figure BDA0002476959180000072
λ max(H) is the largest eigenvalue of H.

由(17)可得:From (17) we can get:

Figure BDA0002476959180000073
Figure BDA0002476959180000073

由上式可得:It can be obtained from the above formula:

Figure BDA0002476959180000074
Figure BDA0002476959180000074

式(19)中,λmin(H)为H的最小特征值。In formula (19), λ min(H) is the minimum eigenvalue of H.

由(19)可以得知:当h(t)有界时,||ε||总是有界的,且只要令wo>1,则||ε||将随着时间的增大而减小,更重要的是可以通过增大wo来增大λ以此来缩小状态估计的误差值。由

Figure BDA0002476959180000075
i=1,2,3,4;及式(13)易得知(15)成立,至此,引理得证。It can be known from (19) that when h(t) is bounded, ||ε|| is always bounded, and as long as w o > 1, then ||ε|| will increase with time. It is more important to increase λ by increasing w o to reduce the error value of state estimation. Depend on
Figure BDA0002476959180000075
i=1, 2, 3, 4; and formula (13) is easy to know that (15) holds, so far, the lemma is proved.

步骤2-2、定义z1=x1-x1d为系统的跟踪误差,根据式(10)中的第一个方程

Figure BDA0002476959180000076
令α1为虚拟控制,使方程
Figure BDA0002476959180000077
趋于稳定状态;α1与真实状态x2的误差为z2=x21,对z1求导可得:Step 2-2, define z 1 =x 1 -x 1d as the tracking error of the system, according to the first equation in equation (10)
Figure BDA0002476959180000076
Let α 1 be the virtual control, so that the equation
Figure BDA0002476959180000077
tends to a stable state; the error between α 1 and the real state x 2 is z 2 =x 21 , and the derivative of z 1 can be obtained:

Figure BDA0002476959180000078
Figure BDA0002476959180000078

设计虚拟控制律:Design a virtual control law:

Figure BDA0002476959180000079
Figure BDA0002476959180000079

式中k1>0为可调增益,则where k 1 > 0 is the adjustable gain, then

Figure BDA0002476959180000081
Figure BDA0002476959180000081

由于z1(s)=G(s)z2(s),式中G(s)=1/(s+k1)是一个稳定的传递函数,当z2趋于0时,z1也必然趋于0;所以在接下来的设计中,将以使z2趋于0为主要设计目标;Since z 1 (s)=G(s)z 2 (s), where G(s)=1/(s+k 1 ) is a stable transfer function, when z 2 tends to 0, z 1 also It must tend to 0; so in the next design, the main design goal will be to make z 2 tend to 0;

步骤2-3、考虑式(10)的第二个方程,选取α2为x3的虚拟控制,z3为虚拟控制α2与x3之间的偏差z3=x32;则z2的动态方程为Step 2-3, consider the second equation of formula (10), select α 2 to be the virtual control of x 3 , and z 3 to be the deviation between the virtual control α 2 and x 3 z 3 =x 32 ; then The dynamic equation of z 2 is

Figure BDA0002476959180000082
Figure BDA0002476959180000082

设计虚拟控制律α2如下:The virtual control law α2 is designed as follows:

Figure BDA0002476959180000083
Figure BDA0002476959180000083

式中k2为正的反馈增益,将式(24)代入式(23)中得:where k 2 is the positive feedback gain. Substitute equation (24) into equation (23) to get:

Figure BDA0002476959180000084
Figure BDA0002476959180000084

由于z2(s)=G'(s)z3(s),式中G'(s)=1/(s+k2)是一个稳定的传递函数,当z3趋于0时,z2也必然趋于0;所以在接下来的设计中,将以使z3趋于0为主要设计目标;Since z 2 (s)=G'(s)z 3 (s), where G'(s)=1/(s+k 2 ) is a stable transfer function, when z 3 tends to 0, z 2 must also tend to 0; so in the next design, the main design goal will be to make z 3 tend to 0;

步骤2-4、为获得一个额外的控制器设计自由度,定义一个辅助的误差信号r(t):Steps 2-4. To gain an additional controller design freedom, define an auxiliary error signal r(t):

Figure BDA0002476959180000085
Figure BDA0002476959180000085

式(26)中k3>0为可调增益,由于r(t)中含有位置的加加速度信号,因此在实际中认为是不可测量的,即r(t)仅为辅助设计所用,并不具体出现在所设计的控制器中;In formula (26), k 3 > 0 is an adjustable gain. Since r(t) contains the jerk signal of the position, it is considered unmeasurable in practice, that is, r(t) is only used for auxiliary design, not Specifically appear in the designed controller;

考虑式(10)的第三个方程,可以得到r的展开式如下:Considering the third equation of Eq. (10), the expansion of r can be obtained as follows:

Figure BDA0002476959180000091
Figure BDA0002476959180000091

根据式(27),基于模型的控制器U可设计为:According to equation (27), the model-based controller U can be designed as:

Figure BDA0002476959180000092
Figure BDA0002476959180000092

式中kr为正的反馈增益,Ua为基于模型的补偿项,Us为鲁棒控制律且其中Us1为线性鲁棒反馈项,Us2为非线性鲁棒项用于克服建模不确定性对系统性能的影响;将式(28)代入式(27)中得:where k r is the positive feedback gain, U a is the model-based compensation term, U s is the robust control law and where U s1 is the linear robust feedback term, U s2 is the nonlinear robust term used to overcome the modeling The influence of uncertainty on system performance; Substitute equation (28) into equation (27) to get:

Figure BDA0002476959180000093
Figure BDA0002476959180000093

根据误差符号积分鲁棒控制器设计方法,积分鲁棒项Us2可设计为:According to the error symbol integral robust controller design method, the integral robust term U s2 can be designed as:

Figure BDA0002476959180000094
Figure BDA0002476959180000094

β需满足以下条件:β must meet the following conditions:

Figure BDA0002476959180000095
Figure BDA0002476959180000095

对式(29)等式两边求导并运用式(7)和(11)可得:Differentiating both sides of equation (29) and applying equations (7) and (11), we get:

Figure BDA0002476959180000096
Figure BDA0002476959180000096

步骤3,所述运用李雅普诺夫稳定性理论对双出杆液压缸位置伺服系统进行稳定性证明,并运用Barbalat引理得到系统能够达到渐进稳定的结果,具体如下:Step 3, using the Lyapunov stability theory to prove the stability of the position servo system of the double-rod hydraulic cylinder, and using Barbalat's lemma to obtain the result that the system can achieve asymptotic stability, as follows:

先给出如下引理:First give the following lemma:

定义辅助函数define helper functions

Figure BDA0002476959180000097
Figure BDA0002476959180000097

如果控制增益β的选取满足式(31)所示的条件即:If the selection of control gain β satisfies the condition shown in equation (31), that is:

Figure BDA0002476959180000098
Figure BDA0002476959180000098

but

Figure BDA0002476959180000099
Figure BDA0002476959180000099

Figure BDA0002476959180000101
Figure BDA0002476959180000101

z3(0)、

Figure BDA0002476959180000102
分别表示z3(t)和
Figure BDA0002476959180000103
的初始值;z 3 (0),
Figure BDA0002476959180000102
denote z 3 (t) and
Figure BDA0002476959180000103
the initial value of ;

对该引理的证明:Proof of this lemma:

对式(33)两边积分并运用式(26)得:Integrating both sides of Equation (33) and applying Equation (26), we get:

Figure BDA0002476959180000104
Figure BDA0002476959180000104

对式(32)中后两项进行分部积分可得:Integrating the last two terms in Eq. (32) by parts can be obtained:

Figure BDA0002476959180000105
Figure BDA0002476959180000105

Therefore

Figure BDA0002476959180000106
Figure BDA0002476959180000106

从式(38)可以看出,若β的选取满足式(31)所示的条件时,有式(34)、(35)成立,即引理得证。It can be seen from equation (38) that if the selection of β satisfies the conditions shown in equation (31), equations (34) and (35) are established, that is, the lemma is proved.

定义辅助函数:Define a helper function:

Figure BDA0002476959180000107
Figure BDA0002476959180000107

根据上述引理证明可知当

Figure BDA0002476959180000108
时,P(t)≥0,因此定义李雅普诺夫函数如下:According to the above proof, it can be seen that when
Figure BDA0002476959180000108
When P(t)≥0, the Lyapunov function is defined as follows:

Figure BDA0002476959180000109
Figure BDA0002476959180000109

对式(27)求导并将式(22)、(25)、(26)、(32)、(39)代入可得:Taking the derivative of equation (27) and substituting equations (22), (25), (26), (32), and (39) into equations (22), (25), (26), (32), and (39), we get:

Figure BDA00024769591800001010
Figure BDA00024769591800001010

定义:definition:

Z=[z1,z2,z3,r]T (42)Z=[z 1 ,z 2 ,z 3 ,r] T (42)

Figure BDA0002476959180000111
Figure BDA0002476959180000111

通过调整参数k1,k2,k3,kr可使对称矩阵Λ为正定,则有:By adjusting the parameters k 1 , k 2 , k 3 , k r , the symmetric matrix Λ can be made positive definite, then:

Figure BDA0002476959180000112
Figure BDA0002476959180000112

式(44)中λmin(Λ)为对称正定矩阵Λ的最小特征值。In formula (44), λ min (Λ) is the minimum eigenvalue of the symmetric positive definite matrix Λ.

对式(44)积分可得:Integrating Equation (44) can get:

Figure BDA0002476959180000113
Figure BDA0002476959180000113

由式(32)可知z1,z2,z3,r∈L2范数,且根据式(22)、(25)、(26)、(32)和假设2可得:

Figure BDA0002476959180000114
范数,因此W是一致连续的,由Barbalat引理可知:t→∞时,W→0。故t→∞时,z1→0。From equation (32), it can be known that z 1 , z 2 , z 3 , r∈L 2 norm, and according to equations (22), (25), (26), (32) and assumption 2, we can get:
Figure BDA0002476959180000114
norm, so W is consistent and continuous, according to Barbalat's lemma: when t→∞, W→0. Therefore, when t→∞, z 1 →0.

因此有结论:针对双出杆液压缸位置伺服系统(2)设计的自抗扰鲁棒控制器可以使系统得到渐近稳定的结果,调节增益k1、k2、k3、kr可以使系统的跟踪误差在时间趋于无穷的条件下趋于零;双出杆液压缸位置伺服系统自抗扰鲁棒(RISEESO)控制原理示意图如图2所示。Therefore, there is a conclusion: the active disturbance rejection robust controller designed for the position servo system (2) of the double-rod hydraulic cylinder can make the system obtain asymptotically stable results, and adjusting the gains k 1 , k 2 , k 3 , and k r can make the system The tracking error of the system tends to zero under the condition that the time tends to infinity; Figure 2 shows the schematic diagram of the control principle of the Robust Active Disturbance Rejection (RISEESO) of the position servo system of the double-rod hydraulic cylinder.

实施例Example

为考核所设计的控制器性能,在仿真中取表1中的参数对双出杆液压缸位置伺服系统进行建模:In order to evaluate the performance of the designed controller, the parameters in Table 1 are used to model the position servo system of the double-rod hydraulic cylinder:

表1双出杆液压系统参数Table 1 Parameters of double-rod hydraulic system

Figure BDA0002476959180000115
Figure BDA0002476959180000115

Figure BDA0002476959180000121
Figure BDA0002476959180000121

给定系统的期望指令为x1d=0.2sin(πt)[1-exp(-0.01t3)](m),如图3所示。为验证本发明提出的控制器的有效性,分两种情况对比如下的控制器。The desired instruction for a given system is x 1d =0.2sin(πt)[1-exp(-0.01t 3 )](m), as shown in FIG. 3 . In order to verify the effectiveness of the controller proposed by the present invention, the following controllers are compared in two cases.

Case1:仅考虑参数不确定性,不考虑内泄露与未建模动态,即θ≠θr,Q(t)=0,f(t)=0。Case1: Only parameter uncertainty is considered, internal leakage and unmodeled dynamics are not considered, that is, θ≠θ r , Q(t)=0, f(t)=0.

由表1可以计算楚参数的真实值为θr=[8.59,6.68×105,205.75]T,取其名义值为θ=[8,7×105,100]TFrom Table 1, the true value of the Chu parameter can be calculated as θ r =[8.59, 6.68×10 5 , 205.75] T , taking its nominal value as θ = [8,7×10 5 ,100] T .

自抗扰鲁棒控制器(RISEESO):RISEESO控制器参数取为k1=3000,k2=500,k3=100,kr=100,β=50,wo=100。Active disturbance rejection robust controller (RISEESO): The parameters of the RISEESO controller are taken as k 1 =3000, k 2 =500, k 3 =100, k r =100, β=50, wo =100.

误差符号积分鲁棒控制器(RISE):RISE控制器为RISEESO中的Ua项去掉

Figure BDA0002476959180000122
其余与之相同,参数取值也与之相同。Error Symbol Integral Robust Controller (RISE): The RISE controller removes the U a term in RISEESO
Figure BDA0002476959180000122
The rest are the same, and the parameter values are also the same.

干扰补偿控制器(ESO):该控制器为不掉有US2项RISEESO控制器,参数取值与RISEESO相同。Interference compensation controller (ESO): This controller is a RISEESO controller without the U S2 item, and the parameter values are the same as RISEESO.

PID控制器:PID控制器参数调节通过反复试验的方法进行,所获得的参数已使PID控制器达到性能极限,如若再增大增益值,跟踪误差将发散。选定的PID控制器参数为PID controller: The parameter adjustment of the PID controller is carried out by trial and error. The obtained parameters have made the PID controller reach the performance limit. If the gain value is increased, the tracking error will diverge. The selected PID controller parameters are

kP=5000,kI=800,kD=50。k P =5000, k I =800, k D =50.

各个控制器的跟踪误差对比如图4所示。由图可知,在只存在参数不确定性的情况下,所提的RISEESO控制器控制性能远比其他三个控制器优秀,这说明了所提算法的有效性。RISEESO控制器作用下系统的控制输入如图5所示。The tracking error comparison of each controller is shown in Figure 4. It can be seen from the figure that the control performance of the proposed RISEESO controller is far better than the other three controllers in the presence of only parameter uncertainty, which shows the effectiveness of the proposed algorithm. The control input of the system under the action of the RISEESO controller is shown in Figure 5.

Case2:不仅考虑参数不确定性,同时考虑系统内泄露和未建模动态,取f(x,t)=1000sint,Q(t)=1×10-4sint。Case2: Consider not only parameter uncertainty, but also leakage and unmodeled dynamics in the system, take f(x,t)=1000sint, Q(t)=1×10 -4 sint.

这种情况下两种控制器的参数同Case1中的相应参数。In this case, the parameters of the two controllers are the same as those in Case1.

图6是在参数不确定性与未建模动态同时存在时各个控制器的跟踪性能对比图,可以看出尽管系统加入了很大的未建模动态,但是RISEESO的控制性能仍然很优秀,且远比其他三个控制器的跟踪性能更加的好,这说明了所提策略具有很强抗干扰能力。RISEESO控制器作用下系统的控制输入如图7所示。Figure 6 is a comparison chart of the tracking performance of each controller when parameter uncertainty and unmodeled dynamics coexist. It can be seen that although a large unmodeled dynamics is added to the system, the control performance of RISEESO is still excellent, and The tracking performance is far better than the other three controllers, which shows that the proposed strategy has strong anti-interference ability. The control input of the system under the action of the RISEESO controller is shown in Figure 7.

Claims (1)

1.一种双出杆液压缸位置伺服系统的自抗扰鲁棒控制方法,其特征在于,包括以下步骤:1. the active disturbance rejection robust control method of a double-out rod hydraulic cylinder position servo system, is characterized in that, comprises the following steps: 步骤1,建立双出杆液压缸位置伺服系统的数学模型,具体如下:Step 1, establish the mathematical model of the position servo system of the double-rod hydraulic cylinder, as follows: 步骤1-1、考虑双出杆液压缸位置伺服系统是通过伺服阀控制的双出杆液压缸驱动惯性负载;Step 1-1. Consider that the position servo system of the double-rod hydraulic cylinder is a double-rod hydraulic cylinder controlled by a servo valve to drive the inertial load; 因此,根据牛顿第二定律,惯性负载的运动方程为:Therefore, according to Newton's second law, the equation of motion for an inertial load is:
Figure FDA0003695757350000011
Figure FDA0003695757350000011
式(1)中m为惯性负载参数;PL为液压缸两腔压差;A为液压缸活塞有效截面面积;B为粘性摩擦系数;f(t)是其他未建模干扰;y为惯性负载的位移;t为时间变量;In formula (1), m is the inertial load parameter; PL is the pressure difference between the two chambers of the hydraulic cylinder; A is the effective cross-sectional area of the hydraulic cylinder piston; B is the viscous friction coefficient; f(t) is other unmodeled disturbances; y is the inertial displacement of the load; t is the time variable; 忽略液压缸的外泄漏,则液压缸两腔压差的动态方程为:Ignoring the external leakage of the hydraulic cylinder, the dynamic equation of the pressure difference between the two chambers of the hydraulic cylinder is:
Figure FDA0003695757350000012
Figure FDA0003695757350000012
式(2)中Vt为液压缸两腔总控制容积;βe为有效油液弹性模量;Ct为内泄漏系数;Q(t)为复杂的内泄漏过程、未建模的压力动态引起的建模误差;QL=(Q1+Q2)/2为负载流量,且Q1和Q2分别为液压缸的进油腔流量和回油腔流量;QL与伺服阀位移xv的关系为:In formula (2), V t is the total control volume of the two chambers of the hydraulic cylinder; β e is the elastic modulus of the effective oil; C t is the internal leakage coefficient; Q(t) is the complex internal leakage process and the unmodeled pressure dynamics Modeling error caused; QL = (Q 1 +Q 2 )/2 is the load flow, and Q 1 and Q 2 are the flow rate of the oil inlet chamber and the oil return chamber of the hydraulic cylinder, respectively; QL and servo valve displacement x The relationship of v is:
Figure FDA0003695757350000013
Figure FDA0003695757350000013
式(3)中,伺服阀流量增益系数
Figure FDA0003695757350000014
符号函数sign(xv)的定义为:
In formula (3), the servo valve flow gain coefficient
Figure FDA0003695757350000014
The sign function sign(x v ) is defined as:
Figure FDA0003695757350000015
Figure FDA0003695757350000015
式中Cd流量系数;ω为阀芯面积梯度;ρ为油液密度;Ps为供油压力,Pr为回油压力;where C d flow coefficient; ω is the spool area gradient; ρ is the oil density; P s is the oil supply pressure, and P r is the oil return pressure; 假设采用高响应的伺服阀,阀芯位移与控制输入近似为比例环节,即xv=kiu,ki是正的电气常数,u为控制输入电压,故式(3)写成Assuming that a high-response servo valve is used, the spool displacement and the control input are approximately proportional links, that is, x v = ki u, ki is a positive electrical constant, and u is the control input voltage, so formula (3) is written as
Figure FDA0003695757350000021
Figure FDA0003695757350000021
式(5)中kt=kqki代表总的流量增益;In formula (5), k t = k q k i represents the total flow gain; 步骤1-2、假设未建模动态项f(t)连续可微,定义状态变量:Step 1-2, assuming that the unmodeled dynamic term f(t) is continuous and differentiable, define the state variable:
Figure FDA0003695757350000022
Figure FDA0003695757350000022
则双出杆液压缸位置伺服系统的状态方程为:Then the state equation of the position servo system of the double-rod hydraulic cylinder is:
Figure FDA0003695757350000023
Figure FDA0003695757350000023
式(6)中In formula (6)
Figure FDA0003695757350000024
Figure FDA0003695757350000024
为了简化双出杆液压缸位置伺服系统状态方程显示格式,记θ=[θ1,...,θ3]T为系统参数的已知名义值,θr=[θ1r,...,θ3r]T为系统参数的真实值,其中,
Figure FDA0003695757350000025
则式(6)写成
In order to simplify the display format of the state equation of the double-rod hydraulic cylinder position servo system, denote θ=[θ 1 ,...,θ 3 ] T is the known nominal value of the system parameters, θ r =[θ 1r ,..., θ 3r ] T is the real value of the system parameter, where,
Figure FDA0003695757350000025
The formula (6) can be written as
Figure FDA0003695757350000026
Figure FDA0003695757350000026
式(8)中,
Figure FDA0003695757350000027
In formula (8),
Figure FDA0003695757350000027
双出杆液压缸位置伺服系统控制器的设计目标为:给定系统参考信号yd(t)=x1d(t),设计一个有界的控制输入U使系统输出y=x1尽可能地跟踪系统的参考信号;The design goal of the dual-rod hydraulic cylinder position servo system controller is: given the system reference signal y d (t) = x 1d (t), design a bounded control input U to make the system output y = x 1 as much as possible the reference signal of the tracking system; 为便于控制器设计,假设如下:To facilitate controller design, the following assumptions are made: 假设1:双出杆液压缸位置伺服系统参考指令信号x1d(t)是三阶连续的,且系统期望位置指令、速度指令、加速度指令及加加速度指令都是有界的;液压系统在正常工况下工作,即P1和P2都小于供油压力Ps,且|PL|也小于Ps;因此可知
Figure FDA0003695757350000031
总是有界的,那么只要所设计的U有界即可以保证真实的控制输入u有界;
Assumption 1: The reference command signal x 1d (t) of the position servo system of the double-rod hydraulic cylinder is continuous in third order, and the system expects that the position command, speed command, acceleration command and jerk command are all bounded; working under working conditions, that is, both P 1 and P 2 are less than the oil supply pressure P s , and |P L | is also less than P s ; therefore, it can be seen that
Figure FDA0003695757350000031
is always bounded, then as long as the designed U is bounded, the real control input u can be guaranteed to be bounded;
假设2:双出杆液压缸位置伺服系统总的干扰
Figure FDA0003695757350000032
足够光滑,使得
Figure FDA0003695757350000033
均存在并有界,即:
Assumption 2: The total disturbance of the position servo system of the double-rod hydraulic cylinder
Figure FDA0003695757350000032
smooth enough that
Figure FDA0003695757350000033
exist and are bounded, that is:
Figure FDA0003695757350000034
Figure FDA0003695757350000034
式(9)中δ12均为未知正常数,即
Figure FDA0003695757350000035
具有不确定的上界;
In formula (9), δ 1 , δ 2 are unknown constants, namely
Figure FDA0003695757350000035
has an indeterminate upper bound;
步骤2,根据上述双出杆液压缸位置伺服系统的数学模型设计自抗扰鲁棒控制器;Step 2, designing an ADRC robust controller according to the mathematical model of the above-mentioned dual-rod hydraulic cylinder position servo system; 所述设计自抗扰鲁棒控制器,步骤如下:The steps of designing the ADRC robust controller are as follows: 步骤2-1、基于扩张状态观测器的干扰补偿设计:Step 2-1. Disturbance compensation design based on extended state observer: 将集成扰动
Figure FDA0003695757350000036
扩张为一个额外的状态变量,即
Figure FDA0003695757350000037
记h(t)为
Figure FDA0003695757350000038
的一阶导数,则式(8)写为:
will integrate perturbation
Figure FDA0003695757350000036
is expanded to an additional state variable, i.e.
Figure FDA0003695757350000037
Let h(t) be
Figure FDA0003695757350000038
The first derivative of , then equation (8) can be written as:
Figure FDA0003695757350000039
Figure FDA0003695757350000039
由于h(t)为
Figure FDA00036957573500000310
的一阶导数,由式(9)得:
Since h(t) is
Figure FDA00036957573500000310
The first derivative of , is obtained from equation (9):
Figure FDA00036957573500000311
Figure FDA00036957573500000311
由式(10)结构可知该系统可观测,为其设计一个线性扩张状态观测器如下所示:From the structure of formula (10), it can be known that the system can be observed, and a linear expansion state observer is designed as follows:
Figure FDA00036957573500000312
Figure FDA00036957573500000312
式中
Figure FDA00036957573500000313
表示状态估计,且wo>0视作扩张状态观测器的带宽;
in the formula
Figure FDA00036957573500000313
represents the state estimation, and w o >0 is regarded as the bandwidth of the extended state observer;
Figure FDA00036957573500000314
表示状态估计误差,由式(10)和式(12)得状态估计误差的导数为:
remember
Figure FDA00036957573500000314
represents the state estimation error, and the derivative of the state estimation error obtained from equations (10) and (12) is:
Figure FDA0003695757350000041
Figure FDA0003695757350000041
Figure FDA0003695757350000042
于是,式(12)写为:
remember
Figure FDA0003695757350000042
So, equation (12) can be written as:
Figure FDA0003695757350000043
Figure FDA0003695757350000043
其中,
Figure FDA0003695757350000044
M=[0 0 0 1]T,D为赫尔维茨矩阵;
in,
Figure FDA0003695757350000044
M=[0 0 0 1] T , D is the Hurwitz matrix;
经证明,由|h(t)|≤δ1,
Figure FDA0003695757350000045
得到如下结论:估计状态总是有界的,且任意时间后该界的大小随着观测器带宽wo的增大而减小,存在正常数
Figure FDA0003695757350000046
满足下列关系:
It has been proved that by |h(t)|≤δ 1 ,
Figure FDA0003695757350000045
The following conclusion is obtained: the estimated state is always bounded, and the size of the bound decreases with the increase of the observer bandwidth w o after any time, and there is a constant
Figure FDA0003695757350000046
The following relationship is satisfied:
Figure FDA0003695757350000047
Figure FDA0003695757350000047
步骤2-2、定义z1=x1-x1d为系统的跟踪误差,根据式(10)中的第一个方程
Figure FDA0003695757350000048
令α1为虚拟控制,使方程
Figure FDA0003695757350000049
趋于稳定状态;α1与真实状态x2的误差为z2=x21,对z1求导可得:
Step 2-2, define z 1 =x 1 -x 1d as the tracking error of the system, according to the first equation in equation (10)
Figure FDA0003695757350000048
Let α 1 be the virtual control, so that the equation
Figure FDA0003695757350000049
tends to a stable state; the error between α 1 and the real state x 2 is z 2 =x 21 , and the derivative of z 1 can be obtained:
Figure FDA00036957573500000410
Figure FDA00036957573500000410
设计虚拟控制律:Design a virtual control law:
Figure FDA00036957573500000411
Figure FDA00036957573500000411
式中k1>0为可调增益,则where k 1 > 0 is the adjustable gain, then
Figure FDA00036957573500000412
Figure FDA00036957573500000412
由于z1(s)=G(s)z2(s),式中G(s)=1/(s+k1)是一个稳定的传递函数,当z2趋于0时,z1也必然趋于0,所以在接下来的设计中,将以使z2趋于0为主要设计目标;Since z 1 (s)=G(s)z 2 (s), where G(s)=1/(s+k 1 ) is a stable transfer function, when z 2 tends to 0, z 1 also It must tend to 0, so in the next design, the main design goal will be to make z 2 tend to 0; 步骤2-3、考虑式(10)的第二个方程,选取α2为x3的虚拟控制,z3为虚拟控制α2与x3之间的偏差z3=x32;则z2的动态方程为Step 2-3, consider the second equation of formula (10), select α 2 as the virtual control of x 3 , and z 3 as the deviation between the virtual control α 2 and x 3 z 3 =x 32 ; then The dynamic equation of z 2 is
Figure FDA0003695757350000051
Figure FDA0003695757350000051
设计虚拟控制律α2如下:The virtual control law α2 is designed as follows:
Figure FDA0003695757350000052
Figure FDA0003695757350000052
式中k2为正的反馈增益,将式(20)代入式(19)中得:where k 2 is the positive feedback gain. Substitute equation (20) into equation (19) to obtain:
Figure FDA0003695757350000053
Figure FDA0003695757350000053
由于z2(s)=G'(s)z3(s),式中G'(s)=1/(s+k2)是一个稳定的传递函数,当z3趋于0时,z2也必然趋于0;所以在接下来的设计中,将以使z3趋于0为主要设计目标;Since z 2 (s)=G'(s)z 3 (s), where G'(s)=1/(s+k 2 ) is a stable transfer function, when z 3 tends to 0, z 2 must also tend to 0; so in the next design, the main design goal will be to make z 3 tend to 0; 步骤2-4、为获得一个额外的控制器设计自由度,定义一个辅助的误差信号r(t):Steps 2-4. To gain an additional controller design freedom, define an auxiliary error signal r(t):
Figure FDA0003695757350000054
Figure FDA0003695757350000054
式(22)中k3>0为可调增益,由于r(t)中含有位置的加加速度信号,因此在实际中认为是不可测量的,即r(t)仅为辅助设计所用,并不具体出现在所设计的控制器中;In formula (22), k 3 > 0 is an adjustable gain. Since r(t) contains the jerk signal of the position, it is considered unmeasurable in practice, that is, r(t) is only used for auxiliary design, not Specifically appear in the designed controller; 考虑式(10)的第三个方程,得到r的展开式如下:Considering the third equation of Eq. (10), the expansion of r is obtained as follows:
Figure FDA0003695757350000055
Figure FDA0003695757350000055
根据式(23),基于模型的控制器U可设计为:According to equation (23), the model-based controller U can be designed as:
Figure FDA0003695757350000056
Figure FDA0003695757350000056
式中kr为正的反馈增益,Ua为基于模型的补偿项,Us为鲁棒控制律且其中Us1为线性鲁棒反馈项,Us2为非线性鲁棒项用于克服建模不确定性对系统性能的影响;将式(24)代入式(23)中得:where k r is the positive feedback gain, U a is the model-based compensation term, U s is the robust control law and U s1 is the linear robust feedback term, and U s2 is the nonlinear robust term used to overcome the modeling The influence of uncertainty on system performance; Substitute equation (24) into equation (23) to get:
Figure FDA0003695757350000061
Figure FDA0003695757350000061
根据误差符号积分鲁棒控制器设计方法,积分鲁棒项Us2可设计为:According to the error symbol integral robust controller design method, the integral robust term U s2 can be designed as:
Figure FDA0003695757350000062
Figure FDA0003695757350000062
变量β需满足以下条件:The variable β must satisfy the following conditions:
Figure FDA0003695757350000063
Figure FDA0003695757350000063
对式(25)等式两边求导并运用式(7)和(11)可得:Differentiating both sides of equation (25) and applying equations (7) and (11), we get:
Figure FDA0003695757350000064
Figure FDA0003695757350000064
步骤3,运用李雅普诺夫稳定性理论对双出杆液压缸位置伺服系统进行稳定性证明,并运用Barbalat引理得到系统能够达到渐进稳定的结果,具体如下:Step 3: Use Lyapunov stability theory to prove the stability of the position servo system of the double-rod hydraulic cylinder, and use Barbalat's lemma to obtain the result that the system can achieve asymptotic stability, as follows: 定义辅助函数define helper functions
Figure FDA0003695757350000065
Figure FDA0003695757350000065
Figure FDA0003695757350000066
Figure FDA0003695757350000066
其中:in:
Figure FDA0003695757350000067
Figure FDA0003695757350000067
z3(0)、
Figure FDA0003695757350000068
分别表示z3
Figure FDA0003695757350000069
的初始值;
z 3 (0),
Figure FDA0003695757350000068
denote z 3 and
Figure FDA0003695757350000069
the initial value of ;
经证明当
Figure FDA00036957573500000610
时,P(t)≥0,因此定义李雅普诺夫函数如下:
proven when
Figure FDA00036957573500000610
When P(t)≥0, the Lyapunov function is defined as follows:
Figure FDA00036957573500000611
Figure FDA00036957573500000611
运用李雅普诺夫稳定性理论进行稳定性证明,并运用Barbalat引理得到系统渐近稳定的结果,因此调节增益k1、k2、k3、kr及使双出杆液压缸位置伺服系统的跟踪误差在时间趋于无穷的条件下趋于零。Use Lyapunov stability theory to prove the stability, and use Barbalat's lemma to get the result of system asymptotic stability. Therefore, adjust the gains k 1 , k 2 , k 3 , k r and make the position servo system of the double-rod hydraulic cylinder. The tracking error tends to zero under the condition that time tends to infinity.
CN202010366842.4A 2020-04-30 2020-04-30 Active-disturbance-rejection robust control method for double-rod hydraulic cylinder position servo system Active CN111577711B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010366842.4A CN111577711B (en) 2020-04-30 2020-04-30 Active-disturbance-rejection robust control method for double-rod hydraulic cylinder position servo system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010366842.4A CN111577711B (en) 2020-04-30 2020-04-30 Active-disturbance-rejection robust control method for double-rod hydraulic cylinder position servo system

Publications (2)

Publication Number Publication Date
CN111577711A CN111577711A (en) 2020-08-25
CN111577711B true CN111577711B (en) 2022-08-16

Family

ID=72120736

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010366842.4A Active CN111577711B (en) 2020-04-30 2020-04-30 Active-disturbance-rejection robust control method for double-rod hydraulic cylinder position servo system

Country Status (1)

Country Link
CN (1) CN111577711B (en)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112068447A (en) * 2020-09-30 2020-12-11 长沙航空职业技术学院 High-precision robust position control method for electro-hydraulic system of large equipment
CN112486021B (en) * 2020-12-07 2021-10-08 燕山大学 A Low-Complexity Control Method for Asymmetric Servo-Hydraulic Position Tracking System
CN113063024B (en) * 2021-03-22 2022-06-14 南昌智能新能源汽车研究院 Closed-loop control method of electromagnetic valve pressure and controller design method thereof
CN113359485B (en) * 2021-07-27 2022-08-16 安徽工业大学 Method for controlling output feedback preset performance of electro-hydraulic servo system
CN116300420B (en) * 2022-12-13 2024-03-15 南方海洋科学与工程广东省实验室(湛江) Servo control method, system, device, terminal equipment and storage medium
CN118545646B (en) * 2024-07-25 2024-11-12 华侨大学 Backstepping sliding mode control method for heavy forklift pump-controlled lifting system based on nonlinear observer

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102006012008A1 (en) * 2006-03-14 2007-09-20 Robert Bosch Gmbh Control device for rotor blade adjustment
CN101907109A (en) * 2010-08-11 2010-12-08 马鞍山钢铁股份有限公司 Synchronous control device for hydraulic cylinder and control method thereof

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7308139B2 (en) * 2002-07-12 2007-12-11 Chroma Energy, Inc. Method, system, and apparatus for color representation of seismic data and associated measurements
JP2006004176A (en) * 2004-06-17 2006-01-05 Sony Corp Servo control device
CN101488010A (en) * 2009-03-06 2009-07-22 北京理工大学 Essentially nonlinear compensation controller of servo system
DE102013210340A1 (en) * 2013-06-04 2014-12-04 Robert Bosch Gmbh Method and apparatus for cylinder equalization of an internal combustion engine, in particular of a motor vehicle
CN104111607B (en) * 2014-06-13 2016-08-17 南京理工大学 A kind of control method of the electric machine position servo system considering input delay
CN104065322B (en) * 2014-06-13 2017-05-17 南京理工大学 Method for controlling output feedback of motor position servo system
CN104345639B (en) * 2014-10-09 2017-03-15 南京理工大学 A kind of electro-hydraulic position servo system Robust Adaptive Control method
CN104345638B (en) * 2014-10-09 2017-06-27 南京理工大学 A Disturbance Rejection Adaptive Control Method for Hydraulic Motor Position Servo System
CN105680750B (en) * 2016-04-20 2018-02-16 无锡信捷电气股份有限公司 PMSM servo system control methods based on improved model compensation ADRC
CN108415249B (en) * 2018-02-09 2021-05-07 南京理工大学 An adaptive robust control method for electro-hydraulic servo system based on low frequency learning
CN110928182B (en) * 2019-11-05 2022-12-13 南京理工大学 Robust Adaptive Repetitive Control Method for Hydraulic Servo System Based on State Estimation

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102006012008A1 (en) * 2006-03-14 2007-09-20 Robert Bosch Gmbh Control device for rotor blade adjustment
CN101907109A (en) * 2010-08-11 2010-12-08 马鞍山钢铁股份有限公司 Synchronous control device for hydraulic cylinder and control method thereof

Also Published As

Publication number Publication date
CN111577711A (en) 2020-08-25

Similar Documents

Publication Publication Date Title
CN111577711B (en) Active-disturbance-rejection robust control method for double-rod hydraulic cylinder position servo system
CN104345639B (en) A kind of electro-hydraulic position servo system Robust Adaptive Control method
CN104345638B (en) A Disturbance Rejection Adaptive Control Method for Hydraulic Motor Position Servo System
Feng et al. Identification and compensation of non-linear friction for a electro-hydraulic system
CN104317198B (en) Nonlinear Robust Position Control Method for Electro-hydraulic Servo System with Time-Varying Output Constraints
Nakkarat et al. Observer-based backstepping force control of an electrohydraulic actuator
CN108181818B (en) Robust adaptive control method for electro-hydraulic position servo system with unmodeled friction dynamics
CN104698844B (en) Uncertainty compensatory sliding-mode control method of hydraulic position servo system
CN108869420A (en) A kind of adaptive backstepping control method of electrohydraulic servo system filtered based on instruction
CN110928182A (en) A Robust Adaptive Repetitive Control Method for Hydraulic Servo System Based on State Estimation
CN110794687A (en) Electro-hydraulic servo system self-adaptive state constraint control method based on interference compensation
CN110308651B (en) Electro-hydraulic servo system all-state constraint control method based on extended state observer
CN104932259A (en) Gain self-adjustment type supercoiling slip form control method for electro-hydraulic positioning servo system
CN114967466B (en) A preset performance output feedback control method for an electro-hydraulic servo system based on disturbance compensation and full-state constraints
CN114943146A (en) Electro-hydraulic proportional servo valve position axial control method considering input time lag
CN115143165B (en) Position axis control method of electro-hydraulic proportional servo valve considering system unknown dynamic compensation
CN105093936B (en) The continuous sliding-mode control of finite time of electro-hydraulic position servo system
CN107315350B (en) A dual closed-loop model reference adaptive control method for electro-hydrostatic actuation systems
Mohorcic et al. Extended state observer-based pressure control for pneumatic actuator servo systems
CN111308889B (en) Adaptive integral robust control method of spray rod system
CN113552805B (en) Indirect self-adaptive robust control method of electro-hydrostatic actuator
CN105068426A (en) Electro-hydraulic position servo system continuous sliding mode control method based on interference compensation
CN107882795A (en) A kind of submissive compensating control method of highly integrated property valve-controlled cylinder force control dynamic
CN118545646B (en) Backstepping sliding mode control method for heavy forklift pump-controlled lifting system based on nonlinear observer
CN118131602B (en) Output feedback control method of pilot type electro-hydraulic proportional servo valve considering disturbance suppression

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