发明名称 星敏感器的三轴精度表述与测量方法
摘要 本发明公开了一种星敏感器的三轴精度表述与测量方法,包括:1)根据实际拍摄时刻(T+Δt)和导航星在(T+Δt)时刻地固坐标系(v<sub>TRF</sub>)下的方向矢量获得的最优姿态矩阵(A<sub>q</sub>(T+Δt))来确定星敏感器的三轴指向矢量p(T+Δt);2)将获得的星敏感器三轴指向矢量p(T+Δt)用行向量表示为p(T+Δt)=[px(T+Δt),py(T+Δt),pz(T+Δt)];3)根据星敏感器三轴指向矢量的行向量,获得三轴的最优矢量p<sub>opt</sub>(T+Δt);4)根据星敏感器三轴最优指向矢量p<sub>opt</sub>(T+Δt)和不同时刻(T+Δt<sub>i</sub>)的三轴指向矢量p(T+Δt<sub>i</sub>),得到余弦矩阵C;5)根据余弦矩阵C,进一步获得(T+Δt<sub>i</sub>)时刻星敏感器三个最优指向矢量与三轴矢量各自的夹角(α<sub>i</sub>,β<sub>i</sub>,ε<sub>i</sub>);6)根据α<sub>i</sub>,β<sub>i</sub>,ε<sub>i</sub>,得到所述星敏感器的滚转精度和指向精度。
申请公布号 CN102607597B 申请公布日期 2014.05.21
申请号 CN201210059546.5 申请日期 2012.03.08
申请人 清华大学 发明人 邢飞;孙婷;尤政
分类号 G01C25/00(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 北京清亦华知识产权代理事务所(普通合伙) 11201 代理人 黄德海
主权项 1.一种星敏感器的三轴精度表述与测量方法,包括如下步骤:1)根据实际拍摄时刻T+Δt和导航星在T+Δt时刻地固坐标系v<sub>TRF</sub>下的方向矢量获得的最优姿态矩阵A<sub>q</sub>(T+Δt)来确定星敏感器的三轴指向矢量p(T+Δt):<maths num="0001"><![CDATA[<math><mrow><mi>p</mi><mrow><mo>(</mo><mi>T</mi><mo>+</mo><mi>&Delta;t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>A</mi><mi>q</mi></msub><mrow><mo>(</mo><mi>T</mi><mo>+</mo><mi>&Delta;t</mi><mo>)</mo></mrow><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>;</mo></mrow></math>]]></maths>2)将获得的星敏感器三轴指向矢量p(T+Δt)用行向量表示为p(T+Δt)=[px(T+Δt),py(T+Δt),pz(T+Δt)]并对每一个行向量进行归一化;3)根据星敏感器三轴指向矢量的行向量,获得星敏感器X轴、Y轴和Z轴的最优矢量p<sub>opt</sub>(T+Δt),并对所述最优矢量p<sub>opt</sub>(T+Δt)的行向量进行归一化,其中,利用最小二乘法,获得星敏感器X轴、Y轴和Z轴的最优矢量p<sub>opt</sub>(T+Δt),使p<sub>opt</sub>(T+Δt)的三个行向量[px<sub>opt</sub>(T+Δt),py<sub>opt</sub>(T+Δt),pz<sub>opt</sub>(T+Δt)]分别与不同时刻T+Δt<sub>i</sub>的[px(T+Δt<sub>i</sub>),py(T+Δt<sub>i</sub>),pz(T+Δt<sub>i</sub>)]向量夹角的平方和最小,并对所述三个行向量进行归一化;4)根据星敏感器三轴最优指向矢量p<sub>opt</sub>(T+Δt)和不同时刻T+Δt<sub>i</sub>的三轴指向矢量p(T+Δt<sub>i</sub>),得到余弦矩阵C:<maths num="0002"><![CDATA[<math><mrow><mi>C</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>c</mi><mn>11</mn></msub></mtd><mtd><msub><mi>c</mi><mn>12</mn></msub></mtd><mtd><msub><mi>c</mi><mn>13</mn></msub></mtd></mtr><mtr><mtd><msub><mi>c</mi><mn>21</mn></msub></mtd><mtd><msub><mi>c</mi><mn>22</mn></msub></mtd><mtd><msub><mi>c</mi><mn>33</mn></msub></mtd></mtr><mtr><mtd><msub><mi>c</mi><mn>31</mn></msub></mtd><mtd><msub><mi>c</mi><mn>32</mn></msub></mtd><mtd><msub><mi>c</mi><mn>33</mn></msub></mtd></mtr></mtable></mfenced><mo>=</mo><msub><mi>p</mi><mi>opt</mi></msub><msup><mrow><mo>(</mo><mi>T</mi><mo>+</mo><mi>&Delta;t</mi><mo>)</mo></mrow><mi>T</mi></msup><mo>&CenterDot;</mo><mi>p</mi><mrow><mo>(</mo><mi>T</mi><mo>+</mo><mi>&Delta;</mi><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow></math>]]></maths>5)根据余弦矩阵C,进一步获得T+Δt<sub>i</sub>时刻星敏感器三个最优指向矢量与星敏感器X轴、Y轴和Z轴矢量各自的夹角α<sub>i</sub>,β<sub>i</sub>,ε<sub>i</sub>:<maths num="0003"><![CDATA[<math><mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>&alpha;</mi><mi>i</mi></msub></mtd></mtr><mtr><mtd><msub><mi>&beta;</mi><mi>i</mi></msub></mtd></mtr><mtr><mtd><msub><mi>&epsiv;</mi><mi>i</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>arccos</mi><mrow><mo>(</mo><mo>|</mo><msub><mi>c</mi><mn>11</mn></msub><mo>|</mo><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>arccos</mi><mrow><mo>(</mo><mo>|</mo><msub><mi>c</mi><mn>22</mn></msub><mo>|</mo><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>arccos</mi><mrow><mo>(</mo><mo>|</mo><msub><mi>c</mi><mn>33</mn></msub><mo>|</mo><mo>)</mo></mrow></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>其中α<sub>i</sub>,β<sub>i</sub>,ε<sub>i</sub>均在<img file="FDA0000455730150000014.GIF" wi="185" he="115" />的范围内;6)将α<sub>i</sub>,β<sub>i</sub>,ε<sub>i</sub>统一用θ<sub>i</sub>表示,σ由以下公式表示:<maths num="0004"><![CDATA[<math><mrow><mi>&sigma;</mi><mo>=</mo><msqrt><mfrac><mrow><munderover><mi>&Sigma;</mi><mn>0</mn><mi>n</mi></munderover><msubsup><mi>&theta;</mi><mi>i</mi><mn>2</mn></msubsup></mrow><mrow><mi>n</mi><mo>-</mo><mn>1</mn></mrow></mfrac></msqrt></mrow></math>]]></maths>将α<sub>i</sub>,β<sub>i</sub>,ε<sub>i</sub>分别代入式中θ<sub>i</sub>以得到σ<sub>X</sub>,σ<sub>Y</sub>,σ<sub>Z</sub>,并基于所获得的σ<sub>X</sub>,σ<sub>Y</sub>,σ<sub>Z</sub>作为所述星敏感器的精度评价标准。
地址 100084 北京市海淀区100084-82信箱