发明名称 一种基于解析模型预测控制设计的船舶舵减摇方法
摘要 本发明属于船舶工程、控制科学与控制工程领域,涉及一种基于解析模型预测控制设计的船舶舵减摇方法。本发明包括:获取控制对象的各项系数;采集横摇角信号;获取横摇角速度信号;设定控制器参数初值。本发明充分利用了不确定项的有界性,结合解析模型预测控制,有效解决了舵减摇控制系统的参数不确定性问题,所提供的方法相比其他方法,在减摇效率上得到了提高。本发明结构简单,易于实现,能很好满足实际工程应用的需要。
申请公布号 CN103935480A 申请公布日期 2014.07.23
申请号 CN201410105375.4 申请日期 2014.05.26
申请人 哈尔滨工程大学 发明人 彭秀艳;贾书丽;孙涛;王显峰;孙宏放
分类号 B63B39/00(2006.01)I 主分类号 B63B39/00(2006.01)I
代理机构 代理人
主权项 一种基于解析模型预测控制设计的船舶舵减摇方法,其特征在于:(1)获取控制对象的各项系数,包括a<sub>1</sub>,a<sub>2</sub>,a<sub>3</sub>,a<sub>4</sub>,b及相对应的由航速及横稳性高度变化引起的不确定项的边界值m<sub>i</sub>(i=1,2,3,4),b<sub>1</sub>,控制对象为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>=</mo><msub><mi>x</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msub><mo>=</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>1</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>1</mn></msub><mo>)</mo></mrow><msub><mi>x</mi><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>2</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>2</mn></msub><mo>)</mo></mrow><mo>|</mo><msub><mi>x</mi><mn>2</mn></msub><mo>|</mo><msub><mi>x</mi><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>3</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>3</mn></msub><mo>)</mo></mrow><msub><mi>x</mi><mn>1</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>4</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>4</mn></msub><mo>)</mo></mrow><msubsup><mi>x</mi><mn>1</mn><mn>3</mn></msubsup><mo>+</mo><mrow><mo>(</mo><mi>b</mi><mo>+</mo><mi>&Delta;b</mi><mo>)</mo></mrow><mi>u</mi><mo>+</mo><mi>w</mi></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000479985750000011.GIF" wi="1679" he="168" /></maths><maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>a</mi><mn>1</mn></msub><mo>=</mo><mo>-</mo><mfrac><msub><mi>K</mi><mi>p</mi></msub><mrow><msub><mi>I</mi><mi>xx</mi></msub><mo>+</mo><msub><mi>J</mi><mi>xx</mi></msub></mrow></mfrac><mo>,</mo><msub><mi>a</mi><mn>2</mn></msub><mo>=</mo><mo>-</mo><mfrac><msub><mi>K</mi><mi>pp</mi></msub><mrow><msub><mi>I</mi><mi>xx</mi></msub><mo>+</mo><msub><mi>J</mi><mi>xx</mi></msub></mrow></mfrac><mo>,</mo><msub><mi>a</mi><mn>3</mn></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mi>W</mi><mo>&CenterDot;</mo><mi>GM</mi></mrow><mrow><msub><mi>I</mi><mi>xx</mi></msub><mo>+</mo><msub><mi>J</mi><mi>xx</mi></msub></mrow></mfrac><mo>,</mo><msub><mi>a</mi><mn>4</mn></msub><mo>=</mo><mfrac><mrow><mi>W</mi><mo>&CenterDot;</mo><mi>GM</mi></mrow><mrow><msub><mi>I</mi><mi>xx</mi></msub><mo>+</mo><msub><mi>J</mi><mi>xx</mi></msub></mrow></mfrac><mo>,</mo></mrow>]]></math><img file="FDA0000479985750000012.GIF" wi="1399" he="147" /></maths><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mi>b</mi><mo>=</mo><mo>-</mo><msub><mi>I</mi><mi>&delta;z</mi></msub><msup><mi>U</mi><mn>2</mn></msup><msub><mi>Y</mi><mi>&delta;yy</mi></msub><mo>/</mo><mrow><mo>(</mo><msub><mi>I</mi><mi>xx</mi></msub><mo>+</mo><msub><mi>J</mi><mi>xx</mi></msub><mo>)</mo></mrow><mo>,</mo><msub><mi>I</mi><mi>xx</mi></msub><mo>+</mo><msub><mi>J</mi><mi>xx</mi></msub><mo>=</mo><mfrac><mi>W</mi><mi>g</mi></mfrac><msup><mrow><mo>[</mo><mrow><mo>(</mo><mn>0.3085</mn><mo>+</mo><mn>0.0227</mn><mi>B</mi><mo>/</mo><mi>d</mi><mo>-</mo><mn>0.0043</mn><mi>L</mi><mo>/</mo><mn>100</mn><mo>)</mo></mrow><mi>B</mi><mo>]</mo></mrow><mn>2</mn></msup><mo>,</mo></mrow>]]></math><img file="FDA0000479985750000013.GIF" wi="1745" he="137" /></maths><img file="FDA0000479985750000014.GIF" wi="702" he="100" />K<sub>pp</sub>=3k<sub>b</sub>(I<sub>xx</sub>+J<sub>xx</sub>)/4,k<sub>a</sub>、k<sub>b</sub>为衰减系数跟船型,及排水量有关,W为排水量,GM为横稳性高,B为船宽,d为吃水深度,L为船长,g为重力加速度;(2)采集横摇角信号<img file="FDA0000479985750000015.GIF" wi="74" he="57" />(3)获取横摇角速度信号<img file="FDA0000479985750000016.GIF" wi="74" he="68" />取高增益观测器增益p<sup>‑1</sup>(θ)C<sub>0</sub><sup>T</sup>=[2θ,θ<sup>2</sup>]<sup>T</sup>,设定参数θ值;高增益观测器状态为:<maths num="0004" id="cmaths0004"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><mover><mi>x</mi><mover><mo>&OverBar;</mo><mo>&CenterDot;</mo></mover></mover><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msub><mi>a</mi><mn>3</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>3</mn></msub></mtd><mtd><msub><mi>a</mi><mn>1</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>1</mn></msub></mtd></mtr></mtable></mfenced><mover><mi>x</mi><mo>&OverBar;</mo></mover><mo>+</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mrow><mo>(</mo><mi>b</mi><mo>+</mo><mi>&Delta;b</mi><mo>)</mo></mrow><mi>u</mi><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>2</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>2</mn></msub><mo>)</mo></mrow><mo>|</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>|</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>4</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>4</mn></msub><mo>)</mo></mrow><msubsup><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn><mn>3</mn></msubsup><mo>-</mo><msup><mi>p</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mrow><mo>(</mo><mi>&theta;</mi><mo>)</mo></mrow><msup><mi>C</mi><mi>T</mi></msup><mrow><mo>(</mo><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>-</mo><mi>y</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mover><mi>x</mi><mo>&OverBar;</mo></mover></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000479985750000017.GIF" wi="1948" he="325" /></maths>其中,“‑”代表观测,<img file="FDA0000479985750000018.GIF" wi="105" he="68" />为非线性项,p<sup>‑1</sup>(θ)C<sub>0</sub><sup>T</sup>=[2θ,θ<sup>2</sup>]<sup>T</sup>,具有观测器系统为:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mover><mi>x</mi><mover><mo>&OverBar;</mo><mo>&CenterDot;</mo></mover></mover><mn>1</mn></msub><mo>=</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>-</mo><mn>2</mn><mi>&theta;&epsiv;</mi></mtd></mtr><mtr><mtd><msub><mover><mi>x</mi><mover><mo>&OverBar;</mo><mo>&CenterDot;</mo></mover></mover><mn>2</mn></msub><mo>=</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>1</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>1</mn></msub><mo>)</mo></mrow><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>2</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>2</mn></msub><mo>)</mo></mrow><mo>|</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>|</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>3</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>3</mn></msub><mo>)</mo></mrow><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn></msub><mrow><mo>(</mo><msub><mi>a</mi><mn>4</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>4</mn></msub><mo>)</mo></mrow><msubsup><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn><mn>3</mn></msubsup><mo>+</mo><mrow><mo>(</mo><mi>b</mi><mo>+</mo><mi>&Delta;b</mi><mo>)</mo></mrow><msub><mi>u</mi><mi>r</mi></msub><mrow><mo>(</mo><mover><mi>x</mi><mo>&OverBar;</mo></mover><mo>)</mo></mrow><mo>-</mo><msup><mi>&theta;</mi><mn>2</mn></msup><mi>&epsiv;</mi></mtd></mtr><mtr><mtd><mi>&epsiv;</mi><mo>=</mo><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>-</mo><mi>y</mi></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000479985750000019.GIF" wi="1811" he="259" /></maths>(4)设定控制器参数初值k<sub>1</sub>,k<sub>2</sub>,以期望横摇角<img file="FDA00004799857500000110.GIF" wi="91" he="57" />横摇角<img file="FDA00004799857500000111.GIF" wi="38" he="54" />及横摇角速度<img file="FDA00004799857500000112.GIF" wi="44" he="68" />为输入信号,计算舵减摇回路的控制输出u<sub>1</sub>,<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><msub><mi>u</mi><mn>1</mn></msub><mrow><mo>(</mo><mover><mi>x</mi><mo>&OverBar;</mo></mover><mo>)</mo></mrow><mo>=</mo><mo>-</mo><mfrac><mn>1</mn><mrow><mi>b</mi><mo>&PlusMinus;</mo><msub><mi>b</mi><mn>1</mn></msub></mrow></mfrac><mrow><mo>(</mo><msub><mi>k</mi><mn>0</mn></msub><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn></msub><mo>+</mo><msub><mi>k</mi><mn>1</mn></msub><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>1</mn></msub><mo>&PlusMinus;</mo><msub><mi>m</mi><mn>1</mn></msub><mo>)</mo></mrow><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>2</mn></msub><mo>&PlusMinus;</mo><msub><mi>m</mi><mn>2</mn></msub><mo>)</mo></mrow><mo>|</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>|</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>3</mn></msub><mo>&PlusMinus;</mo><msub><mi>m</mi><mn>3</mn></msub><mo>)</mo></mrow><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>4</mn></msub><mo>&PlusMinus;</mo><msub><mi>m</mi><mn>4</mn></msub><mo>)</mo></mrow><msubsup><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn><mn>3</mn></msubsup><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA00004799857500000113.GIF" wi="1771" he="138" /></maths>得到基于解析模型预测控制设计的船舶舵减横摇控制系统为:<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mover><mi>x</mi><mover><mo>&OverBar;</mo><mo>&CenterDot;</mo></mover></mover><mn>1</mn></msub><mo>=</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>-</mo><mn>2</mn><mi>&theta;&epsiv;</mi></mtd></mtr><mtr><mtd><msub><mover><mi>x</mi><mover><mo>&OverBar;</mo><mo>&CenterDot;</mo></mover></mover><mn>2</mn></msub><mo>=</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>1</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>1</mn></msub><mo>)</mo></mrow><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>2</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>2</mn></msub><mo>)</mo></mrow><mo>|</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>|</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>3</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>3</mn></msub><mo>)</mo></mrow><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>4</mn></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>a</mi><mn>4</mn></msub><mo>)</mo></mrow><msubsup><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn><mn>3</mn></msubsup><mo>+</mo><mrow><mo>(</mo><mi>b</mi><mo>+</mo><mi>&Delta;b</mi><mo>)</mo></mrow><msub><mi>u</mi><mi>r</mi></msub><mrow><mo>(</mo><mover><mi>x</mi><mo>&OverBar;</mo></mover><mo>)</mo></mrow><mo>+</mo><mi>w</mi><mo>-</mo><msup><mi>&theta;</mi><mn>2</mn></msup><mi>&epsiv;</mi></mtd></mtr><mtr><mtd><msub><mi>u</mi><mn>1</mn></msub><mrow><mo>(</mo><mover><mi>x</mi><mo>&OverBar;</mo></mover><mo>)</mo></mrow><mo>=</mo><mo>-</mo><mfrac><mn>1</mn><mrow><mi>b</mi><mo>&PlusMinus;</mo><msub><mi>b</mi><mn>1</mn></msub></mrow></mfrac><mrow><mo>(</mo><msub><mi>k</mi><mn>0</mn></msub><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn></msub><mo>+</mo><msub><mi>k</mi><mn>1</mn></msub><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>1</mn></msub><mo>&PlusMinus;</mo><msub><mi>m</mi><mn>1</mn></msub><mo>)</mo></mrow><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>2</mn></msub><mo>&PlusMinus;</mo><msub><mi>m</mi><mn>2</mn></msub><mo>)</mo></mrow><mo>|</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>|</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>3</mn></msub><mo>&PlusMinus;</mo><msub><mi>m</mi><mn>3</mn></msub><mo>)</mo></mrow><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>4</mn></msub><mo>&PlusMinus;</mo><msub><mi>m</mi><mn>4</mn></msub><mo>)</mo></mrow><msubsup><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn><mn>3</mn></msubsup><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>&epsiv;</mi><mo>=</mo><mover><mi>y</mi><mo>&OverBar;</mo></mover><mo>-</mo><mi>y</mi></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000479985750000021.GIF" wi="1758" he="358" /></maths>其中:<img file="FDA0000479985750000022.GIF" wi="46" he="49" />为x的观测值,<img file="FDA0000479985750000023.GIF" wi="334" he="159" />
地址 150001 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室