CN107246883A - 一种高精度星敏感器安装矩阵在轨实时校准方法 - Google Patents
一种高精度星敏感器安装矩阵在轨实时校准方法 Download PDFInfo
- Publication number
- CN107246883A CN107246883A CN201710666994.4A CN201710666994A CN107246883A CN 107246883 A CN107246883 A CN 107246883A CN 201710666994 A CN201710666994 A CN 201710666994A CN 107246883 A CN107246883 A CN 107246883A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- msubsup
- mtd
- matrix
- 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.)
- Granted
Links
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
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
一种高精度星敏感器安装矩阵在轨实时校准方法,解算实测安装关系四元数,对安装关系四元数的矢量部分进行滤波校准,采用校准后的安装关系四元数解算安装矩阵。本发明在无准确先验信息的条件下,通过量测残差序列给出滤波收敛判据,若收敛,衰减因子取1,并在线估计参数R,以避免收敛判据失效,若发散,实时解算衰减因子,调整当前拍在滤波过程中的权重,可有效解决因模型不准确导致的滤波性能下降甚至发散问题,本发明对安装矩阵进行实时校准补偿,不需存储大量的量测信息,本发明直接对安装关系四元数的矢部进行滤波,而不是三轴欧拉角,避免了反三角解算引入的误差。
Description
技术领域
本发明涉及一种高精度星敏感器安装矩阵在轨实时校准方法。
背景技术
星敏感器作为目前精度最高的姿态敏感器在航天任务中得到了广泛应用。传统星敏感器星光来自单一视场,受视场限制,星间角距较小,导致解算出的光轴方向姿态角精度比另外两轴姿态角精度低一个数量级,导致三轴姿态精度不一致。当杂散光进视场,或者受空间辐射影响时可能无法稳定可靠的输出姿态。
为了进一步提高星敏感器的性能,近年来国外出现了多视场星敏感器的概念。如法国Sodern公司的Hydra星敏感器,美国Ball公司的FSC-701星敏感器,日本三菱电机的SIS星敏感器以及德国Jena-Optroni公司的ASTRO-APS星敏感器。与单视场星敏感器相比,对多个视场的观测信息融合处理,扩大了视场角,提高了光轴方向的精度,使多探头星敏感器三轴精度一致,可靠性更高。
在多视场观测信息融合过程中,涉及到各探头之间的空间关系转换,探头之间的安装矩阵准确与否对最终的融合姿态精度起到决定性作用。在航天器发射之前,通过安装装调已经确定了星敏感器各探头之间的空间关系。受航天器发射过程中的振动,以及在轨热环境等因素的影响,各探头的安装关系并非常值。因此,实时校准探头之间的安装关系成为保证多探头星敏感器精度的关键。
星矢量融合需要对不同探头测量坐标系下的定姿星做空间配准,安装矩阵的准确性直接影响了融合姿态的精度。由各探头输出的四元数直接解算出的实测安装关系包含了不同频率的误差成分,因此不能简单的做滤波去噪,如果不作处理直接采用该值,测量误差会导致融合结果无法达到要求。
发明内容
本发明提供一种高精度星敏感器安装矩阵在轨实时校准方法,可以在轨实时校准补偿卫星的结构变形对探头之间安装矩阵的影响,具有很强的跟踪能力和自适应性,用于多探头星敏感器视场融合中的空间配准,提高融合姿态的精度。
为了达到上述目的,本发明提供一种高精度星敏感器安装矩阵在轨实时校准方法,包含以下步骤:
步骤S1、解算实测安装关系四元数;
步骤S2、对安装关系四元数的矢量部分进行滤波校准;
步骤S3、采用校准后的安装关系四元数解算安装矩阵。
在步骤S1中,选定探头A为基准头部,由实时输出的探头A,探头B的四元数qA,qB解算探头A和探头B之间的实测安装关系四元数qBA:
实测安装关系四元数qBA表示为:
由于四元数的自由度为3,只对其矢部q滤波平滑;
取线性离散系统状态为则系统方程为:
式中,k为离散时间;系统在时刻k的状态矢量xk∈R3;yk∈R3为对应状态的观测矢量;wk~N(0,Qk)为高斯分布的过程激励噪声;vk~N(0,Rk)为高斯观测噪声;D为状态转移矩阵;G为观测矩阵;由于建立的是线性模型,这里D和G取为三阶单位阵。
所述的步骤S2中,对安装关系四元数的矢量部分进行滤波校准的方法包含以下步骤:
步骤S2.1、输入线性离散系统状态量的初始值x0和协方差的初始值P0;
地面安装装调时得到安装关系四元数初值,x0取其矢部,P0任取一量级小于单位阵的非零对角阵;
步骤S2.2、进行状态一步预测:
xk|k-1=Dxk-1 (4)
步骤S2.3、计算量测残差:
vk=yk-Gxk|k-1 (5)
步骤S2.4、判断系统是否发散,若收敛判据成立,说明滤波正常,进行步骤S2.5,若收敛判据不成立,说明滤波发散,进行步骤S2.6;
所述的收敛判据为:
式中,γ为储备系数(γ≥1),γ=1是最严格的收敛判据;
步骤S2.5、令衰减因子λk=1,同时由量测残差在线估计测量噪声协方差R,进行步骤S2.7
式中,dk=(1-b)/(1-bk+1),b为遗忘因子,一般取0.95~0.99;
步骤S2.6、更新衰减因子,进行步骤S2.7;
步骤S2.7、一步预测协方差阵:
式中,Q为过程激励噪声协方差;
步骤S2.8、计算增益:
Kk=Pk|k-1GT(R+GPk|k-1GT)-1 (9)
步骤S2.9、更新状态方程:
xk=xk|k-1+Kkvk (10)
步骤S2.10、更新协方差阵:
Pk=(I3×3-KkG)Pk|k-1 (11)。
所述的步骤S2.6中,更新衰减因子的方法具体包含以下步骤:
步骤S2.6.1、根据量测残差实时调整衰减因子:
步骤S2.6.2、判断衰减因子是否满足Lk≤ω,其中,ω是星敏运行角速度,若是,进行步骤S2.6.4,若否,进行步骤S2.6.3;
步骤S2.6.3、令Lk=Lk/10,进行步骤S2.6.2;
步骤S2.6.4、令λk=1+Lk,若λk>λmax,取λk=λmax,λmax为设定的衰减因子最大值。
所述的步骤S3中,采用校准后的安装关系四元数解算安装矩阵的方法包含以下步骤:
步骤S3.1、获得滤波校准后的安装关系四元数的矢量部分:
步骤S3.2、解算安装关系四元数的标量部分:
若q0<0,则否则
步骤S3.3、根据安装关系四元数解算安装矩阵:
转换矩阵CBA由下式解得:
本发明在无准确先验信息的条件下,通过量测残差序列给出滤波收敛判据,若收敛,衰减因子取1,并在线估计参数R,以避免收敛判据失效,若发散,实时解算衰减因子,调整当前拍在滤波过程中的权重,可有效解决因模型不准确导致的滤波性能下降甚至发散问题,本发明对安装矩阵进行实时校准补偿,不需存储大量的量测信息,本发明直接对安装关系四元数的矢部进行滤波,而不是三轴欧拉角,避免了反三角解算引入的误差。
附图说明
图1是本发明提供的一种高精度星敏感器安装矩阵在轨实时校准方法的流程图。
图2是集中式星矢量融合示意图。
图3是对安装关系四元数的矢量部分进行滤波校准的方法的流程图。
图4是参数Q取不同值时的滤波结果。
图5是更新衰减因子的流程图。
图6是采用校准后的安装关系四元数解算安装矩阵的流程图。
具体实施方式
以下根据图1~图6,具体说明本发明的较佳实施例。
考虑到星敏感器在轨运行期间,受空间热环境影响,结构发生变形,本发明基于四元数自适应卡尔曼滤波原理(以下简称q-AKF),根据量测残差实时调整当前拍在滤波中的权重,避免因模型不准导致滤波性能下降甚至发散的问题。
如图1所示,本发明提供一种高精度星敏感器安装矩阵在轨实时校准方法,包含以下步骤:
步骤S1、解算实测安装关系四元数;
步骤S2、对安装关系四元数的矢量部分进行滤波校准;
步骤S3、采用校准后的安装关系四元数解算安装矩阵。
如图2所示,是集中式星矢量融合示意图,在步骤S1中,选定探头A为基准头部,由实时输出的探头A,探头B的四元数qA,qB解算探头A和探头B之间的实测安装关系四元数qBA:
由于结构变形量较小,在短时间内(10~20min以内)也可认为不变,因此可建立线性离散卡尔曼Kalman滤波模型对安装矩阵进行实时校准;
实测安装关系四元数qBA可表示为:
由于四元数的自由度为3,所以可只对其矢部滤波平滑;
取线性离散系统状态为则系统方程为:
式中,k为离散时间;系统在时刻k的状态矢量xk∈R3;yk∈R3为对应状态的观测矢量;wk~N(0,Qk)为高斯分布的过程激励噪声;vk~N(0,Rk)为高斯观测噪声;D为状态转移矩阵;G为观测矩阵;由于建立的是线性模型,这里D和G取为三阶单位阵。
如图3所示,所述的步骤S2中,对安装关系四元数的矢量部分进行滤波校准的方法包含以下步骤:
步骤S2.1、输入线性离散系统状态量的初始值x0和协方差的初始值P0;
地面安装装调时得到安装关系四元数初值,x0取其矢部,P0任取一量级小于单位阵的非零对角阵;
步骤S2.2、进行状态一步预测:
xk|k-1=Dxk-1 (4)
步骤S2.3、计算量测残差:
vk=yk-Gxk|k-1 (5)
步骤S2.4、判断系统是否发散,若收敛判据成立,说明滤波正常,进行步骤S2.5,若收敛判据不成立,说明滤波发散,进行步骤S2.6;
所述的收敛判据为:
式中,γ为储备系数(γ≥1),γ=1是最严格的收敛判据;
步骤S2.5、令衰减因子λk=1,同时,为了避免因参数R的取值不合理导致收敛判据失效,由量测残差在线估计测量噪声协方差R,进行步骤S2.7
式中,dk=(1-b)/(1-bk+1),b为遗忘因子,一般取0.95~0.99;
步骤S2.6、更新衰减因子,进行步骤S2.7;
步骤S2.7、一步预测协方差阵:
Pk|k-1=D(λk*Pk-1)DT+Q (8)
式中,Q为过程激励噪声协方差,该参数被用来表示状态转换矩阵与实际过程之间的误差,因为无法直接观测到过程信号,所以Q的取值是很难确定的,无在轨数据支撑条件下,参数Q无法准确估计,如图4所示,在Q取值接近于真实值和小于真实值的条件下,安装矩阵三轴欧拉角总能收敛于参考值,Q越接近于真实值收敛速度越快,当Q过大时,融合姿态精度降低,所以Q取值不宜过大;
步骤S2.8、计算增益:
Kk=Pk|k-1GT(R+GPk|k-1GT)-1 (9)
式中,R为测量噪声协方差,滤波器实际实现时,测量噪声协方差一般可以观测得到;
若星敏感器高频误差为Expect_Error角秒,测量噪声协方差R可由下式求出:
步骤S2.9、更新状态方程:
xk=xk|k-1+Kkvk (10)
步骤S2.10、更新协方差阵:
Pk=(I3×3-KkG)Pk|k-1 (11)。
如图5所示,所述的步骤S2.6中,更新衰减因子的方法具体包含以下步骤:
步骤S2.6.1、根据量测残差实时调整衰减因子:
步骤S2.6.2、判断衰减因子是否满足Lk≤ω,其中,ω是星敏运行角速度(ω的单位为度/秒),若是,进行步骤S2.6.4,若否,进行步骤S2.6.3;
由于结构变形量与温度变化量成正比,星敏运行角速率ω与温度变化率成正比;
步骤S2.6.3、令Lk=Lk/10,进行步骤S2.6.2;
步骤S2.6.4、令λk=1+Lk,若λk>λmax,取λk=λmax,λmax为设定的衰减因子最大值。
如图6所示,所述的步骤S3中,采用校准后的安装关系四元数解算安装矩阵的方法包含以下步骤:
步骤S3.1、获得滤波校准后的安装关系四元数的矢量部分:
步骤S3.2、解算安装关系四元数的标量部分:
若q0<0,则否则
步骤S3.3、根据安装关系四元数解算安装矩阵:
转换矩阵CBA可由下式解得:
本发明在无准确先验信息的条件下,通过量测残差序列给出滤波收敛判据,若收敛,衰减因子取1,并在线估计参数R,以避免收敛判据失效,若发散,实时解算衰减因子,调整当前拍在滤波过程中的权重,可有效解决因模型不准确导致的滤波性能下降甚至发散问题,本发明对安装矩阵进行实时校准补偿,不需存储大量的量测信息,本发明直接对安装关系四元数的矢部进行滤波,而不是三轴欧拉角,避免了反三角解算引入的误差。
本发明可以在轨实时校准补偿卫星的结构变形对探头之间安装矩阵的影响,具有很强的跟踪能力和自适应性,用于多探头星敏感器视场融合中的空间配准,提高融合姿态的精度。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (5)
1.一种高精度星敏感器安装矩阵在轨实时校准方法,其特征在于,包含以下步骤:
步骤S1、解算实测安装关系四元数;
步骤S2、对安装关系四元数的矢量部分进行滤波校准;
步骤S3、采用校准后的安装关系四元数解算安装矩阵。
2.如权利要求1所述的高精度星敏感器安装矩阵在轨实时校准方法,其特征在于,在步骤S1中,选定探头A为基准头部,由实时输出的探头A,探头B的四元数qA,qB解算探头A和探头B之间的实测安装关系四元数qBA:
<mrow>
<msub>
<mi>q</mi>
<mrow>
<mi>B</mi>
<mi>A</mi>
</mrow>
</msub>
<mo>=</mo>
<msubsup>
<mi>q</mi>
<mi>B</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mo>&CircleTimes;</mo>
<msub>
<mi>q</mi>
<mi>A</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
实测安装关系四元数qBA表示为:
<mrow>
<msub>
<mi>q</mi>
<mrow>
<mi>B</mi>
<mi>A</mi>
</mrow>
</msub>
<mo>=</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>T</mi>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>q</mi>
<mo>&RightArrow;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
由于四元数的自由度为3,只对其矢部滤波平滑;
取线性离散系统状态为则系统方程为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mi>k</mi>
</msub>
<mo>=</mo>
<msub>
<mi>Dx</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>w</mi>
<mi>k</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>k</mi>
</msub>
<mo>=</mo>
<msub>
<mi>Gx</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>v</mi>
<mi>k</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,k为离散时间;系统在时刻k的状态矢量xk∈R3;yk∈R3为对应状态的观测矢量;wk~N(0,Qk)为高斯分布的过程激励噪声;vk~N(0,Rk)为高斯观测噪声;D为状态转移矩阵;G为观测矩阵;由于建立的是线性模型,这里D和G取为三阶单位阵。
3.如权利要求2所述的高精度星敏感器安装矩阵在轨实时校准方法,其特征在于,所述的步骤S2中,对安装关系四元数的矢量部分进行滤波校准的方法包含以下步骤:
步骤S2.1、输入线性离散系统状态量的初始值x0和协方差的初始值P0;
地面安装装调时得到安装关系四元数初值,x0取其矢部,P0任取一量级小于单位阵的非零对角阵;
步骤S2.2、进行状态一步预测:
xk|k-1=Dxk-1 (4)
步骤S2.3、计算量测残差:
vk=yk-Gxk|k-1 (5)
步骤S2.4、判断系统是否发散,若收敛判据成立,说明滤波正常,进行步骤S2.5,若收敛判据不成立,说明滤波发散,进行步骤S2.6;
所述的收敛判据为:
<mrow>
<msubsup>
<mi>v</mi>
<mi>k</mi>
<mi>T</mi>
</msubsup>
<msub>
<mi>v</mi>
<mi>k</mi>
</msub>
<mo>&le;</mo>
<mi>&gamma;</mi>
<mi>t</mi>
<mi>r</mi>
<mo>&lsqb;</mo>
<mi>E</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>v</mi>
<mi>k</mi>
</msub>
<msubsup>
<mi>v</mi>
<mi>k</mi>
<mi>T</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,γ为储备系数(γ≥1),γ=1是最严格的收敛判据;
步骤S2.5、令衰减因子λk=1,同时由量测残差在线估计测量噪声协方差R,进行步骤S2.7
<mrow>
<msub>
<mi>R</mi>
<mi>k</mi>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msub>
<mi>d</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>d</mi>
<mi>k</mi>
</msub>
<mo>&lsqb;</mo>
<mrow>
<mo>(</mo>
<mi>I</mi>
<mo>-</mo>
<msub>
<mi>GK</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>v</mi>
<mi>k</mi>
</msub>
<msubsup>
<mi>v</mi>
<mi>k</mi>
<mi>T</mi>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<mi>I</mi>
<mo>-</mo>
<msub>
<mi>GK</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>+</mo>
<msub>
<mi>GP</mi>
<mi>k</mi>
</msub>
<msup>
<mi>G</mi>
<mi>T</mi>
</msup>
<mo>&rsqb;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,dk=(1-b)/(1-bk+1),b为遗忘因子,一般取0.95~0.99;
步骤S2.6、更新衰减因子,进行步骤S2.7;
步骤S2.7、一步预测协方差阵:
Pk|k-1=D(λk*Pk-1)DT+Q (8)
式中,Q为过程激励噪声协方差;
步骤S2.8、计算增益:
Kk=Pk|k-1GT(R+GPk|k-1GT)-1 (9)
步骤S2.9、更新状态方程:
xk=xk|k-1+Kkvk (10)
步骤S2.10、更新协方差阵:
Pk=(I3×3-KkG)Pk|k-1 (11)。
4.如权利要求3所述的高精度星敏感器安装矩阵在轨实时校准方法,其特征在于,所述的步骤S2.6中,更新衰减因子的方法具体包含以下步骤:
步骤S2.6.1、根据量测残差实时调整衰减因子:
<mrow>
<msub>
<mi>L</mi>
<mi>k</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msubsup>
<mi>v</mi>
<mi>k</mi>
<mi>T</mi>
</msubsup>
<msub>
<mi>v</mi>
<mi>k</mi>
</msub>
<mo>-</mo>
<mi>t</mi>
<mi>r</mi>
<mo>&lsqb;</mo>
<msup>
<mi>GQG</mi>
<mi>T</mi>
</msup>
<mo>+</mo>
<msub>
<mi>R</mi>
<mi>k</mi>
</msub>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mi>t</mi>
<mi>r</mi>
<mo>&lsqb;</mo>
<msub>
<mi>GDP</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<msup>
<mi>D</mi>
<mi>T</mi>
</msup>
<msup>
<mi>G</mi>
<mi>T</mi>
</msup>
<mo>&rsqb;</mo>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
步骤S2.6.2、判断衰减因子是否满足Lk≤ω,其中,ω是星敏运行角
速度,若是,进行步骤S2.6.4,若否,进行步骤S2.6.3;
步骤S2.6.3、令Lk=Lk/10,进行步骤S2.6.2;
步骤S2.6.4、令λk=1+Lk,若λk>λmax,取λk=λmax,λmax为设定的衰减因子最大值。
5.如权利要求4所述的高精度星敏感器安装矩阵在轨实时校准方法,其特征在于,所述的步骤S3中,采用校准后的安装关系四元数解算安装矩阵的方法包含以下步骤:
步骤S3.1、获得滤波校准后的安装关系四元数的矢量部分:
<mrow>
<msub>
<mover>
<mover>
<mi>q</mi>
<mo>&RightArrow;</mo>
</mover>
<mo>^</mo>
</mover>
<mi>k</mi>
</msub>
<mo>=</mo>
<msubsup>
<mi>x</mi>
<mi>k</mi>
<mi>T</mi>
</msubsup>
<mo>;</mo>
</mrow>
步骤S3.2、解算安装关系四元数的标量部分:
若q0<0,则否则
步骤S3.3、根据安装关系四元数解算安装矩阵:
转换矩阵CBA由下式解得:
<mrow>
<msub>
<mi>C</mi>
<mrow>
<mi>B</mi>
<mi>A</mi>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>q</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>q</mi>
<mn>0</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>q</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>q</mi>
<mn>0</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>q</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>q</mi>
<mn>0</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
<mo>.</mo>
</mrow>
2
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710666994.4A CN107246883B (zh) | 2017-08-07 | 2017-08-07 | 一种高精度星敏感器安装矩阵在轨实时校准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710666994.4A CN107246883B (zh) | 2017-08-07 | 2017-08-07 | 一种高精度星敏感器安装矩阵在轨实时校准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107246883A true CN107246883A (zh) | 2017-10-13 |
CN107246883B CN107246883B (zh) | 2020-11-03 |
Family
ID=60013405
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710666994.4A Active CN107246883B (zh) | 2017-08-07 | 2017-08-07 | 一种高精度星敏感器安装矩阵在轨实时校准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107246883B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107966697A (zh) * | 2017-11-07 | 2018-04-27 | 浙江工业大学 | 一种基于渐进无迹卡尔曼的移动目标跟踪方法 |
CN109029504A (zh) * | 2018-08-08 | 2018-12-18 | 中国空间技术研究院 | 一种基于光信号的整星级恒星敏感器测试系统及方法 |
CN109238307A (zh) * | 2018-08-30 | 2019-01-18 | 衡阳市衡山科学城科技创新研究院有限公司 | 一种基于多惯组信息辅助的飞行故障检测方法及装置 |
CN109489689A (zh) * | 2018-11-20 | 2019-03-19 | 上海航天控制技术研究所 | 一种基于α-β滤波的星矢量测量误差在轨估计方法 |
CN110793540A (zh) * | 2019-09-11 | 2020-02-14 | 北京控制工程研究所 | 一种提高多探头星敏感器姿态测量精度的方法 |
CN111023988A (zh) * | 2019-12-02 | 2020-04-17 | 南京航空航天大学 | 一种磁矢量与光矢量安装矩阵微变化动态监测装置和方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101381004A (zh) * | 2008-08-20 | 2009-03-11 | 南京航空航天大学 | 基于大气阻力的微小卫星编队飞行控制方法及控制装置 |
WO2012068359A2 (en) * | 2010-11-17 | 2012-05-24 | Hillcrest Laboratories, Inc. | Apparatuses and methods for magnetometer alignment calibration without prior knowledge of the local magnetic |
EP2469229A1 (en) * | 2010-12-24 | 2012-06-27 | Magneti Marelli S.p.A. | Method for calibrating an inertial sensor installed in an arbitrary position on board a vehicle, and sensor system of the dynamics of a vehicle able to be installed on board in an arbitrary position |
CN103900574A (zh) * | 2014-04-04 | 2014-07-02 | 哈尔滨工程大学 | 一种基于迭代容积卡尔曼滤波姿态估计方法 |
CN104034334A (zh) * | 2014-06-05 | 2014-09-10 | 哈尔滨工程大学 | 一种小视场星敏感器的单星及双星定姿方法 |
CN104062672A (zh) * | 2013-11-28 | 2014-09-24 | 哈尔滨工程大学 | 基于强跟踪自适应Kalman滤波的SINSGPS组合导航方法 |
CN105371852A (zh) * | 2015-12-24 | 2016-03-02 | 哈尔滨工业大学 | 一种基于残差生成器的最优陀螺组合选取方法 |
-
2017
- 2017-08-07 CN CN201710666994.4A patent/CN107246883B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101381004A (zh) * | 2008-08-20 | 2009-03-11 | 南京航空航天大学 | 基于大气阻力的微小卫星编队飞行控制方法及控制装置 |
WO2012068359A2 (en) * | 2010-11-17 | 2012-05-24 | Hillcrest Laboratories, Inc. | Apparatuses and methods for magnetometer alignment calibration without prior knowledge of the local magnetic |
EP2469229A1 (en) * | 2010-12-24 | 2012-06-27 | Magneti Marelli S.p.A. | Method for calibrating an inertial sensor installed in an arbitrary position on board a vehicle, and sensor system of the dynamics of a vehicle able to be installed on board in an arbitrary position |
CN104062672A (zh) * | 2013-11-28 | 2014-09-24 | 哈尔滨工程大学 | 基于强跟踪自适应Kalman滤波的SINSGPS组合导航方法 |
CN103900574A (zh) * | 2014-04-04 | 2014-07-02 | 哈尔滨工程大学 | 一种基于迭代容积卡尔曼滤波姿态估计方法 |
CN104034334A (zh) * | 2014-06-05 | 2014-09-10 | 哈尔滨工程大学 | 一种小视场星敏感器的单星及双星定姿方法 |
CN105371852A (zh) * | 2015-12-24 | 2016-03-02 | 哈尔滨工业大学 | 一种基于残差生成器的最优陀螺组合选取方法 |
Non-Patent Citations (1)
Title |
---|
张惟 等: ""改进粒子滤波与预测滤波相结合的单星敏姿态估计"", 《控制与决策》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107966697A (zh) * | 2017-11-07 | 2018-04-27 | 浙江工业大学 | 一种基于渐进无迹卡尔曼的移动目标跟踪方法 |
CN109029504A (zh) * | 2018-08-08 | 2018-12-18 | 中国空间技术研究院 | 一种基于光信号的整星级恒星敏感器测试系统及方法 |
CN109238307A (zh) * | 2018-08-30 | 2019-01-18 | 衡阳市衡山科学城科技创新研究院有限公司 | 一种基于多惯组信息辅助的飞行故障检测方法及装置 |
CN109489689A (zh) * | 2018-11-20 | 2019-03-19 | 上海航天控制技术研究所 | 一种基于α-β滤波的星矢量测量误差在轨估计方法 |
CN109489689B (zh) * | 2018-11-20 | 2020-11-03 | 上海航天控制技术研究所 | 一种基于α-β滤波的星矢量测量误差在轨估计方法 |
CN110793540A (zh) * | 2019-09-11 | 2020-02-14 | 北京控制工程研究所 | 一种提高多探头星敏感器姿态测量精度的方法 |
CN111023988A (zh) * | 2019-12-02 | 2020-04-17 | 南京航空航天大学 | 一种磁矢量与光矢量安装矩阵微变化动态监测装置和方法 |
CN111023988B (zh) * | 2019-12-02 | 2021-06-22 | 南京航空航天大学 | 一种磁矢量与光矢量安装矩阵微变化动态监测装置和方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107246883B (zh) | 2020-11-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107246883A (zh) | 一种高精度星敏感器安装矩阵在轨实时校准方法 | |
CN107525503B (zh) | 基于双天线gps和mimu组合的自适应级联卡尔曼滤波方法 | |
CN107421534B (zh) | 一种冗余式捷联惯导系统多故障隔离方法 | |
Searcy et al. | Magnetometer-only attitude determination using novel two-step Kalman filter approach | |
Murrell | Precision attitude determination for multimission spacecraft | |
CN108387227B (zh) | 机载分布式pos的多节点信息融合方法及系统 | |
CN102506893B (zh) | 一种基于地标信息的星敏感器低频误差补偿方法 | |
Ivanov et al. | Analytical study of microsatellite attitude determination algorithms | |
CN107525492B (zh) | 一种适用于敏捷对地观测卫星的偏流角仿真分析方法 | |
CN112082574A (zh) | 星敏感器的校正方法及系统 | |
US20140229136A1 (en) | Method And Apparatus For Spacecraft Gyroscope Scale Factor Calibration | |
CN112461262A (zh) | 一种校正三轴磁强计误差的装置和方法 | |
CN113447043A (zh) | 一种基于gnss的卫星天文导航系统误差自主标定方法及系统 | |
Han et al. | A fast SINS initial alignment method based on RTS forward and backward resolution | |
CN107764268A (zh) | 一种机载分布式pos传递对准的方法和装置 | |
Gaisser et al. | Improvements in attitude determination and control of the small satellite flying laptop | |
CN113188540B (zh) | 基于恒星数目和构型的惯性/天文自适应滤波方法 | |
Lee et al. | Spacecraft attitude estimation under attitude tracking maneuver during close-proximity operations | |
CN113252029A (zh) | 一种基于光学陀螺量测信息的天文导航姿态传递方法 | |
Da Forno et al. | Autonomous navigation of MegSat1: Attitude, sensor bias and scale factor estimation by EKF and magnetometer-only measurement | |
CN113405567B (zh) | 一种重力卫星星敏感器安装矩阵在轨定标方法及系统 | |
CN115290118A (zh) | 一种基于星敏感器的卫星激光通信系统指向误差校正方法 | |
CN110793540A (zh) | 一种提高多探头星敏感器姿态测量精度的方法 | |
Feng et al. | A analytic coarse alignment method for SINS based on two-step recursive least squares | |
CN114408220B (zh) | 磁浮作动器力臂在轨标定方法及系统 |
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 |