发明名称 一种具有时变测量延迟输出和噪声的伺服电机的状态观测方法
摘要 一种具有时变测量延迟输出和噪声的伺服电机的状态观测方法,它有四大步骤:步骤一、伺服电机系统模型分析及建模;步骤二、伺服电机系统延时观测器设计;步骤三、跟踪性能检验与参数调节;步骤四、设计结束。采用这种状态观测方法,可以消除延迟输出和测量噪声的影响,并且不需要速度传感器便可以得到系统的全状态信息,更方便在工程实践中应用。本发明设计的观测器,通过李雅普诺夫-拉祖米欣定理来分析观测误差的收敛性。此外,通过数字仿真,验证了所发明的观测器的有效性。
申请公布号 CN104038132A 申请公布日期 2014.09.10
申请号 CN201410260578.0 申请日期 2014.06.12
申请人 国电科学技术研究院 发明人 陈彦桥;贺庆;刘金琨
分类号 H02P21/14(2006.01)I 主分类号 H02P21/14(2006.01)I
代理机构 北京慧泉知识产权代理有限公司 11232 代理人 王顺荣;唐爱华
主权项 一种具有时变测量延迟输出和噪声的伺服电机的状态观测方法,其特征在于:该方法具体步骤如下:步骤一:伺服电机系统模型分析及建模:伺服电机系统采用负反馈的控制结构,输出量为伺服电机系统转角;伺服电机系统传递函数描述如下:<maths num="0001" id="cmaths0001"><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>[</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>]</mo></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000519825100000011.GIF" wi="1249" he="153" /></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="FDA0000519825100000012.GIF" wi="171" he="70" />取x=[x<sub>1</sub> x<sub>2</sub> x<sub>3</sub>],这时(1)就写成<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mover><mi>x</mi><mo>.</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="FDA0000519825100000013.GIF" wi="1166" he="82" /></maths>其中:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mi>A</mi><mi>n</mi></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000519825100000014.GIF" wi="359" he="232" /></maths>M<sub>n</sub>(z,t,u)=az<sub>2</sub>+bz<sub>3</sub>+cu,<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mi>a</mi><mo>=</mo><mo>-</mo><mfrac><mrow><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></mrow><msub><mi>JL</mi><mi>d</mi></msub></mfrac><mo>,</mo></mrow>]]></math><img file="FDA0000519825100000015.GIF" wi="410" he="142" /></maths><maths num="0005" id="cmaths0005"><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><msub><mi>JL</mi><mi>d</mi></msub></mfrac><mo>,</mo><mi>c</mi><mo>=</mo><mfrac><msub><mi>K</mi><mi>m</mi></msub><msub><mi>JL</mi><mi>d</mi></msub></mfrac><mo>;</mo></mrow>]]></math><img file="FDA0000519825100000016.GIF" wi="571" he="142" /></maths>伺服电机输出表示为:<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mover><mi>y</mi><mo>&OverBar;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>x</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mi>&delta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>)</mo></mrow><mo>=</mo><mi>Cx</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mi>&delta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0000519825100000017.GIF" wi="709" he="90" /></maths>其中C=[1 0 0],δ(t)为时变的伺服电机角位置传感器的信号延时时间,满足|δ(t)|≤1;如此处理的目的是将伺服电机系统化为状态方程的表达形式,便于下一步设计;步骤二:伺服电机系统延时观测器设计针对以上伺服电机系统的动力学模型,设计出对应的观测器,消除测量延迟所带来的影响,得其输出<img file="FDA0000519825100000021.GIF" wi="82" he="70" />收敛于实际状态x(t);对以上系统设计出的观测器为以下的形式:<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><mover><mi>x</mi><mover><mo>^</mo><mo>.</mo></mover></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><mrow><mo>(</mo><mover><mi>y</mi><mo>&OverBar;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><mi>C</mi><mover><mi>x</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mi>&delta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>)</mo></mrow><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000519825100000022.GIF" wi="1362" he="97" /></maths>其中K=[k<sub>1</sub> k<sub>2</sub> k<sub>3</sub>]<sup>T</sup>,需使A‑KC满足Hurwitz条件,即A‑KC的特征根实部为负;若期望配置的极点位置为‑λ<sub>1</sub>,‑λ<sub>2</sub>,‑λ<sub>3</sub>,λ<sub>i</sub>&gt;0,则矩阵K的计算公式为:<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><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></mtd></mtr><mtr><mtd><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></mtd></mtr><mtr><mtd><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></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000519825100000023.GIF" wi="1072" he="235" /></maths>首先,定义观测误差<img file="FDA0000519825100000024.GIF" wi="360" he="70" />然后,对上述提出的观测器进行李雅普诺夫‑拉祖米欣收敛性分析;定义李雅普诺夫函数V(e),利用拉祖米欣理论,对其进行收敛性分析;采用观测器式(3),证明出<img file="FDA0000519825100000025.GIF" wi="327" he="85" />其中ω&gt;0,即保证所设计的观测器的收敛性;但是由于所设计的观测器中包含有很多的参数,为了使观测效果达到最好,即观测器的响应速度最快和观测误差超调量最小,需要对观测器中的参数进行调整;步骤三:跟踪性能检验与参数调节这一步将检验系统性能是否满足设计要求,并且适当调节控制参数,借助于常用的数值计算和控制系统仿真工具Matlab7.0进行;参数λ<sub>1</sub>,λ<sub>2</sub>,λ<sub>3</sub>为调节参数,若跟踪误差过大,不满足设计要求,则调节以上参数使控制算法满足要求;步骤四:设计结束整个设计过程重点考虑了三个方面的控制需求,分别为设计的简便性,观测误差的收敛性,跟踪的快速精确性;围绕这三个方面,首先在上述第一步中确定了伺服电机的动力学模型;第二步中重点给出了伺服电机系统延时观测器设计方法;第三步中介绍了用以提高跟踪性能的参数调节方法;经上述各步骤后,设计结束。
地址 210031 江苏省南京市浦口区浦东路10号