基于非线性鲁棒的电液伺服系统自适应位置控制器的实现方法与流程

文档序号:12175337阅读:来源:国知局

技术特征:

1.一种基于非线性鲁棒的电液伺服系统自适应位置控制器的实现方法,其特征在于,该方法包括以下步骤:

步骤一、建立电液位置伺服系统的非线性数学模型,根据牛顿第二定律可得系统的运动学方程为:

<mrow> <mi>J</mi> <mover> <mi>y</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>P</mi> <mi>L</mi> </msub> <msub> <mi>D</mi> <mi>m</mi> </msub> <mo>-</mo> <mi>B</mi> <mover> <mi>y</mi> <mo>&CenterDot;</mo> </mover> <mo>-</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

公式(1)中,J为负载的转动惯量;y为负载的角位移;PL=P1-P2为液压马达的负载压力,P1、P2分别为液压马达两腔的油压,;Dm为液压马达的排量;B为线性摩擦模型的粘性摩擦系数;f(t)为不确定性项,包括未建模的摩擦以及外干扰;

液压马达的负载压力动态方程为:

<mrow> <mfrac> <msub> <mi>V</mi> <mi>t</mi> </msub> <mrow> <mn>4</mn> <msub> <mi>&beta;</mi> <mi>e</mi> </msub> </mrow> </mfrac> <msub> <mover> <mi>P</mi> <mo>&CenterDot;</mo> </mover> <mi>L</mi> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>D</mi> <mi>m</mi> </msub> <mover> <mi>y</mi> <mo>&CenterDot;</mo> </mover> <mo>-</mo> <msub> <mi>C</mi> <mi>t</mi> </msub> <msub> <mi>P</mi> <mi>L</mi> </msub> <mo>+</mo> <msub> <mi>Q</mi> <mi>L</mi> </msub> <mo>-</mo> <mi>q</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>

公式(2)中,Vt、βe、Ct、QL分别为液压马达控制腔的总容积、液压油有效弹性模量、液压马达内泄漏系数及伺服阀负载流量,QL=(Q1+Q2)/2,其中Q1为由伺服阀流进液压马达进油腔的液压流量,Q2为由伺服阀流出液压马达回油腔的液压流量;q(t)为建模误差;

伺服阀负载流量QL与阀芯位移xv之间的关系为:

<mrow> <msub> <mi>Q</mi> <mi>L</mi> </msub> <mo>=</mo> <msub> <mi>k</mi> <mi>q</mi> </msub> <msub> <mi>x</mi> <mi>v</mi> </msub> <msqrt> <mrow> <msub> <mi>P</mi> <mi>s</mi> </msub> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>v</mi> </msub> <mo>)</mo> </mrow> <msub> <mi>P</mi> <mi>L</mi> </msub> </mrow> </msqrt> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>

公式(3)中Cd为流量系数;ω为阀芯面积梯度;ρ为油液密度;Ps为与回油压力Pr相关的供油压力;sign(·)定义为:

假设伺服阀响应速度非常快即伺服阀频宽远远高于系统频宽,则阀芯位移xv与控制输入u近似为比例环节,即xv=kiu,ki为正增益,那么(3)式可写为:

<mrow> <msub> <mi>Q</mi> <mi>L</mi> </msub> <mo>=</mo> <msub> <mi>k</mi> <mi>t</mi> </msub> <mi>u</mi> <msqrt> <mrow> <msub> <mi>P</mi> <mi>s</mi> </msub> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <mi>u</mi> <mo>)</mo> </mrow> <msub> <mi>P</mi> <mi>L</mi> </msub> </mrow> </msqrt> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>

公式(5)中kt=kqki为与控制输入u相关的总的流量增益;

为使控制器的设计更具广泛性,针对液压马达伺服系统,由式(1)(2)及(5)表征的非线性模型,定义系统状态变量为则系统非线性模型的状态空间形式为:

