压电精密位置平台自适应输出反馈逆控制方法与流程

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

技术特征:

1.一种压电精密位置平台自适应输出反馈逆控制方法,其特征是,它包括以下内容:

1)压电精密位置平台数学模型

考虑到一类加入回滞的非线性系统表达式为:

<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>f</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <msub> <mover> <mi>x</mi> <mo>&OverBar;</mo> </mover> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>d</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mi>n</mi> </msub> <mo>=</mo> <msub> <mi>b</mi> <mn>0</mn> </msub> <mi>w</mi> <mrow> <mo>(</mo> <mi>u</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>f</mi> <mi>n</mi> </msub> <mrow> <mo>(</mo> <msub> <mover> <mi>x</mi> <mo>&OverBar;</mo> </mover> <mi>n</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>d</mi> <mi>n</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mo>=</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>0</mn> <mo>,</mo> <mn>1</mn> <mo>,</mo> <mn>...</mn> <mo>,</mo> <mi>n</mi> <mo>-</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

其中,是状态向量;未知光滑线性函数,di(t)是外部干扰,b0未知常数参数,w∈R未知的回滞现象,表示为:

w(u)=P(u(t)) (2)

u是执行器的输入信号,P是滞后算子,

对于系统式(1),以下假设是必需的:

A1:干扰di(t),i=1,…,n,满足:

<mrow> <mo>|</mo> <msub> <mi>d</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>|</mo> <mo>&le;</mo> <msub> <mover> <mi>d</mi> <mo>&OverBar;</mo> </mover> <mi>i</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>

其中,是一些未知正常数;A2:在设计处理下,期望轨迹yr是光滑的,且yr(0)是能够得到的;对于所有的t≥0,属于一个已知的紧集;A3:b0的符号是已知的,不失一般性,为了方便,假设b0>0;

2)Prandtl-Ishlinskii(PI)模型及其逆

采用适用于描述压电执行器中磁滞模型的PI模型,且采用其相应的模型逆来减轻磁滞现象的影响,

w(t)=P[u](t) (4)

其中P[u](t)定义为:

<mrow> <mi>P</mi> <mo>&lsqb;</mo> <mi>u</mi> <mo>&rsqb;</mo> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>p</mi> <mn>0</mn> </msub> <mi>u</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mi>&Lambda;</mi> </msubsup> <mi>p</mi> <mrow> <mo>(</mo> <mi>r</mi> <mo>)</mo> </mrow> <msub> <mi>F</mi> <mi>r</mi> </msub> <mo>&lsqb;</mo> <mi>u</mi> <mo>&rsqb;</mo> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mi>d</mi> <mi>r</mi> <mo>,</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>

其中r是阈值,p(r)是给定的密度函数满足p(r)>0,中,为了方便起见,是由密度函数p(r)所决定的常数,Λ表示积分的上限,令fr:R→R,由(6)式定义:

fr(u,w)=max(u-r,min(u+r,w)) (6)

进而,play算子Fr[u](t)满足:

<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mi>F</mi> <mi>r</mi> </msub> <mo>&lsqb;</mo> <mi>u</mi> <mo>&rsqb;</mo> <mrow> <mo>(</mo> <mn>0</mn> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>f</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>u</mi> <mo>(</mo> <mn>0</mn> <mo>)</mo> <mo>,</mo> <mn>0</mn> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>F</mi> <mi>r</mi> </msub> <mo>&lsqb;</mo> <mi>u</mi> <mo>&rsqb;</mo> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>f</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>u</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <msub> <mi>F</mi> <mi>r</mi> </msub> <mo>&lsqb;</mo> <mi>u</mi> <mo>&rsqb;</mo> <mo>(</mo> <msub> <mi>t</mi> <mi>i</mi> </msub> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>,</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>

其中,ti<t≤ti+1,0≤i≤N-1,0=t0<t1<…<tN=tE是[0,tE]上的一个分割,以使函数u在(ti,ti+1]上的每个子区间是单调的,即非增或非减,

为了补偿式(1)中回滞非线性w(u),构造PI模型的逆:

其中,表示补偿算子;P-1[·](t)是PI模型的逆补偿算子,

<mrow> <msup> <mi>P</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mo>&lsqb;</mo> <mi>u</mi> <mo>&rsqb;</mo> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mover> <mi>p</mi> <mo>&OverBar;</mo> </mover> <mn>0</mn> </msub> <mi>u</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mover> <mi>&Lambda;</mi> <mo>&OverBar;</mo> </mover> </msubsup> <mover> <mi>p</mi> <mo>&OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>r</mi> <mo>)</mo> </mrow> <msub> <mi>F</mi> <mi>r</mi> </msub> <mo>&lsqb;</mo> <mi>u</mi> <mo>&rsqb;</mo> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mi>d</mi> <mi>r</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>

其中是常数,表示的是式(9)中的积分上限,且,

由于在实际中,回滞是无法获得的,这就意味着密度函数p(r)需要在测量数据的基础上来得到,逆模型是在基于估计密度函数基础上构造的,使用作为P[u](t)的估计值,因此,通过将补偿理论应用到P[·](t)和得:

其中,γ(r),δ(r)是P[·](t)和初始载入曲线,ud是被设计的控制信号,

考虑到式(11)和不等式Fr[ud](t)+Er[ud](t)=ud(t),得出:

w(t)=φ′(Λ)ud+db(t) (12)

其中φ′(Λ)正常数,Er(·)是PI模型的stop算子,由于Er(·)|<Λ,有界且满足:

|db(t)|≤D (13)

其中,D正常数,从式(11)至式(12)获得分析误差e(t)表达式为:

<mrow> <mtable> <mtr> <mtd> <mrow> <mi>e</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>w</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>u</mi> <mi>d</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <mo>&lsqb;</mo> <msup> <mi>&phi;</mi> <mo>&prime;</mo> </msup> <mrow> <mo>(</mo> <mi>&Lambda;</mi> <mo>)</mo> </mrow> <mo>-</mo> <mn>1</mn> <mo>&rsqb;</mo> <msub> <mi>u</mi> <mi>d</mi> </msub> <mo>+</mo> <msub> <mi>d</mi> <mi>b</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>14</mn> <mo>)</mo> </mrow> </mrow>

将式(12)代入式(1),得:

<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>f</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <msub> <mover> <mi>x</mi> <mo>&OverBar;</mo> </mover> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>d</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>0</mn> <mo>,</mo> <mn>1</mn> <mo>,</mo> <mn>...</mn> <mo>,</mo> <mi>n</mi> <mo>-</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>b</mi> <mi>&Lambda;</mi> </msub> <msub> <mi>u</mi> <mi>d</mi> </msub> <mo>+</mo> <msub> <mi>f</mi> <mi>n</mi> </msub> <mrow> <mo>(</mo> <msub> <mover> <mi>x</mi> <mo>&OverBar;</mo> </mover> <mi>n</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>b</mi> <mn>0</mn> </msub> <msub> <mi>d</mi> <mi>b</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>d</mi> <mi>n</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mo>=</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>,</mo> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>15</mn> <mo>)</mo> </mrow> </mrow>

其中,bΛ是正常数且满足:

bΛ=b0φ′(Λ) (16)

3)径向基函数神经网络(RBFNNs)对未知项逼近

