发明名称 最速地实现自抗扰反馈控制的方法及其装置
摘要 本发明涉及一种最速地实现自抗扰反馈控制的方法及其装置。对设定值安排目标过渡过程,而这个目标过渡过程是由给定的加速度变化模式来决定的。本装置中含有由被控对象的输入-输出信号来能够实时估计被控对象状态及对系统的所有未知扰动总和作用量的估计器。目标过渡过程与被控对象状态估计值之间误差来计算最速反馈控制量并扰动估计值的补偿来实现自抗扰功能的新型实用控制技术。
申请公布号 CN1225679C 申请公布日期 2005.11.02
申请号 CN01129433.7 申请日期 2001.06.19
申请人 韩京清;韩学锋 发明人 韩京清
分类号 G05B11/00;G05B11/42 主分类号 G05B11/00
代理机构 北京三幸商标专利事务所 代理人 刘激扬
主权项 1.一种最速地实现自抗扰反馈控制的方法,该方法中反馈控制量是根据对设定值安排的目标过渡过程与被控对象状态估计值之间的误差,按最速反馈律算出的,自抗扰功能是作用于被控对象的总扰动量的估计与补偿来实现的;其特征在于,该方法还包括:1)记忆装置根据设定值安排的目标过渡过程,包括,在记忆装置中寄存多种加速度变化的模式、上述加速度变化模式经积分决定的目标速度变化模式及再积分上述速度变化模式所得的目标过渡过程模式;2)扩张状态观测过程,将未知扰动和未知动态的实时作用量的总和视作对系统的总扰动作用而表示成新的状态变量作为扩张的状态;然后根据对象的实际输出与其估计值之间误差的折线函数构造能够估计对象状态和扩张状态;所述扩张状态观测过程是以对象输出的估计值与实际输出值之间的误差作为输入,用这个误差的折线函数来构成如下非线性状态观测器,<math> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <mi>&epsiv;</mi> <mo>=</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <mi>y</mi> </mtd> </mtr> <mtr> <mtd> <mfrac> <msub> <mi>dz</mi> <mn>1</mn> </msub> <mi>dt</mi> </mfrac> <mo>=</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>&beta;</mi> <mn>01</mn> </msub> <msub> <mi>g</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>&epsiv;</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mfrac> <msub> <mi>dz</mi> <mn>2</mn> </msub> <mi>dt</mi> </mfrac> <mo>=</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>&beta;</mi> <mn>02</mn> </msub> <msub> <mi>g</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>&epsiv;</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>bu</mi> <mo>+</mo> <msub> <mi>f</mi> <mn>0</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>,</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>,</mo> <msub> <mi>w</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mfrac> <msub> <mi>dz</mi> <mn>3</mn> </msub> <mi>dt</mi> </mfrac> <mo>=</mo> <mo>-</mo> <msub> <mi>&beta;</mi> <mn>03</mn> </msub> <msub> <mi>g</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>&epsiv;</mi> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> </math> 该非线性状态观测器用于估计对象状态变量和不确定扰动总和作用,其中的非线性函数gi(ε)取成如下公式:<math> <mrow> <msub> <mi>fpl</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>x</mi> <mo>,</mo> <msub> <mi>d</mi> <mn>1</mn> </msub> <mo>,</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msub> <mi>k</mi> <mn>1</mn> </msub> <mi>x</mi> <mo>,</mo> </mtd> <mtd> <mo>|</mo> <mi>x</mi> <mo>|</mo> <mo>&le;</mo> <msub> <mi>d</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <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> </mrow> <msub> <mi>d</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <mo>|</mo> <mi>x</mi> <mo>|</mo> <mo>)</mo> </mrow> <mi>sign</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>,</mo> </mtd> <mtd> <mo>|</mo> <mi>x</mi> <mo>|</mo> <mo>></mo> <msub> <mi>d</mi> <mn>1</mn> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow> </math> 0<d1<1,0<k1,k1d1≤1,<math> <mrow> <msub> <mi>k</mi> <mn>2</mn> </msub> <mo>=</mo> <mfrac> <mrow> <mn>1</mn> <mo>-</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <msub> <mi>d</mi> <mn>1</mn> </msub> </mrow> <mrow> <mn>1</mn> <mo>-</mo> <msub> <mi>d</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mrow> </math> <math> <mrow> <msub> <mi>fpl</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>x</mi> <mo>,</mo> <msub> <mi>d</mi> <mn>1</mn> </msub> <mo>,</mo> <msub> <mi>d</mi> <mn>2</mn> </msub> <mo>,</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>,</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> </mrow> </math> <math> <mrow> <mo>=</mo> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msub> <mi>k</mi> <mn>1</mn> </msub> <mi>x</mi> <mo>,</mo> </mtd> <mtd> <mo>|</mo> <mi>x</mi> <mo>|</mo> <mo>&le;</mo> <msub> <mi>d</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <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> </mrow> <msub> <mi>d</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <mo>|</mo> <mi>x</mi> <mo>|</mo> <mo>)</mo> </mrow> <mi>sign</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>,</mo> </mtd> <mtd> <msub> <mi>d</mi> <mn>1</mn> </msub> <mo>&lt;</mo> <mo>|</mo> <mi>x</mi> <mo>|</mo> <mo>&le;</mo> <msub> <mi>d</mi> <mn>2</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <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> </mrow> <msub> <mi>d</mi> <mn>1</mn> </msub> <mo>+</mo> <mrow> <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>d</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>|</mo> <mi>x</mi> <mo>|</mo> <mo>)</mo> </mrow> <mi>sign</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>,</mo> </mtd> <mtd> <msub> <mi>d</mi> <mn>2</mn> </msub> <mo>&lt;</mo> <mo>|</mo> <mi>x</mi> <mo>|</mo> </mtd> </mtr> </mtable> </mfenced> </mrow> </math> 0<d1<d2<1,0<k2<k1,(k1-k2)d1+k2d2≤1,<math> <mrow> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>=</mo> <mfrac> <mrow> <mn>1</mn> <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> </mrow> <msub> <mi>d</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>d</mi> <mn>2</mn> </msub> </mrow> <mrow> <mn>1</mn> <mo>-</mo> <msub> <mi>d</mi> <mn>2</mn> </msub> </mrow> </mfrac> </mrow> </math> 所示折线函数fl2(ε,d,k)或fl3(ε,d1,d2,k1,k2);β01,β02,β03是可调参数;f0(z1,z2,w0)是对象模型中的已知部分;3)反馈控制量生成过程,根据控制要求和对象的承受能力,从上述目标过渡过程的中取出一种目标过渡过程模式及其变化模式与上述扩张状态观测过程给出的对象状态的估计值之间的误差,按最速反馈律生成反馈控制量;根据扩张状态观测过程给出的被控对象输出估计值与目标过渡过程之间误差及被控对象输出微分的估计值与目标过渡过程微分之间误差,使这两个误差无震荡地都收敛于零的非线性最速反馈控制律为:d=rh1 d1=dh1 y=ε1(t)+h1ε2(t)<math> <mrow> <msub> <mi>a</mi> <mn>0</mn> </msub> <mo>=</mo> <msqrt> <msup> <mi>d</mi> <mn>2</mn> </msup> <mo>+</mo> <mn>8</mn> <mi>r</mi> <mo>|</mo> <mi>y</mi> <mo>|</mo> </msqrt> </mrow> </math> <math> <mrow> <mi>a</mi> <mo>=</mo> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msub> <mi>&epsiv;</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mi>y</mi> <msub> <mi>h</mi> <mn>1</mn> </msub> </mfrac> <mo>,</mo> </mtd> <mtd> <mo>|</mo> <mi>y</mi> <mo>|</mo> <mo>&le;</mo> <msub> <mi>d</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>&epsiv;</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mrow> <mi>sign</mi> <mrow> <mo>(</mo> <mi>y</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <msub> <mi>a</mi> <mn>0</mn> </msub> <mo>-</mo> <mi>d</mi> <mo>)</mo> </mrow> </mrow> <mn>2</mn> </mfrac> <mo>,</mo> </mtd> <mtd> <mo>|</mo> <mi>y</mi> <mo>|</mo> <mo>></mo> <msub> <mi>d</mi> <mn>0</mn> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow> </math> <math> <mrow> <mi>fst</mi> <mrow> <mo>(</mo> <msub> <mi>&epsiv;</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <msub> <mi>&epsiv;</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>r</mi> <mo>,</mo> <msub> <mi>h</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <mo>-</mo> <mi>r</mi> <mfrac> <mi>a</mi> <mi>d</mi> </mfrac> <mo>,</mo> </mtd> <mtd> <mo>|</mo> <mi>a</mi> <mo>|</mo> <mo>&le;</mo> <mi>d</mi> </mtd> </mtr> <mtr> <mtd> <mo>-</mo> <mi>rsign</mi> <mrow> <mo>(</mo> <mi>a</mi> <mo>)</mo> </mrow> <mo>,</mo> </mtd> <mtd> <mo>|</mo> <mi>a</mi> <mo>|</mo> <mo>></mo> <mi>d</mi> </mtd> </mtr> </mtable> </mfenced> </mrow> </math> u0(t)=fst(ε1(t),ε2(t),r,h1)其中,t-离散时间,ε1(t)-在离散时刻t的误差值,ε2(t)-在离散时刻t的误差微分值,r-与过渡过程加速度有关的参数,y-内部变量,a0-内部变量,sing(y)和sing(a)-分别是y和a的符号(+1或-1),a-内部变量fst(ε1(t),ε2(t),r,h1)-上述非线性最速反馈控制律函数,u0(t)-离散时刻t的反馈控制量;4)最终控制量决定过程,对上述反馈控制量部分补偿上述扩张状态观测过程估计出的总扰动量的估计值,决定最终控制量;对上述反馈控制量补偿扩张状态观测过程估计出的总扰动量的估计值z3(t),决定出最终控制量:<math> <mrow> <mi>u</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>u</mi> <mn>0</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>z</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> <msub> <mi>b</mi> <mn>0</mn> </msub> </mfrac> </mrow> </math> 其中,t-离散时间;u0(t)-离散时刻t的反馈控制量;b0 是对象控制量放大系数b的估计值;u(t)-实现抗干扰功能及快速无超调地实现过渡过程的控制量。
地址 100080北京市海淀区中关村935楼610号