<mrow> <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>x</mi> <mn>3</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mrow> <msub> <mi>JV</mi> <mi>t</mi> </msub> </mrow> <mrow> <mn>4</mn> <msub> <mi>D</mi> <mi>m</mi> </msub> <msub> <mi>&beta;</mi> <mi>e</mi> </msub> <msub> <mi>k</mi> <mi>t</mi> </msub> </mrow> </mfrac> <msub> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mn>3</mn> </msub> <mo>=</mo> <mi>U</mi> <mo>-</mo> <mrow> <mo>(</mo> <mfrac> <msub> <mi>D</mi> <mi>m</mi> </msub> <msub> <mi>k</mi> <mi>t</mi> </msub> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>C</mi> <mi>t</mi> </msub> <mi>B</mi> </mrow> <mrow> <msub> <mi>D</mi> <mi>m</mi> </msub> <msub> <mi>k</mi> <mi>t</mi> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>C</mi> <mi>t</mi> </msub> <mi>J</mi> </mrow> <mrow> <msub> <mi>D</mi> <mi>m</mi> </msub> <msub> <mi>k</mi> <mi>t</mi> </msub> </mrow> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>V</mi> <mi>t</mi> </msub> <mi>B</mi> </mrow> <mrow> <mn>4</mn> <msub> <mi>D</mi> <mi>m</mi> </msub> <msub> <mi>&beta;</mi> <mi>e</mi> </msub> <msub> <mi>k</mi> <mi>t</mi> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>+</mo> <mi>d</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>

公式(6)中U、d(t)表示为:

<mrow> <mtable> <mtr> <mtd> <mrow> <mi>U</mi> <mover> <mo>=</mo> <mi>&Delta;</mi> </mover> <mi>u</mi> <msqrt> <mrow> <msub> <mi>P</mi> <mi>s</mi> </msub> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <mi>u</mi> <mo>)</mo> </mrow> <msub> <mi>P</mi> <mi>L</mi> </msub> </mrow> </msqrt> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mi>d</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mover> <mo>=</mo> <mi>&Delta;</mi> </mover> <mo>-</mo> <mfrac> <mn>1</mn> <msub> <mi>k</mi> <mi>t</mi> </msub> </mfrac> <mi>q</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mfrac> <msub> <mi>C</mi> <mi>t</mi> </msub> <mrow> <msub> <mi>D</mi> <mi>m</mi> </msub> <msub> <mi>k</mi> <mi>t</mi> </msub> </mrow> </mfrac> <mi>f</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mfrac> <msub> <mi>V</mi> <mi>t</mi> </msub> <mrow> <mn>4</mn> <msub> <mi>D</mi> <mi>m</mi> </msub> <msub> <mi>&beta;</mi> <mi>e</mi> </msub> <msub> <mi>k</mi> <mi>t</mi> </msub> </mrow> </mfrac> <mover> <mi>f</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>

由公式(6),由于定义了一个新的变量U来替代系统的实际控制输入u,系统中安装了压力传感器,(Ps-sign(u)PL)1/2的值可以实时获得,那么实际的控制输入u可以通过U/(Ps-sign(u)PL)1/2来计算;

由于系统的参数J、B、βe、kt以及Ct可能存在大的变化从而使系统遭受参数不确定性,因此,为了简化(6)式,定义不确定参数集其中以及

状态空间等式(6)可以重新写为:

假设1:期望跟踪的位置指令x1d=yd(t)∈C5并且有界;实际液压马达伺服系统在正常工作条件下,PL有界,即0<PL<Ps

假设2:不确定性参数集满足:

公式(9)中均已知常量;

假设3:公式(8)中的时变不确定性d(t)足够光滑并且满足:

<mrow> <mo>|</mo> <mover> <mi>d</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>|</mo> <mo>&le;</mo> <msub> <mi>&delta;</mi> <mn>1</mn> </msub> <mo>,</mo> <mo>|</mo> <mover> <mi>d</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>|</mo> <mo>&le;</mo> <msub> <mi>&delta;</mi> <mn>2</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>

公式(10)中δ1、δ2为已知正常数;

步骤二、基于不连续投影算子设计自适应律对液压马达系统中的不确定性参数进行估计

定义分别为的估计值及估计误差,即

定义不连续投影函数为:

公式(11)中i=1,2,3,·i为矢量·的第i个元素,对于两个矢量之间的运算“<”为矢量中相应元素之间的运算;

自适应律设计为:

公式(12)中Γ为对角自适应律矩阵且Γ>0,σ为自适应函数;

对于任意自适应函数σ,运用投影函数(12)能保证:

步骤三、针对公式(6)中的状态方程,设计基于非线性鲁棒的电液伺服系统自适应位置控制器,其具体步骤如下:

步骤三(一)、定义一组类似开关函数的变量为:

<mrow> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mrow> <mn>1</mn> <mi>d</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>=</mo> <msub> <mover> <mi>z</mi> <mo>&CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>,</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>=</mo> <msub> <mover> <mi>z</mi> <mo>&CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>,</mo> <msub> <mi>z</mi> <mn>4</mn> </msub> <mo>=</mo> <msub> <mover> <mi>z</mi> <mo>&CenterDot;</mo> </mover> <mn>3</mn> </msub> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>14</mn> <mo>)</mo> </mrow> </mrow>

公式(14)中z1为系统的跟踪误差,k1、k2、k3为正反馈增益;

步骤三(二)、设计自适应函数以及控制器输入U,使得液压马达伺服系统具有全局渐近跟踪性能

根据公式(14),辅助误差信号z4可以整理为:

<mrow> <msub> <mi>z</mi> <mn>4</mn> </msub> <mo>=</mo> <msub> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mn>3</mn> </msub> <mo>-</mo> <msub> <mover> <mi>x</mi> <mo>&CenterDot;&CenterDot;&CenterDot;</mo> </mover> <mrow> <mn>1</mn> <mi>d</mi> </mrow> </msub> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>)</mo> </mrow> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <msubsup> <mi>k</mi> <mn>2</mn> <mn>2</mn> </msubsup> <mo>+</mo> <msubsup> <mi>k</mi> <mn>1</mn> <mn>2</mn> </msubsup> <mo>+</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <msub> <mi>k</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>+</mo> <msubsup> <mi>k</mi> <mn>1</mn> <mn>3</mn> </msubsup> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>15</mn> <mo>)</mo> </mrow> </mrow>