遵循引理1,采用一个权重属性的线性径向基函数神经网络(RBFNNs)来近似紧集中的一个连续函数,

引理1:对任意给定的连续实函数f而言,RBFNNs是一个全局逼近器,f:Ωξ→R其中,ξ是神经网络的输入,q是输入维数。对于任意的εm>0,通过适当的选择σ和ζk∈Rq,k=1,…,N,之后,存在一个RBFNN使得:

f(ξ)=ψT(ξ)θ*+ε (17)

|ε|≤εm,其中θ*是θ=[θ1,…,θN]∈RN最优权值向量,且定义为:

<mrow> <msup> <mi>&theta;</mi> <mo>*</mo> </msup> <mo>=</mo> <mi>arg</mi> <munder> <mrow> <mi>m</mi> <mi>i</mi> <mi>n</mi> </mrow> <mrow> <mi>&theta;</mi> <mo>&Element;</mo> <msup> <mi>R</mi> <mi>n</mi> </msup> </mrow> </munder> <mo>{</mo> <munder> <mi>sup</mi> <mrow> <mi>&xi;</mi> <mo>&Element;</mo> <msub> <mi>&Omega;</mi> <mi>&xi;</mi> </msub> </mrow> </munder> <mo>|</mo> <mi>Y</mi> <mrow> <mo>(</mo> <mi>&xi;</mi> <mo>)</mo> </mrow> <mo>-</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>&xi;</mi> <mo>)</mo> </mrow> <mo>|</mo> <mo>}</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>18</mn> <mo>)</mo> </mrow> </mrow>

