发明名称 适用于卫星姿态控制的干扰力矩辨识方法
摘要 适用于卫星姿态控制的干扰力矩辨识方法,属于航天器姿态控制技术领域。为了解决传统滤波算法无法在高精度姿态控制任务中分离测量噪声和干扰力矩的问题。所述方法包括如下步骤:步骤一、根据待辨识的卫星姿态控制系统,建立带有未知干扰力矩的小量化的卫星姿态控制系统模型;步骤二、根据步骤一建立的卫星姿态控制系统模型获得未知输入观测器,采用获得的未知输入观测器估计包含噪声的干扰力矩;步骤三、采用离散傅里叶变换和离散傅里叶反变换来离线处理步骤二估计的包含噪声的干扰力矩,获得去除噪声后的干扰力矩的估计结果;步骤四、对步骤三中的估计结果采用傅里叶级数拟合得到干扰力矩的数学表达式。它用于在轨卫星进行姿态控制。
申请公布号 CN104503233B 申请公布日期 2017.04.12
申请号 CN201410705776.3 申请日期 2014.11.27
申请人 哈尔滨工业大学 发明人 陈雪芹;孙瑞;李诚良;宋道喆;易涛;曾奎;盛靖;耿云海
分类号 G05B13/04(2006.01)I;G05D1/08(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 哈尔滨市松花江专利商标事务所 23109 代理人 岳昕
主权项 适用于卫星姿态控制的干扰力矩辨识方法,所述方法包括如下步骤:步骤一、根据待辨识的卫星姿态控制系统,建立带有未知干扰力矩的小量化的卫星姿态控制系统模型;步骤二、根据步骤一建立的卫星姿态控制系统模型获得未知输入观测器,采用获得的未知输入观测器估计包含噪声的干扰力矩;步骤三、采用离散傅里叶变换和离散傅里叶反变换来离线处理步骤二估计的包含噪声的干扰力矩,获得去除噪声后的干扰力矩的估计结果;步骤四、对步骤三中的估计结果采用傅里叶级数拟合得到干扰力矩的数学表达式;其特征在于,所述步骤一中,根据待辨识的卫星姿态控制系统,建立带有未知干扰力矩的小量化的卫星姿态控制系统模型:<maths num="0001"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mi>A</mi><mi>x</mi><mo>+</mo><msub><mi>B</mi><mi>u</mi></msub><mi>u</mi><mo>+</mo><msub><mi>B</mi><mi>d</mi></msub><mi>d</mi><mo>+</mo><mi>w</mi></mrow></mtd></mtr><mtr><mtd><mrow><mi>y</mi><mo>=</mo><mi>C</mi><mi>x</mi><mo>+</mo><mi>v</mi></mrow></mtd></mtr></mtable><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001171143760000011.GIF" wi="1110" he="135" /></maths>其中,卫星姿态控制系统状态矩阵<img file="FDA0001171143760000012.GIF" wi="494" he="157" />输入矩阵<img file="FDA0001171143760000013.GIF" wi="302" he="151" />输入矩阵<img file="FDA0001171143760000014.GIF" wi="307" he="151" />观测矩阵C=I<sub>6×6</sub>,所述卫星姿态控制系统扰动w和测量噪声v为彼此不相关的零均值白噪声;卫星姿态控制系统输入量u是3维矢量,卫星姿态控制系统干扰量d是3维矢量;系统状态量x是6维矢量,<img file="FDA0001171143760000015.GIF" wi="645" he="69" />其中<img file="FDA0001171143760000016.GIF" wi="245" he="71" />是卫星欧拉角,[ω<sub>x</sub> ω<sub>y</sub> ω<sub>z</sub>]<sup>T</sup>是卫星姿态相对参考坐标系的转动角速度在xyz星体坐标系中的表示,<img file="FDA0001171143760000017.GIF" wi="37" he="45" />为x的导数;系统输出量y是6维矢量,是系统状态量x的测量量;上式中,<maths num="0002"><math><![CDATA[<mrow><msub><mi>A</mi><mn>0</mn></msub><mo>=</mo><msubsup><mi>&omega;</mi><mn>0</mn><mn>2</mn></msubsup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mn>4</mn><mrow><mo>(</mo><msub><mi>I</mi><mn>2</mn></msub><mo>-</mo><msub><mi>I</mi><mn>3</mn></msub><mo>)</mo></mrow></mrow></mtd><mtd><mrow></mrow></mtd><mtd><mrow></mrow></mtd></mtr><mtr><mtd><mrow></mrow></mtd><mtd><mrow><mn>3</mn><mrow><mo>(</mo><msub><mi>I</mi><mn>1</mn></msub><mo>-</mo><msub><mi>I</mi><mn>3</mn></msub><mo>)</mo></mrow></mrow></mtd><mtd><mrow></mrow></mtd></mtr><mtr><mtd><mrow></mrow></mtd><mtd><mrow></mrow></mtd><mtd><mrow><msub><mi>I</mi><mn>2</mn></msub><mo>-</mo><msub><mi>I</mi><mn>1</mn></msub></mrow></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0001171143760000018.GIF" wi="790" he="223" /></maths><maths num="0003"><math><![CDATA[<mrow><msub><mi>A</mi><mn>1</mn></msub><mo>=</mo><msub><mi>&omega;</mi><mn>0</mn></msub><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow></mrow></mtd><mtd><mrow></mrow></mtd><mtd><mrow><mo>-</mo><msub><mi>I</mi><mn>1</mn></msub><mo>+</mo><msub><mi>I</mi><mn>2</mn></msub><mo>-</mo><msub><mi>I</mi><mn>3</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>I</mi><mn>1</mn></msub><mo>-</mo><msub><mi>I</mi><mn>2</mn></msub><mo>+</mo><msub><mi>I</mi><mn>3</mn></msub></mrow></mtd><mtd><mrow></mrow></mtd><mtd><mrow></mrow></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0001171143760000019.GIF" wi="766" he="223" /></maths>A<sub>2</sub>=I<sub>b</sub>,G<sub>d</sub>=G<sub>u</sub>=I<sub>3×3</sub>其中,[0 ‑ω<sub>0</sub> 0]<sup>T</sup>为卫星运动的牵连角速度,I<sub>3×3</sub>为3×3阶的单位阵;I<sub>b</sub>是卫星转动惯量矩阵,定义为<maths num="0004"><math><![CDATA[<mrow><msub><mi>I</mi><mi>b</mi></msub><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>I</mi><mn>1</mn></msub></mtd><mtd><mrow><mo>-</mo><msub><mi>I</mi><mn>12</mn></msub></mrow></mtd><mtd><mrow><mo>-</mo><msub><mi>I</mi><mn>13</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>I</mi><mn>12</mn></msub></mrow></mtd><mtd><msub><mi>I</mi><mn>2</mn></msub></mtd><mtd><mrow><mo>-</mo><msub><mi>I</mi><mn>23</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>I</mi><mn>13</mn></msub></mrow></mtd><mtd><mrow><mo>-</mo><msub><mi>I</mi><mn>23</mn></msub></mrow></mtd><mtd><msub><mi>I</mi><mn>3</mn></msub></mtd></mtr></mtable></mfenced><mo>.</mo></mrow>]]></math><img file="FDA0001171143760000021.GIF" wi="490" he="224" /></maths>。
地址 150001 黑龙江省哈尔滨市南岗区西大直街92号