发明名称 基于耗散理论的TORA系统自适应控制方法
摘要 基于耗散理论的TORA系统自适应控制方法。该方法包括:选取一种旋转小球可在竖直平面内转动的双自旋航天器的简化模型;根据所选系统模型确定系统的控制目标;最终提出一种自适应控制方法,可镇定控制转动小球和平移振荡小车,同时能够在线估计系统的未知参数。相比已有的控制方法,该方法不仅能够达到控制TORA系统的目的,而且可在线估计系统的未知参数,简单易行,减少了调节增益的时间,大大提高了系统的控制效率。
申请公布号 CN104199291A 申请公布日期 2014.12.10
申请号 CN201410391120.9 申请日期 2014.08.11
申请人 浙江工业大学 发明人 武宪青;欧县华;何熊熊
分类号 G05B13/04(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 杭州天正专利事务所有限公司 33201 代理人 王兵;黄美娟
主权项 基于耗散理论的TORA系统自适应控制方法,包括以下步骤:步骤1、被控系统的选取;对于已有的双自旋航天器的简化模型主要有:旋转小球可在水平面内转动、旋转小球可在竖直平面内转动、旋转小球沿斜平面转动等模型;所考虑的模型为旋转小球可在竖直平面内转动的双自旋航天器的简化模型;该简化模型由可驱动的旋转小球和一个与弹簧连接的移动小车组成为,小球在电机驱动力的作用下可在竖直平面内转动,称该模型为TORA系统,该系统的动力学模型表示如下:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mrow><mo>(</mo><mi>M</mi><mo>+</mo><mi>m</mi><mo>)</mo></mrow><mover><mi>x</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>+</mo><mi>mr</mi><mover><mi>&theta;</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>cos</mi><mi>&theta;</mi><mo>-</mo><mi>mr</mi><msup><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msup><mi>sin</mi><mi>&theta;</mi><mo>+</mo><mi>kx</mi><mo>=</mo><mn>0</mn><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000551660930000011.GIF" wi="1035" he="84" /></maths><maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mi>mr</mi><mover><mi>x</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>cos</mi><mi>&theta;</mi><mo>+</mo><mrow><mo>(</mo><msup><mi>mr</mi><mn>2</mn></msup><mo>+</mo><mi>J</mi><mo>)</mo></mrow><mover><mi>&theta;</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>+</mo><mi>mgr</mi><mi>sin</mi><mi>&theta;</mi><mo>=</mo><mi>&tau;</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000551660930000012.GIF" wi="946" he="84" /></maths>其中,M为平移小车质量;m为转动小球的质量;转动半径为r;k为弹簧的劲度系数;J为小球关于其质心的转动惯量;g表示重力加速度;x(t)和θ(t)分别是小车距离初始位置的位移和小球逆时针转离竖直向下方向的角度;t表示时间,变量后面的(t)表示该变量为关于时间的变量,为简明起见,公式中略去大部分变量中的(t);<img file="FDA0000551660930000013.GIF" wi="91" he="83" />和<img file="FDA0000551660930000014.GIF" wi="88" he="82" />分别表示转动小球的角速度和角加速度;τ(t)为作用在转动小球上的输入转矩;步骤2、控制目标的确定;对于步骤1所给出的TORA系统,控制目标是当平移振荡小车受到外界干扰时,使用一种控制方法可以通过控制旋转小球间接地控制平移振荡小车,将小车镇定到稳定点的同时旋转小球也将稳定于稳定平衡点的位置,即:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><munder><mi>lim</mi><mrow><mi>t</mi><mo>&RightArrow;</mo><mo>&infin;</mo></mrow></munder><msup><mfenced open='[' close=']'><mtable><mtr><mtd><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mi>&theta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>19</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000551660930000015.GIF" wi="1149" he="114" /></maths>其中,x(t)和θ(t)分别是小车距离初始位置的位移和小球逆时针转离竖直向下方向的角度;<img file="FDA0000551660930000016.GIF" wi="93" he="79" />和<img file="FDA0000551660930000017.GIF" wi="88" he="76" />分别表示转动小球的角速度和平移振荡小车的速度;T表示向量的转置;步骤3、能量函数的选择;为实现同时镇定平移振荡小车和旋转小球的目的,定义如下李雅普诺夫候选函数V(t):<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mi>V</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>V</mi><mn>0</mn></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><mfrac><mn>1</mn><mn>2</mn></mfrac><msub><mi>k</mi><mi>v</mi></msub><msup><mover><mi>&omega;</mi><mo>~</mo></mover><mi>T</mi></msup><msup><mi>&Gamma;</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mover><mi>&omega;</mi><mo>~</mo></mover><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>21</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000551660930000018.GIF" wi="729" he="134" /></maths>其中,V<sub>0</sub>(t)为式(11)所定义的正定函数,<img file="FDA0000551660930000021.GIF" wi="44" he="57" />表示参数估计误差;利用该李雅普诺夫提出具有在线估计功能的自适应控制方法,达到对TORA系统控制的目的;步骤4、控制律的提出;为实现步骤2所述的控制目标,基于步骤3所选择的新颖的李雅普诺夫候选函数,确定一种既能控制旋转小球又能控制平移振荡小车的自适应控制方法τ(t)如下:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mi>&tau;</mi><mo>=</mo><mfrac><mrow><msub><mrow><mo>-</mo><mi>k</mi></mrow><mi>p</mi></msub><mi>&theta;</mi><mo>-</mo><msub><mi>k</mi><mi>d</mi></msub><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mo>-</mo><msub><mi>k</mi><mi>v</mi></msub><msup><mi>Y</mi><mi>T</mi></msup><mover><mi>&omega;</mi><mo>^</mo></mover></mrow><mrow><msub><mi>k</mi><mi>E</mi></msub><mo>+</mo><msub><mi>k</mi><mi>v</mi></msub></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>17</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000551660930000022.GIF" wi="686" he="157" /></maths>其中,k<sub>E</sub>,k<sub>v</sub>,k<sub>p</sub>,k<sub>d</sub>∈R<sup>+</sup>为控制增益;Y∈R<sup>2</sup>代表已知向量,是系统的可测向量;<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mover><mi>&omega;</mi><mo>^</mo></mover><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mover><mi>&omega;</mi><mo>^</mo></mover><mn>1</mn></msub></mtd><mtd><msub><mover><mi>&omega;</mi><mo>^</mo></mover><mn>2</mn></msub></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>&Element;</mo><msup><mi>R</mi><mn>2</mn></msup></mrow>]]></math><img file="FDA0000551660930000023.GIF" wi="406" he="91" /></maths>表示对系统参数ω的估计,它由以下自适应机制来在线更新:<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><mover><mi>&omega;</mi><mover><mo>^</mo><mo>&CenterDot;</mo></mover></mover><mo>=</mo><mi>&Gamma;Y</mi><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>18</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000551660930000024.GIF" wi="398" he="86" /></maths>其中,<img file="FDA0000551660930000025.GIF" wi="56" he="78" />为估计向量<img file="FDA0000551660930000026.GIF" wi="54" he="66" />关于时间的导数;Γ=diag{γ<sub>1</sub>,γ<sub>2</sub>}表示更新增益矩阵,<img file="FDA0000551660930000027.GIF" wi="213" he="73" />代表控制增益;所提出的自适应机制可在线估计不可驱动小车质量、转动小球质量和弹簧的劲度系数等系统参数,克服了现有技术的不足;步骤5、控制方法的实现;通过借助传感器在线获取小球的旋转角度θ(t),角速度<img file="FDA0000551660930000028.GIF" wi="125" he="73" />小车的位移x(t)以及小车的速度<img file="FDA0000551660930000029.GIF" wi="115" he="69" />根据控制律(17)实时计算出相应的控制信号,控制TORA系统中旋转小球的转矩,实现控制的目标。
地址 310014 浙江省杭州市下城区潮王路18号
您可能感兴趣的专利