发明名称 具有时变测量延迟输出和噪声的伺服电机的状态观测方法
摘要 一种具有时变测量延迟输出和噪声的伺服电机的状态观测方法,它有四大步骤:步骤一、伺服电机系统模型分析及建模;步骤二、伺服电机系统延时观测器设计;步骤三、跟踪性能检验与参数调节;步骤四、设计结束。采用这种状态观测方法,可以消除延迟输出和测量噪声的影响,并且不需要速度传感器便可以得到系统的全状态信息,更方便在工程实践中应用。本发明设计的观测器,通过李雅普诺夫‑拉祖米欣定理来分析观测误差的收敛性。此外,通过数字仿真,验证了所发明的观测器的有效性。
申请公布号 CN104038132B 申请公布日期 2016.08.24
申请号 CN201410260578.0 申请日期 2014.06.12
申请人 国电科学技术研究院 发明人 陈彦桥;贺庆;刘金琨
分类号 H02P21/14(2016.01)I 主分类号 H02P21/14(2016.01)I
代理机构 北京慧泉知识产权代理有限公司 11232 代理人 王顺荣;唐爱华
主权项 一种具有时变测量延迟输出和噪声的伺服电机的状态观测方法,其特征在于:该方法具体步骤如下:步骤一:伺服电机系统模型分析及建模:伺服电机系统采用负反馈的控制结构,输出量为伺服电机系统转角;伺服电机系统传递函数描述如下:<maths num="0001"><math><![CDATA[<mrow><msub><mi>G</mi><mi>d</mi></msub><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow><mo>=</mo><mfrac><msub><mi>K</mi><mi>m</mi></msub><mrow><mi>s</mi><mo>&lsqb;</mo><msub><mi>JL</mi><mi>d</mi></msub><msup><mi>s</mi><mn>2</mn></msup><mo>+</mo><mrow><mo>(</mo><msub><mi>JR</mi><mi>d</mi></msub><mo>+</mo><msub><mi>f</mi><mn>0</mn></msub><msub><mi>L</mi><mi>d</mi></msub><mo>)</mo></mrow><mi>s</mi><mo>+</mo><mrow><mo>(</mo><msub><mi>R</mi><mi>d</mi></msub><msub><mi>f</mi><mn>0</mn></msub><mo>+</mo><msub><mi>K</mi><mi>e</mi></msub><msub><mi>K</mi><mi>m</mi></msub><mo>)</mo></mrow><mo>&rsqb;</mo></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000940861950000011.GIF" wi="1412" he="142" /></maths>其中:K<sub>m</sub>表示伺服电机的力矩系数;J表示汽轮发电机功角初值;L<sub>d</sub>表示伺服电机系统电枢绕组的电感;R<sub>d</sub>表示伺服电机系统电枢绕组的电阻;f<sub>0</sub>表示阻尼系数;K<sub>e</sub>表示伺服电机系统反电势系数;为了便于设计,分别定义三个状态变量x<sub>1</sub>、x<sub>2</sub>、x<sub>3</sub>分别定义为:x<sub>1</sub>=θ,x<sub>2</sub>=ω,<img file="FDA0000940861950000012.GIF" wi="160" he="59" />取x=[x<sub>1</sub> x<sub>2</sub> x<sub>3</sub>],这时公式(1)写成<maths num="0002"><math><![CDATA[<mrow><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>A</mi><mi>n</mi></msub><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>M</mi><mi>n</mi></msub><mrow><mo>(</mo><mi>x</mi><mo>,</mo><mi>t</mi><mo>,</mo><mi>u</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000940861950000013.GIF" wi="1152" he="71" /></maths>其中:<img file="FDA0000940861950000014.GIF" wi="350" he="221" />M<sub>n</sub>(x,t,u)=ax<sub>2</sub>+bx<sub>3</sub>+cu,<img file="FDA0000940861950000015.GIF" wi="406" he="135" /><maths num="0003"><math><![CDATA[<mrow><mi>b</mi><mo>=</mo><mo>-</mo><mfrac><mrow><msub><mi>JR</mi><mi>d</mi></msub><mo>+</mo><msub><mi>f</mi><mn>0</mn></msub><msub><mi>L</mi><mi>d</mi></msub></mrow><mrow><msub><mi>JL</mi><mi>d</mi></msub></mrow></mfrac><mo>,</mo><mi>c</mi><mo>=</mo><mfrac><msub><mi>K</mi><mi>m</mi></msub><mrow><msub><mi>JL</mi><mi>d</mi></msub></mrow></mfrac><mo>;</mo></mrow>]]></math><img file="FDA0000940861950000016.GIF" wi="558" he="134" /></maths>另外,需考虑系统慑动,故系统状态方程为:<maths num="0004"><math><![CDATA[<mrow><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>A</mi><mi>n</mi></msub><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>M</mi><mi>n</mi></msub><mrow><mo>(</mo><mi>x</mi><mo>,</mo><mi>t</mi><mo>,</mo><mi>u</mi><mo>)</mo></mrow><mo>+</mo><mi>w</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000940861950000017.GIF" wi="1166" he="70" /></maths>其中,w(t)为系统状态慑动;伺服电机输出表示为:<img file="FDA0000940861950000018.GIF" wi="989" he="79" />其中C=[1 0 0],δ(t)为时变的伺服电机角位置传感器的信号延时时间,满足|δ(t)|≤1,v(t)为输出噪声;步骤二:伺服电机系统延时观测器设计针对以上伺服电机系统的动力学模型,设计出对应的观测器,消除测量延迟所带来的影响,得其输出<img file="FDA0000940861950000021.GIF" wi="89" he="62" />收敛于实际状态x(t);对以上系统设计出的观测器为以下的形式:<maths num="0005"><math><![CDATA[<mrow><mover><mover><mi>x</mi><mo>^</mo></mover><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>A</mi><mi>n</mi></msub><mover><mi>x</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>M</mi><mi>n</mi></msub><mrow><mo>(</mo><mover><mi>x</mi><mo>^</mo></mover><mo>,</mo><mi>t</mi><mo>,</mo><mi>u</mi><mo>)</mo></mrow><mo>+</mo><mi>K</mi><mi>e</mi><mrow><mo>(</mo><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>,</mo><mover><mi>x</mi><mo>^</mo></mover><mo>)</mo></mrow><mo>+</mo><msub><mi>S</mi><mrow><mi>l</mi><mi>i</mi><mi>d</mi></mrow></msub><mrow><mo>(</mo><mi>e</mi><mo>(</mo><mrow><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>,</mo><mover><mi>x</mi><mo>^</mo></mover></mrow><mo>)</mo><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000940861950000022.GIF" wi="1373" he="79" /></maths>其中<img file="FDA0000940861950000023.GIF" wi="656" he="87" />K=[k<sub>1</sub> k<sub>2</sub> k<sub>3</sub>]<sup>T</sup>,需使A<sub>n</sub>‑KC满足Hurwitz条件,即A<sub>n</sub>‑KC的特征根实部为负;若期望配置的极点位置为‑λ<sub>1</sub>,‑λ<sub>2</sub>,‑λ<sub>3</sub>,λ<sub>i</sub>>0,则矩阵K的计算公式为:<maths num="0006"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>k</mi><mn>1</mn></msub><mo>=</mo><msub><mi>&lambda;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;</mi><mn>2</mn></msub><mo>+</mo><msub><mi>&lambda;</mi><mn>3</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>k</mi><mn>2</mn></msub><mo>=</mo><msub><mi>&lambda;</mi><mn>1</mn></msub><msub><mi>&lambda;</mi><mn>2</mn></msub><mo>+</mo><msub><mi>&lambda;</mi><mn>2</mn></msub><msub><mi>&lambda;</mi><mn>3</mn></msub><mo>+</mo><msub><mi>&lambda;</mi><mn>3</mn></msub><msub><mi>&lambda;</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>k</mi><mn>3</mn></msub><mo>=</mo><msub><mi>&lambda;</mi><mn>1</mn></msub><msub><mi>&lambda;</mi><mn>2</mn></msub><msub><mi>&lambda;</mi><mn>3</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000940861950000024.GIF" wi="1061" he="223" /></maths>另外,<maths num="0007"><math><![CDATA[<mrow><msub><mi>S</mi><mrow><mi>l</mi><mi>i</mi><mi>d</mi></mrow></msub><mrow><mo>(</mo><mi>e</mi><mo>(</mo><mrow><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>,</mo><mover><mi>x</mi><mo>^</mo></mover></mrow><mo>)</mo><mo>)</mo></mrow><mo>=</mo><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mfrac><mrow><msup><mi>P</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><msup><mi>QC</mi><mi>T</mi></msup><mi>e</mi><mrow><mo>(</mo><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>,</mo><mover><mi>x</mi><mo>^</mo></mover><mo>)</mo></mrow></mrow><mrow><mo>|</mo><mo>|</mo><mi>e</mi><mrow><mo>(</mo><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>,</mo><mover><mi>x</mi><mo>^</mo></mover><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow></mfrac><mo>,</mo></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mo>|</mo><mo>|</mo><mi>e</mi><mrow><mo>(</mo><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>,</mo><mover><mi>x</mi><mo>^</mo></mover><mo>)</mo></mrow><mo>|</mo><mo>|</mo><mo>&gt;</mo><mi>&epsiv;</mi></mrow></mtd></mtr><mtr><mtd><mrow><mfrac><mrow><msup><mi>P</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><msup><mi>QC</mi><mi>T</mi></msup><mi>e</mi><mrow><mo>(</mo><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>,</mo><mover><mi>x</mi><mo>^</mo></mover><mo>)</mo></mrow></mrow><mi>&epsiv;</mi></mfrac><mo>,</mo></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mo>|</mo><mo>|</mo><mi>e</mi><mrow><mo>(</mo><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>,</mo><mover><mi>x</mi><mo>^</mo></mover><mo>)</mo></mrow><mo>|</mo><mo>|</mo><mo>&le;</mo><mi>&epsiv;</mi></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000940861950000025.GIF" wi="1406" he="303" /></maths>其中,<img file="FDA0000940861950000026.GIF" wi="845" he="235" />Q和ε是分别是需要调节的矩阵和参数;首先,定义观测误差<img file="FDA0000940861950000027.GIF" wi="346" he="62" />然后,对上述提出的观测器进行李雅普诺夫‑拉祖米欣收敛性分析;定义李雅普诺夫函数V(e),利用拉祖米欣理论,对其进行收敛性分析;采用观测器式(4),证明出<img file="FDA0000940861950000028.GIF" wi="315" he="71" />其中ω>0,即保证所设计的观测器的收敛性;但是由于所设计的观测器中包含有很多的参数,为了使观测效果达到最好,即观测器的响应速度最快和观测误差超调量最小,需要对观测器中的参数进行调整;步骤三:跟踪性能检验与参数调节检验系统性能是否满足设计要求,并且适当调节控制参数,借助于常用的数值计算和控制系统仿真工具Matlab 7.0进行;参数λ<sub>1</sub>,λ<sub>2</sub>,λ<sub>3</sub>为调节参数,若跟踪误差过大,不满足设计要求,则调节以上参数使控制算法满足要求;步骤四:设计结束经过上述步骤一至步骤三之后,设计结束。
地址 210031 江苏省南京市浦口区浦东路10号