[發(fā)明專利]一種衛(wèi)星平臺多星敏感器姿態(tài)自適應(yīng)融合方法

有效

• 申請?zhí)枺?/td>: 202211274073.0
• 申請日: 2022-10-18
• 公開（公告）號: CN115512239B
• 公開（公告）日: 2023-10-03
• 發(fā)明（設(shè)計）人: 鄭守住;柳思聰;馬小龍;葉真;趙菲;龍騰飛;江威;張建霞;陳思明;陳紹杰
• 申請（專利權(quán)）人: 閩江學(xué)院
• 主分類號: G06V20/13
• 分類號: G06V20/13;G06V10/24;G06V10/80;G06F17/11;G06F17/18
• 代理公司: 成都正德明志知識產(chǎn)權(quán)代理有限公司 51360
• 代理人: 陳瑤

1.一種衛(wèi)星平臺多星敏感器姿態(tài)自適應(yīng)融合方法，其特征在于，包括以下步驟：

S1、根據(jù)衛(wèi)星平臺多臺星敏感器的姿態(tài)觀測信息，獲取各星敏感器坐標信息在慣性系和本體系下的矢量坐標；

S2、根據(jù)各星敏感器矢量坐標在慣性系和本體系的轉(zhuǎn)換關(guān)系，構(gòu)建星敏觀測方程；

S3、根據(jù)星敏觀測方程構(gòu)建最小二乘平差模型；

S4、求解最小二乘平差模型，得到觀測值改正數(shù)與單位權(quán)方差的關(guān)系模型；

S5、根據(jù)觀測值改正數(shù)與單位權(quán)方差的關(guān)系模型構(gòu)建Helmert方差分量估計模型；

S6、判斷Helmert方差分量估計模型是否存在負方差，若是則進入步驟S7，否則進入步驟S8；

S7、對Helmert方差分量估計模型進行動態(tài)二次規(guī)劃；

S8、判斷各單位權(quán)方差是否都小于設(shè)定閾值，若是則輸出多星敏感器姿態(tài)融合結(jié)果，否則進入步驟S9；

S9、對最小二乘平差模型進行重定權(quán)，返回步驟S4。

2.根據(jù)權(quán)利要求1所述的衛(wèi)星平臺多星敏感器姿態(tài)自適應(yīng)融合方法，其特征在于，所述步驟S2中構(gòu)建的星敏觀測方程為：

其中V_iICS表示第i臺星敏感器在慣性系下的矢量坐標，V_iBody表示第i臺星敏感器在本體系下的矢量坐標，v_3×1表示星敏感器觀測軸的觀測誤差，表示本體系到慣性系的旋轉(zhuǎn)矩陣，表示姿態(tài)四元素的標量部分，和表示姿態(tài)四元素的矢量部分，i＝1,2,...,n。

3.根據(jù)權(quán)利要求2所述的衛(wèi)星平臺多星敏感器姿態(tài)自適應(yīng)融合方法，其特征在于，所述步驟S3包括以下分步驟：

S31、將星敏觀測方程進行泰勒級數(shù)展開至一次項，得到：

其中Q₀＝[q₀₀ q₀₁ q₀₂ q₀₃]表示待求姿態(tài)四元素的初值，q₀表示待求姿態(tài)四元素的標量部分，q₁、q₂和q₃表示待求姿態(tài)四元素的矢量部分，dq₀表示待求姿態(tài)四元素標量部分的改正值，dq₁、dq₂和dq₃表示待求姿態(tài)四元素矢量部分的改正值；

S32、將步驟S31中展開的公式改寫為矩陣形式，得到最小二乘平差模型：

V＝BX-L

其中V＝[v_i1 v_i2 v_i3]^T表示觀測值的改正數(shù)，v_i1表示第i個星敏感器的x軸觀測值，v_i2表示第i個星敏感器的y軸觀測值，v_i3表示第i個星敏感器的z軸觀測值，表示誤差方程的常數(shù)項，表示待求姿態(tài)四元素改正值的系數(shù)陣，X＝[dq₀ dq₁ dq₂ dq₃]^T表示待求姿態(tài)四元素改正值的矩陣。

4.根據(jù)權(quán)利要求3所述的衛(wèi)星平臺多星敏感器姿態(tài)自適應(yīng)融合方法，其特征在于，所述步驟S4包括以下分步驟：

S41、求解最小二乘平差模型，得到：

X＝N^-1W

其中N表示法方程的系數(shù)矩陣，W表示法方程的常數(shù)項矩陣，N_i表示法方程中第i類觀測值的系數(shù)矩陣，W_i表示法方程中第i類觀測值的常數(shù)項矩陣，B_i表示第i類觀測值參數(shù)的系數(shù)陣，P_i表示第i類觀測值的權(quán)陣，L_i表示誤差方程第i類觀測值的常數(shù)項；

S42、將求解結(jié)果代入最小二乘平差模型，得到觀測值改正數(shù)與單位權(quán)方差的關(guān)系模型：

其中E(·)表示數(shù)學(xué)期望，V_i表示第i類觀測值的改正數(shù)，表示第i類觀測值的單位權(quán)方差，tr(·)表示矩陣的跡，n_i表示第i類觀測值的個數(shù)。