主权项 |
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σ</mi><msup><mrow><mo>+</mo><mi>r</mi></mrow><mn>3</mn></msup><mo>-</mo><mover><mi>φ</mi><mo>‾</mo></mover><mi>x</mi><mo>-</mo><mover><mi>d</mi><mo>‾</mo></mover><mo>+</mo><munderover><mi>Σ</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>ϵ</mi><mo>+</mo><mo>|</mo><msub><mi>λσ</mi><mn>0</mn></msub><msup><mi>e</mi><mrow><mo>-</mo><mi>λ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>σ</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>·</mo><mo>·</mo></mrow></mover><mn>1</mn></msub></mtd></mtr><mtr><mtd><msub><mover><mi>y</mi><mrow><mo>·</mo><mo>·</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>θ</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>θ</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>θ</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>θ</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>Δ</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>θ</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>·</mo><mo>·</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>Δ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>Δ</mi><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msub><mi>k</mi><mi>y</mi></msub><msub><mi>Δ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>Δ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>Δ</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>θ</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>·</mo><mo>·</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>Δ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>Δ</mi><msub><mi>y</mi><mn>2</mn></msub><mo>-</mo><msub><mi>k</mi><mi>y</mi></msub><msub><mi>Δ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>Δ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>·</mo><mo>·</mo></mrow></mover><mn>1</mn></msub><mo>-</mo><msub><mover><mi>y</mi><mrow><mo>·</mo><mo>·</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>·</mo></mover><mn>1</mn></msub><mo>-</mo><msub><mover><mi>y</mi><mo>·</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处理器中的控制程序实现,其控制步骤如下:步骤一:系统初始化;步骤二:开总中断;步骤三:检测是否有结束请求信号;如果有,转到步骤八;如果没有,继续;步骤四:检测是否有中断请求信号;步骤五:如果没有中断信号,则等待中断转回步骤四;步骤六:如果有中断,继续;步骤七:启动系统控制中断子程序;步骤八:关总中断;步骤九:结束。 |