[發(fā)明專利]一種星敏感器定姿星矢量權(quán)值實時分配方法

有效

• 申請?zhí)枺?/td>: 201710864352.5
• 申請日: 2017-09-22
• 公開（公告）號: CN107861919B
• 公開（公告）日: 2021-03-26
• 發(fā)明（設(shè)計）人: 李新鵬;孫少勇;鄭循江;王燕清;金荷
• 申請（專利權(quán)）人: 上海航天控制技術(shù)研究所
• 主分類號: G06F17/16
• 分類號: G06F17/16;G01C21/02;G01C21/24
• 代理公司: 中國航天科技專利中心 11009
• 代理人: 陳鵬

1.一種星敏感器定姿星矢量權(quán)值實時分配方法，其特征在于，包括以下步驟：

S1、根據(jù)定姿星觀測矢量W_i，參考矢量V_i和星矢量權(quán)值其中i＝1,2,…,n，n為定姿星顆數(shù)，首次解算先驗姿態(tài)四元數(shù)

S2、根據(jù)首次解算的先驗姿態(tài)四元數(shù)解算先驗姿態(tài)矩陣A；

S3、根據(jù)定姿星觀測矢量W_i，參考矢量V_i和先驗姿態(tài)矩陣A計算星矢量誤差

S4、根據(jù)星矢量誤差計算動態(tài)權(quán)值a_i；

S5、根據(jù)定姿星觀測矢量W_i，參考矢量V_i和動態(tài)權(quán)值a_i二次迭代解算姿態(tài)四元數(shù)q；

在步驟S3中，根據(jù)等式來計算星矢量誤差

2.根據(jù)權(quán)利要求1所述的星敏感器定姿星矢量權(quán)值實時分配方法，其特征在于，在步驟S1中，根據(jù)定姿星觀測矢量W_i，參考矢量V_i，和星矢量權(quán)值使用QUEST方法解算先驗姿態(tài)四元數(shù)

3.根據(jù)權(quán)利要求2所述的星敏感器定姿星矢量權(quán)值實時分配方法，其特征在于，在步驟S2中，先驗姿態(tài)矩陣

4.根據(jù)權(quán)利要求1所述的星敏感器定姿星矢量權(quán)值實時分配方法，其特征在于，在步驟S4中，根據(jù)等式來計算動態(tài)權(quán)值a_i。

5.根據(jù)權(quán)利要求1所述的星敏感器定姿星矢量權(quán)值實時分配方法，其特征在于，在步驟S5中，根據(jù)定姿星觀測矢量W_i，參考矢量V_i和動態(tài)權(quán)值a_i使用QUEST方法進(jìn)行二次迭代解算姿態(tài)四元數(shù)q。

6.一種存儲了指令的計算機(jī)可讀介質(zhì)，其特征在于，當(dāng)所述指令被至少一個處理器執(zhí)行時，使得所述至少一個處理器執(zhí)行以下步驟：

S1、根據(jù)定姿星觀測矢量W_i，參考矢量V_i和星矢量權(quán)值其中i＝1,2,…,n，n為定姿星顆數(shù)，使用QUEST方法首次解算先驗姿態(tài)四元數(shù)

S2、根據(jù)首次解算的先驗姿態(tài)四元數(shù)解算先驗姿態(tài)矩陣A；

S3、根據(jù)定姿星觀測矢量W_i，參考矢量V_i和姿態(tài)矩陣A計算星矢量誤差

S4、根據(jù)矢量誤差計算動態(tài)權(quán)值a_i；

S5、根據(jù)定姿星觀測矢量W_i，參考矢量V_i和動態(tài)權(quán)值a_i使用QUEST方法進(jìn)行二次迭代解算姿態(tài)四元數(shù)q；

在步驟S3中，根據(jù)等式來計算星矢量誤差

7.根據(jù)權(quán)利要求6所述的存儲了指令的計算機(jī)可讀介質(zhì)，其特征在于，在步驟S2中，先驗姿態(tài)矩陣

8.根據(jù)權(quán)利要求6所述的存儲了指令的計算機(jī)可讀介質(zhì)，其特征在于，在步驟S4中，根據(jù)等式來計算動態(tài)權(quán)值a_i。