一种不确定时变时滞的欠驱动UUV深度自适应全局滑模控制方法与流程

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

技术特征:

1.一种不确定时变时滞的欠驱动UUV深度自适应全局滑模控制方法,其特征是:

步骤一、UUV进入初始化阶段,检测当前深度z及UUV本身数据信息,同时根据当前任务,将期望深度信息zr下达到UUV,获得当前的状态信息x=(ze θ q)T,其中ze为深度差,即ze=zr-z;所述UUV本身数据信息包括纵倾角θ,纵倾角速度q;

步骤二、利用步骤一中获得的当前UUV状态信息x=(ze θ q)T,再结合外界环境干扰建立欠驱动无人水下航行器的T-S模糊时变时滞数学模型;

根据外界海流环境干扰以及系统不确定项,建立基于反馈增益的全局滑模控制器模型;

步骤三、通过对外界干扰的分析,设计自适应滑模控制器模型中参数的自适应规律,然后对步骤二中获得的数学模型中存在的不确定性进行逼近,并给出优化后系统控制率;

步骤四、将步骤三中计算出的控制率导入UUV执行机构,实现欠驱动无人水下航行器的深度控制,并将深度状态实时反馈,判断是否到达指定深度,若没有则返回步骤二,否则结束本次控制。

2.根据权利要求1所述的不确定时变时滞的欠驱动UUV深度自适应全局滑模控制方法,其特征是所述欠驱动无人水下航行器的T-S模糊时变时滞数学模型为:

<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>r</mi> </munderover> <msub> <mi>&lambda;</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>u</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>{</mo> <mi>&beta;</mi> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>i</mi> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>A</mi> <mo>)</mo> </mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>&beta;</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>i</mi> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>A</mi> <mo>)</mo> </mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>-</mo> <mi>&tau;</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>B</mi> <mi>i</mi> </msub> <msub> <mi>&delta;</mi> <mi>s</mi> </msub> <mo>+</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>}</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>&eta;</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>t</mi> <mo>&Element;</mo> <mo>&lsqb;</mo> <mo>-</mo> <mi>&tau;</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mn>0</mn> <mo>&rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

其中,i=1,2,···,r,r为模糊规则条数,ui和u(t)分别为UUV航行的单点模糊速度和实时速度,β为UUV垂直面通信时滞系数,Iyy为关于纵倾角的转动惯量,Muq、Mqq、Muu为的水动力参数,ΔA为系统建模的不确定性,x(t)为系统状态,f(x,t)为外界干扰,τ(t)为时变时滞,h1≤τ(t)≤h2,h1,h2为正数,λi(u(t))为u(t)在模糊区间Ui中的隶属度,η(t)为系统的初始状态,针对外界干扰f(x,t)=B0F(x,t)且存在未知正常数μ满足||f(x,t)||≤μ||x(t)||。

3.根据权利要求2所述的不确定时变时滞的欠驱动UUV深度自适应全局滑模控制方法,其特征是步骤三的具体过程为:

首先,基于全局滑模,设计积分滑模面,进而通过构造模糊权依赖型Lyapunov-Krasovskii函数,证明动态滑模稳定性并以一组线性矩阵不等式可行解给出系统稳定的充分条件,

其中,积分滑模面:

<mrow> <mtable> <mtr> <mtd> <mrow> <mi>S</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>G</mi> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mi>t</mi> </msubsup> <mi>G</mi> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>a</mi> </msub> <mo>(</mo> <mi>&theta;</mi> <mo>)</mo> <mo>-</mo> <msub> <mi>B</mi> <mi>b</mi> </msub> <mo>(</mo> <mi>&theta;</mi> <mo>)</mo> <msub> <mi>K</mi> <mi>k</mi> </msub> <mo>(</mo> <mi>&theta;</mi> <mo>)</mo> <mo>)</mo> </mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>&theta;</mi> <mo>)</mo> </mrow> <mi>d</mi> <mi>&theta;</mi> <mo>-</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mi>t</mi> </msubsup> <msub> <mi>GA</mi> <mi>d</mi> </msub> <mrow> <mo>(</mo> <mi>&theta;</mi> <mo>)</mo> </mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>&theta;</mi> <mo>-</mo> <mi>&tau;</mi> <mo>(</mo> <mi>&theta;</mi> <mo>)</mo> <mo>)</mo> </mrow> <mi>d</mi> <mi>&theta;</mi> <mo>-</mo> <mi>G</mi> <mi>x</mi> <mrow> <mo>(</mo> <mn>0</mn> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>

式中G∈R1×3满足GB非奇异,是常数矩阵;

模糊权依赖型Lyapunov-Krasovskii函数:

<mrow> <mtable> <mtr> <mtd> <mrow> <mover> <mi>V</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>2</mn> <msup> <mi>x</mi> <mi>T</mi> </msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mi>P</mi> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>2</mn> </munderover> <msup> <mi>x</mi> <mi>T</mi> </msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msub> <mi>Q</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>2</mn> </munderover> <msup> <mi>x</mi> <mi>T</mi> </msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>-</mo> <msub> <mi>h</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <msub> <mi>Q</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>-</mo> <msub> <mi>h</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>-</mo> <msub> <mi>h</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mi>T</mi> </msup> <mrow> <mo>(</mo> <msubsup> <mi>h</mi> <mn>1</mn> <mn>2</mn> </msubsup> <msub> <mi>R</mi> <mn>1</mn> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>+</mo> <msub> <mi>h</mi> <mn>12</mn> </msub> <msub> <mi>R</mi> <mn>2</mn> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msubsup> <mo>&Integral;</mo> <mrow> <mi>t</mi> <mo>-</mo> <msub> <mi>h</mi> <mn>1</mn> </msub> </mrow> <mi>t</mi> </msubsup> <msub> <mi>h</mi> <mn>1</mn> </msub> <msup> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mi>T</mi> </msup> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <msub> <mi>R</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mi>d</mi> <mi>s</mi> <mo>-</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mo>&Integral;</mo> <mrow> <mi>t</mi> <mo>-</mo> <msub> <mi>h</mi> <mn>2</mn> </msub> </mrow> <mi>t</mi> </msubsup> <msup> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mi>T</mi> </msup> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <msub> <mi>R</mi> <mn>2</mn> </msub> <mover> <mi>x</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mi>d</mi> <mi>s</mi> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>

式中,是含有隶属度函数的模糊权矩阵,且0<P=PT∈R3×3,0≤Qij=QijT∈R3×3,0≤Rkj=RkjT∈R3×3

然后设计出自适应滑模控制器:

<mrow> <msub> <mi>&delta;</mi> <mi>s</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <msub> <mi>K</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>GB</mi> <mi>b</mi> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mo>&lsqb;</mo> <mi>&epsiv;</mi> <mo>+</mo> <mover> <mi>&mu;</mi> <mo>^</mo> </mover> <mo>|</mo> <mo>|</mo> <mi>G</mi> <mo>|</mo> <mo>|</mo> <mo>|</mo> <mo>|</mo> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>|</mo> <mo>|</mo> <mo>&rsqb;</mo> <mi>sgn</mi> <mrow> <mo>(</mo> <mi>S</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>

式中,ε为正常数,为μ对应的估计值。

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