基于系统模型(6),可以得到:

根据公式(16)的结构,自适应函数以及基于模型的控制器可以设计为:

(17)

<mrow> <msub> <mi>Y</mi> <mi>d</mi> </msub> <mover> <mo>=</mo> <mi>&Delta;</mi> </mover> <msup> <mrow> <mo>&lsqb;</mo> <msub> <mover> <mi>x</mi> <mo>&CenterDot;&CenterDot;&CenterDot;</mo> </mover> <mrow> <mn>1</mn> <mi>d</mi> </mrow> </msub> <mo>,</mo> <msub> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mn>1</mn> <mi>d</mi> </mrow> </msub> <mo>,</mo> <msub> <mover> <mi>x</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> <mrow> <mn>1</mn> <mi>d</mi> </mrow> </msub> <mo>&rsqb;</mo> </mrow> <mi>T</mi> </msup> <mo>,</mo> <mi>&sigma;</mi> <mo>=</mo> <mo>-</mo> <msub> <mover> <mi>Y</mi> <mo>&CenterDot;</mo> </mover> <mi>d</mi> </msub> <msub> <mi>z</mi> <mn>4</mn> </msub> </mrow>

其中kr为正反馈增益;Ua为可调节的基于模型的前馈控制律,通过参数自适应来获得提高的模型补偿;Us为线性鲁棒控制律用来保证系统名义模型的稳定性;Un为基于辅助误差符号z4积分的非线性鲁棒控制律,用来处理时变的扰动,Un将在以下的设计步骤中给出;

从(17)可以看出,自适应函数σ依赖于误差信号z4,但是通过对σ进行积分可得:

<mrow> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mi>t</mi> </msubsup> <mrow> <mi>&sigma;</mi> <mi>d</mi> <mi>v</mi> <mo>=</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>Y</mi> <mo>&CenterDot;</mo> </mover> <mi>d</mi> </msub> <msub> <mi>z</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mi>t</mi> </msubsup> <mrow> <msub> <mover> <mi>Y</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> <mi>d</mi> </msub> <msub> <mi>z</mi> <mn>3</mn> </msub> <mi>d</mi> <mi>v</mi> </mrow> <mo>-</mo> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mi>t</mi> </msubsup> <msub> <mi>k</mi> <mn>3</mn> </msub> <msub> <mover> <mi>Y</mi> <mo>&CenterDot;</mo> </mover> <mi>d</mi> </msub> <msub> <mi>z</mi> <mn>3</mn> </msub> <mi>d</mi> <mi>v</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>18</mn> <mo>)</mo> </mrow> </mrow>

由(18)可以看出,参数估计中并不需要用到不可测信号z4

基于(18)对(12)进行积分可得:

由式(19)可以看出,参数的估计值并没有直接用到误差信号z4,而是运用了z4的符号sign(z4),为了计算sign(z4),定义函数h(t)为:

<mrow> <mi>h</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mi>t</mi> </msubsup> <msub> <mi>z</mi> <mn>4</mn> </msub> <mrow> <mo>(</mo> <mi>v</mi> <mo>)</mo> </mrow> <mi>d</mi> <mi>v</mi> <mo>=</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mn>0</mn> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mi>t</mi> </msubsup> <msub> <mi>z</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>v</mi> <mo>)</mo> </mrow> <mi>d</mi> <mi>v</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>20</mn> <mo>)</mo> </mrow> </mrow>

由于z4(t)=limτ→0(h(t)-h(t-τ))/τ,τ可以选取为采样时间,根据(19)可知只需要知道z4的符号sign(z4)即可,因此只需要知道h(t)增加还是减小就可以获得sign(z4),其中sign(z4)=sign(h(t)-h(t-τ));

把(17)带入到(16)中,我们可以得到:

根据公式(21)可以设计鲁棒控制律为:

<mrow> <msub> <mi>U</mi> <mi>n</mi> </msub> <mo>=</mo> <mo>-</mo> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mi>t</mi> </msubsup> <mrow> <msub> <mi>k</mi> <mi>r</mi> </msub> <msub> <mi>k</mi> <mn>3</mn> </msub> <msub> <mi>z</mi> <mn>3</mn> </msub> </mrow> <mo>+</mo> <mi>&beta;</mi> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>)</mo> </mrow> <mi>d</mi> <mi>v</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>22</mn> <mo>)</mo> </mrow> </mrow>

其中β>0;

步骤四、确定液压马达伺服系统中不确定性参数集的范围即的值并使确定数据采样时间τ,同时调节对角自适应律矩阵Γ的值,并调节参数β、k1、k2、k3以及kr,从而来确保整个系统稳定,并使液压马达位置伺服系统的位置输出y(t)准确地跟踪期望的位置指令yd,其中采样时间τ、调节参数β、k1、k2、k3以及kr、对角自适应律矩阵Γ均大于0。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1