其中,Y(ξ)=ψT(ξ)θ表示的是RBFNNs的输出,ψ(ξ)=[ψ1(ξ),…,ψN(ξ)]∈RN是基本函数向量,通常情况下,所谓的高斯函数一般按如下形式作为基本函数:

<mrow> <msub> <mi>&psi;</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>&xi;</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>exp</mi> <mrow> <mo>(</mo> <mo>-</mo> <mfrac> <mrow> <mo>|</mo> <mo>|</mo> <mi>&xi;</mi> <mo>-</mo> <msub> <mi>&zeta;</mi> <mi>k</mi> </msub> <mo>|</mo> <mo>|</mo> </mrow> <mrow> <mn>2</mn> <msup> <mi>&sigma;</mi> <mn>2</mn> </msup> </mrow> </mfrac> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>19</mn> <mo>)</mo> </mrow> </mrow>

其中,σ>0,k=1,…,N,ζk∈Rn是常值向量,称为基本函数的中心;σ是实数,称为基本函数的宽度,ε是近似误差,且满足:

ε=f(ξ)-θ*Tψ(ξ) (20)

使用引理1和式(17),RBFNNs作为逼近器来近似式(17)中的未知连续函数,得(21)式:

<mrow> <msub> <mi>f</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <msub> <mover> <mi>x</mi> <mo>&OverBar;</mo> </mover> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msup> <msub> <mi>&psi;</mi> <mi>i</mi> </msub> <mi>T</mi> </msup> <mrow> <mo>(</mo> <msub> <mi>&xi;</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <msup> <msub> <mi>&theta;</mi> <mi>i</mi> </msub> <mo>*</mo> </msup> <mo>+</mo> <msub> <mi>&epsiv;</mi> <mi>i</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>21</mn> <mo>)</mo> </mrow> </mrow>

其中,εi,i=1…,N是任意正常数,表示神经网络逼近误差,且,

<mrow> <msub> <mi>&xi;</mi> <mi>i</mi> </msub> <mo>:</mo> <mo>=</mo> <mrow> <mo>(</mo> <msub> <mover> <mover> <mi>x</mi> <mo>^</mo> </mover> <mo>^</mo> </mover> <mn>1</mn> </msub> <mo>,</mo> <mn>...</mn> <mo>,</mo> <msub> <mover> <mover> <mi>x</mi> <mo>^</mo> </mover> <mo>^</mo> </mover> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>...</mn> <mo>,</mo> <mi>n</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>22</mn> <mo>)</mo> </mrow> </mrow>

其中是状态变量x1,…,xi的估计值,并会在式(40)中引入,

将式(21)代入式(15),得:

<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msup> <msub> <mi>&psi;</mi> <mi>i</mi> </msub> <mi>T</mi> </msup> <mrow> <mo>(</mo> <msub> <mi>&xi;</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <msup> <msub> <mi>&theta;</mi> <mi>i</mi> </msub> <mo>*</mo> </msup> <mo>+</mo> <msub> <mi>&epsiv;</mi> <mi>i</mi> </msub> <mo>+</mo> <msub> <mi>d</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mi>n</mi> </msub> <mo>=</mo> <msub> <mi>b</mi> <mi>&Lambda;</mi> </msub> <msub> <mi>u</mi> <mi>d</mi> </msub> <mo>+</mo> <msup> <msub> <mi>&psi;</mi> <mi>n</mi> </msub> <mi>T</mi> </msup> <mrow> <mo>(</mo> <msub> <mi>&xi;</mi> <mi>n</mi> </msub> <mo>)</mo> </mrow> <msup> <msub> <mi>&theta;</mi> <mi>n</mi> </msub> <mo>*</mo> </msup> <mo>+</mo> <msub> <mi>&epsiv;</mi> <mi>n</mi> </msub> <mo>+</mo> <msub> <mi>b</mi> <mn>0</mn> </msub> <msub> <mi>d</mi> <mi>b</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>d</mi> <mi>n</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mo>=</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>0</mn> <mo>,</mo> <mn>1</mn> <mo>,</mo> <mn>...</mn> <mo>,</mo> <mi>n</mi> <mo>-</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>23</mn> <mo>)</mo> </mrow> </mrow>

系统式(1)表达成下面的状态空间形式:

<mrow> <mtable> <mtr> <mtd> <mrow> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <mi>A</mi> <mi>x</mi> <mo>+</mo> <msup> <mi>&Psi;</mi> <mi>T</mi> </msup> <mrow> <mo>(</mo> <mi>&xi;</mi> <mo>)</mo> </mrow> <msup> <mi>&theta;</mi> <mo>*</mo> </msup> <mo>+</mo> <msub> <mi>bu</mi> <mi>d</mi> </msub> <mo>+</mo> <mi>B</mi> <mo>,</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mo>=</mo> <msup> <msub> <mi>e</mi> <mn>1</mn> </msub> <mi>T</mi> </msup> <mi>x</mi> <mo>,</mo> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>24</mn> <mo>)</mo> </mrow> </mrow>

其中,b=[0,…0,bΛ]T∈Rn,e1=[1,0,…,0]T

B=Db+ε+d (25)

其中,d=[d1(t),…,dn(t)]T,ε=[ε1,…,εn]T,Db=[0,…,0,db(t)]T∈Rn是类干扰项,

其中,在式(19)中被定义,对于一类回滞非线性系统,控制的目标是建立一种基于自适应神经网的输出反馈动态面控制方案,使得与跟踪误差的L范数一致,输出信号y能很好的跟踪参考信号yr,且闭环系统的所有信号都是一致有界的;

4)基于观测器的自适应动态面逆补偿器设计

①高增益卡尔曼滤波观测器

将式(24)转变为(27)式:

<mrow> <mtable> <mtr> <mtd> <mrow> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>A</mi> <mn>0</mn> </msub> <mi>x</mi> <mo>+</mo> <mi>q</mi> <mi>y</mi> <mo>+</mo> <msup> <mi>&Psi;</mi> <mi>T</mi> </msup> <mrow> <mo>(</mo> <mi>&xi;</mi> <mo>)</mo> </mrow> <msup> <mi>&theta;</mi> <mo>*</mo> </msup> <mo>+</mo> <msub> <mi>bu</mi> <mi>d</mi> </msub> <mo>+</mo> <mi>B</mi> <mo>,</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mo>=</mo> <msup> <msub> <mi>e</mi> <mn>1</mn> </msub> <mi>T</mi> </msup> <mi>x</mi> <mo>,</mo> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>27</mn> <mo>)</mo> </mrow> </mrow>

A0=A-qe1T (28)

其中,q=[q1,…,qn],通过适当的选择向量q使A0为赫维茨矩阵,

构造高增益卡尔曼滤波器来估计式(27)中的状态变量x,

<mrow> <msub> <mover> <mi>v</mi> <mo>&CenterDot;</mo> </mover> <mn>0</mn> </msub> <mo>=</mo> <msub> <mi>kA</mi> <mn>0</mn> </msub> <msub> <mi>v</mi> <mn>0</mn> </msub> <mo>+</mo> <msup> <mi>&Phi;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <msub> <mi>e</mi> <mi>n</mi> </msub> <msub> <mi>u</mi> <mi>d</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>29</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <msub> <mover> <mi>&xi;</mi> <mo>&CenterDot;</mo> </mover> <mn>0</mn> </msub> <mo>=</mo> <msub> <mi>kA</mi> <mn>0</mn> </msub> <msub> <mi>&xi;</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>k</mi> <mi>q</mi> <mi>y</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>30</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mover> <mi>&Xi;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>kA</mi> <mn>0</mn> </msub> <mi>&Xi;</mi> <mo>+</mo> <msup> <mi>&Phi;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <msup> <mi>&Psi;</mi> <mi>T</mi> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>31</mn> <mo>)</mo> </mrow> </mrow>

其中k≥1是正设计参数,en代表的属于Rn形式的n阶坐标向量,且,

Φ=diag{1,k,…,kn-1} (32)

从式(29)至式(32),估计状态向量如下,

<mrow> <mover> <mi>x</mi> <mo>^</mo> </mover> <mo>=</mo> <msub> <mi>&Phi;&xi;</mi> <mn>0</mn> </msub> <mo>+</mo> <msub> <mi>&Phi;b</mi> <mi>&Lambda;</mi> </msub> <msub> <mi>v</mi> <mn>0</mn> </msub> <mo>+</mo> <msup> <mi>&Phi;&Xi;&theta;</mi> <mo>*</mo> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>33</mn> <mo>)</mo> </mrow> </mrow>

进一步,定义估计误差,

<mrow> <mi>&epsiv;</mi> <mo>=</mo> <mi>x</mi> <mo>-</mo> <mover> <mi>x</mi> <mo>^</mo> </mover> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>34</mn> <mo>)</mo> </mrow> </mrow>

然后,对式(34)求导得,

<mrow> <mover> <mi>&epsiv;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <mi>A</mi> <mi>&epsiv;</mi> <mo>-</mo> <msub> <mi>k&Phi;q&epsiv;</mi> <mn>1</mn> </msub> <mo>+</mo> <mi>B</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>35</mn> <mo>)</mo> </mrow> </mrow>

其中,ε1是ε的第一项,B在式(25)中已定义;

引理2:令高增益卡尔曼滤波器由式(29)-式(31)和如下二阶函数定义,

Vε:=εTPε (36)

其中,是正定矩阵且满足:

<mrow> <msup> <msub> <mi>A</mi> <mn>0</mn> </msub> <mi>T</mi> </msup> <mover> <mi>P</mi> <mo>&OverBar;</mo> </mover> <mo>+</mo> <mover> <mi>P</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>A</mi> <mn>0</mn> </msub> <mo>=</mo> <mo>-</mo> <mn>2</mn> <mi>I</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>37</mn> <mo>)</mo> </mrow> </mrow>

其中,A0由式(28)定义,令:

<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mi>&zeta;</mi> <mi>&epsiv;</mi> </msub> <mo>:</mo> <mo>=</mo> <mfrac> <mi>k</mi> <mrow> <msub> <mi>&lambda;</mi> <mi>max</mi> </msub> <mrow> <mo>(</mo> <mover> <mi>P</mi> <mo>&OverBar;</mo> </mover> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>,</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&delta;</mi> <mi>&epsiv;</mi> </msub> <mo>:</mo> <mo>=</mo> <mi>k</mi> <msup> <mrow> <mo>(</mo> <mfrac> <mrow> <mo>|</mo> <mo>|</mo> <mover> <mi>P</mi> <mo>&OverBar;</mo> </mover> <mo>|</mo> <mo>|</mo> <mo>|</mo> <mo>|</mo> <mi>B</mi> <mo>|</mo> <msub> <mo>|</mo> <mi>max</mi> </msub> </mrow> <msup> <mi>k</mi> <mi>n</mi> </msup> </mfrac> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>38</mn> <mo>)</mo> </mrow> </mrow>

其中,||B||max是||B||的最大值。对于任意的k≥1,对式(36)求导得:

<mrow> <msub> <mover> <mi>V</mi> <mo>&CenterDot;</mo> </mover> <mi>&epsiv;</mi> </msub> <mo>&le;</mo> <mo>-</mo> <msub> <mi>&zeta;</mi> <mi>&epsiv;</mi> </msub> <msub> <mi>V</mi> <mi>&epsiv;</mi> </msub> <mo>+</mo> <msub> <mi>&delta;</mi> <mi>&epsiv;</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>39</mn> <mo>)</mo> </mrow> </mrow>

由于式(33)中的bΛ和θ*未知,是无法获得的,因此实际的状态估计是:

<mrow> <mover> <mover> <mi>x</mi> <mo>^</mo> </mover> <mo>^</mo> </mover> <mo>=</mo> <msub> <mi>&Phi;&xi;</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>&Phi;</mi> <msub> <mover> <mi>b</mi> <mo>^</mo> </mover> <mi>&Lambda;</mi> </msub> <msub> <mi>v</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>&Phi;</mi> <mi>&Xi;</mi> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>40</mn> <mo>)</mo> </mrow> </mrow>

其中,是bΛ和θ*的估计值,

改进的所述高增益卡尔曼滤波器是用来处理定义在式(25)中的有界B项,通过适当的选择式(29)至式(31)中的设计参数k≥1和式(32)中定义的矩阵Φ,能够使观测误差ε任意小;

②动态面逆控制器设计

控制器的设计包括替代变量、控制律和自适应律,其中τ2,…,τn是低通滤波器的时间常数,li,i=1,…,n和γθθζζbb是正的设计常数,

替代变量:S1=y-yr (T.1)

Si=v0,i-zi,i=2,…,n (T.2)

其中,zi有下式产生,

<mrow> <msub> <mi>&tau;</mi> <mrow> <mi>i</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <msub> <mover> <mi>z</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>i</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>z</mi> <mrow> <mi>i</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>=</mo> <msub> <mover> <mi>v</mi> <mo>&OverBar;</mo> </mover> <mrow> <mn>0</mn> <mo>,</mo> <mi>i</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>...</mn> <mo>,</mo> <mi>n</mi> <mo>-</mo> <mn>1</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mi>T</mi> <mn>.3</mn> <mo>)</mo> </mrow> </mrow>

其中,

<mrow> <msub> <mover> <mi>v</mi> <mo>&OverBar;</mo> </mover> <mrow> <mn>0</mn> <mo>,</mo> <mn>2</mn> </mrow> </msub> <mo>=</mo> <mover> <mi>&zeta;</mi> <mo>&OverBar;</mo> </mover> <msub> <msup> <mover> <mi>v</mi> <mo>&OverBar;</mo> </mover> <mo>&prime;</mo> </msup> <mrow> <mn>0</mn> <mo>,</mo> <mn>2</mn> </mrow> </msub> <mo>,</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mi>T</mi> <mn>.4</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <msub> <msup> <mover> <mi>v</mi> <mo>&OverBar;</mo> </mover> <mo>&prime;</mo> </msup> <mrow> <mn>0</mn> <mo>,</mo> <mn>2</mn> </mrow> </msub> <mo>=</mo> <mo>&lsqb;</mo> <mo>-</mo> <msub> <mi>l</mi> <mn>1</mn> </msub> <msub> <mi>S</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>k&xi;</mi> <mrow> <mn>0</mn> <mo>,</mo> <mn>2</mn> </mrow> </msub> <mo>-</mo> <msup> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> <mi>T</mi> </msup> <msup> <mrow> <mo>(</mo> <msub> <mi>k&Xi;</mi> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </msub> <mo>+</mo> <msub> <mi>&Psi;</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msub> <mo>)</mo> </mrow> <mi>T</mi> </msup> <mo>+</mo> <msub> <mover> <mi>y</mi> <mo>&CenterDot;</mo> </mover> <mi>r</mi> </msub> <mo>&rsqb;</mo> <mo>/</mo> <mi>k</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mi>T</mi> <mn>.5</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <msub> <mover> <mi>v</mi> <mo>&OverBar;</mo> </mover> <mrow> <mn>0</mn> <mo>,</mo> <mn>3</mn> </mrow> </msub> <mo>=</mo> <mrow> <mo>(</mo> <mo>-</mo> <msub> <mi>l</mi> <mn>2</mn> </msub> <msub> <mi>S</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>kq</mi> <mn>2</mn> </msub> <msub> <mi>v</mi> <mrow> <mn>0</mn> <mo>,</mo> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>z</mi> <mo>&CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mo>^</mo> </mover> <mi>&Lambda;</mi> </msub> <msub> <mi>kS</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> <mo>/</mo> <mi>k</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mi>T</mi> <mn>.6</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <msub> <mover> <mi>v</mi> <mo>&OverBar;</mo> </mover> <mrow> <mn>0</mn> <mo>,</mo> <mi>i</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>=</mo> <mrow> <mo>(</mo> <mo>-</mo> <msub> <mi>l</mi> <mi>i</mi> </msub> <msub> <mi>S</mi> <mi>i</mi> </msub> <mo>+</mo> <msub> <mi>kq</mi> <mi>i</mi> </msub> <msub> <mi>v</mi> <mrow> <mn>0</mn> <mo>,</mo> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>z</mi> <mo>&CenterDot;</mo> </mover> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>/</mo> <mi>k</mi> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>3</mn> <mo>,</mo> <mn>...</mn> <mo>,</mo> <mi>n</mi> <mo>-</mo> <mn>1</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mi>T</mi> <mn>.7</mn> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

控制律:

自适应律:

<mrow> <mover> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>&gamma;</mi> <mi>&theta;</mi> </msub> <mo>&lsqb;</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>k&Xi;</mi> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </msub> <mo>+</mo> <msub> <mi>&Psi;</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msub> <mo>)</mo> </mrow> <mi>T</mi> </msup> <msub> <mi>S</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>&sigma;</mi> <mi>&theta;</mi> </msub> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> <mo>&rsqb;</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mi>T</mi> <mn>.10</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <msub> <mover> <mi>b</mi> <mo>^</mo> </mover> <mi>&Lambda;</mi> </msub> <mo>=</mo> <msub> <mi>&gamma;</mi> <mi>b</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>kS</mi> <mn>1</mn> </msub> <msub> <mi>S</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>&sigma;</mi> <mi>b</mi> </msub> <msub> <mover> <mi>b</mi> <mo>^</mo> </mover> <mi>&Lambda;</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mi>T</mi> <mn>.11</mn> <mo>)</mo> </mrow> <mo>.</mo> </mrow>

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