发明名称 一种利用零运动避免单框架控制力矩陀螺群框架轴转速死区的方法
摘要 一种利用零运动避免单框架控制力矩陀螺群框架轴转速死区的方法,本发明涉及航天器姿态控制技术领域。本发明是要解决由SGCMG框架轴的最小转速引起的力矩输出误差大、控制精度低的问题。步骤一、产生指令力矩T<sub>c</sub>所需要的SGCMGs框架轴转速<img file="DDA00003104689600011.GIF" wi="29" he="50" />与零运动<img file="DDA00003104689600012.GIF" wi="51" he="64" />的表达式;步骤二、利用奇异值分解方法求取零空间的基底;步骤三、选取优化指标H;步骤四、令H取极小值,求取零空间基底坐标组成的列阵a的单位方向<img file="DDA00003104689600013.GIF" wi="53" he="48" />步骤五、求取基底坐标组成的列阵a的幅值a;步骤六、构造零空间基底坐标组成的列阵a的翻转策略;步骤七、根据已经求出的坐标值a与步骤六构造的a的翻转策略求出SGCMGs的零运动<img file="DDA00003104689600014.GIF" wi="77" he="64" />本发明应用于航天器姿态控制技术领域。
申请公布号 CN103235515B 申请公布日期 2016.01.20
申请号 CN201310148114.6 申请日期 2013.04.25
申请人 哈尔滨工业大学 发明人 耿云海;侯志立;李诚良
分类号 G05B13/04(2006.01)I;G05D1/08(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 哈尔滨市松花江专利商标事务所 23109 代理人 金永焕
主权项 一种利用零运动避免单框架控制力矩陀螺群框架轴转速死区的方法,其特征在于利用零运动避免单框架控制力矩陀螺群框架轴转速死区的方法具体过程如下:步骤一、产生指令力矩T<sub>c</sub>所需要的SGCMGs框架轴转速<img file="FDA0000767071120000011.GIF" wi="47" he="73" />与零运动<img file="FDA0000767071120000012.GIF" wi="64" he="81" />的表达式:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><mover><mi>&delta;</mi><mo>&CenterDot;</mo></mover><mo>=</mo><msup><mi>A</mi><mi>T</mi></msup><msup><mrow><mo>(</mo><msup><mi>AA</mi><mi>T</mi></msup><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><msub><mi>T</mi><mi>c</mi></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>E</mi><mi>n</mi></msub><mo>-</mo><msup><mi>A</mi><mi>T</mi></msup><msup><mrow><mo>(</mo><msup><mi>AA</mi><mi>T</mi></msup><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mi>A</mi><mo>)</mo></mrow><mi>d</mi></mtd></mtr><mtr><mtd><msub><mover><mi>&delta;</mi><mo>&CenterDot;</mo></mover><mi>N</mi></msub><mo>=</mo><mrow><mo>(</mo><msub><mi>E</mi><mi>n</mi></msub><mo>-</mo><msup><mi>A</mi><mi>T</mi></msup><msup><mrow><mo>(</mo><msup><mi>AA</mi><mi>T</mi></msup><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mi>A</mi><mo>)</mo></mrow><mi>d</mi></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000767071120000013.GIF" wi="1353" he="220" /></maths>式中,A为SGCMGs的雅克比矩阵,由SGCMGs的安装形式决定,<img file="FDA0000767071120000014.GIF" wi="295" he="106" />是由SGCMGs框架角转速组成的n维列阵,n是大于3的整数;式中,<img file="FDA0000767071120000015.GIF" wi="62" he="83" />是n维列阵,代表SGCMGs零运动的大小,<img file="FDA0000767071120000016.GIF" wi="65" he="81" />存在与否不影响SGCMGs输出力矩大小,E<sub>n</sub>是n维的单位矩阵,d是由任意常值组成的n维列阵,d决定了SGCMGs零运动的大小与方向;步骤二、利用奇异值分解方法求取零空间的基底;步骤三、以SGCMGs的零运动远离0为原则,选取优化指标H;步骤四、令H取极小值,求取零空间基底坐标组成的列阵a的单位方向<img file="FDA0000767071120000017.GIF" wi="68" he="69" />步骤五、以<img file="FDA0000767071120000018.GIF" wi="44" he="76" />每个元素都大于最小转速<img file="FDA0000767071120000019.GIF" wi="86" he="93" />为原则,求取零空间基底坐标组成的列阵a的幅值a;步骤六、构造零空间基底坐标组成的列阵a的翻转策略;步骤七、根据已经求出的坐标值a与步骤六构造的a的翻转策略求出SGCMGs的零运动<img file="FDA00007670711200000110.GIF" wi="90" he="85" />根据a求取d的值,具体表达式为<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mi>d</mi><mo>=</mo><msup><mi>V</mi><mi>T</mi></msup><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mn>0</mn><mrow><mn>3</mn><mo>&times;</mo><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><mi>a</mi></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00007670711200000111.GIF" wi="1039" he="158" /></maths>式中,0<sub>3×1</sub>为3×1的零矩阵;根据d与式(1)可以求出<img file="FDA00007670711200000112.GIF" wi="88" he="81" />将式(2)带入式(1)可以得到<img file="FDA00007670711200000113.GIF" wi="61" he="85" />的表达式为<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mover><mi>&delta;</mi><mo>&CenterDot;</mo></mover><mi>N</mi></msub><mo>=</mo><mrow><mo>(</mo><msub><mi>E</mi><mi>n</mi></msub><mo>-</mo><msup><mi>A</mi><mi>T</mi></msup><msup><mrow><mo>(</mo><msup><mi>AA</mi><mi>T</mi></msup><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mi>A</mi><mo>)</mo></mrow><msup><mi>V</mi><mi>T</mi></msup><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mn>0</mn><mrow><mn>3</mn><mo>&times;</mo><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><mi>a</mi></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00007670711200000114.GIF" wi="1261" he="159" /></maths>式中,V为n×n的矩阵,V是对A进行奇异值分解得到酉矩阵,其各行对应A<sup>T</sup>A的特征向量。
地址 150001 黑龙江省哈尔滨市南岗区西大直街92号