CN106438593B - 一种存在参数不确定性和负载干扰的电液伺服控制方法及机械臂 - Google Patents
一种存在参数不确定性和负载干扰的电液伺服控制方法及机械臂 Download PDFInfo
- Publication number
- CN106438593B CN106438593B CN201610918468.8A CN201610918468A CN106438593B CN 106438593 B CN106438593 B CN 106438593B CN 201610918468 A CN201610918468 A CN 201610918468A CN 106438593 B CN106438593 B CN 106438593B
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- mover
- mtd
- mtr
- 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.)
- Expired - Fee Related
Links
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B21/00—Common features of fluid actuator systems; Fluid-pressure actuator systems or details thereof, not covered by any other group of this subclass
- F15B21/08—Servomotor systems incorporating electrically operated control means
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Physics & Mathematics (AREA)
- Fluid Mechanics (AREA)
- Mechanical Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Servomotors (AREA)
- Other Investigation Or Analysis Of Materials By Electrical Means (AREA)
Abstract
一种存在参数不确定性和负载干扰的电液伺服控制方法及机械臂,非对称电液伺服执行器数学模型首先通过变换为严格反馈非线性模型,模型中的液压不确定参数采用参数自适应估计律进行估计,外负载动态干扰采用高增益观测器进行在线估计,为了避免反步控制律中的虚拟控制量产生的微分***效果,采用一阶动态面设计技术,抑制了反步迭代中虚拟控制变量的剧烈变化,同时采用基于基于障碍李亚普洛夫函数构建***能量函数,并设计最终的反步控制律,将输出位移跟踪误差和液压缸无杆腔和有杆腔的压力约束到预定的指标边界以内,提高了2‑DOF机械臂关节运动的动态控制性能。
Description
技术领域
本发明涉及一种可用于非对称液压缸执行机构的控制方法,特别是同时存在液压参数不确定性和外负载干扰情况下电液伺服执行器的状态约束控制。
背景技术
在电液伺服控制***中同时考虑液压参数不确定性和外负载动态干扰,并且对电液伺服***状态和***输出进行约束。本专利采用比例积分形式的干扰观测器与参数自适应估计律相结合的方法同时估计未知液压参数和外负载干扰,采用基于障碍李雅普洛夫函数和动态面控制技术的反步控制方法实现非对称液压缸左右腔压力约束和液压缸位移跟踪误差约束,保证***状态收敛,同时参数估计和外负载估计收敛,动态面稳定,液压动态响应性能良好,从而驱动机械臂的关节运动。
发明内容
本发明的目的是克服目前电液伺服控制方法的不足,适用于存在液压参数不确定性和外负载干扰情况下的电液伺服执行器状态约束控制,可以防止控制饱和,并提高电液伺服控制***的动态跟踪性能。
本发明的技术方案是一种存在参数不确定性和负载干扰的电液伺服控制方法,该方法包括:
步骤1:建立非对称电液伺服执行器模型;
非对称电液伺服执行器模型为:
y=x1
其中
y液压缸输出位移,为输出位移变化率,pa和pb为非对称液压缸无杆腔和有杆腔压力,xv为伺服阀阀芯位移,m为负载质量,ps为供油压力,Aa和Ab为非对称缸无杆腔和有杆腔的横截面积,Ctl为液压缸总泄漏系数,V0a和V0b为非对称液压缸无杆腔和有杆腔的初始容积,βe为液压油有效体积弹性模量,Cd为伺服阀流量系数,w为伺服阀面积梯度,ρ为液压油密度,K为负载刚度系数,b为液压油阻尼系数,FL为外负载压力,Ksv为伺服阀放大系数,Tsv为伺服阀一阶响应时间常数,sgn(·)为符号函数,u为伺服阀控制电压。
由于模型(1)含有1个内部动态,因此定义2个新状态变量 同时需要将模型(1)转换为严格反馈模型形式如下:
其中θ1=b,θ2=βe,θ3=βeCtl,为4个未知不确定液压参数,
f21(x1)=-Kx1/m f22(x2)=-x2/m
g2=Aa/m d(t)=-FL(t)/m
f31(x1,x2)=-(h1Aa+h2Abυ)x2/βe
f32(x1,x3,x4)=-(x3-x4)(h1+h2)/βe
g4=Ksv/Tsv
其中υ表示液压缸无杆腔与有杆腔面积之比,υ=Ab/Aa。
步骤2:驱动电液伺服,实时获取电液伺服的反馈数据:液压缸输出位移、液压缸输出位移变化率、液压缸无杆腔和有杆腔的压力、伺服阀阀芯位移;
步骤3:采用高增益干扰观测器对外负载干扰进行估计;
步骤4:采用参数自适应估计律对液压未知常参数进行估计;
步骤5:采用动态面控制计算反步控制中的虚拟控制变量;
步骤6:基于障碍李雅普洛夫函数,并结合反馈数据、***误差和、参数自适应估计值和负载干扰估计量计算反步控制律;
步骤7:根据反步控制律对非对称电液伺服机构实时进行驱动。
进一步的,所述步骤3中高增益干扰观测器对外负载干扰进行估计如下:
其中和为负载干扰d和未知参数θ1的估计值,Kd为观测器增益。
进一步的,所述步骤4中参数自适应估计律设计如下:
首先,***误差zi(i=1,…,4)表示为
其中yd表示液压缸期望位移指令,αi(i=1,2,3)为反步控制律设计中虚拟控制变量;
其次,参数自适应估计律表示为:
其中为4个未知液压参数的估计值,为的初始值,kθi(i=1,…,4)为参数自适应估计律增益,ηi(i=1,…,4)为设定的正常数,
ka1和kb1为***误差z3的左右约束边界。
进一步的,所述步骤5中动态面设计如下:
其中βi(i=1,…,3)为动态面稳定函数,τi(i=1,…,3)为动态面时间常数;
动态面误差表示为Si=αi-βi(i=1,…,3),虚拟控制量微分表示为动态面稳定函数βi(i=1,…,3)进一步表示为:
其中表示输出误差z1的约束边界,ki(i=1,2,3)表示控制增益,
进一步的,所述步骤6中反步控制律设计如下:
首先,考虑***状态约束条件如下:
其中kc1为输出误差z1的约束边界,ka1和kb1为***误差z3的左右约束边界,表示为:
ka1=(υ+1)ps-pr,kb1=ps-(υ+1)pr
其中υ表示液压缸无杆腔与有杆腔面积之比,ps表示***供油压力,pr表示***回油压力;
基于障碍李雅普洛夫函数,构建***的能量函数为:
则状态约束反步控制律u表示为:
其中k4表示控制增益,τi(i=1,…,3)为动态面时间常数。
一种应用存在参数不确定性和负载干扰的电液伺服控制方法的机械臂,该机械臂包括:3个机械连杆,包括:第一连杆、第二连杆、第三连杆,2个电液伺服阀,2个双作用液压缸,1个伺服电机,1个定量柱塞泵,1个油箱;其中第一连杆与第二连杆之间铰接,称该处为肩关节,第二连杆与第三连杆铰接,称该处为肘关节;肩关节与肘关节处分别设置一个电液伺服阀与双作用液压缸;整个机械臂设置1个伺服电机、1个定量柱塞泵和1个油箱;第二连杆与第三连杆上分别设置一光电编码器,用于测量两个关节的运动角度和角速度;在两个液压缸进油口和出油口各设置1个压力传感器,测量液压缸的负载力,在定量柱塞泵出口安装1个压力表,监测***的供油压力。
本发明的目的之三是提出基于障碍利亚普洛夫函数和动态面设计技术的状态约束控制方法,结合高增益负载干扰观测器和参数自适应估计律,既能对对液压4个不确定参数进行估计,同时也可以对时变的外负载干扰进行估计,而且利用动态面设计规避了对反步控制律中的虚拟控制量进行直接微分解算,防止出现微分***现象,将输出位移跟踪误差和液压缸无杆腔和有杆腔的压力约束到预定的指标边界以内,提高了电液伺服***的动态性能。
附图说明
图1为本发明的采用存在液压参数不确定性和负载干扰情况下电液伺服执行器状态约束控制方法的二自由度机械臂机构示意图;
图2为本发明一种存在液压参数不确定性和负载干扰情况下电液伺服执行器状态约束控制方法方案图。
具体实施方式
以下提供本发明一种存在液压参数不确定性和负载干扰情况下电液伺服执行器状态约束控制驱动二自由度机械臂的具体实时方式。
非对称电液伺服执行器的模型为5阶模型,不考虑机械臂机构运动的模型,机械臂运动所需要的关节力矩作为电液伺服执行器的负载干扰考虑,简述如下:
1)非对称电液伺服执行器模型电液伺服执行器建模
采用五阶模型描述伺服阀驱动液压缸回路的电液伺服执行器模型如下:
y=x1
其中
xi(i=1,…,4)为模型状态变量,y液压缸输出位移,为输出位移变化率,pa和pb为非对称液压缸无杆腔和有杆腔压力,xv为伺服阀阀芯位移,m为负载质量,ps为供油压力,Aa和Ab为非对称缸无杆腔和有杆腔的横截面积,Ctl为液压缸总泄漏系数,V0a和V0b为非对称液压缸无杆腔和有杆腔的初始容积,βe为液压油有效体积弹性模量,Cd为伺服阀流量系数,w为伺服阀面积梯度,ρ为液压油密度,K为负载刚度系数,b为液压油阻尼系数,FL为外负载压力,Ksv为伺服阀放大系数,Tsv为伺服阀一阶响应时间常数,sgn(·)为符号函数,u为伺服阀控制电压。
由于模型(1)含有1个内部动态,因此定义2个新状态变量 同时需要将模型(1)转换为严格反馈模型形式如下:
其中θ1=b,θ2=βe,θ3=βeCtl,为4个未知不确定液压参数,
f31(x1,x2)=-(h1Aa+h2Abα)x2/βe
f32(x1,x3,x4)=-(x3-x4)(h1+h2)/βe
2)高增益负载干扰观测器表述为:
其中和为负载干扰d和未知参数θ1的估计值,Kd为观测器增益。
3)参数自适应估计律表示为:
其中为4个未知液压参数的估计值,为的初始值,kθi(i=1,…,4)为参数自适应估计律增益,ηi(i=1,…,4)为设定的正常数,
***误差zi(i=1,…,4)表示为
其中yd表示液压缸期望位移指令,αi(i=1,2,3)为反步控制律设计中虚拟控制变量。
4)虚拟控制变量αi(i=1,…,3)的动态面设计如下:
其中βi(i=1,…,3)为动态面稳定函数,τi(i=1,…,3)为动态面时间常数。
动态面误差表示为Si=αi-βi(i=1,…,3),虚拟控制量微分表示为动态面稳定函数βi(i=1,…,3)进一步表示为:
5)基于障碍李雅普洛夫函数的状态约束反步控制律u表示为:
Claims (5)
1.一种存在参数不确定性和负载干扰的电液伺服控制方法,该方法包括:
步骤1:建立非对称电液伺服执行器模型;
非对称电液伺服执行器模型为:
<mrow>
<mtable>
<mtr>
<mtd>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<msub>
<mi>A</mi>
<mi>a</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<msub>
<mi>A</mi>
<mi>b</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Kx</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>bx</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>F</mi>
<mi>L</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>/</mo>
<mi>m</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>=</mo>
<msub>
<mi>h</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<mo>-</mo>
<msub>
<mi>A</mi>
<mi>a</mi>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>t</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>+</mo>
<msub>
<mi>h</mi>
<mn>1</mn>
</msub>
<msub>
<mi>C</mi>
<mi>d</mi>
</msub>
<msub>
<mi>wx</mi>
<mn>5</mn>
</msub>
<msqrt>
<mfrac>
<mn>2</mn>
<mi>&rho;</mi>
</mfrac>
</msqrt>
<mrow>
<mo>(</mo>
<msub>
<mi>s</mi>
<mn>1</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>p</mi>
<mi>s</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
</mrow>
</msqrt>
<mo>+</mo>
<msub>
<mi>s</mi>
<mn>2</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>p</mi>
<mi>r</mi>
</msub>
</mrow>
</msqrt>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>=</mo>
<msub>
<mi>h</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mi>b</mi>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>t</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>h</mi>
<mn>2</mn>
</msub>
<msub>
<mi>C</mi>
<mi>d</mi>
</msub>
<msub>
<mi>wx</mi>
<mn>5</mn>
</msub>
<msqrt>
<mfrac>
<mn>2</mn>
<mi>&rho;</mi>
</mfrac>
</msqrt>
<mrow>
<mo>(</mo>
<msub>
<mi>s</mi>
<mn>1</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>p</mi>
<mi>r</mi>
</msub>
</mrow>
</msqrt>
<mo>-</mo>
<msub>
<mi>s</mi>
<mn>2</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>p</mi>
<mi>s</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
</mrow>
</msqrt>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>5</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>5</mn>
</msub>
<mo>/</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>K</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
<mi>u</mi>
<mo>/</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中
<mrow>
<msub>
<mi>h</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<msub>
<mi>&beta;</mi>
<mi>e</mi>
</msub>
<mrow>
<msub>
<mi>V</mi>
<mrow>
<mn>0</mn>
<mi>a</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>A</mi>
<mi>a</mi>
</msub>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
</mrow>
</mfrac>
<mo>;</mo>
<msub>
<mi>h</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<msub>
<mi>&beta;</mi>
<mi>e</mi>
</msub>
<mrow>
<msub>
<mi>V</mi>
<mrow>
<mn>0</mn>
<mi>b</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>A</mi>
<mi>b</mi>
</msub>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
</mrow>
</mfrac>
</mrow>
<mrow>
<msub>
<mi>s</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>1</mn>
<mo>+</mo>
<mi>sgn</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>5</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mn>2</mn>
</mfrac>
<mo>;</mo>
<msub>
<mi>s</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>sgn</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>5</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mn>2</mn>
</mfrac>
</mrow>
y为液压缸输出位移,为输出位移变化率,pa和pb为非对称液压缸无杆腔和有杆腔压力,xv为伺服阀阀芯位移,m为负载质量,ps为供油压力,Aa和Ab为非对称缸无杆腔和有杆腔的横截面积,Ctl为液压缸总泄漏系数,V0a和V0b为非对称液压缸无杆腔和有杆腔的初始容积,βe为液压油有效体积弹性模量,Cd为伺服阀流量系数,w为伺服阀面积梯度,ρ为液压油密度,K为负载刚度系数,b为液压油阻尼系数,FL为外负载压力,Ksv为伺服阀放大系数,Tsv为伺服阀一阶响应时间常数,sgn(·)为符号函数,u为伺服阀控制电压;
由于模型(1)含有1个内部动态,因此定义2个新状态变量其中υ=Ab/Aa<1,同时需要将模型(1)转换为严格反馈模型形式如下:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mn>21</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>&theta;</mi>
<mn>1</mn>
</msub>
<msub>
<mi>f</mi>
<mn>22</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>g</mi>
<mn>2</mn>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>+</mo>
<mi>d</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>=</mo>
<msub>
<mi>&theta;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>f</mi>
<mn>31</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>f</mi>
<mn>32</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>&theta;</mi>
<mn>4</mn>
</msub>
<msub>
<mi>g</mi>
<mn>3</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mn>4</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>g</mi>
<mn>4</mn>
</msub>
<mi>u</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
其中θ1=b,θ2=βe,θ3=βeCtl,为4个未知不确定液压参数,
f21(x1)=-Kx1/m;f22(x2)=-x2/m
g2=Aa/m;d(t)=-FL(t)/m
f31(x1,x2)=-(h1Aa+h2Abυ)x2/βe
f32(x1,x3,x4)=-(x3-x4)(h1+h2)/βe
<mrow>
<msub>
<mi>g</mi>
<mn>3</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mover>
<mi>s</mi>
<mo>&OverBar;</mo>
</mover>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>h</mi>
<mn>1</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>p</mi>
<mi>s</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
</mrow>
</msqrt>
<mo>+</mo>
<msub>
<mi>&upsi;h</mi>
<mn>2</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>p</mi>
<mi>r</mi>
</msub>
</mrow>
</msqrt>
<mo>)</mo>
</mrow>
<mo>/</mo>
<msub>
<mi>&beta;</mi>
<mi>e</mi>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>s</mi>
<mo>&OverBar;</mo>
</mover>
<mn>2</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>h</mi>
<mn>1</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>p</mi>
<mi>r</mi>
</msub>
</mrow>
</msqrt>
<mo>+</mo>
<msub>
<mi>&upsi;h</mi>
<mn>2</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>p</mi>
<mi>s</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
</mrow>
</msqrt>
<mo>)</mo>
</mrow>
<mo>/</mo>
<msub>
<mi>&beta;</mi>
<mi>e</mi>
</msub>
</mrow>
<mrow>
<msub>
<mi>f</mi>
<mn>4</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>/</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
<mo>;</mo>
<msub>
<mi>g</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<msub>
<mi>K</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
<mo>/</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mover>
<mi>s</mi>
<mo>&OverBar;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>1</mn>
<mo>+</mo>
<mi>tanh</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mn>2</mn>
</mfrac>
<mo>;</mo>
<msub>
<mover>
<mi>s</mi>
<mo>&OverBar;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>tanh</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mn>2</mn>
</mfrac>
</mrow>
其中υ表示液压缸非对称有杆腔与无杆腔横截面积之比,υ=Ab/Aa;
步骤2:驱动电液伺服执行器,实时获取电液伺服执行器的反馈数据:液压缸输出位移、液压缸输出位移变化率、液压缸无杆腔和有杆腔的压力、伺服阀阀芯位移;
步骤3:采用高增益干扰观测器对外负载干扰进行估计;
步骤4:采用参数自适应估计律对未知不确定液压参数进行估计;
步骤5:采用动态面控制计算反步控制中的虚拟控制变量;
步骤6:基于障碍李雅普洛夫函数,并结合反馈数据、***误差、参数自适应估计值和负载干扰估计量计算反步控制律;
步骤7:根据反步控制律对非对称电液伺服机构实时进行驱动。
2.如权利要求1所述的一种存在参数不确定性和负载干扰的电液伺服控制方法,其特征在于所述步骤3中高增益干扰观测器对外负载干扰进行估计如下:
<mrow>
<mover>
<mover>
<mi>d</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>d</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>f</mi>
<mn>21</mn>
</msub>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>1</mn>
</msub>
<msub>
<mi>f</mi>
<mn>22</mn>
</msub>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
<mo>-</mo>
<msub>
<mi>g</mi>
<mn>2</mn>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>-</mo>
<mover>
<mi>d</mi>
<mo>^</mo>
</mover>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
其中和为负载干扰d和未知参数θ1的估计值,Kd为观测器增益。
3.如权利要求1所述的一种存在参数不确定性和负载干扰的电液伺服控制方法,其特征在于所述步骤4中参数自适应估计律设计如下:
首先,***误差zi,i=1,2,3,4表示为
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>d</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>z</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<mi>i</mi>
<mo>=</mo>
<mn>3</mn>
<mo>,</mo>
<mn>4</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
其中yd表示液压缸期望位移指令,αi(i=1,2,3,4)为反步控制律设计中虚拟控制变量;
其次,参数自适应估计律表示为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<mo>&lsqb;</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<msub>
<mi>f</mi>
<mn>22</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&eta;</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>10</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>/</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>&theta;</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>&lsqb;</mo>
<msub>
<mi>&mu;f</mi>
<mn>31</mn>
</msub>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&eta;</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>20</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>/</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>&theta;</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>&lsqb;</mo>
<msub>
<mi>&mu;f</mi>
<mi>32</mi>
</msub>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&eta;</mi>
<mn>3</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>30</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>/</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>&theta;</mi>
<mn>3</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>=</mo>
<mo>&lsqb;</mo>
<msub>
<mi>&mu;g</mi>
<mi>3</mi>
</msub>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&eta;</mi>
<mn>4</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>40</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>/</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>&theta;</mi>
<mn>4</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
其中为4个未知液压参数的估计值,为的初始值,kθi(i=1,2,3,4)为参数自适应估计律增益,ηi(i=1,2,3,4)为设定的正常数,
<mrow>
<mi>&mu;</mi>
<mo>=</mo>
<mfrac>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mi>q</mi>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mrow>
<msubsup>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>z</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<mrow>
<mi>q</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msubsup>
<mi>k</mi>
<mrow>
<mi>b</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>z</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mfrac>
</mrow>
<mrow>
<mi>q</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mrow>
<mn>0</mn>
<mo><</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo><</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>b</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
</msub>
<mo><</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>&le;</mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
ka1和kb1为***误差z3的左右约束边界。
4.如权利要求1所述的一种存在参数不确定性和负载干扰的电液伺服控制方法,其特征在于所述步骤5中动态面设计如下:
<mrow>
<msub>
<mi>&tau;</mi>
<mi>i</mi>
</msub>
<msub>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>&beta;</mi>
<mi>i</mi>
</msub>
<mo>;</mo>
<msub>
<mi>&alpha;</mi>
<mi>i</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>&beta;</mi>
<mi>i</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
其中βi(i=1,2,3)为动态面稳定函数,τi(i=1,2,3)为动态面时间常数;
动态面误差表示为Si=αi-βi,i=1,2,3,虚拟控制量微分表示为动态面稳定函数βi(i=1,2,3)进一步表示为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&beta;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>k</mi>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>z</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&beta;</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msub>
<mi>g</mi>
<mn>2</mn>
</msub>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>k</mi>
<mn>2</mn>
</msub>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<mfrac>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mrow>
<msubsup>
<mi>k</mi>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>z</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mfrac>
<mo>+</mo>
<msub>
<mi>f</mi>
<mn>21</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>1</mn>
</msub>
<msub>
<mi>f</mi>
<mn>22</mn>
</msub>
<mo>+</mo>
<mover>
<mi>d</mi>
<mo>^</mo>
</mover>
<mo>+</mo>
<msub>
<mi>S</mi>
<mn>1</mn>
</msub>
<mo>/</mo>
<msub>
<mi>&tau;</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&beta;</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mrow>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>4</mn>
</msub>
<msub>
<mi>g</mi>
<mn>3</mn>
</msub>
</mrow>
</mfrac>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>g</mi>
<mn>2</mn>
</msub>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
</mrow>
<mi>&mu;</mi>
</mfrac>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>2</mn>
</msub>
<msub>
<mi>f</mi>
<mn>31</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>3</mn>
</msub>
<msub>
<mi>f</mi>
<mn>32</mn>
</msub>
<mo>+</mo>
<msub>
<mi>S</mi>
<mn>2</mn>
</msub>
<mo>/</mo>
<msub>
<mi>&tau;</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>k</mi>
<mn>3</mn>
</msub>
<mi>&phi;</mi>
<mo>(</mo>
<mrow>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>,</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>b</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
其中表示***误差z1的约束边界,ki(i=1,2,3)表示控制增益,
<mrow>
<mi>&phi;</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>,</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>b</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mi>q</mi>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<msubsup>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>z</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>q</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<msubsup>
<mi>k</mi>
<mrow>
<mi>b</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>z</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>.</mo>
</mrow>
5.如权利要求1所述的一种存在参数不确定性和负载干扰的电液伺服控制方法,其特征在于所述步骤6中反步控制律设计如下:
首先,考虑***状态约束条件如下:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<mo><</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>d</mi>
</msub>
<mo><</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
</msub>
<mo><</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>2</mn>
</msub>
<mo><</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>b</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
其中kc1为***误差z1的约束边界,ka1和kb1为***误差z3的左右约束边界,表示为:
ka1=(υ+1)ps-pr,kb1=ps-(υ+1)pr
ps表示***供油压力,pr表示***回油压力;
基于障碍李雅普洛夫函数,构建***的能量函数为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>V</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mi>ln</mi>
<mfrac>
<msubsup>
<mi>k</mi>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msubsup>
<mrow>
<msubsup>
<mi>k</mi>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>z</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msubsup>
<mi>S</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>V</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>V</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msubsup>
<mi>z</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>k</mi>
<msub>
<mi>&theta;</mi>
<mn>1</mn>
</msub>
</msub>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>~</mo>
</mover>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msup>
<mover>
<mi>d</mi>
<mo>~</mo>
</mover>
<mn>2</mn>
</msup>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msubsup>
<mi>S</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>V</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<msub>
<mi>V</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>2</mn>
</mrow>
<mn>4</mn>
</munderover>
<msub>
<mi>k</mi>
<msub>
<mi>&theta;</mi>
<mi>i</mi>
</msub>
</msub>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>~</mo>
</mover>
<mi>i</mi>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mi>q</mi>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mi>ln</mi>
<mfrac>
<msubsup>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mrow>
<msubsup>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>z</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mi>q</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>ln</mi>
<mfrac>
<msubsup>
<mi>k</mi>
<mrow>
<mi>b</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mrow>
<msubsup>
<mi>k</mi>
<mrow>
<mi>b</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>z</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msubsup>
<mi>S</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>V</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<msub>
<mi>V</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msubsup>
<mi>z</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
则状态约束反步控制律H表示为:
<mrow>
<mi>H</mi>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msub>
<mi>g</mi>
<mn>4</mn>
</msub>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>k</mi>
<mn>4</mn>
</msub>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mo>+</mo>
<mi>&mu;</mi>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>4</mn>
</msub>
<msub>
<mi>g</mi>
<mn>3</mn>
</msub>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>f</mi>
<mn>4</mn>
</msub>
<mo>(</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>)</mo>
<mo>+</mo>
<mfrac>
<msub>
<mi>S</mi>
<mn>3</mn>
</msub>
<msub>
<mi>&tau;</mi>
<mn>3</mn>
</msub>
</mfrac>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
其中k4表示控制增益,为动态面时间常数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610918468.8A CN106438593B (zh) | 2016-10-21 | 2016-10-21 | 一种存在参数不确定性和负载干扰的电液伺服控制方法及机械臂 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610918468.8A CN106438593B (zh) | 2016-10-21 | 2016-10-21 | 一种存在参数不确定性和负载干扰的电液伺服控制方法及机械臂 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106438593A CN106438593A (zh) | 2017-02-22 |
CN106438593B true CN106438593B (zh) | 2018-01-12 |
Family
ID=58176618
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610918468.8A Expired - Fee Related CN106438593B (zh) | 2016-10-21 | 2016-10-21 | 一种存在参数不确定性和负载干扰的电液伺服控制方法及机械臂 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106438593B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108626203B (zh) * | 2018-05-14 | 2019-08-27 | 大连海事大学 | 一种六自由度运动平台电液伺服***的低频干扰补偿方法 |
CN108628172B (zh) * | 2018-06-25 | 2021-05-07 | 南京理工大学 | 一种基于扩张状态观测器的机械臂高精度运动控制方法 |
CN110173487B (zh) * | 2019-05-27 | 2020-07-31 | 电子科技大学 | 一种多电液伺服执行器在切换网络下的领导同步控制方法 |
CN110081046B (zh) * | 2019-05-27 | 2020-07-31 | 电子科技大学 | 一种基于反步控制的多电液伺服执行器跟踪同步控制方法 |
CN111558938B (zh) * | 2020-04-27 | 2021-06-22 | 江苏建筑职业技术学院 | 一种基于观测器的机械臂***保瞬态与稳态性能控制方法 |
CN111546350B (zh) * | 2020-04-30 | 2021-09-10 | 浙江大学 | 一种多关节重载液压机器人***及高精度运动控制方法 |
CN111648758B (zh) * | 2020-06-28 | 2023-07-18 | 青岛科技大学 | 一种水井钻机推进装置无模型自适应控制方法及*** |
CN111775142B (zh) * | 2020-08-12 | 2021-12-14 | 电子科技大学 | 一种液压机械臂的模型辨识与自适应控制方法 |
CN112068435B (zh) * | 2020-09-09 | 2021-07-16 | 北京航空航天大学 | 基于干扰观测器的康复机械装置迭代学习控制方法及*** |
CN112555202B (zh) * | 2020-11-27 | 2023-08-11 | 上海凯科疏水阀业有限公司 | 一种基于参数自适应的液压***控制方法 |
CN112731801B (zh) * | 2020-12-17 | 2022-10-14 | 上海工程技术大学 | 一种对称死区非线性的自适应动态面输出反馈控制方法 |
CN113050417B (zh) * | 2021-02-26 | 2022-04-01 | 中国地质大学(武汉) | 全状态约束机械臂的快速有限时间控制器的设计方法 |
CN114738338B (zh) * | 2022-04-27 | 2023-02-10 | 浙江大学 | 一种面向水下多自由度液压机械臂的滑模控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103753526A (zh) * | 2013-12-30 | 2014-04-30 | 重庆交通大学 | 可定位补偿的精密重载机械手 |
CN104317198A (zh) * | 2014-10-21 | 2015-01-28 | 南京理工大学 | 具有时变输出约束的电液伺服***非线性鲁棒位置控制方法 |
CN104635490A (zh) * | 2014-12-15 | 2015-05-20 | 南京理工大学 | 一种单出杆液压缸位置伺服***的输出反馈控制方法 |
CN105159076A (zh) * | 2015-08-24 | 2015-12-16 | 南京理工大学 | 基于融合型自适应鲁棒的电液负载模拟器力控制方法 |
CN105182742A (zh) * | 2015-07-23 | 2015-12-23 | 北京航空航天大学 | 一种弹性体飞行器自适应受限跟踪控制间接法 |
-
2016
- 2016-10-21 CN CN201610918468.8A patent/CN106438593B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103753526A (zh) * | 2013-12-30 | 2014-04-30 | 重庆交通大学 | 可定位补偿的精密重载机械手 |
CN104317198A (zh) * | 2014-10-21 | 2015-01-28 | 南京理工大学 | 具有时变输出约束的电液伺服***非线性鲁棒位置控制方法 |
CN104635490A (zh) * | 2014-12-15 | 2015-05-20 | 南京理工大学 | 一种单出杆液压缸位置伺服***的输出反馈控制方法 |
CN105182742A (zh) * | 2015-07-23 | 2015-12-23 | 北京航空航天大学 | 一种弹性体飞行器自适应受限跟踪控制间接法 |
CN105159076A (zh) * | 2015-08-24 | 2015-12-16 | 南京理工大学 | 基于融合型自适应鲁棒的电液负载模拟器力控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106438593A (zh) | 2017-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106438593B (zh) | 一种存在参数不确定性和负载干扰的电液伺服控制方法及机械臂 | |
CN106402089B (zh) | 一种基于耦合干扰观测器的级联电液伺服***控制方法及*** | |
Feng et al. | Identification and compensation of non-linear friction for a electro-hydraulic system | |
CN104317198A (zh) | 具有时变输出约束的电液伺服***非线性鲁棒位置控制方法 | |
Sarkar et al. | GA-optimized feedforward-PID tracking control for a rugged electrohydraulic system design | |
CN104635490A (zh) | 一种单出杆液压缸位置伺服***的输出反馈控制方法 | |
CN105538310A (zh) | 一种基于衰减记忆滤波的电液伺服控制方法及2-dof机械臂 | |
CN108181818A (zh) | 含未建模摩擦动态的电液位置伺服***鲁棒自适应控制方法 | |
CN110081046B (zh) | 一种基于反步控制的多电液伺服执行器跟踪同步控制方法 | |
CN106483844A (zh) | 基于非线性鲁棒的电液伺服***自适应位置控制器的实现方法 | |
CN110456646A (zh) | 基于ekf的锚杆钻机钻臂摆角自适应滑模控制***设计方法 | |
CN111648758B (zh) | 一种水井钻机推进装置无模型自适应控制方法及*** | |
CN112925208A (zh) | 一种数据驱动的水井钻机电液伺服***扰动补偿方法 | |
Coskun et al. | Intelligent PID control of an industrial electro-hydraulic system | |
Li et al. | Command filter-based adaptive fuzzy finite-time output feedback control of nonlinear electrohydraulic servo system | |
Ye et al. | Model-based adaptive command filtering control of an electrohydraulic actuator with input saturation and friction | |
Miao et al. | Vibration reduction control of in-pipe intelligent isolation plugging tool based on deep reinforcement learning | |
CN111810493A (zh) | 一种四足机器人液压***仿真建模方法 | |
Chen et al. | Observer-based adaptive robust precision motion control of a multi-joint hydraulic manipulator | |
CN106066603B (zh) | 具有精确跟踪性能的电液伺服***自适应鲁棒位置控制器的实现方法 | |
Zhang et al. | Velocity Feedback Control of Swing Phase for 2-DoF Robotic Leg Driven by Electro-hydraulic Servo System. | |
CN111775142B (zh) | 一种液压机械臂的模型辨识与自适应控制方法 | |
Nakadoi et al. | Liquid environment-adaptive IPMC fish-like robot using extremum seeking feedback | |
Kumawat et al. | Discrete-Time Constrained Controller for Proportional Directional Control Valve-Based Electrohydraulic System With Parametric Uncertainty and Disturbances | |
Zou et al. | Sliding mode based mode free control of electro-hydraulic system with extended state observer |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180112 Termination date: 20201021 |