1.一种永磁同步直线电机稳定自适应鲁棒位置控制方法,其特征在于,提供一稳定自适应鲁棒控制器以实现永磁同步直线电机的高精度位置控制;所述稳定自适应鲁棒控制器,以动子实际位移x与位移指令xd之间的跟踪误差e为输入信号,跟踪误差记为e,输出控制律u作为指令控制信号;实际系统存在参数不确定性、不确定的非线性和非参数不确定性的不利因素,控制目标是在此情况下,设计一个输出控制律u,使跟踪误差e尽可能小,具体包括步骤如下:
步骤S1:设计控制律和自适应律
已知永磁同步直线电机的动力学方程为
<mrow>
<mi>M</mi>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>L</mi>
</msub>
<mo>=</mo>
<msub>
<mi>F</mi>
<mi>m</mi>
</msub>
<mo>+</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>f</mi>
<mi>r</mi>
<mi>i</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>L</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>d</mi>
<mi>i</mi>
<mi>s</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>,</mo>
<msub>
<mi>x</mi>
<mi>L</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>L</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,M为运动部分的质量,xL为惯性负载的位移,Fm为电机推力,Ffric为系统的摩擦力,Fdis为系统的干扰;
经相对输入增益规范化后,转换成如下状态方程形式:
<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>
<mrow>
<msub>
<mi>M</mi>
<mi>k</mi>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mi>u</mi>
<mo>-</mo>
<msub>
<mi>B</mi>
<mi>k</mi>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>F</mi>
<mi>k</mi>
</msub>
<mi>S</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>d</mi>
<mi>k</mi>
</msub>
<mo>+</mo>
<mi>&Delta;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,Mk为规范化后的运动部分的质量,Bk为规范化后的阻尼和粘滞摩擦系数,Fk为规范化后的库仑摩擦力系数,dk为规范化后的系统非线性因素的常数部分,Δ为规范化后的系统非线性因素的时变部分;
状态变量为位移、速度组成的列向量;
记未知参数列向量为θ=[θ1,θ2,θ3,θ4]T=[Mk,Bk,Fk,dk]T;
首先定义如下滑模项变量p为
<mrow>
<mi>p</mi>
<mo>=</mo>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>p</mi>
</msub>
<mi>e</mi>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mrow>
<mn>2</mn>
<mi>e</mi>
<mi>q</mi>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mrow>
<mn>2</mn>
<mi>e</mi>
<mi>q</mi>
</mrow>
</msub>
<mover>
<mo>=</mo>
<mi>&Delta;</mi>
</mover>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mi>p</mi>
</msub>
<mi>e</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
其中e=x1-xd(t)为跟踪误差,kp>0;如果p很小或指数收敛于零,则跟踪误差e也会很小或指数收敛于零;
设计控制器使p收敛;对p微分,并由式(2)得
其中
由拉格朗日中值定理,知
其中g(x2,t)为确定的非线性函数;
为应对非参数不确定性,应用回归量替代和死区方法选取稳定自适应鲁棒控制器的控制律和自适应律为:
其中为应用目标轨线信息的回归量,ks1是任一非线性正定矩阵增益,满足如下条件:
<mrow>
<msub>
<mi>k</mi>
<mrow>
<mi>s</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>&GreaterEqual;</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>k</mi>
<mrow>
<mi>s</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&theta;</mi>
<mn>1</mn>
</msub>
<msub>
<mi>k</mi>
<mi>p</mi>
</msub>
<mo>+</mo>
<msub>
<mi>&theta;</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&theta;</mi>
<mn>3</mn>
</msub>
<mi>g</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>&theta;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>k</mi>
<mi>p</mi>
</msub>
<mo>+</mo>
<msub>
<mi>&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>gk</mi>
<mi>p</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>&theta;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>k</mi>
<mi>p</mi>
</msub>
<mo>+</mo>
<msub>
<mi>&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>gk</mi>
<mi>p</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>&theta;</mi>
<mn>1</mn>
</msub>
<msubsup>
<mi>k</mi>
<mi>p</mi>
<mn>3</mn>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
其中鲁棒反馈us2要满足如下条件:
i.pus2≤0
步骤S2:收敛性证明
构造一候选李雅普诺夫函数
<mrow>
<msub>
<mi>V</mi>
<mi>a</mi>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msup>
<mi>e</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msup>
<mover>
<mi>&theta;</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<msup>
<mi>&Gamma;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mi>&theta;</mi>
<mo>~</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
上式显然是正定的,当Δ(x,t)=0时,由式(3)和式(8),得其时间导数为
因此,
对式(10)积分得:
<mrow>
<msubsup>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>t</mi>
</msubsup>
<msup>
<mi>e</mi>
<mn>2</mn>
</msup>
<mrow>
<mo>(</mo>
<mi>v</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>v</mi>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mi>k</mi>
</mfrac>
<msubsup>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>t</mi>
</msubsup>
<msub>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>a</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>v</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>v</mi>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mi>k</mi>
</mfrac>
<mo>&lsqb;</mo>
<msub>
<mi>V</mi>
<mi>a</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>V</mi>
<mi>a</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>&le;</mo>
<mfrac>
<mn>1</mn>
<mi>k</mi>
</mfrac>
<msub>
<mi>V</mi>
<mi>a</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
知由式(5)和式(11)知,并且e是一致连续的;
根据Babalat引理得,
当t→∞时,e→0 (13)
即跟踪误差全局渐近收敛于零,即证明系统的收敛性;
步骤S3:鲁棒性证明
构造一候选李雅普诺夫函数
<mrow>
<msub>
<mi>V</mi>
<mi>r</mi>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msup>
<mi>e</mi>
<mn>2</mn>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
由式(7)、式(8),得其时间导数为
根据比较引理,得
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mrow>
<mo>|</mo>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>&le;</mo>
<msup>
<mrow>
<mo>|</mo>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
<mn>2</mn>
</msup>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mn>2</mn>
<mi>k</mi>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<msubsup>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>t</mi>
</msubsup>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mn>2</mn>
<mi>k</mi>
<mo>(</mo>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mi>v</mi>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>v</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>v</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>&le;</mo>
<msup>
<mrow>
<mo>|</mo>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
<mn>2</mn>
</msup>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mn>2</mn>
<mi>k</mi>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<msub>
<mi>&epsiv;</mi>
<mi>M</mi>
</msub>
<mi>k</mi>
</mfrac>
<mo>&lsqb;</mo>
<mn>1</mn>
<mo>-</mo>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mn>2</mn>
<mi>k</mi>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
即当t→∞时,有
<mrow>
<mo>|</mo>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>&infin;</mi>
<mo>)</mo>
</mrow>
<mo>|</mo>
<mo><</mo>
<mfrac>
<msub>
<mi>&epsiv;</mi>
<mi>M</mi>
</msub>
<mi>k</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>17</mn>
<mo>)</mo>
</mrow>
</mrow>
通过调整参数k,ε调整指数收敛率为k,稳态值上界为εM/k,即证明系统的鲁棒性;步骤S4:将控制律u作为伺服控制器的控制输入,编码器信号作为位置信息的实时反馈。