CN112082574B - 星敏感器的校正方法及系统 - Google Patents
星敏感器的校正方法及系统 Download PDFInfo
- Publication number
- CN112082574B CN112082574B CN202010923915.5A CN202010923915A CN112082574B CN 112082574 B CN112082574 B CN 112082574B CN 202010923915 A CN202010923915 A CN 202010923915A CN 112082574 B CN112082574 B CN 112082574B
- Authority
- CN
- China
- Prior art keywords
- star
- matrix
- sensitive
- sensor
- satellite
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000012937 correction Methods 0.000 title claims abstract description 137
- 238000000034 method Methods 0.000 title claims abstract description 40
- 239000011159 matrix material Substances 0.000 claims abstract description 140
- 238000005259 measurement Methods 0.000 claims abstract description 112
- 238000009434 installation Methods 0.000 claims abstract description 98
- 230000003287 optical effect Effects 0.000 claims abstract description 70
- 230000010354 integration Effects 0.000 claims abstract description 18
- 239000013598 vector Substances 0.000 claims description 57
- 230000035945 sensitivity Effects 0.000 claims description 35
- 238000004364 calculation method Methods 0.000 claims description 21
- 230000007704 transition Effects 0.000 claims description 9
- 238000003491 array Methods 0.000 claims description 3
- 238000004422 calculation algorithm Methods 0.000 claims description 3
- 230000008878 coupling Effects 0.000 claims description 3
- 238000010168 coupling process Methods 0.000 claims description 3
- 238000005859 coupling reaction Methods 0.000 claims description 3
- 238000009825 accumulation Methods 0.000 claims 1
- 238000010606 normalization Methods 0.000 claims 1
- 238000004088 simulation Methods 0.000 description 11
- 238000004458 analytical method Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000005096 rolling process Methods 0.000 description 3
- 230000003111 delayed effect Effects 0.000 description 2
- 238000010438 heat treatment Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000005856 abnormality Effects 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/02—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
- G01C21/025—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means with the use of startrackers
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Astronomy & Astrophysics (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
本发明提供了一种星敏感器的校正方法及系统,包括:根据星敏曝光时刻、当前定姿时刻以及陀螺测量信息进行陀螺积分,修正星敏感器测量系相对于J2000系的姿态四元素信息,校正时间延迟对星敏感器测量精度的影响;在轨实时计算星敏感器相对安装误差校正矩阵系数;根据两台星敏感器的校正时间延迟后的测量信息,以及星敏感器相对安装误差校正矩阵系数进行双星敏感器的姿态校正,以提高星敏感器绕光轴的测量精度。
Description
技术领域
本发明涉及卫星姿态确定技术领域,特别涉及一种星敏感器的校正方法及系统。
背景技术
星敏感器主要用于输出星敏测量坐标系相对于惯性系的三轴姿态,作为当前卫星姿态敏感器中,测量信息较为准确的一种敏感器,已大量在各类导航卫星、遥感卫星、通信卫星、气象卫星、天文观测卫星等卫星中得到了大量的应用,已经成为各类航天器的一种标配敏感器。星敏感器的测量误差主要包括几类:星敏感器自身的测量误差、星敏感器的时延误差、星敏感器相对于载荷或整星基准的安装误差。其中星敏感器的自身测量误差包括低频误差、高频误差和等效误差角误差,这些误差又是由于星敏的星表误差、AD转换误差、暗电流、电路散粒噪声等各种因素造成,星敏感器自身测量合成误差又表现为绕光轴误差,垂直光轴方向误差,其中绕光轴误差比垂直光轴误差大约5~20倍;星敏的时延误差是由于星敏计算姿态的曝光时刻距离当前卫星的定姿时刻存在时间延迟,该延迟在几十毫秒到几百毫秒左右,对于一些惯性定向卫星影响不明显,但对于一些对地观测定向卫星影响较大;星敏感器相对于载荷或整星基准的安装误差主要是由于机械加工、安装工艺、入轨力学冲击振动影响造成星敏感器测量系相对于载荷或整星基准存在一个安装矩阵偏差,也因此对于安装有多个星敏感器的卫星而言,其相对安装矩阵也存在安装矩阵偏差,此外星敏感器安装舱板以及星敏感器自身机械结构受到不同热环境、热梯度的影响,星敏感器测量系相对于载荷或整星基准以及星敏感器之间的相对安装矩阵是变化的,该变化表现为一个慢变低频漂移。
现有的卫星星敏感器定姿的技术中,已经考虑了通过双星敏校正星敏绕光轴方向精度的影响、通过星敏相对安装矩阵的实时校正以及星敏测量时延的校正技术,现有的双星敏校正星敏绕光轴方向精度的技术方案主要考虑星敏相对安装无误差的情况,数学仿真表明星敏间的相对安装误差存在的情况下,双星敏的定姿结果中不仅仅带有星敏的测量噪声还存在相对安装误差的分量,因此双星敏定姿时应考虑星敏相对安装误差的影响消除。另一方面,时间延迟对于双星敏的测量精度也有影响,因此在双星敏校正计算过程中还应考虑时间延迟对于双星敏定姿精度的影响。
发明内容
本发明的目的在于提供一种星敏感器的校正方法及系统,以解决现有的星敏感器的校正方法精度不足的问题。
为解决上述技术问题,本发明提供一种星敏感器的校正方法,包括:
根据星敏曝光时刻、当前定姿时刻以及陀螺测量信息进行陀螺积分,修正星敏感器测量系相对于J2000系的姿态四元素信息,校正时间延迟对星敏感器测量精度的影响;
在轨实时计算星敏感器相对安装误差校正矩阵系数;
根据两台星敏感器的校正时间延迟后的测量信息,以及星敏感器相对安装误差校正矩阵系数进行双星敏感器的姿态校正,以提高星敏感器绕光轴的测量精度。
可选的,在所述的星敏感器的校正方法中,根据星敏曝光时刻、当前定姿时刻以及陀螺测量信息进行陀螺积分,修正星敏感器测量系相对于J2000系的姿态四元素信息,校正时间延迟对星敏感器测量精度的影响包括:
将第一星敏的陀螺测量的角速度信息转化为星敏相对J2000系的角速度,进行陀螺积分,修正星敏时间延迟对星敏测量精度的影响,包括:
根据当前星上时间Tdetermine及星敏返回的曝光时间Tst计算星敏曝光时刻距离当前定姿时刻的时间差△t,则
△t=Tdetermine-Tst
将陀螺测量获得本体系相对于惯性系的角速度ωbi_b转化为该星敏测量系相对于J2000系的角速度ωmi_A:
ωmi_A=Amb_A·ωbi_b
其中:Amb_A为卫星本体系到该星敏测量系的安装矩阵,根据角速度模值,计算角度增量△θ=|ωmi_A|·△t
其中Ω为姿态四元素运动学里的耦合矩阵,由星敏测量系相对于J2000系的角速度ωmi_A确定,根据该星敏测量系相对于J2000系的姿态四元素Qmi_starA,以及陀螺积分计算校正星敏时延后的姿态四元素Qmi_A:
根据校正之后的星敏测量系相对于J2000系的姿态四元素计算J2000系到该星敏测量系的姿态矩阵Ami_A以及其转置Aim_A=Ami_A T,其中:
可选的,在所述的星敏感器的校正方法中,根据两台星敏感器的校正时间延迟后的测量信息,以及星敏感器相对安装误差校正矩阵系数进行双星敏感器的姿态校正包括:
第一星敏光轴矢量在第一星敏测量系中表示为LmA=[0 0 1]T;
第二星敏光轴矢量在第二星敏测量系中表示为LmB=[0 0 1]T;
计算J2000系中星敏的光轴矢量:
LiA=Aim_A·LmA
LiB=Aim_B·LmB
其中:
LiA为第一星敏光轴描述在J2000系下的矢量;
LiB为第二星敏光轴描述在J2000系下的矢量;
根据星敏安装矩阵校正系数矩阵AεA和AεB计算本体系中星敏的光轴矢量:
LbA=Abm_A·AεA·LmA
LbB=Abm_B·AεB·LmB
其中:
LbA为第一星敏光轴描述在卫星本体系下的矢量;
LbB为第二星敏光轴描述在卫星本体系下的矢量;
由双矢量算法计算姿态过渡矩阵:
Vi1=LiA Vb1=LbA
Vi3=Vi1×Li2 Vb3=Vb1×Lb2
Mi=[Vi1 Vi2 Vi3] Mb=[Vb1 Vb2 Vb3]
其中:
Vi1为利用第一星敏光轴描述在J2000系下的矢量;
Vi2为利用第一星敏光轴描述在J2000系下的矢量与第二星敏光轴描述在J2000系下的矢量的叉乘矢量,然后再归一化;
Vi3为利用Vi1与Vi2叉乘计算得到的矢量;
Vi1、Vi2与Vi3两两正交,共同构造得到了姿态过渡矩阵Mi;
Vb1为利用第一星敏光轴描述在卫星本体系下的矢量;
Vb2为利用第一星敏光轴描述在卫星本体系下的矢量与第二星敏光轴描述在卫星本体系下的矢量的叉乘矢量,然后再归一化;
Vb3为利用Vb1与Vb2叉乘计算得到的矢量;
Vb1、Vb2与Vb3两两正交,共同构造得到了姿态过渡矩阵Mb;
根据:Mb=AbiMi,可获得姿态矩阵计算为:
Abi=MbMi T。
可选的,在所述的星敏感器的校正方法中,在轨实时计算星敏感器相对安装误差校正矩阵系数包括:
设置其中一台星敏的安装没有误差,作为主星敏,根据两个星敏理论测量信息计算得到的卫星本体系相对于J2000系的姿态矩阵相等,计算获得另外一台星敏相对于主星敏的安装误差矩阵:
Abi_A=Abi_B
Abi_B=Abm_BAeeBAmi_B
其中,Abi_A和Abi_B分别为主星敏与另一星敏理论测量信息计算得到的卫星本体系相对J2000系的姿态矩阵;
Abm_B为另一星敏测量系到本体系的安装矩阵,AeeB为另一星敏测量系到本体系安装矩阵与真实姿态安装矩阵的误差,Ami_B为另一星敏测量系相对J2000系的姿态矩阵。
可选的,在所述的星敏感器的校正方法中,在轨实时计算星敏感器相对安装误差校正矩阵系数还包括:
根据Abi_A和Abi_B相等,则
而:
则
可选的,在所述的星敏感器的校正方法中,还包括:
在轨情况下,设置第一星敏为主星敏,获得第一星敏误差校正矩阵校正后的姿态矩阵:
Abi_A=Abm_A·AεA·Ami_A
在轨情况下,对于第一星敏安装矩阵校正,若存在载荷与第一星敏联合标定时,计算出其误差校正矩阵,则AεA非单位阵,否则AεA为单位阵;
计算第二星敏相对于第一星敏的安装矩阵误差校正系数:
计算星敏标定系数累加和:
cntSTR=cntSTR+1
判断是否更新第二星敏校正系数:
当cntSTR>=cntSTRFlag,则e1、e2、e3进行一次更新,每隔cntSTRFlag次更新一次系数,其中cntSTRFlag为标定计算次数阈值,可根据不同的时间间隔及控制周期设置;
cntSTR=0
否则,第二星敏校正系数不更新,cntSTR不清零,第二星敏校正系数初始值由地面指令上注指定或初始化为零。
本发明还提供一种星敏感器的校正系统,包括:
时间延迟校正模块,被配置为根据星敏曝光时刻、当前定姿时刻以及陀螺测量信息进行陀螺积分,修正星敏感器测量系相对于J2000系的姿态四元素信息,校正时间延迟对星敏感器测量精度的影响;
矩阵系数计算模块,被配置为在轨实时计算星敏感器相对安装误差校正矩阵系数;
绕光轴精度校正模块,被配置为根据两台星敏感器的校正时间延迟后的测量信息,以及星敏感器相对安装误差校正矩阵系数进行双星敏感器的姿态校正,以提高星敏感器绕光轴的测量精度。
在本发明提供的星敏感器的校正方法及系统中,针对星敏感器定姿,提出一种利用星敏曝光时刻、当前定姿时刻以及陀螺测量信息进行陀螺积分,修正星敏感器测量系相对于J2000系的姿态四元素信息,校正时间延迟对星敏感器测量精度的影响;然后利用两台星敏的修正时延后测量信息,以及安装误差校正矩阵进行双星敏姿态校正,改善星敏感器绕光轴的测量精度。另外提出了一种星敏感器安装误差校正矩阵系数的在轨实时计算方法,该方法可较好计算获得安装误差校正矩阵系数,且可以在轨实时校正由于星敏感器的结构热弹引起的星敏感器之间相对安装误差的慢变漂移。通过时延校正、星敏感器相对安装误差校正系数实时计算、双星敏校正进一步提高卫星姿态控制系统的姿态确定精度,避免时间延迟、结构慢变热弹、星敏绕光轴误差对姿态确定精度的影响。
附图说明
图1是本发明一实施例星敏感器的校正方法及系统示意图;
图2是本发明仿真分析:卫星对地定向情况下,修正安装矩阵和校正时延后的定姿效果;
图3是本发明仿真分析:卫星对地定向情况下,修正安装矩阵但未校正时延的定姿效果;
图4是本发明仿真分析:卫星对地定向情况下,校正时延但未修正安装矩阵时的定姿效果;
图5是本发明仿真分析:卫星对地定向情况下,星敏A定姿精度;
图6是本发明仿真分析:卫星对地定向情况下,星敏B定姿精度。
具体实施方式
以下结合附图和具体实施例对本发明提出的星敏感器的校正方法及系统作进一步详细说明。根据下面说明和权利要求书,本发明的优点和特征将更清楚。需说明的是,附图均采用非常简化的形式且均使用非精准的比例,仅用以方便、明晰地辅助说明本发明实施例的目的。
另外,除非另行说明,本发明的不同实施例中的特征可以相互组合。例如,可以用第二实施例中的某特征替换第一实施例中相对应或功能相同或相似的特征,所得到的实施例同样落入本申请的公开范围或记载范围。
本发明的核心思想在于提供一种星敏感器的校正方法及系统,以解决现有的星敏感器的校正方法精度不足的问题。
为实现上述思想,本发明提供了一种星敏感器的校正方法及系统,包括:时间延迟校正模块,被配置为根据星敏曝光时刻、当前定姿时刻以及陀螺测量信息进行陀螺积分,修正星敏感器测量系相对于J2000系的姿态四元素信息,校正时间延迟对星敏感器测量精度的影响;矩阵系数计算模块,被配置为在轨实时计算星敏感器相对安装误差校正矩阵系数;绕光轴精度校正模块,被配置为根据两台星敏感器的校正时间延迟后的测量信息,以及星敏感器相对安装误差校正矩阵系数进行双星敏感器的姿态校正,以提高星敏感器绕光轴的测量精度。
本发明涉及星敏感器姿态确定领域,特别涉及修正星敏时延、安装及敏感器间慢变误差、绕光轴误差的实时在轨校正方法。针对星敏感器定姿,提出一种利用星敏曝光时刻、当前定姿时刻以及陀螺测量信息进行陀螺积分,修正星敏感器测量系相对于J2000系的姿态四元素信息,校正时间延迟对星敏感器测量精度的影响;然后利用两台星敏的修正时延后测量信息,以及安装误差校正矩阵进行双星敏姿态校正,改善星敏感器绕光轴的测量精度。另外提出了一种星敏感器安装误差校正矩阵系数的在轨实时计算方法,该方法可较好计算获得安装误差校正矩阵系数,且可以在轨实时校正由于星敏感器的热弹引起的星敏感器之间相对安装误差的慢变漂移。通过时延校正、星敏感器相对安装误差校正系数实时计算、双星敏校正进一步提高卫星姿态控制系统的姿态确定精度,避免时间延迟、结构慢变热弹、星敏绕光轴误差对姿态确定精度的影响。
在本发明的一个实施例中,星敏感器的时间延迟校正包括:首先进行星敏时延校正(以星敏A为例),将陀螺测量得到的角速度信息转化到星敏相对J2000系的角速度,再进行陀螺积分修正星敏时间延迟对星敏测量精度的影响。
根据当前星上时间Tdetermine及星敏返回的曝光时间Tst计算星敏曝光时刻距离当前定姿时刻的时间差△t,则
△t=Tdetermine-Tst
将本体系相对于惯性系的角速度ωbi_b(陀螺测量获得)转化到星敏A测量系相对于J2000系的角速度ωmi_A,也即:
ωmi_A=Amb_A·ωbi_b
其中Amb_A为卫星本体系到星敏A测量系的安装矩阵,根据角速度模值,计算角度增量△θ=|ωmi_A|·△t
其中:Ω为姿态四元素运动学里的耦合矩阵,由星敏测量系相对于J2000系的角速度ωmi_A确定,根据星敏A原始测量四元素信息(Qmi_starA,星敏A测量系相对于J2000系的姿态四元素)和陀螺积分计算校正星敏时延后的姿态四元素Qmi_A:
利用校正之后的星敏测量系相对于J2000系的姿态四元素可以计算J2000系到星敏A测量系的姿态矩阵Ami_A以及其转置Aim_A=Ami_A T,其中:
同理可以计算星上其他各个星敏时延校正后的星敏测量系相对于J2000系的姿态四元素,以及其对应的姿态矩阵。
在本发明的一个实施例中,双星敏校正包括:以星敏AB双星敏定姿为例。
星敏A光轴矢量在星敏A测量系表示为LmA=[0 0 1]T
星敏B光轴矢量在星敏B测量系表示为LmB=[0 0 1]T
计算J2000系中星敏的光轴矢量:
LiA=Aim_A·LmA
LiB=Aim_B·LmB
其中:
LiA为第一星敏光轴描述在J2000系下的矢量;
LiB为第二星敏光轴描述在J2000系下的矢量;利用星敏安装矩阵校正系数矩阵AεA和AεB计算本体系中星敏的光轴矢量:
LbA=Abm_A·AεA·LmA
LbB=Abm_B·AεB·LmB
其中:
LbA为第一星敏光轴描述在卫星本体系下的矢量;
LbB为第二星敏光轴描述在卫星本体系下的矢量;
由双矢量算法计算姿态过渡矩阵:
Vi1=LiA Vb1=LbA
Vi3=Vi1×Li2 Vb3=Vb1×Lb2
Mi=[Vi1 Vi2 Vi3] Mb=[Vb1 Vb2 Vb3]
其中:
Vi1为利用第一星敏光轴描述在J2000系下的矢量;
Vi2为利用第一星敏光轴描述在J2000系下的矢量与第二星敏光轴描述在J2000系下的矢量的叉乘矢量,然后再归一化;
Vi3为利用Vi1与Vi2叉乘计算得到的矢量;
Vi1、Vi2与Vi3两两正交,共同构造得到了姿态过渡矩阵Mi;
Vb1为利用第一星敏光轴描述在卫星本体系下的矢量;
Vb2为利用第一星敏光轴描述在卫星本体系下的矢量与第二星敏光轴描述在卫星本体系下的矢量的叉乘矢量,然后再归一化;
Vb3为利用Vb1与Vb2叉乘计算得到的矢量;
Vb1、Vb2与Vb3两两正交,共同构造得到了姿态过渡矩阵Mb
根据:Mb=AbiMi,获得姿态矩阵计算为:
Abi=MbMi T。
在本发明的一个实施例中,星敏安装矩阵系数在轨自主校正包括:(以双星敏AB校正为例)
校正机理:
理论情况下两个星敏计算的得到的卫星本体系相对于J2000系的安装应该是相等的,因此利用这个关系式以其中一台星敏作为主星敏(假设其安装没有误差),可以计算获得另外一台星敏相对于该星敏的安装误差矩阵。
利用以下表达式:
Abi_A=Abi_B
Abi_B=Abm_BAeeBAmi_B
其中假设星敏A为主星敏,Abi_A和Abi_B分别为星敏A与星敏B理论测量信息计算得到卫星本体系相对J2000系的姿态矩阵,理论下两者是相等的,Abm_B为星敏B测量系到本体系的安装矩阵,该矩阵由于存在安装误差、结构热弹等因素与真实的姿态安装矩阵是存在差异的,而该差异表现为AeeB,Ami_B为星敏B测量系相对J2000系的姿态矩阵。
得到:
而:
可以计算得到
在本发明的一个实施例中,在轨校正,在轨情况下由于卫星结构温度变化诱发的热弹影响,星敏之间的相对安装位置存在缓慢的漂移的变化,星敏安装矩阵修正参数的在轨维护受测控圈次、地面参数计算等多种因素无法做到快速校正参数注入,实时性差,因此可以采用本发明的在轨参数自主校正方法进行在轨计算。包括:
一、在轨情况下,首先获得经过星敏A误差校正矩阵校正后的姿态矩阵。
Abi_A=Abm_A·AεA·Ami_A
在轨情况下,对于主星敏也即星敏A的安装矩阵校正,若存在载荷与星敏A联合标定时,可以计算出其误差校正矩阵,此时AεA非单位阵,否则AεA为单位阵。
二、计算星敏B相对于星敏A的安装矩阵误差校正系数:
三、计算星敏标定系数累加和:
cntSTR=cntSTR+1
四、判断是否更新星敏B校正系数:
当cntSTR>=cntSTRFlag,则e1、e2、e3进行一次更新,也即每隔cntSTRFlag次(建议约100s)更新一次系数。其中cntSTRFlag为标定计算次数阈值,可根据不同的时间间隔及控制周期设置。
cntSTR=0
否则,星敏B校正系数不更新,cntSTR不清零,星敏B校正系数初始值可由地面指令上注指定,也可以初始化为零。
需要说明的是,星敏安装校正矩阵系数的计算需要考虑星敏A与星敏B数据同时有效,且由于单一星敏定姿使用星数的不同其定姿误差也不同,其定姿精度满足的关系,也即定姿使用星数越多,定姿精度越高,因此为了使得星敏A与星敏B均在其定姿效果较好时才进行星敏B与星敏A的安装校正矩阵系数计算,星敏A与星敏B定姿使用星数需大于某一阈值后方可进行,可建议设置为8颗,当星敏定姿使用星数大于8颗后对同一星敏的定姿精度影响不大。
整个流程可以表示如图1所示:
本发明的实施例提供了仿真验证,其中仿真用例为:星敏A测量精度为X/Y向3.5角秒,Z向24角秒。
星敏A安装矩阵:
星敏A常值安装误差:[80 -80 100]角秒;
星敏A时延设置:0.25s;
星敏B测量精度:X/Y:3.5角秒,Z:24角秒;
星敏B安装矩阵:
星敏A常值安装误差:[330 460 480]角秒;
星敏A时延设置:0.2s;
星敏AB之间夹角理论夹角为72.86°。
卫星轨道高度为505km,太阳同步轨道,降交点地方时为9:30,仿真过程中卫星保持对地定向。
星敏感器仿真的结果如图2~6所示,图2为在进行星敏时间延迟以及星敏相对安装误差修正的情况下的双星敏校正,双星敏定姿的结果表明:三轴测量精度约为3.5角秒,其中星敏定姿误差定义为星敏确定的卫星本体系相对于J2000系姿态角与动力学输出的真实的卫星本体系与J2000系之间的误差,下同。
图3为仅进行星敏相对安装误差修正,但没有进行测量时间延迟校正情况下的双星敏定姿结果,双星敏定姿结果表明,滚动和偏航姿态定姿精度约为3.5角秒,但俯仰姿态定姿均值约为-46角秒,考虑到星敏A时间延迟为0.25s,星敏B时间延迟为0.2s,则时间延迟的理论值约为0.063*0.2*3600=45.36角秒,俯仰定姿结果表明,时间延迟对定姿影响与仿真结果比较接近。
图4为仅进行测量时间延迟校正,但为进行安装矩阵误差修正的双星敏定姿结果,双星敏定姿结果表明,滚动、俯仰、偏航方向均存在与轨道周期有关的误差,由于存在星敏安装矩阵误差,以及卫星维持对地定向方式,因此由于安装误差引起三轴双星敏定姿姿态会随着轨道位置周期性变化,当卫星保持惯性定向时,三轴双星敏定姿误差均表现为某一值上下浮动。
图5和图6分别为星敏A和星敏B不考虑星敏时间延迟影响和安装矩阵误差影响时的定姿结果,星敏A相对卫星正装,光轴沿卫星Y轴,星敏A惯性定姿结果中俯仰轴表现为星敏光轴的测量精度,约为24角秒,而星敏A的滚动和偏航轴不受轨道影响,定姿精度约为3.5角秒。星敏B没有相对卫星正装,其光轴方向在卫星本体系三个方向均有不为0的分量,因此卫星保持三轴对地定向时,星敏B三轴测量精度随轨道位置变化而变化。
本发明针对双星敏校正星敏绕光轴方向精度差、星敏相对安装矩阵存在误差,以及星敏存在测量时延问题,本技术方案采取了以下方式解决该问题:
一、通过星敏曝光时刻、当前定姿时刻以及陀螺信息,利用陀螺积分计算星敏感器当前定姿时刻星敏感器测量系相对于J2000系的姿态四元素,校正时延对星敏测量精度的影响;
二、通过引入星敏感器安装矩阵校正消除星敏感器间的相对安装矩阵误差,从而改善双星敏的绕光轴定姿精度,该方式还可以将从星敏的定姿精度校正为与主星敏的定姿精度一致。
三、本发明提出了一种新的相对安装矩阵误差参数得计算方式,利用了安装矩阵误差参数构造相对安装矩阵,计算精度高,从而为确保双星敏校正定姿精度不受星敏相对安装矩阵慢变漂移的影响。
本发明针对双星敏校正星敏绕光轴方向精度差、星敏相对安装矩阵存在误差,以及星敏存在测量时延问题,具有以下优点:
一、采用陀螺积分校正星敏延时,消除星敏时间延迟带来的定姿精度影响。
二、引入星敏安装矩阵校正消除星敏感器间的相对安装矩阵误差,避免星敏间相对安装误差造成对双星敏的定姿精度影响,进而确保双星敏提高绕光轴方向姿态确定精度。
三、星敏的安装矩阵修正可以在轨实时计算也可以地面上注该参数进行双星敏修正。
四、星敏的安装误差校正可实现将所有从星敏的姿态测量结果校正为与主星敏的姿态结果一致,即使仅进行单星敏定姿时,由于星敏受地气光影响、受太阳异常或自身故障引起当前星敏定姿切换为其他星敏定姿时不会发生姿态抖动及控制抖动。
五、在可进行卫星载荷及星敏联合标定的前提下,提供了主星敏相对载荷或卫星基准的相对安装矩阵误差校正接口,主星敏的安装误差校正参数可通过地面上注,其他星敏(从星敏)相对主星敏的安装误差校正参数可以实时计算,最终将所有星敏与卫星载荷或某一参考基准的相对安装矩阵误差消除,实现星上所有星敏定姿参数校正为与载荷坐标系相对J2000系的姿态四元素一致(仅带有星敏自身测量误差),然后再利用非平行双星敏定姿提高绕光轴的测量结果。
本发明提出的方案已经成功应用于多颗科学对地观测卫星的姿态确定设计中。
综上,上述实施例对星敏感器的校正方法及系统的不同构型进行了详细说明,当然,本发明包括但不局限于上述实施中所列举的构型,任何在上述实施例提供的构型基础上进行变换的内容,均属于本发明所保护的范围。本领域技术人员可以根据上述实施例的内容举一反三。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统而言,由于与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
上述描述仅是对本发明较佳实施例的描述,并非对本发明范围的任何限定,本发明领域的普通技术人员根据上述揭示内容做的任何变更、修饰,均属于权利要求书的保护范围。
Claims (6)
1.一种星敏感器的校正方法,其特征在于,包括:
根据星敏曝光时刻、当前定姿时刻以及陀螺测量信息进行陀螺积分,修正星敏感器测量系相对于J2000系的姿态四元素信息,利用陀螺积分校正星敏曝光时间相对当前定姿时刻的延迟对星敏感器测量精度的影响;
在轨实时计算星敏感器相对安装矩阵的校正系数矩阵的校正系数;
根据两台星敏感器的校正时间延迟后的测量信息,以及星敏感器安装矩阵的校正系数矩阵进行双星敏感器的姿态校正,以提高星敏感器绕光轴的测量精度;
根据星敏曝光时刻、当前定姿时刻以及陀螺测量信息进行陀螺积分,修正星敏感器测量系相对于J2000系的姿态四元素信息,校正时间延迟对星敏感器测量精度的影响包括:
将第一星敏的陀螺测量的角速度信息转化为星敏相对J2000系的角速度,进行陀螺积分,修正星敏时间延迟对星敏测量精度的影响,包括:
根据当前星上时间Tdetermine及星敏返回的曝光时间Tst计算星敏曝光时刻距离当前定姿时刻的时间差Δt,则
Δt=Tdetermine-Tst
将陀螺测量获得本体系相对于惯性系的角速度ωbi_b转化为该星敏感器测量系相对于J2000系的角速度ωmi_A:
ωmi_A=Amb_A·ωbi_b
其中:Amb_A为卫星本体系到该星敏感器测量系的安装矩阵,根据角速度模值,计算角度增量Δθ=|ωmi_A|·Δt
其中:Ω为姿态四元素运动学里的耦合矩阵,由星敏感器测量系相对于J2000系的角速度ωmi_A确定,根据星敏感器测量系相对于J2000系的姿态四元素Qmi_starA,以及陀螺积分计算校正星敏时延后的姿态四元素Qmi_A:
根据校正之后的星敏感器测量系相对于J2000系的姿态四元素Qmi_A计算J2000系到该星敏感器测量系的姿态矩阵Ami_A以及其转置Aim_A=Ami_A T,其中:
2.如权利要求1所述的星敏感器的校正方法,其特征在于,根据两台星敏感器的校正时间延迟后的测量信息,以及星敏感器安装矩阵的校正系数矩阵进行双星敏感器的姿态校正包括:
第一星敏光轴矢量在第一星敏测量系中表示为LmA=[0 0 1]T;
第二星敏光轴矢量在第二星敏测量系中表示为LmB=[0 0 1]T;
计算J2000系中星敏的光轴矢量:
LiA=Aim_A·LmA
LiB=Aim_B·LmB
其中:
LiA为第一星敏光轴描述在J2000系下的矢量;
LiB为第二星敏光轴描述在J2000系下的矢量;
根据星敏安装矩阵的校正系数矩阵AεA和AεB计算本体系中星敏的光轴矢量:
LbA=Abm_A·AεA·LmA
LbB=Abm_B·AεB·LmB
其中:
LbA为第一星敏光轴描述在卫星本体系下的矢量;
LbB为第二星敏光轴描述在卫星本体系下的矢量;
由双矢量算法计算姿态过渡矩阵:
Vi1=LiA Vb1=LbA
Vi3=Vi1×Li2 Vb3=Vb1×Lb2
Mi=[Vi1 Vi2 Vi3] Mb=[Vb1 Vb2 Vb3]
其中:
Vi1为利用第一星敏光轴描述在J2000系下的矢量;
Vi2为利用第一星敏光轴描述在J2000系下的矢量与第二星敏光轴描述在J2000系下的矢量的叉乘矢量,然后再归一化;
Vi3为利用Vi1与Vi2叉乘计算得到的矢量;
Vi1、Vi2与Vi3两两正交,共同构造得到了姿态过渡矩阵Mi;
Vb1为利用第一星敏光轴描述在卫星本体系下的矢量;
Vb2为利用第一星敏光轴描述在卫星本体系下的矢量与第二星敏光轴描述在卫星本体系下的矢量的叉乘矢量,然后再归一化;
Vb3为利用Vb1与Vb2叉乘计算得到的矢量;
Vb1、Vb2与Vb3两两正交,共同构造得到了姿态过渡矩阵Mb;
根据:Mb=AbiMi,获得姿态矩阵计算为:
Abi=MbMi T。
3.如权利要求2所述的星敏感器的校正方法,其特征在于,在轨实时计算星敏感器相对安装矩阵的校正系数矩阵的校正系数包括:
设置其中一台星敏的安装没有误差,作为主星敏,根据两个星敏理论测量信息计算得到的卫星本体系相对于J2000系的姿态矩阵相等,计算获得另外一台星敏相对于主星敏的安装矩阵的校正系数矩阵的校正系数:
Abi_A=Abi_B
Abi_B=Abm_BAeeBAmi_B
其中,Abi_A和Abi_B分别为主星敏与另一星敏理论测量信息计算得到的卫星本体系相对J2000系的姿态矩阵;
Abm_B为另一星敏感器测量系到本体系的安装矩阵,AeeB为另一星敏感器测量系到本体系安装矩阵与真实姿态安装矩阵的误差,Ami_B为另一星敏感器测量系相对J2000系的姿态矩阵。
5.如权利要求4所述的星敏感器的校正方法,其特征在于,还包括:
在轨情况下,设置第一星敏为主星敏,获得第一星敏经安装矩阵的校正系数矩阵校正后的姿态矩阵:
Abi_A=Abm_A·AεA·Ami_A
在轨情况下,对于第一星敏安装矩阵校正,若存在载荷与第一星敏联合标定时,计算出安装矩阵的校正系数矩阵AεA,AεA非单位阵,否则AεA为单位阵;
计算第二星敏相对于第一星敏的安装矩阵的校正系数矩阵的的校正系数e1 *、e* 2、e* 3:
计算安装矩阵的校正系数矩阵的的校正系数累加和:
cntSTR=cntSTR+1
判断是否更新第二星敏安装矩阵的校正系数矩阵AτB的校正系数e1、e2、e3:
当cntSTR>=cntSTRFlag,则e1、e2、e3进行一次更新,每隔cntSTRFlag次更新一次系数,其中cntSTRFlag为标定计算次数阈值,可根据不同的时间间隔及控制周期设置;
cntSTR=0
否则,第二星敏安装矩阵的校正系数矩阵AτB的校正系数e1、e2、e3不更新,cntSTR不清零,第二星敏校正系数初始值由地面指令上注指定或初始化为零。
6.一种实施如权利要求1所述方法的星敏感器的校正系统,其特征在于,包括:
时间延迟校正模块,被配置为根据星敏曝光时刻、当前定姿时刻以及陀螺测量信息进行陀螺积分,修正星敏感器测量系相对于J2000系的姿态四元素信息,利用陀螺积分校正星敏曝光时间相对当前定姿时刻的延迟对星敏感器测量精度的影响;
矩阵系数计算模块,被配置为在轨实时计算星敏感器相对安装矩阵的校正系数矩阵的校正系数;
绕光轴精度校正模块,被配置为根据两台星敏感器的校正时间延迟后的测量信息,以及星敏感器安装矩阵的校正系数矩阵进行双星敏感器的姿态校正,以提高星敏感器绕光轴的测量精度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010923915.5A CN112082574B (zh) | 2020-09-04 | 2020-09-04 | 星敏感器的校正方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010923915.5A CN112082574B (zh) | 2020-09-04 | 2020-09-04 | 星敏感器的校正方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112082574A CN112082574A (zh) | 2020-12-15 |
CN112082574B true CN112082574B (zh) | 2023-05-12 |
Family
ID=73732825
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010923915.5A Active CN112082574B (zh) | 2020-09-04 | 2020-09-04 | 星敏感器的校正方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112082574B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113063444B (zh) * | 2021-04-02 | 2024-03-15 | 北京控制工程研究所 | 亚角秒精度星敏感器光轴测量基准偏差标定方法及系统 |
CN113252075B (zh) * | 2021-05-12 | 2023-04-25 | 中国科学院微小卫星创新研究院 | 一种基于轨道周期特性的星敏感器精度修正方法 |
CN113252074B (zh) * | 2021-05-12 | 2023-04-07 | 中国科学院微小卫星创新研究院 | 一种基于双波束激光实时测量的星敏感器标定方法 |
CN113310505B (zh) * | 2021-06-15 | 2024-04-09 | 苏州挚途科技有限公司 | 传感器系统的外参标定方法、装置及电子设备 |
CN113932802B (zh) * | 2021-10-12 | 2024-05-14 | 中国科学院微小卫星创新研究院 | 多个星敏感器的优先级变更方法及系统 |
CN115290118B (zh) * | 2022-06-29 | 2024-08-30 | 西安空间无线电技术研究所 | 一种基于星敏感器的卫星激光通信系统指向误差校正方法 |
CN115675919B (zh) * | 2022-10-31 | 2024-05-31 | 北京控制工程研究所 | 一种用于卫星主动指向超静平台的在轨标定方法 |
CN117570999B (zh) * | 2023-11-17 | 2024-06-18 | 中国科学院微小卫星创新研究院 | 多个星敏感器的姿态融合方法、系统及计算机可读介质 |
CN117876889A (zh) * | 2024-02-02 | 2024-04-12 | 国家卫星气象中心(国家空间天气监测预警中心) | 一种遥感卫星仪器在轨安装矩阵人工智能订正方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103398713A (zh) * | 2013-04-26 | 2013-11-20 | 哈尔滨工程大学 | 一种星敏感器/光纤惯性设备量测数据同步方法 |
CN109000638A (zh) * | 2018-05-28 | 2018-12-14 | 哈尔滨工程大学 | 一种小视场星敏感器量测延时滤波方法 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6272432B1 (en) * | 1999-05-10 | 2001-08-07 | Hughes Electronics Corporation | System and method for correcting star tracker low spatial frequency error in stellar-inertial attitude determination systems |
US20110007167A1 (en) * | 2009-07-10 | 2011-01-13 | Starvision Technologies Inc. | High-Update Rate Estimation of Attitude and Angular Rates of a Spacecraft |
CN102865866B (zh) * | 2012-10-22 | 2015-01-28 | 哈尔滨工业大学 | 基于双星敏感器的卫星姿态确定方法及定姿误差分析方法 |
CN103674023B (zh) * | 2013-12-26 | 2014-10-15 | 中国人民解放军国防科学技术大学 | 一种基于陀螺精确角度关联的星敏感器动态测姿方法 |
CN105160125B (zh) * | 2015-09-24 | 2018-09-18 | 航天东方红卫星有限公司 | 一种星敏感器四元数的仿真分析方法 |
CN106338296B (zh) * | 2016-11-04 | 2019-03-26 | 上海航天控制技术研究所 | 一种双星敏感器在轨实时交互的修正方法 |
CN106918349A (zh) * | 2016-11-22 | 2017-07-04 | 上海航天控制技术研究所 | 星敏感器在轨相对安装误差标定系统及标定补偿方法 |
CN106896819A (zh) * | 2017-02-23 | 2017-06-27 | 上海航天控制技术研究所 | 基于三星敏感器的卫星姿态确定方法和系统 |
CN109612472B (zh) * | 2019-01-11 | 2020-08-25 | 中国人民解放军国防科技大学 | 一种深空探测器自主导航系统构建方法及装置 |
CN109945854B (zh) * | 2019-03-26 | 2020-12-25 | 上海微小卫星工程中心 | 一种基于四元数差值融合星敏感器数据的方法 |
-
2020
- 2020-09-04 CN CN202010923915.5A patent/CN112082574B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103398713A (zh) * | 2013-04-26 | 2013-11-20 | 哈尔滨工程大学 | 一种星敏感器/光纤惯性设备量测数据同步方法 |
CN109000638A (zh) * | 2018-05-28 | 2018-12-14 | 哈尔滨工程大学 | 一种小视场星敏感器量测延时滤波方法 |
Non-Patent Citations (2)
Title |
---|
Effect of dynamic model of satellite on accuracy of attitude estimation with unknown star sensor noise level;H Bolandi等;《The 2nd International Conference on Control, Instrumentation and Automation》;全文 * |
采用多敏感器相互校正的卫星入轨姿态计算方法;李笑月;熊淑杰;林宝军;;国防科技大学学报(第01期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112082574A (zh) | 2020-12-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112082574B (zh) | 星敏感器的校正方法及系统 | |
CN104792340A (zh) | 一种星敏感器安装误差矩阵与导航系统星地联合标定与校正的方法 | |
US9694918B1 (en) | Method for disturbance compensation based on sliding mode disturbance observer for spacecraft with large flexible appendage | |
US9073648B2 (en) | Star tracker rate estimation with kalman filter enhancement | |
US8583371B1 (en) | Autonomous gyro temperature calibration | |
Ivanov et al. | Analytical study of microsatellite attitude determination algorithms | |
US6691033B1 (en) | System and method for calibrating inter-star-tracker misalignments in a stellar inertial attitude determination system | |
US20150310276A1 (en) | Method for the automatic correction of alignment errors in star tracker systems | |
JP3027734B2 (ja) | 衛星の位置を機内で自主的に求める方法と装置 | |
US9643740B2 (en) | Gyroless three-axis sun acquisition using sun sensor and unscented kalman filter | |
CN102116628A (zh) | 一种着陆或附着深空天体探测器的高精度导航方法 | |
CN102621565A (zh) | 一种机载分布式pos的传递对准方法 | |
CN109708663B (zh) | 基于空天飞机sins辅助的星敏感器在线标定方法 | |
CN108387227A (zh) | 机载分布式pos的多节点信息融合方法及系统 | |
CN107246883A (zh) | 一种高精度星敏感器安装矩阵在轨实时校准方法 | |
CN107402023B (zh) | 地球静止轨道卫星星敏慢变误差预报校正的方法 | |
CN113447043B (zh) | 一种基于gnss的卫星天文导航系统误差自主标定方法及系统 | |
Zhang et al. | Stellar/inertial integrated guidance for responsive launch vehicles | |
Iwata et al. | Precision attitude determination for the advanced land observing satellite (ALOS): design, verification, and on-orbit calibration | |
CN112498747B (zh) | 深空探测器推力矢量与目标加速度偏差角计算方法及系统 | |
CN115688337A (zh) | 一种geo航天器多视线融合近场感知队形设计方法 | |
Zhang et al. | Decentralized adaptive sliding mode control for beam synchronization of tethered InSAR system | |
CN112520070B (zh) | 深空探测器推力矢量实时修正方法和系统 | |
Guecha-Ahumada et al. | Design of the Attitude Estimation Algorithms for the GT-1 CubeSat | |
Bae et al. | Algorithm theoretical basis document for precision pointing determination |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |