发明名称 考虑死区特性的伺服系统有限时间控制方法
摘要 一种考虑死区特性的伺服系统有限时间控制方法,包括:建立伺服系统模型,初始化系统状态以及控制器参数;对死区环节进行近似补偿;设计非线性扩张状态观测器;运用极点配置法确定观测器参数;设计全阶滑模控制器。设计扩张状态观测器,用于估计系统状态以及包括系统摩擦和外部扰动的不确定项,采用极点配置法确定观测器增益参数;设计全阶滑模控制器,保证系统跟踪误差快速稳定并收敛至零点,并减弱抖振问题,实现伺服系统的快速稳定控制。本发明解决系统摩擦等外部扰动状态不可测的问题,补偿了系统存在的非线性死区环节的影响,改善了普通滑模方法存在的抖振问题和收敛时间长的问题,增强了系统的抗干扰性,实现了系统快速稳定地跟踪期望信号。
申请公布号 CN105759616A 申请公布日期 2016.07.13
申请号 CN201610237431.9 申请日期 2016.04.15
申请人 浙江工业大学 发明人 陈强;罗鹏;陶亮;董方
分类号 G05B13/04(2006.01)I;H02P23/12(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 杭州斯可睿专利事务所有限公司 33241 代理人 王利强
主权项 一种考虑死区特性的伺服系统有限时间控制方法,其特征在于:所述控制方法包括以下步骤:步骤1,建立如式(1)所示的伺服系统模型,初始化系统状态以及控制参数;<img file="FDA0000965902060000011.GIF" wi="1110" he="263" />其中,θ<sub>m</sub>,<img file="FDA0000965902060000012.GIF" wi="62" he="47" />为状态变量,分别表示电机输出轴位置和转速;J和D是折算到电机轴上的等效转动惯量和等效阻尼系数;K<sub>t</sub>是电机扭矩常数;v(u)是具有死区特性的控制量,<img file="FDA0000965902060000013.GIF" wi="565" he="222" />b<sub>ir</sub>,b<sub>il</sub>分别为死区特性的上下边界,u为控制器的输出量;T是折算到电机轴上的负载摩擦扭矩以及摩擦的扰动部分;步骤2,对死区特性进行近似处理;现扩展对g<sub>ir</sub>(u),g<sub>il</sub>(u)的定义如下:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>g</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow><mo>=</mo><msubsup><mi>g</mi><mrow><mi>i</mi><mi>r</mi></mrow><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub><mo>)</mo></mrow><mrow><mo>(</mo><mrow><mi>u</mi><mo>-</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub></mrow><mo>)</mo></mrow></mrow></mtd><mtd><mrow><mi>u</mi><mo>&Element;</mo><mo>(</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub><mo>,</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub><mo>&rsqb;</mo></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>g</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow><mo>=</mo><msubsup><mi>g</mi><mrow><mi>i</mi><mi>l</mi></mrow><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub><mo>)</mo></mrow><mrow><mo>(</mo><mrow><mi>u</mi><mo>-</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub></mrow><mo>)</mo></mrow></mrow></mtd><mtd><mrow><mi>u</mi><mo>&Element;</mo><mo>&lsqb;</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub><mo>,</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000014.GIF" wi="1135" he="150" /></maths>根据微分中值定理,存在ξ<sub>il</sub>∈(‑∞,b<sub>il</sub>),ξ<sub>ir</sub>∈(b<sub>ir</sub>,+∞)使下式成立:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>g</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow><mo>=</mo><msubsup><mi>g</mi><mrow><mi>i</mi><mi>r</mi></mrow><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>&xi;</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub><mo>)</mo></mrow><mrow><mo>(</mo><mrow><mi>u</mi><mo>-</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub></mrow><mo>)</mo></mrow></mrow></mtd><mtd><mrow><mi>u</mi><mo>&Element;</mo><mo>&lsqb;</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub><mo>,</mo><mo>+</mo><mi>&infin;</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>g</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow><mo>=</mo><msubsup><mi>g</mi><mrow><mi>i</mi><mi>l</mi></mrow><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>&xi;</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub><mo>)</mo></mrow><mrow><mo>(</mo><mrow><mi>u</mi><mo>-</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub></mrow><mo>)</mo></mrow></mrow></mtd><mtd><mrow><mi>u</mi><mo>&Element;</mo><mo>(</mo><mo>-</mo><mi>&infin;</mi><mo>,</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub><mo>&rsqb;</mo></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000015.GIF" wi="1142" he="151" /></maths>其中,ξ<sub>il</sub>=ξ<sub>l</sub>u+(1‑ξ<sub>l</sub>)b<sub>il</sub>,0<ξ<sub>l</sub><1,ξ<sub>ir</sub>=ξ<sub>r</sub>u+(1‑ξ<sub>r</sub>)b<sub>ir</sub>,0<ξ<sub>r</sub><1,那么,死区特性v(u)改写为<img file="FDA0000965902060000016.GIF" wi="1006" he="55" />其中<img file="FDA0000965902060000017.GIF" wi="99" he="54" />的表达式如下<img file="FDA0000965902060000018.GIF" wi="1238" he="226" />d(u)的表达式为:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mi>d</mi><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow><mo>=</mo><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mo>-</mo><msubsup><mi>g</mi><mrow><mi>i</mi><mi>r</mi></mrow><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>&xi;</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub><mo>)</mo></mrow><msub><mi>b</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub><mo>,</mo></mrow></mtd><mtd><mrow><mi>u</mi><mo>&GreaterEqual;</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><mrow><mo>&lsqb;</mo><mrow><msubsup><mi>g</mi><mrow><mi>i</mi><mi>l</mi></mrow><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub><mo>)</mo></mrow><mo>+</mo><msubsup><mi>g</mi><mrow><mi>i</mi><mi>r</mi></mrow><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub><mo>)</mo></mrow></mrow><mo>&rsqb;</mo></mrow><mi>u</mi></mrow></mtd><mtd><mrow><msub><mi>b</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub><mo>&lt;</mo><mi>u</mi><mo>&lt;</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>r</mi></mrow></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msubsup><mi>g</mi><mrow><mi>i</mi><mi>l</mi></mrow><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>&xi;</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub><mo>)</mo></mrow><msub><mi>b</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub><mo>,</mo></mrow></mtd><mtd><mrow><mi>u</mi><mo>&le;</mo><msub><mi>b</mi><mrow><mi>i</mi><mi>l</mi></mrow></msub></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000021.GIF" wi="1237" he="223" /></maths>则式(1)改写为<img file="FDA0000965902060000022.GIF" wi="1196" he="269" />步骤3,设计非线性扩张状态观测器,过程如下:3.1,令x<sub>1</sub>=θ<sub>m</sub>,<img file="FDA0000965902060000023.GIF" wi="182" he="46" />则式(7)改写为<img file="FDA0000965902060000024.GIF" wi="1070" he="205" />其中,x<sub>1</sub>,x<sub>2</sub>为系统状态,u为控制器的输出量,则式(8)改写为<maths num="0004" id="cmaths0004"><math><![CDATA[<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><mi>a</mi><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>+</mo><mi>b</mi><mi>u</mi></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>9</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000025.GIF" wi="1029" he="151" /></maths>其中,<img file="FDA0000965902060000026.GIF" wi="1110" he="119" />3.2,令a(x)=a<sub>0</sub>+Δa,b=b<sub>0</sub>+Δb,d=Δa+Δbu,其中b<sub>0</sub>和a<sub>0</sub>分别为b和a(x)的最优估计值,根据系统结构给定;基于扩张观测器的设计思想,定义扩张状态x<sub>3</sub>=d,且d≤l<sub>d</sub>,其中l<sub>d</sub>>0,则式(9)改写为以下等效形式:<maths num="0005" id="cmaths0005"><math><![CDATA[<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>x</mi><mn>3</mn></msub><mo>+</mo><msub><mi>a</mi><mn>0</mn></msub><mo>+</mo><msub><mi>b</mi><mn>0</mn></msub><mi>u</mi></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>3</mn></msub><mo>=</mo><mi>h</mi></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000027.GIF" wi="946" he="221" /></maths>其中,<img file="FDA0000965902060000028.GIF" wi="139" he="62" />且|h|≤k<sub>d</sub>,k<sub>d</sub>为一个常数;3.3,令z<sub>i</sub>,i=1,2,3,分别为式(10)中状态变量x<sub>i</sub>的观测值,定义跟踪误差e<sub>ci</sub>=z<sub>i</sub><sup>*</sup>‑x<sub>i</sub>,其中z<sub>i</sub><sup>*</sup>为期望信号,观测误差为e<sub>oi</sub>=z<sub>i</sub>‑x<sub>i</sub>,则设计非线性扩张状态观测器表达式为:<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>=</mo><msub><mi>z</mi><mn>2</mn></msub><mo>-</mo><msub><mi>&beta;</mi><mn>1</mn></msub><mi>g</mi><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>o</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msub><mo>=</mo><msub><mi>z</mi><mn>3</mn></msub><mo>-</mo><msub><mi>&beta;</mi><mn>2</mn></msub><mi>g</mi><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>o</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>a</mi><mn>0</mn></msub><mo>+</mo><msub><mi>b</mi><mn>0</mn></msub><mi>u</mi></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mn>3</mn></msub><mo>=</mo><mo>-</mo><msub><mi>&beta;</mi><mn>3</mn></msub><mi>g</mi><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>o</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>11</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000031.GIF" wi="1062" he="223" /></maths>其中,β<sub>1</sub>,β<sub>2</sub>,β<sub>3</sub>为观测器增益参数,需用极点配置法确定,g(e<sub>o1</sub>)为<img file="FDA0000965902060000032.GIF" wi="1214" he="222" />其中,α<sub>j</sub>=[1,0.5,0.25],δ=1°;步骤4,运用极点配置法确定观测器增益参数β<sub>1</sub>,β<sub>2</sub>,β<sub>3</sub>的取值;令δx<sub>1</sub>=e<sub>o1</sub>=z<sub>1</sub>‑x<sub>1</sub>,δx<sub>2</sub>=z<sub>2</sub>‑x<sub>2</sub>,δx<sub>3</sub>=z<sub>3</sub>‑d,则式(11)减去式(9)得<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mi>&delta;</mi><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>=</mo><msub><mi>&delta;x</mi><mn>2</mn></msub><mo>-</mo><msub><mi>&beta;</mi><mn>1</mn></msub><mi>g</mi><mrow><mo>(</mo><msub><mi>&delta;x</mi><mn>1</mn></msub><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><mi>&delta;</mi><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msub><mo>=</mo><msub><mi>&delta;x</mi><mn>3</mn></msub><mo>-</mo><msub><mi>&beta;</mi><mn>2</mn></msub><mi>g</mi><mrow><mo>(</mo><msub><mi>&delta;x</mi><mn>1</mn></msub><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><mi>&delta;</mi><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>3</mn></msub><mo>=</mo><mo>-</mo><msub><mi>&beta;</mi><mn>3</mn></msub><mi>g</mi><mrow><mo>(</mo><msub><mi>&delta;x</mi><mn>1</mn></msub><mo>)</mo></mrow><mo>-</mo><mi>h</mi></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>12</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000033.GIF" wi="1166" he="223" /></maths>设h有界,且g(e<sub>o1</sub>)是光滑的,g(0)=0,g′(e<sub>o1</sub>)≠0,根据泰勒公式,式(12)写为<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mi>&delta;</mi><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>=</mo><msub><mi>&delta;x</mi><mn>2</mn></msub><mo>-</mo><msub><mi>&beta;</mi><mn>1</mn></msub><msup><mi>g</mi><mo>&prime;</mo></msup><mrow><mo>(</mo><msub><mi>&delta;x</mi><mn>1</mn></msub><mo>)</mo></mrow><msub><mi>&delta;x</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><mi>&delta;</mi><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msub><mo>=</mo><msub><mi>&delta;x</mi><mn>3</mn></msub><mo>-</mo><msub><mi>&beta;</mi><mn>2</mn></msub><msup><mi>g</mi><mo>&prime;</mo></msup><mrow><mo>(</mo><msub><mi>&delta;x</mi><mn>1</mn></msub><mo>)</mo></mrow><msub><mi>&delta;x</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><mi>&delta;</mi><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>3</mn></msub><mo>=</mo><mo>-</mo><msub><mi>&beta;</mi><mn>3</mn></msub><msup><mi>g</mi><mo>&prime;</mo></msup><mrow><mo>(</mo><msub><mi>&delta;x</mi><mn>1</mn></msub><mo>)</mo></mrow><msub><mi>&delta;x</mi><mn>1</mn></msub><mo>-</mo><mi>h</mi></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>13</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000034.GIF" wi="1182" he="222" /></maths>令<img file="FDA0000965902060000035.GIF" wi="498" he="127" />则式(13)写为以下状态空间方程形式<maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mi>&delta;</mi><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><mi>&delta;</mi><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><mi>&delta;</mi><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>3</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mo>-</mo><msub><mi>l</mi><mn>1</mn></msub></mrow></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>l</mi><mn>3</mn></msub></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msub><mi>&delta;x</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;x</mi><mn>2</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;x</mi><mn>3</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>+</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mn>1</mn></mtd></mtr></mtable></mfenced><mi>h</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>14</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000036.GIF" wi="1190" he="223" /></maths>设计补偿矩阵<maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><mi>A</mi><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mo>-</mo><msub><mi>l</mi><mn>1</mn></msub></mrow></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>l</mi><mn>3</mn></msub></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>,</mo><mi>E</mi><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mn>1</mn></mtd></mtr></mtable></mfenced><mo>,</mo><mi>&delta;</mi><mi>X</mi><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mi>&delta;</mi><msub><mi>x</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;x</mi><mn>2</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;x</mi><mn>3</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000965902060000037.GIF" wi="853" he="239" /></maths>则式(14)写为<maths num="0011" id="cmaths0011"><math><![CDATA[<mrow><mi>&delta;</mi><mover><mi>X</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mi>A</mi><mi>&delta;</mi><mi>X</mi><mo>+</mo><mi>E</mi><mi>h</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>15</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000038.GIF" wi="1078" he="71" /></maths>至此,参数β<sub>i</sub>的确定转化为l<sub>i</sub>的确定,使式(8)在扰动h的作用下渐近稳定的必要条件是补偿矩阵A的特征值全部落在复平面的左半平面上,即式(8)的极点充分的负,由此,根据极点配置法,选定期望的极点p<sub>i</sub>(i=1,2,3),使参数l<sub>i</sub>满足<maths num="0012" id="cmaths0012"><math><![CDATA[<mrow><mo>|</mo><mi>s</mi><mi>I</mi><mo>-</mo><mi>A</mi><mo>|</mo><mo>=</mo><munderover><mo>&Pi;</mo><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mn>3</mn></munderover><mrow><mo>(</mo><mi>s</mi><mo>-</mo><msub><mi>p</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>16</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000041.GIF" wi="1093" he="127" /></maths>I为单位矩阵,令左右两边关于s的多项式的各项系数相等,则分别求出参数l<sub>1</sub>,l<sub>2</sub>,l<sub>3</sub>的值,从而得到扩张状态观测器的表达式为<maths num="0013" id="cmaths0013"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>=</mo><msub><mi>z</mi><mn>2</mn></msub><mo>-</mo><mfrac><msub><mi>l</mi><mn>1</mn></msub><mrow><msup><mi>g</mi><mo>&prime;</mo></msup><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>o</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow></mrow></mfrac><mi>g</mi><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>o</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msub><mo>=</mo><msub><mi>z</mi><mn>3</mn></msub><mo>-</mo><mfrac><msub><mi>l</mi><mn>2</mn></msub><mrow><msup><mi>g</mi><mo>&prime;</mo></msup><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>o</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow></mrow></mfrac><mi>g</mi><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>o</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>a</mi><mn>0</mn></msub><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>b</mi><mn>0</mn></msub><mi>u</mi></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mn>3</mn></msub><mo>=</mo><mo>-</mo><mfrac><msub><mi>l</mi><mn>3</mn></msub><mrow><msup><mi>g</mi><mo>&prime;</mo></msup><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>o</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow></mrow></mfrac><mi>g</mi><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>o</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>17</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000042.GIF" wi="1070" he="446" /></maths>步骤5,基于全阶终端滑模的方法设计终端滑模控制器u,过程如下:5.1,设计滑模面如下:<maths num="0014" id="cmaths0014"><math><![CDATA[<mrow><mi>s</mi><mo>=</mo><msub><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mrow><mi>c</mi><mn>2</mn></mrow></msub><mo>+</mo><msub><mi>&lambda;</mi><mn>2</mn></msub><mi>s</mi><mi>i</mi><mi>g</mi><mi>n</mi><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>c</mi><mn>2</mn></mrow></msub><mo>)</mo></mrow><mo>|</mo><msub><mi>e</mi><mrow><mi>c</mi><mn>2</mn></mrow></msub><msup><mo>|</mo><msub><mi>c</mi><mn>2</mn></msub></msup><mo>+</mo><msub><mi>&lambda;</mi><mn>1</mn></msub><mi>s</mi><mi>i</mi><mi>g</mi><mi>n</mi><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>c</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow><mo>|</mo><msub><mi>e</mi><mrow><mi>c</mi><mn>1</mn></mrow></msub><msup><mo>|</mo><msub><mi>c</mi><mn>1</mn></msub></msup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>18</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000043.GIF" wi="1245" he="71" /></maths>其中,c<sub>1</sub>,c<sub>2</sub>和λ<sub>1</sub>,λ<sub>2</sub>为常数,λ<sub>1</sub>,λ<sub>2</sub>满足多项式p<sup>2</sup>+λ<sub>2</sub>p+λ<sub>1</sub>,使多项式的极点都在复平面的左半边,<img file="FDA0000965902060000044.GIF" wi="816" he="118" />5.2,终端滑模控制器设计如下:<maths num="0015" id="cmaths0015"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mi>u</mi><mo>=</mo><msup><mi>b</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mrow><mo>(</mo><msub><mi>u</mi><mrow><mi>e</mi><mi>q</mi></mrow></msub><mo>+</mo><msub><mi>u</mi><mi>n</mi></msub><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>u</mi><mrow><mi>e</mi><mi>q</mi></mrow></msub><mo>=</mo><mo>-</mo><msub><mi>a</mi><mn>0</mn></msub><mo>-</mo><msub><mi>&lambda;</mi><mn>2</mn></msub><mi>s</mi><mi>i</mi><mi>g</mi><mi>n</mi><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>c</mi><mn>2</mn></mrow></msub><mo>)</mo></mrow><mo>|</mo><msub><mi>e</mi><mrow><mi>c</mi><mn>2</mn></mrow></msub><msup><mo>|</mo><msub><mi>c</mi><mn>2</mn></msub></msup><mo>-</mo><msub><mi>&lambda;</mi><mn>1</mn></msub><mi>s</mi><mi>i</mi><mi>g</mi><mi>n</mi><mrow><mo>(</mo><msub><mi>e</mi><mrow><mi>c</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow><mo>|</mo><msub><mi>e</mi><mrow><mi>c</mi><mn>1</mn></mrow></msub><msup><mo>|</mo><msub><mi>c</mi><mn>1</mn></msub></msup></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>u</mi><mo>&CenterDot;</mo></mover><mi>n</mi></msub><mo>+</mo><msub><mi>Tu</mi><mi>n</mi></msub><mo>=</mo><mi>V</mi></mrow></mtd></mtr><mtr><mtd><mrow><mi>V</mi><mo>=</mo><mo>-</mo><mrow><mo>(</mo><msub><mi>k</mi><mi>d</mi></msub><mo>+</mo><msub><mi>k</mi><mi>T</mi></msub><mo>+</mo><mi>&eta;</mi><mo>)</mo></mrow><mi>s</mi><mi>i</mi><mi>g</mi><mi>n</mi><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>19</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000965902060000045.GIF" wi="1270" he="327" /></maths>其中,T≥0,k<sub>T</sub>≥Tl<sub>d</sub>,η>0。
地址 310014 浙江省杭州市下城区潮王路18号浙江工业大学科技处
您可能感兴趣的专利