发明名称 一种磁悬浮球位置控制方法
摘要 本发明公开了一种磁悬浮球位置控制方法,针对磁悬浮球系统难以建立精确物理模型的缺点,采用系统辨识方法建立带函数权系数型自回归模型来描述电磁绕组输入电压与钢球位置间的非线性动态特性。该模型用钢球位置的一次线性函数作为高斯RBF网络的权系数,并用该RBF网络作为非线性自回归模型的函数型系数,使该模型能较好地刻画磁悬浮球系统的动态特性。该模型在某一时刻回归系数为常数,类似于一个线性ARX模型。基于此,本发明设计一个时变的、局部线性的预测控制器,通过在各时刻在线求解二次规划来快速实现钢球的最优位置控制,满足磁悬浮球系统稳定、快速的要求。
申请公布号 CN104793645A 申请公布日期 2015.07.22
申请号 CN201510180614.7 申请日期 2015.04.16
申请人 中南大学 发明人 彭辉;覃业梅;阮文杰;高家成
分类号 G05D3/12(2006.01)I 主分类号 G05D3/12(2006.01)I
代理机构 长沙正奇专利事务所有限责任公司 43113 代理人 马强;王娟
主权项 一种磁悬浮球位置控制方法,其特征在于,包括以下步骤:1)对磁悬浮球系统建立自回归模型:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mi>g</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>&phi;</mi><mn>0</mn></msub><mo>+</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mn>7</mn></munderover><msubsup><mi>&phi;</mi><mi>i</mi><mi>g</mi></msubsup><mi>g</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mi>i</mi><mo>)</mo></mrow><mo>+</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mn>7</mn></munderover><msubsup><mi>&phi;</mi><mi>i</mi><mi>u</mi></msubsup><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mi>i</mi><mo>)</mo></mrow><mo>+</mo><mi>&xi;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000700496050000011.GIF" wi="891" he="147" /></maths>其中,g(t)为t时刻磁悬浮球的位置;u(t)为电磁绕组输入电压;ξ(t)为白噪声;<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>&phi;</mi><mn>0</mn></msub><mo>=</mo><msubsup><mi>c</mi><mn>0</mn><mn>0</mn></msubsup><mo>+</mo><msubsup><mi>V</mi><mn>1</mn><mn>0</mn></msubsup><mi>exp</mi><mrow><mo>(</mo><mo>-</mo><mn>0.03</mn><msup><mrow><mo>|</mo><mo>|</mo><mi>W</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>-</mo><mn>11.74</mn><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msubsup><mi>&phi;</mi><mi>i</mi><mi>g</mi></msubsup><mo>=</mo><msubsup><mi>c</mi><mrow><mi>i</mi><mo>,</mo><mn>0</mn></mrow><mi>g</mi></msubsup><mo>+</mo><msubsup><mi>V</mi><mrow><mi>i</mi><mo>,</mo><mi>l</mi></mrow><mi>g</mi></msubsup><mi>exp</mi><mrow><mo>(</mo><mo>-</mo><mn>0.03</mn><mo>|</mo><mo>|</mo><mi>W</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>-</mo><mn>11.74</mn><msup><mrow><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msubsup><mi>&phi;</mi><mi>j</mi><mi>u</mi></msubsup><mo>=</mo><msubsup><mi>c</mi><mrow><mi>j</mi><mo>,</mo><mn>0</mn></mrow><mi>u</mi></msubsup><mo>+</mo><msubsup><mi>V</mi><mrow><mi>j</mi><mo>,</mo><mn>1</mn></mrow><mi>u</mi></msubsup><mi>exp</mi><mrow><mo>(</mo><mo>-</mo><mn>1.33</mn><mo>|</mo><mo>|</mo><msup><mrow><mi>W</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><mn>3.82</mn><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>W</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>=</mo><mi>g</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>V</mi><mn>0</mn></msup><mo>=</mo><msubsup><mi>v</mi><mn>0</mn><mn>0</mn></msubsup><mo>+</mo><msubsup><mi>v</mi><mn>1</mn><mn>0</mn></msubsup><mi>g</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msubsup><mi>V</mi><mi>i</mi><mi>g</mi></msubsup><mo>=</mo><msubsup><mi>v</mi><mrow><mi>i</mi><mo>,</mo><mn>0</mn></mrow><mi>g</mi></msubsup><mo>+</mo><msubsup><mi>v</mi><mrow><mi>i</mi><mo>,</mo><mn>1</mn></mrow><mi>g</mi></msubsup><mi>g</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msubsup><mi>V</mi><mi>j</mi><mi>u</mi></msubsup><mo>=</mo><msubsup><mi>v</mi><mrow><mi>j</mi><mo>,</mo><mn>0</mn></mrow><mi>g</mi></msubsup><mo>+</mo><msubsup><mi>v</mi><mrow><mi>j</mi><mo>,</mo><mn>1</mn></mrow><mi>u</mi></msubsup><mi>g</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>i</mi><mo>=</mo><mn>1,2</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mn>7</mn><mo>;</mo><mi>j</mi><mo>=</mo><mn>1,2</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mn>6</mn></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000700496050000012.GIF" wi="941" he="754" /></maths>V<sup>0</sup>、<img file="FDA0000700496050000013.GIF" wi="66" he="72" />和<img file="FDA0000700496050000014.GIF" wi="58" he="77" />为RBF网络的权系数,是钢球位置的一次线性函数;<img file="FDA0000700496050000015.GIF" wi="933" he="91" />为常数系数,通过SNPOM优化方法辨识;g(t‑1)为t‑1时刻磁悬浮球的位置;2)基于所述自回归模型设计预测控制器,优化下列二次规划函数J获得最优控制量,控制磁悬浮球的位置g(t):<maths num="0003" id="cmaths0003"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><munder><mi>min</mi><mrow><mover><mi>u</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></munder></mtd><mtd><mi>J</mi><mo>=</mo><msubsup><mrow><mo>|</mo><mo>|</mo><mover><mi>g</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><msub><mover><mi>g</mi><mo>^</mo></mover><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><msub><mrow><mn>1.8</mn><mi>I</mi></mrow><mn>12</mn></msub><mn>2</mn></msubsup><mo>+</mo><msubsup><mrow><mo>|</mo><mo>|</mo><mover><mi>u</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mrow><mn>0.0002</mn><msub><mi>I</mi><mn>4</mn></msub></mrow><mn>2</mn></msubsup><mo>+</mo><msubsup><mrow><mo>|</mo><mo>|</mo><mi>&Delta;</mi><mover><mi>u</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><msub><mrow><mn>0.16</mn><mi>I</mi></mrow><mn>4</mn></msub><mn>2</mn></msubsup></mtd></mtr><mtr><mtd><mi>s</mi><mo>.</mo><mi>t</mi><mo>.</mo></mtd><mtd><mo>-</mo><mn>22</mn><mo>&le;</mo><mover><mi>g</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&le;</mo><mn>0</mn></mtd></mtr><mtr><mtd></mtd><mtd><mn>0</mn><mo>&le;</mo><mover><mi>u</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&le;</mo><mn>10</mn></mtd></mtr><mtr><mtd></mtd><mtd><mo>-</mo><mn>3</mn><mo>&le;</mo><mi>&Delta;</mi><mover><mi>u</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&le;</mo><mn>3</mn></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000700496050000016.GIF" wi="1043" he="296" /></maths>其中,<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msub><mover><mi>g</mi><mo>^</mo></mover><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>g</mi><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow></mtd><mtd><msub><mi>g</mi><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>+</mo><mn>2</mn><mo>)</mo></mrow></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><msub><mi>g</mi><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>+</mo><mn>12</mn><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>,</mo></mrow>]]></math><img file="FDA0000700496050000017.GIF" wi="866" he="94" /></maths>g<sub>r</sub>(t+l)为t时刻给定的l步向前参考位置,l=1,2,…,12;<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mover><mi>u</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow></mtd><mtd><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>+</mo><mn>2</mn><mo>)</mo></mrow></mtd><mtd><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>+</mo><mn>3</mn><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>,</mo></mrow>]]></math><img file="FDA0000700496050000018.GIF" wi="878" he="89" /></maths>u(t+p)为t时刻要优化的电磁绕组输入电压,仅取第一项u(t)作用于被控磁悬浮球,p=0,1,2,3;<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mi>&Delta;</mi><mrow><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo></mrow><msup><mfenced open='[' close=']' separators=''><mtable><mtr><mtd><mi>&Delta;u</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mi>&Delta;u</mi><mrow><mo>(</mo><mi>t</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow></mtd><mtd><mi>&Delta;u</mi><mrow><mo>(</mo><mi>t</mi><mo>+</mo><mn>2</mn><mo>)</mo></mrow></mtd><mtd><mi>&Delta;u</mi><mrow><mo>(</mo><mi>t</mi><mo>+</mo><mn>3</mn></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>,</mo></mrow>]]></math><img file="FDA0000700496050000019.GIF" wi="962" he="87" /></maths>Δu(t)=u(t)‑u(t‑1)为输入电压增量;<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><mover><mi>g</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mover><mi>C</mi><mo>&OverBar;</mo></mover><msub><mover><mi>A</mi><mo>&OverBar;</mo></mover><mi>t</mi></msub><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><mover><mi>C</mi><mo>&OverBar;</mo></mover><msub><mover><mi>B</mi><mo>&OverBar;</mo></mover><mi>t</mi></msub><mover><mi>u</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><mover><mi>C</mi><mo>&OverBar;</mo></mover><msub><mover><mi>&Gamma;</mi><mo>&OverBar;</mo></mover><mi>t</mi></msub><msub><mover><mi>&Phi;</mi><mo>&OverBar;</mo></mover><mi>t</mi></msub><mo>,</mo></mrow>]]></math><img file="FDA00007004960500000110.GIF" wi="729" he="79" /></maths><img file="FDA00007004960500000111.GIF" wi="361" he="79" />和<img file="FDA00007004960500000112.GIF" wi="62" he="79" />为系统预测系数矩阵;<maths num="0008" id="cmaths0008"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><msup><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>x</mi><mrow><mn>1</mn><mo>,</mo><mi>t</mi></mrow></msub></mtd><mtd><msub><mi>x</mi><mrow><mn>2</mn><mo>,</mo><mi>t</mi></mrow></msub></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><msub><mi>x</mi><mrow><mn>7</mn><mo>,</mo><mi>t</mi></mrow></msub></mtd></mtr></mtable></mfenced><mi>T</mi></msup></msup></mtd></mtr><mtr><mtd><msub><mi>x</mi><mrow><mn>1</mn><mo>,</mo><mi>t</mi></mrow></msub><mo>=</mo><mi>g</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>x</mi><mrow><mi>k</mi><mo>,</mo><mi>t</mi></mrow></msub><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mrow><mn>7</mn><mo>-</mo><mi>k</mi><mo>+</mo><mn>1</mn></mrow></munderover><msubsup><mi>&phi;</mi><mrow><mi>i</mi><mo>+</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>g</mi></msubsup><mi>g</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mi>i</mi><mo>)</mo></mrow><mo>+</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mrow><mn>7</mn><mo>-</mo><mi>k</mi><mo>+</mo><mn>1</mn></mrow></munderover><msubsup><mi>&phi;</mi><mrow><mi>i</mi><mo>+</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>u</mi></msubsup><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>-</mo><mi>i</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>k</mi><mo>=</mo><mn>2,3</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mn>7</mn></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000700496050000021.GIF" wi="836" he="372" /></maths>为状态向量;<maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><msub><mover><mi>&Phi;</mi><mo>&OverBar;</mo></mover><mi>t</mi></msub><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>&Phi;</mi><mi>t</mi><mi>T</mi></msubsup></mtd><mtd><msubsup><mi>&Phi;</mi><mrow><mi>t</mi><mo>+</mo><mn>1</mn></mrow><mi>T</mi></msubsup></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><msubsup><mi>&Phi;</mi><mrow><mi>t</mi><mo>+</mo><mn>11</mn></mrow><mi>T</mi></msubsup></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>,</mo></mrow>]]></math><img file="FDA0000700496050000022.GIF" wi="668" he="101" /></maths><maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><msub><mi>&Phi;</mi><mi>t</mi></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>&phi;</mi><mn>0</mn></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000700496050000023.GIF" wi="237" he="261" /></maths>φ<sub>0</sub>、<img file="FDA00007004960500000210.GIF" wi="65" he="77" />和<img file="FDA00007004960500000211.GIF" wi="60" he="84" />为自回归模型的回归函数系数,<maths num="0011" id="cmaths0011"><math><![CDATA[<mrow><msubsup><mi>&phi;</mi><mn>7</mn><mi>u</mi></msubsup><mo>=</mo><mn>0</mn><mo>;</mo></mrow>]]></math><img file="FDA0000700496050000024.GIF" wi="166" he="77" /></maths>I为单位矩阵。
地址 410083 湖南省长沙市岳麓区麓山南路932号