发明名称 时变滑模变结构和交叉耦合控制磁悬浮系统的控制方法
摘要 本发明的基于时变滑模变结构控制和交叉耦合的双电磁悬浮系统同步控制的装置包括:时变滑模变结构控制器:根据悬浮高度误差量输出悬浮系统的控制量,使移动横梁能快速、准确的悬浮到给定高度;交叉耦合同步控制器:调节两个电磁悬浮系统的同步性能;驱动器:将时变滑模变结构控制器和交叉耦合控制器的输出信号驱动双电磁悬浮系统;信号检测器:采集电磁悬浮系统的速度和位置信号。基于时变滑模变结构和交叉耦合双电磁悬浮系统同步控制方法发明内容包括:单电磁悬浮系统采用时变滑模变结构控制方法。本发明在保持滑模变结构控制器所具有的对参数摄动和外部不确定干扰具有强鲁棒性等良好的特性下,加快了系统的响应速度。
申请公布号 CN103336483A 申请公布日期 2013.10.02
申请号 CN201310193753.4 申请日期 2013.05.22
申请人 沈阳工业大学 发明人 刘春芳;荣刚;王通;张健;初旸;朱思佳
分类号 G05B19/404(2006.01)I 主分类号 G05B19/404(2006.01)I
代理机构 沈阳智龙专利事务所(普通合伙) 21115 代理人 宋铁军;周智博
主权项 1.一种时变滑模变结构和交叉耦合控制磁悬浮系统的控制方法,其特征在于:单电磁悬浮系统采用时变滑模变结构控制方法,双电磁悬浮系统采用加速度、速度、气隙双三交叉耦合同步控制方法减小同步误差,具体包括如下步骤:(1)单电磁悬浮系统:直接驱动电磁悬浮系统的信号为位置信号,单电磁悬浮系统的采用时变滑模变结构控制方法来提高单电磁悬浮系统的快速性和鲁棒性,时变滑模变结构控制律为:u=u<sub>c</sub>+u<sub>vss</sub>其中:u<sub>c</sub>为线性控制律,表达式为:<maths num="0001"><![CDATA[<math><mrow><msub><mi>u</mi><mi>c</mi></msub><mo>=</mo><mo>[</mo><mi>k&sigma;</mi><msup><mrow><mo>+</mo><mi>r</mi></mrow><mn>3</mn></msup><mo>-</mo><mover><mi>&phi;</mi><mo>&OverBar;</mo></mover><mi>x</mi><mo>-</mo><mover><mi>d</mi><mo>&OverBar;</mo></mover><mo>+</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mn>2</mn></munderover><msub><mi>c</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>ri</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>)</mo></mrow><mo>]</mo><mo>/</mo><msub><mi>b</mi><mi>min</mi></msub></mrow></math>]]></maths>u<sub>vss</sub>为切换控制,表达式为:<maths num="0002"><![CDATA[<math><mrow><msub><mi>u</mi><mi>vss</mi></msub><mo>=</mo><mrow><mo>(</mo><mi>&epsiv;</mi><mo>+</mo><mo>|</mo><msub><mi>&lambda;&sigma;</mi><mn>0</mn></msub><msup><mi>e</mi><mrow><mo>-</mo><mi>&lambda;t</mi></mrow></msup><mo>|</mo><mo>/</mo><msub><mi>b</mi><mi>min</mi></msub><mo>)</mo></mrow><mi>sgn</mi><mrow><mo>(</mo><mi>&sigma;</mi><mo>)</mo></mrow></mrow></math>]]></maths>选择合适的函数消除抖振;为了消除滑模变结构普遍存在的抖振问题采用饱和函数代替了符号函数,其中饱和函数为:<img file="FDA00003229874900016.GIF" wi="584" he="231" />(2)双电磁悬浮系统:(原来的描述功能的用语放在说明书里就可以了!建立双电磁悬浮系统交叉耦合定量关系,通过对两个电磁悬浮系统的受力分析和位移坐标变换可以得出当悬浮框架倾斜θ角度时,两个电磁悬浮系统的交叉耦合定量关系为:<maths num="0003"><![CDATA[<math><mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mover><mi>y</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mn>1</mn></msub></mtd></mtr><mtr><mtd><msub><mover><mi>y</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mn>2</mn></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mo>-</mo><mfrac><mn>1</mn><mi>m</mi></mfrac><mo>-</mo><mfrac><mn>1</mn><msub><mi>m</mi><mi>&theta;</mi></msub></mfrac></mtd><mtd><mo>-</mo><mfrac><mn>1</mn><mi>m</mi></mfrac><mo>+</mo><mfrac><mn>1</mn><msub><mi>m</mi><mi>&theta;</mi></msub></mfrac></mtd></mtr><mtr><mtd><mo>-</mo><mfrac><mn>1</mn><mi>m</mi></mfrac><mo>+</mo><mfrac><mn>1</mn><msub><mi>m</mi><mi>&theta;</mi></msub></mfrac></mtd><mtd><mo>-</mo><mfrac><mn>1</mn><mi>m</mi></mfrac><mo>-</mo><mfrac><mn>1</mn><msub><mi>m</mi><mi>&theta;</mi></msub></mfrac></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>f</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msub><mi>f</mi><mn>2</mn></msub></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>计算两个电磁悬浮系统的交叉耦合补偿控制量:电磁悬浮系统1对电磁悬浮系统2的交叉耦合控制量为:<maths num="0004"><![CDATA[<math><mrow><mi>&Delta;</mi><msub><mi>W</mi><mn>2</mn></msub><mo>=</mo><mrow><mo>(</mo><mo>-</mo><mfrac><mn>1</mn><mi>m</mi></mfrac><mo>+</mo><mfrac><mn>1</mn><msub><mi>m</mi><mi>&theta;</mi></msub></mfrac><mo>)</mo></mrow><mfrac><mrow><mo>-</mo><msub><mi>u</mi><mn>0</mn></msub><mi>A</mi><msup><mi>N</mi><mn>2</mn></msup></mrow><mn>4</mn></mfrac><msup><mrow><mrow><mo>{</mo><mfrac><msub><mi>u</mi><mn>1</mn></msub><mrow><mi>R</mi><mo>+</mo><mfrac><mrow><msub><mi>u</mi><mn>0</mn></msub><mi>A</mi><msup><mi>N</mi><mn>2</mn></msup></mrow><msub><mrow><mn>2</mn><mi>y</mi></mrow><mn>1</mn></msub></mfrac><mo>-</mo><mfrac><mrow><msub><mi>u</mi><mn>0</mn></msub><msup><mi>AN</mi><mn>2</mn></msup></mrow><msub><mi>y</mi><mn>1</mn></msub></mfrac></mrow></mfrac></mrow><mo>}</mo></mrow><mn>2</mn></msup><msub><mover><mi>y</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mn>1</mn></msub><mo>+</mo><mfrac><mrow><mo>-</mo><mrow><mo>(</mo><msub><mi>u</mi><mn>1</mn></msub><mfrac><mn>1</mn><msub><mi>l</mi><mn>0</mn></msub></mfrac><mo>+</mo><mfrac><mrow><msub><mi>k</mi><mi>i</mi></msub><mi>s</mi><msub><mi>y</mi><mn>1</mn></msub></mrow><msub><mi>l</mi><mn>0</mn></msub></mfrac><mo>-</mo><mfrac><mrow><msub><mi>&Delta;i</mi><mn>1</mn></msub><msub><mi>l</mi><mn>0</mn></msub></mrow><mi>R</mi></mfrac><mo>)</mo></mrow><mfrac><msub><mi>k</mi><mi>i</mi></msub><mi>s</mi></mfrac><mo>+</mo><msub><mi>k</mi><mi>y</mi></msub><mi>&Delta;</mi><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msub><mi>k</mi><mi>y</mi></msub><msub><mi>&Delta;y</mi><mn>2</mn></msub></mrow><mrow><mo>-</mo><mrow><mo>(</mo><msub><mi>u</mi><mn>2</mn></msub><mfrac><mn>1</mn><msub><mi>l</mi><mn>0</mn></msub></mfrac><mo>+</mo><mfrac><mrow><msub><mi>k</mi><mi>i</mi></msub><msub><mi>sy</mi><mn>2</mn></msub></mrow><msub><mi>l</mi><mn>0</mn></msub></mfrac><mo>-</mo><mfrac><mrow><msub><mi>&Delta;i</mi><mn>2</mn></msub><msub><mi>l</mi><mi>o</mi></msub></mrow><mi>R</mi></mfrac><mo>)</mo></mrow><mfrac><msub><mi>k</mi><mi>i</mi></msub><mi>s</mi></mfrac></mrow></mfrac><msub><mi>f</mi><mn>1</mn></msub></mrow></math>]]></maths>同理电磁悬浮系统2对电磁悬浮系统1的交叉耦合控制量为:<maths num="0005"><![CDATA[<math><mrow><mi>&Delta;</mi><msub><mi>W</mi><mn>1</mn></msub><mo>=</mo><mrow><mo>(</mo><mo>-</mo><mfrac><mn>1</mn><mi>m</mi></mfrac><mo>+</mo><mfrac><mn>1</mn><msub><mi>m</mi><mi>&theta;</mi></msub></mfrac><mo>)</mo></mrow><mfrac><mrow><mo>-</mo><msub><mi>u</mi><mn>0</mn></msub><mi>A</mi><msup><mi>N</mi><mn>2</mn></msup></mrow><mn>4</mn></mfrac><msup><mrow><mrow><mo>{</mo><mfrac><msub><mi>u</mi><mn>2</mn></msub><mrow><mi>R</mi><mo>+</mo><mfrac><mrow><msub><mi>u</mi><mn>0</mn></msub><mi>A</mi><msup><mi>N</mi><mn>2</mn></msup></mrow><msub><mrow><mn>2</mn><mi>y</mi></mrow><mn>2</mn></msub></mfrac><mo>-</mo><mfrac><mrow><msub><mi>u</mi><mn>0</mn></msub><msup><mi>AN</mi><mn>2</mn></msup></mrow><msub><mi>y</mi><mn>2</mn></msub></mfrac></mrow></mfrac></mrow><mo>}</mo></mrow><mn>2</mn></msup><msub><mover><mi>y</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mn>2</mn></msub><mo>+</mo><mfrac><mrow><mo>-</mo><mrow><mo>(</mo><msub><mi>u</mi><mn>2</mn></msub><mfrac><mn>1</mn><msub><mi>l</mi><mn>0</mn></msub></mfrac><mo>+</mo><mfrac><mrow><msub><mi>k</mi><mi>i</mi></msub><mi>s</mi><msub><mi>y</mi><mn>2</mn></msub></mrow><msub><mi>l</mi><mn>0</mn></msub></mfrac><mo>-</mo><mfrac><mrow><msub><mi>&Delta;i</mi><mn>2</mn></msub><msub><mi>l</mi><mn>0</mn></msub></mrow><mi>R</mi></mfrac><mo>)</mo></mrow><mfrac><msub><mi>k</mi><mi>i</mi></msub><mi>s</mi></mfrac><mo>+</mo><msub><mi>k</mi><mi>y</mi></msub><mi>&Delta;</mi><msub><mi>y</mi><mn>2</mn></msub><mo>-</mo><msub><mi>k</mi><mi>y</mi></msub><msub><mi>&Delta;y</mi><mn>1</mn></msub></mrow><mrow><mo>-</mo><mrow><mo>(</mo><msub><mi>u</mi><mn>1</mn></msub><mfrac><mn>1</mn><msub><mi>l</mi><mn>0</mn></msub></mfrac><mo>+</mo><mfrac><mrow><msub><mi>k</mi><mi>i</mi></msub><msub><mi>sy</mi><mn>1</mn></msub></mrow><msub><mi>l</mi><mn>0</mn></msub></mfrac><mo>-</mo><mfrac><mrow><msub><mi>&Delta;i</mi><mn>2</mn></msub><msub><mi>l</mi><mi>o</mi></msub></mrow><mi>R</mi></mfrac><mo>)</mo></mrow><mfrac><msub><mi>k</mi><mi>i</mi></msub><mi>s</mi></mfrac></mrow></mfrac><msub><mi>f</mi><mn>2</mn></msub></mrow></math>]]></maths>两个电磁悬浮系统的速度、气隙同步误差分别为:<maths num="0006"><![CDATA[<math><mrow><msub><mi>e</mi><mn>1</mn></msub><mo>=</mo><msub><mi>k</mi><mn>1</mn></msub><mrow><mo>(</mo><msub><mover><mi>y</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mn>1</mn></msub><mo>-</mo><msub><mover><mi>y</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mn>2</mn></msub><mo>)</mo></mrow><mo>,</mo><msub><mi>e</mi><mn>2</mn></msub><mo>=</mo><msub><mi>k</mi><mn>2</mn></msub><mrow><mo>(</mo><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>-</mo><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msub><mo>)</mo></mrow><mo>,</mo><msub><mi>e</mi><mn>3</mn></msub><mo>=</mo><msub><mi>k</mi><mn>3</mn></msub><mrow><mo>(</mo><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msub><mi>y</mi><mn>2</mn></msub><mo>)</mo></mrow></mrow></math>]]></maths>其中<img file="FDA00003229874900023.GIF" wi="372" he="72" />为两个电磁悬浮系统的加速度、速度、气隙采集信号k<sub>1</sub>,k<sub>2</sub>,k<sub>3</sub>代表加速度、速度、气隙增益;加速度、速度、气隙总同步误差为:E=e<sub>1</sub>+e<sub>2</sub>+e<sub>3</sub>双电磁悬浮系统同步误差补偿量为:W=E×w其中E为输出总同步误差,w为同步误差补偿增益,W+ΔW<sub>1</sub>和W+ΔW<sub>2</sub>分别为两个电磁悬浮系统同步误差补偿量,将同步误差补偿量和时变滑模变结构控制器输出控制量u叠加来控制电磁悬浮系统;(3),“(1)步骤”和“(2)步骤”所述的方法最终由嵌入控制电路DSP处理器中的控制程序实现,其控制步骤如下:步骤一:系统初始化;步骤二:开总中断;步骤三:检测是否有结束请求信号;如果有,转到步骤八;如果没有,继续;步骤四:检测是否有中断请求信号;步骤五:如果没有中断信号,则等待中断转回步骤四;步骤六:如果有中断,继续;步骤七:启动系统控制中断子程序;步骤八:关总中断;步骤九:结束。
地址 110870 辽宁省沈阳市经济技术开发区沈辽西路111号