CN105486312A - 一种星敏感器与高频角位移传感器组合定姿方法及*** - Google Patents
一种星敏感器与高频角位移传感器组合定姿方法及*** Download PDFInfo
- Publication number
- CN105486312A CN105486312A CN201610067447.XA CN201610067447A CN105486312A CN 105486312 A CN105486312 A CN 105486312A CN 201610067447 A CN201610067447 A CN 201610067447A CN 105486312 A CN105486312 A CN 105486312A
- Authority
- CN
- China
- Prior art keywords
- represent
- omega
- angular displacement
- attitude
- displacement sensor
- 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
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- 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
- G01C21/165—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 combined with non-inertial navigation instruments
-
- 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)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本发明提供了一种星敏感器与高频角位移传感器组合定姿方法及***,包括根据角位移传感器测量原理构建其误差测量模型,充分考虑其观测值存在的各种误差源;基于多星敏感器信息融合结果构建***量测方程;根据卫星姿态运动学方程和角位移传感器测量模型构建***状态方程;最后采用双向卡尔曼滤波与整体加权平差模型,实现高频姿态参数最优估计。本发明可以实现低频星敏感器与高频角位移传感器最优信息融合,得到高频高精度的姿态数据,从而为高分辨率光学影像高精度几何处理奠定基础。
Description
技术领域
本发明属于遥感卫星地面预处理领域,特别是涉及到一种星敏感器与高频角位移传感器组合定姿方法及***。
背景技术
高分辨率光学卫星是我国高分辨率对地观测***发展的重要研究领域之一,未来十年我国将发射数颗空间分辨率优于1米的光学卫星(简称亚米级光学卫星),最高空间分辨率甚至可以达到0.1米左右。但是,更高的空间分辨率并不意味着具有更高的几何相对精度。由于高分辨率光学卫星推扫成像频率为上万赫兹,而传统的星敏感器与陀螺组合定姿方式输出的姿态频率为几赫兹到几十赫兹,很难满足其高精度几何处理需求。本发明针对该问题,提出一种低频星敏感器与高频角位移传感器组合定姿方法。近年来,角位移传感器作为一种新型姿态敏感器逐渐搭载在一系列高分辨率光学卫星上进行在轨使用,由于其可以输出上万赫兹的角增量姿态数据,将其与低频星敏感器进行最优信息融合可以得到高频姿态数据,以满足高分辨率光学影像高精度几何处理要求。
发明内容
本发明针对当前低频姿态数据难以满足高分辨率光学卫星影像几何处理要求的问题,提供了一种基于低频星敏感器与高频角位移传感器高精度组合定姿技术方案。
本发明提供的技术方案为一种星敏感器与高频角位移传感器组合定姿方法,包括以下步骤:
步骤1,构建角位移传感器测量模型如下,
ωg=(1+Δ+Λ)ω+b+ηg
其中,ωg为角位移传感器测量得到的角速度大小,Δ表示角位移传感器安装误差,Λ表示角位移传感器标度因数误差,ω为卫星本体相对于惯性空间的真实角速度,b表示角位移传感器漂移大小,ηg为角位移传感器测量噪声;
步骤2,基于多星敏感器信息融合结果构建***量测方程,实现如下,
设有一组正交矢量,表示正交矢量在本体坐标系下真实值,表示正交矢量在惯性坐标系下的测量值,表示正交矢量在惯性坐标系下真实值;
得到量测方程如下,
Zk=HkXk+Vk
其中,Zk表示观测矢量,Hk表示观测矩阵,Xk表示状态变量,表示四元数最优估计值,表示由本体到惯性系转换矩阵,Vk表示tk时刻观测噪声序列;
步骤3,根据卫星姿态运动学方程和角位移传感器测量模型构建***状态方程,实现如下,
根据姿态运动学方程得到基于状态 的***状态方程如下,
W(t)=[-0.5ηgηb]T
其中,表示状态量微分值,X(t)表示状态量,F(t)表示状态转移矩阵微分,W(t)表示***噪声序列,表示角速度矢量叉乘,I3×3表示单位矩阵,03×3表示元素为0的矩阵,表示误差四元数矢量部分,ΔbT表示误差漂移;
对以上***状态方程进行线性化离散化得到,
Xk=Φk,k-1Xk-1+Γk-1Wk-1
其中,Xk、Xk-1表示tk时刻、tk-1时刻状态变量,Φk,k-1表示状态转移矩阵,Γk-1表示***噪声驱动阵,Wk-1表示***噪声序列;
步骤4,基于步骤2和步骤3分别构建的***量测方程和***状态方程,采用双向卡尔曼滤波与整体加权平差模型,实现高频姿态参数最优估计。
而且,步骤3中姿态运动学方程表示如下姿态运动学方程表示如下,
其中,表示四元数的微分值,q和ω分别表示卫星本体坐标系相对于惯性坐标系的姿态四元数与三轴旋转角速度,q=[q0q1q2q3]T,ω=(ωx,ωy,ωz)。
而且,步骤4实现如下,
(1)基于角位移测量信息进行姿态预测
基于角位移测量信息在tk-1时刻对下式进行积分,得到卫星姿态四元数预测值
其中,表示tk-1时刻四元数最优估计值,表示tk-1时刻角速度最优估计值;
角位移漂移预测值的预测模型如下,
其中,表示tk-1时刻角位移漂移最优估计值;
对于误差协方差阵的预测值解算模型如下,
其中,表示tk-1时刻误差协方差阵估计值,Qk-1表示***干扰方差阵;
(2)基于星敏感器测量值进行姿态修正
在tk时刻,根据***量测方程计算观测矩阵Hk,进一步计算滤波增益Kk,
其中,Pk/k-1表示误差协方差阵预测值,则相应的***状态变量为,
卫星姿态四元数tk时刻的修正更新值与角位移漂移的修正更新值分别为,
其中,表示误差四元数估计值,表示误差漂移量估计值;
误差协方差阵Pk的更新计算为,
其中,Rk表示星敏感器量测噪声方差阵,I表示单位矩阵,Hk采用修正更新后的状态变量重新进行计算;
根据上述过程(1)(2)进行初始滤波、反向滤波以及正向滤波,最终基于正向滤波与反向滤波结果进行整体加权平差。
本发明还提供一种星敏感器与高频角位移传感器组合定姿***,包括以下模块:
第一模块,用于构建角位移传感器测量模型如下,
ωg=(1+Δ+Λ)ω+b+ηg
其中,ωg为角位移传感器测量得到的角速度大小,Δ表示角位移传感器安装误差,Λ表示角位移传感器标度因数误差,ω为卫星本体相对于惯性空间的真实角速度,b表示角位移传感器漂移大小,ηg为角位移传感器测量噪声;
第二模块,用于基于多星敏感器信息融合结果构建***量测方程,实现如下,
设有一组正交矢量,表示正交矢量在本体坐标系下真实值,表示正交矢量在惯性坐标系下的测量值,表示正交矢量在惯性坐标系下真实值;
得到量测方程如下,
Zk=HkXk+Vk
其中,Zk表示观测矢量,Hk表示观测矩阵,Xk表示状态变量,表示四元数最优估计值,表示由本体到惯性系转换矩阵,Vk表示tk时刻观测噪声序列;
第三模块,用于根据卫星姿态运动学方程和角位移传感器测量模型构建***状态方程,实现如下,
根据姿态运动学方程得到基于状态 的***状态方程如下,
W(t)=[-0.5ηgηb]T
其中,表示状态量微分值,X(t)表示状态量,F(t)表示状态转移矩阵微分,W(t)表示***噪声序列,表示角速度矢量叉乘,I3×3表示单位矩阵,03×3表示元素为0的矩阵,表示误差四元数矢量部分,ΔbT表示误差漂移;
对以上***状态方程进行线性化离散化得到,
Xk=Φk,k-1Xk-1+Γk-1Wk-1
其中,Xk、Xk-1表示tk时刻、tk-1时刻状态变量,Φk,k-1表示状态转移矩阵,Γk-1表示***噪声驱动阵,Wk-1表示***噪声序列;
第四模块,用于基于第二模块和第三模块分别构建的***量测方程和***状态方程,采用双向卡尔曼滤波与整体加权平差模型,实现高频姿态参数最优估计。
而且,第三模块中姿态运动学方程表示如下姿态运动学方程表示如下,
其中,表示四元数的微分值,q和ω分别表示卫星本体坐标系相对于惯性坐标系的姿态四元数与三轴旋转角速度,q=[q0q1q2q3]T,ω=(ωx,ωy,ωz)。
而且,第四模块实现如下,
(1)基于角位移测量信息进行姿态预测
基于角位移测量信息在tk-1时刻对下式进行积分,得到卫星姿态四元数预测值
其中,表示tk-1时刻四元数最优估计值,表示tk-1时刻角速度最优估计值;
角位移漂移预测值的预测模型如下,
其中,表示tk-1时刻角位移漂移最优估计值;
对于误差协方差阵的预测值解算模型如下,
其中,表示tk-1时刻误差协方差阵估计值,Qk-1表示***干扰方差阵;
(2)基于星敏感器测量值进行姿态修正
在tk时刻,根据***量测方程计算观测矩阵Hk,进一步计算滤波增益Kk,
其中,Pk/k-1表示误差协方差阵预测值,则相应的***状态变量为,
卫星姿态四元数tk时刻的修正更新值与角位移漂移的修正更新值分别为,
其中,表示误差四元数估计值,表示误差漂移量估计值;
误差协方差阵Pk的更新计算为,
其中,Rk表示星敏感器量测噪声方差阵,I表示单位矩阵,Hk采用修正更新后的状态变量重新进行计算;
根据上述过程(1)(2)进行初始滤波、反向滤波以及正向滤波,最终基于正向滤波与反向滤波结果进行整体加权平差。
本发明提供了一种低频星敏感器与高频角位移传感器组合定姿技术方案,实现了星敏感器高精度定姿优势与角位移传感器高频率角增量输出优势互补,通过本发明提供的技术方案可以得到高频率、高精度的卫星姿态数据,为高分辨率光学卫星高精度几何处理奠定基础。
附图说明
图1为本发明实施例的流程图。
具体实施方式
以下结合附图和实施例详细说明本发明技术方案。
参见图1所示星敏感器与高频角位移传感器组合定姿技术流程图,以下针对实施例流程中的各步骤,对本发明方法做进一步详细描述。
步骤1,根据角位移传感器工作原理,构建合理的误差测量模型,充分考虑其测量值中存在的各种误差源。
角位移传感器作为一种惯性姿态传感器,可以直接输出高频的角增量数据,得到的测量数据含义是该采样时刻相比上一采样时刻时间间隔内所产生的角增量大小。根据上述原理得到:假设角位移传感器数据采样周期为T,某一时刻t的卫星三轴角位移观测值分别为NX,Ny,Nz,则得到该时刻t的三轴角速度ωx,ωy,ωz,具体展开如下:
由于角位移传感器在轨工作过程中存在的误差项包括安装误差、标度因数误差、漂移误差以及测量噪声等,故进一步得到角位移传感器的误差测量模型如下:
ωg=(1+Δ+Λ)ω+b+ηg(2)
其中,ωg为角位移传感器测量得到的角速度大小,Δ表示角位移传感器安装误差,Λ表示角位移传感器标度因数误差,ω为卫星本体相对于惯性空间的真实角速度,b表示角位移传感器漂移大小,ηg为角位移传感器测量噪声。这里假设角位移传感器测量噪声为高斯白噪声,即σg表示测量噪声中误差。
进一步假设角位移传感器的漂移b由白噪声驱动,表示为:
其中,表示漂移量的微分值,ηb为角位移传感器与时间相关的噪声,满足σb表示漂移噪声中误差。
步骤2,基于多星敏感器信息融合结果构建***量测方程。
本发明基于多星敏感器光轴矢量观测值实现多星敏感器最优信息融合,进一步构建***量测方程,具体过程如下:
假设一组正交矢量在本体坐标系、惯性坐标系下表达方式如下:
其中,表示正交矢量在本体坐标系下真实值,表示正交矢量在惯性坐标系下的测量值,表示正交矢量在惯性坐标系下真实值。
进一步根据推导得到量测方程如下:
Zk=HkXk+Vk
其中,Zk表示观测矢量,Hk表示观测矩阵,Xk表示状态变量,表示四元数最优估计值,表示由本体到惯性系转换矩阵,Vk表示tk时刻观测噪声序列,且满足: E(Vk)表示观测噪声序列平均值,表示不同时刻之间观测噪声序列协方差,表示tj时刻观测噪声矩阵转置,δkj表示狄克莱函数;Rk表示星敏感器量测噪声方差阵。
步骤3,基于姿态运动学方程以及角位移传感器误差测量模型构建***的状态方程。
本发明根据姿态运动学方程以及角位移传感器测量模型进一步构建状态方程,具体过程如下:
姿态运动学方程表示如下:
其中,表示四元数的微分值,q和ω分别表示卫星本体坐标系相对于惯性坐标系的姿态四元数与三轴旋转角速度,q=[q0q1q2q3]T,ω=(ωx,ωy,ωz)。
进一步推导得到基于状态 的***状态方程:
其中,表示状态量微分值,X(t)表示状态量,F(t)表示状态转移矩阵微分,W(t)表示***噪声序列,表示角速度矢量叉乘,I3×3表示单位矩阵,03×3表示元素为0的矩阵,表示误差四元数矢量部分,ΔbT表示误差漂移,以上得到的状态方程为连续动态***滤波方程,需要进行线性化和离散化,故进行线性化离散化得到:
Xk=Φk,k-1Xk-1+Γk-1Wk-1(8)
其中,Xk、Xk-1表示tk时刻、tk-1时刻状态变量,Φk,k-1表示状态转移矩阵,Γk-1表示***噪声驱动阵,Wk-1表示***噪声序列。
步骤4,基于步骤2和步骤3分别构建的***量测方程和***状态方程,采用双向卡尔曼滤波与整体加权平差模型,实现高频姿态参数最优估计。
由于星敏感器输出频率为几赫兹到几十赫兹,而角位移传感器输出频率达到上万赫兹,以往的组合定姿滤波器设计已经无法满足实际需要。本发明针对该问题提出一种双向卡尔曼滤波与整体加权平差相结合的模型算法实现多频多种姿态敏感器最优信息融合。
(1)基于角位移测量信息进行姿态预测
基于角位移测量信息在tk-1时刻对下式进行积分,可以得到卫星姿态四元数预测值
其中,表示tk-1时刻四元数最优估计值,表示tk-1时刻角速度最优估计值。
角位移漂移预测值的预测模型如下:
其中,表示tk-1时刻角位移漂移最优估计值。
对于误差协方差阵的预测值解算模型如下:
其中,表示tk-1时刻误差协方差阵估计值,Qk-1表示***干扰方差阵。
(2)基于星敏感器测量值进行姿态修正
在tk时刻,根据步骤2量测方程计算观测矩阵Hk。进一步计算滤波增益Kk:
其中,Pk/k-1表示误差协方差阵预测值,则相应的***状态变量为:
卫星姿态四元数tk时刻的修正更新值与角位移漂移的修正更新值分别为:
其中,表示误差四元数估计值,表示误差漂移量估计值。
误差协方差阵Pk的更新计算为:
其中,Rk表示星敏感器量测噪声方差阵,I表示单位矩阵,Hk采用修正更新后的状态变量重新进行计算,这样做的目的是使滤波过程具有更好的收敛性。在校正了卫星姿态四元数和角位移的漂移后,状态变量需要重新设置为零。
根据上述过程进行初始滤波、反向滤波以及正向滤波,(1)到(2)为初次滤波;(2)到(1)为反向滤波;最后(1)到(2)为正向滤波,每次滤波的初始值为上次滤波的结果;最终基于正向滤波与反向滤波结果进行整体加权平差。
根符号“f”表示正向滤波结果,根符号“b”表示反向滤波结果,根符号“s”表示整体加权平差结果,
表示tk时刻正向滤波姿态最优估计值,表示tk时刻反向滤波姿态最优估计值的逆,表示tk时刻正反向滤波结果四元数误差;
表示正反向状态量滤波结果误差矩阵,表示返回标量正负号, 表示tk时刻漂移正向与反向滤波最优估计值,
与分别表示误差协方差阵正反向最优估计值的逆,表示整理加权的误差协方差阵估计值;
表示正反向状态量滤波结果误差矩阵加权平均值,表示误差四元数整体加权平均矢量部分结果,表示误差漂移整体加权平均结果;
表示误差四元数整体加权结果,表示误差漂移整体加权结果;
表示tk时刻四元数整体加权结果, 表示tk时刻漂移量整体加权结果。
具体实施时,本发明所提供方法可基于软件技术实现自动运行流程,也可采用模块化方式实现相应***。本发明实施例还提供一种星敏感器与高频角位移传感器组合定姿***,包括以下模块:
第一模块,用于构建角位移传感器测量模型如下,
ωg=(1+Δ+Λ)ω+b+ηg
其中,ωg为角位移传感器测量得到的角速度大小,Δ表示角位移传感器安装误差,Λ表示角位移传感器标度因数误差,ω为卫星本体相对于惯性空间的真实角速度,b表示角位移传感器漂移大小,ηg为角位移传感器测量噪声;
第二模块,用于基于多星敏感器信息融合结果构建***量测方程,实现如下,
设有一组正交矢量,表示正交矢量在本体坐标系下真实值,表示正交矢量在惯性坐标系下的测量值,表示正交矢量在惯性坐标系下真实值;
得到量测方程如下,
Zk=HkXk+Vk
其中,Zk表示观测矢量,Hk表示观测矩阵,Xk表示状态变量,表示四元数最优估计值,表示由本体到惯性系转换矩阵,Vk表示tk时刻观测噪声序列;
第三模块,用于根据卫星姿态运动学方程和角位移传感器测量模型构建***状态方程,实现如下,
根据姿态运动学方程得到基于状态 的***状态方程如下,
W(t)=[-0.5ηgηb]T
其中,表示状态量微分值,X(t)表示状态量,F(t)表示状态转移矩阵微分,W(t)表示***噪声序列,表示角速度矢量叉乘,I3×3表示单位矩阵,03×3表示元素为0的矩阵,表示误差四元数矢量部分,ΔbT表示误差漂移;
对以上***状态方程进行线性化离散化得到,
Xk=Φk,k-1Xk-1+Γk-1Wk-1
其中,Xk、Xk-1表示tk时刻、tk-1时刻状态变量,Φk,k-1表示状态转移矩阵,Γk-1表示***噪声驱动阵,Wk-1表示***噪声序列;
第四模块,用于基于第二模块和第三模块分别构建的***量测方程和***状态方程,采用双向卡尔曼滤波与整体加权平差模型,实现高频姿态参数最优估计。
各模块具体实现可参见相应步骤,本发明不予赘述。
本文中所描述的具体实例仅仅是对本发明精神作举例说明。本发明所属技术领域的技术人员可以对所描述的具体实例做各种各样的修改或补充或采用类似的方式替代,但并不会偏离本发明的精神或者超越所附权利要求书所定义的范围。
Claims (6)
1.一种星敏感器与高频角位移传感器组合定姿方法,其特征在于,包括以下步骤:
步骤1,构建角位移传感器测量模型如下,
ωg=(1+Δ+Λ)ω+b+ηg
其中,ωg为角位移传感器测量得到的角速度大小,Δ表示角位移传感器安装误差,Λ表示角位移传感器标度因数误差,ω为卫星本体相对于惯性空间的真实角速度,b表示角位移传感器漂移大小,ηg为角位移传感器测量噪声;
步骤2,基于多星敏感器信息融合结果构建***量测方程,实现如下,
设有一组正交矢量,表示正交矢量在本体坐标系下真实值,表示正交矢量在惯性坐标系下的测量值,表示正交矢量在惯性坐标系下真实值;
得到量测方程如下,
Zk=HkXk+Vk
其中,Zk表示观测矢量,Hk表示观测矩阵,Xk表示状态变量,表示四元数最优估计值,表示由本体到惯性系转换矩阵,Vk表示tk时刻观测噪声序列;
步骤3,根据卫星姿态运动学方程和角位移传感器测量模型构建***状态方程,实现如下,
根据姿态运动学方程得到基于状态 的***状态方程如下,
W(t)=[-0.5ηgηb]T
其中,表示状态量微分值,X(t)表示状态量,F(t)表示状态转移矩阵微分,W(t)表示***噪声序列,表示角速度矢量叉乘,I3×3表示单位矩阵,03×3表示元素为0的矩阵,表示误差四元数矢量部分,ΔbT表示误差漂移;
对以上***状态方程进行线性化离散化得到,
Xk=Φk,k-1Xk-1+Γk-1Wk-1
其中,Xk、Xk-1表示tk时刻、tk-1时刻状态变量,Φk,k-1表示状态转移矩阵,Γk-1表示***噪声驱动阵,Wk-1表示***噪声序列;
步骤4,基于步骤2和步骤3分别构建的***量测方程和***状态方程,采用双向卡尔曼滤波与整体加权平差模型,实现高频姿态参数最优估计。
2.根据权利要求1所述星敏感器与高频角位移传感器组合定姿方法,其特征在于:步骤3中姿态运动学方程表示如下姿态运动学方程表示如下,
其中,表示四元数的微分值,q和ω分别表示卫星本体坐标系相对于惯性坐标系的姿态四元数与三轴旋转角速度,q=[q0q1q2q3]T,ω=(ωx,ωy,ωz)。
3.根据权利要求1或2所述星敏感器与高频角位移传感器组合定姿方法,其特征在于:步骤4实现如下,
(1)基于角位移测量信息进行姿态预测
基于角位移测量信息在tk-1时刻对下式进行积分,得到卫星姿态四元数预测值
其中,表示tk-1时刻四元数最优估计值,表示tk-1时刻角速度最优估计值;
角位移漂移预测值的预测模型如下,
其中,表示tk-1时刻角位移漂移最优估计值;
对于误差协方差阵的预测值解算模型如下,
其中,表示tk-1时刻误差协方差阵估计值,Qk-1表示***干扰方差阵;
(2)基于星敏感器测量值进行姿态修正
在tk时刻,根据***量测方程计算观测矩阵Hk,进一步计算滤波增益Kk,
其中,Pk/k-1表示误差协方差阵预测值,则相应的***状态变量为,
卫星姿态四元数tk时刻的修正更新值与角位移漂移的修正更新值分别为,
其中,表示误差四元数估计值,表示误差漂移量估计值;
误差协方差阵Pk的更新计算为,
其中,Rk表示星敏感器量测噪声方差阵,I表示单位矩阵,Hk采用修正更新后的状态变量重新进行计算;
根据上述过程(1)(2)进行初始滤波、反向滤波以及正向滤波,最终基于正向滤波与反向滤波结果进行整体加权平差。
4.一种星敏感器与高频角位移传感器组合定姿***,其特征在于,包括以下模块:
第一模块,用于构建角位移传感器测量模型如下,
ωg=(1+Δ+Λ)ω+b+ηg
其中,ωg为角位移传感器测量得到的角速度大小,Δ表示角位移传感器安装误差,Λ表示角位移传感器标度因数误差,ω为卫星本体相对于惯性空间的真实角速度,b表示角位移传感器漂移大小,ηg为角位移传感器测量噪声;
第二模块,用于基于多星敏感器信息融合结果构建***量测方程,实现如下,
设有一组正交矢量,表示正交矢量在本体坐标系下真实值,表示正交矢量在惯性坐标系下的测量值,表示正交矢量在惯性坐标系下真实值;
得到量测方程如下,
Zk=HkXk+Vk
其中,Zk表示观测矢量,Hk表示观测矩阵,Xk表示状态变量,表示四元数最优估计值,表示由本体到惯性系转换矩阵,Vk表示tk时刻观测噪声序列;
第三模块,用于根据卫星姿态运动学方程和角位移传感器测量模型构建***状态方程,实现如下,
根据姿态运动学方程得到基于状态 的***状态方程如下,
W(t)=[-0.5ηgηb]T
其中,表示状态量微分值,X(t)表示状态量,F(t)表示状态转移矩阵微分,W(t)表示***噪声序列,表示角速度矢量叉乘,I3×3表示单位矩阵,03×3表示元素为0的矩阵,表示误差四元数矢量部分,ΔbT表示误差漂移;
对以上***状态方程进行线性化离散化得到,
Xk=Φk,k-1Xk-1+Γk-1Wk-1
其中,Xk、Xk-1表示tk时刻、tk-1时刻状态变量,Φk,k-1表示状态转移矩阵,Γk-1表示***噪声驱动阵,Wk-1表示***噪声序列;
第四模块,用于基于第二模块和第三模块分别构建的***量测方程和***状态方程,采用双向卡尔曼滤波与整体加权平差模型,实现高频姿态参数最优估计。
5.根据权利要求4所述星敏感器与高频角位移传感器组合定姿方法,其特征在于:第三模块中姿态运动学方程表示如下姿态运动学方程表示如下,
其中,表示四元数的微分值,q和ω分别表示卫星本体坐标系相对于惯性坐标系的姿态四元数与三轴旋转角速度,q=[q0q1q2q3]T,ω=(ωx,ωy,ωz)。
6.根据权利要求4或5所述星敏感器与高频角位移传感器组合定姿方法,其特征在于:第四模块实现如下,
(1)基于角位移测量信息进行姿态预测
基于角位移测量信息在tk-1时刻对下式进行积分,得到卫星姿态四元数预测值
其中,表示tk-1时刻四元数最优估计值,表示tk-1时刻角速度最优估计值;
角位移漂移预测值的预测模型如下,
其中,表示tk-1时刻角位移漂移最优估计值;
对于误差协方差阵的预测值解算模型如下,
其中,表示tk-1时刻误差协方差阵估计值,Qk-1表示***干扰方差阵;
(2)基于星敏感器测量值进行姿态修正
在tk时刻,根据***量测方程计算观测矩阵Hk,进一步计算滤波增益Kk,
其中,Pk/k-1表示误差协方差阵预测值,则相应的***状态变量为,
卫星姿态四元数tk时刻的修正更新值与角位移漂移的修正更新值分别为,
其中,表示误差四元数估计值,表示误差漂移量估计值;
误差协方差阵Pk的更新计算为,
其中,Rk表示星敏感器量测噪声方差阵,I表示单位矩阵,Hk采用修正更新后的状态变量重新进行计算;
根据上述过程(1)(2)进行初始滤波、反向滤波以及正向滤波,最终基于正向滤波与反向滤波结果进行整体加权平差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610067447.XA CN105486312B (zh) | 2016-01-30 | 2016-01-30 | 一种星敏感器与高频角位移传感器组合定姿方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610067447.XA CN105486312B (zh) | 2016-01-30 | 2016-01-30 | 一种星敏感器与高频角位移传感器组合定姿方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105486312A true CN105486312A (zh) | 2016-04-13 |
CN105486312B CN105486312B (zh) | 2018-05-15 |
Family
ID=55673449
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610067447.XA Active CN105486312B (zh) | 2016-01-30 | 2016-01-30 | 一种星敏感器与高频角位移传感器组合定姿方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105486312B (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106275508A (zh) * | 2016-08-15 | 2017-01-04 | 上海航天控制技术研究所 | 一种卫星绕空间轴的最短路径姿态机动控制方法 |
CN106767767A (zh) * | 2016-11-23 | 2017-05-31 | 上海航天控制技术研究所 | 一种微纳多模星敏感器***及其数据融合方法 |
CN107389069A (zh) * | 2017-07-25 | 2017-11-24 | 上海航天控制技术研究所 | 基于双向卡尔曼滤波的地面姿态处理方法 |
CN107588768A (zh) * | 2017-08-21 | 2018-01-16 | 中国科学院长春光学精密机械与物理研究所 | 基于星图的帧间角速度计算方法 |
CN107702709A (zh) * | 2017-08-31 | 2018-02-16 | 西北工业大学 | 一种非合作目标运动与惯性参数的时频域混合辨识方法 |
CN108195403A (zh) * | 2017-12-28 | 2018-06-22 | 中国人民解放军国防科技大学 | 星敏感器在轨姿态测量数据综合误差模型的构建方法及装置 |
CN108871312A (zh) * | 2018-07-09 | 2018-11-23 | 北京控制工程研究所 | 一种重力梯度仪及星敏感器的联合定姿方法 |
CN109141394A (zh) * | 2018-07-06 | 2019-01-04 | 航天星图科技(北京)有限公司 | 一种基于多种姿态传感器的高精度卫星定姿方法 |
CN109741381A (zh) * | 2019-01-23 | 2019-05-10 | 张过 | 基于平行观测的星载推扫式光学传感器高频误差消除方法 |
CN110703596A (zh) * | 2019-08-01 | 2020-01-17 | 中国科学院力学研究所 | 一种星-臂耦合***的主星姿态预报方法及*** |
CN110793540A (zh) * | 2019-09-11 | 2020-02-14 | 北京控制工程研究所 | 一种提高多探头星敏感器姿态测量精度的方法 |
CN111240297A (zh) * | 2018-11-28 | 2020-06-05 | 中国科学院沈阳自动化研究所 | 基于Kalman滤波器的航天器姿控***故障诊断方法 |
CN111649766A (zh) * | 2020-06-01 | 2020-09-11 | 哈尔滨理工大学 | 一种磁电编码器角度值噪声主动抑制方法及装置 |
CN113720330A (zh) * | 2021-11-01 | 2021-11-30 | 武汉大学 | 一种亚角秒级的遥感卫星高精度姿态确定设计与实现方法 |
CN114485574A (zh) * | 2021-12-21 | 2022-05-13 | 武汉大学 | 基于卡尔曼滤波模型的三线阵影像pos辅助对地定位方法 |
CN115507845A (zh) * | 2022-10-18 | 2022-12-23 | 闽江学院 | 一种顾及虚拟观测值的卫星姿态融合估计方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4567564A (en) * | 1980-08-19 | 1986-01-28 | Messerschmitt-Bolkow-Blohm Gesellschaft Mit Beschrankter Haftung | Arrangement for the attitude stabilization of flexible vehicles with weakly-dampened structural vibrations and discontinuous control intervention |
CN101556155A (zh) * | 2009-05-20 | 2009-10-14 | 上海微小卫星工程中心 | 小卫星姿态确定***及方法 |
CN102114918A (zh) * | 2010-12-31 | 2011-07-06 | 北京航空航天大学 | 一种基于多速率敏感器组合定姿的姿控反馈回路 |
CN102607564A (zh) * | 2012-03-09 | 2012-07-25 | 北京航空航天大学 | 一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法 |
CN102879011A (zh) * | 2012-09-21 | 2013-01-16 | 北京控制工程研究所 | 一种基于星敏感器辅助的月面惯导对准方法 |
US20130125667A1 (en) * | 2010-07-14 | 2013-05-23 | University Of Florida Research Foundation, Inc. | System and method for assessing the performance of an attitude control system for small satellites |
CN103940433A (zh) * | 2014-05-12 | 2014-07-23 | 哈尔滨工业大学 | 一种基于改进的自适应平方根ukf算法的卫星姿态确定方法 |
-
2016
- 2016-01-30 CN CN201610067447.XA patent/CN105486312B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4567564A (en) * | 1980-08-19 | 1986-01-28 | Messerschmitt-Bolkow-Blohm Gesellschaft Mit Beschrankter Haftung | Arrangement for the attitude stabilization of flexible vehicles with weakly-dampened structural vibrations and discontinuous control intervention |
CN101556155A (zh) * | 2009-05-20 | 2009-10-14 | 上海微小卫星工程中心 | 小卫星姿态确定***及方法 |
US20130125667A1 (en) * | 2010-07-14 | 2013-05-23 | University Of Florida Research Foundation, Inc. | System and method for assessing the performance of an attitude control system for small satellites |
CN102114918A (zh) * | 2010-12-31 | 2011-07-06 | 北京航空航天大学 | 一种基于多速率敏感器组合定姿的姿控反馈回路 |
CN102607564A (zh) * | 2012-03-09 | 2012-07-25 | 北京航空航天大学 | 一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法 |
CN102879011A (zh) * | 2012-09-21 | 2013-01-16 | 北京控制工程研究所 | 一种基于星敏感器辅助的月面惯导对准方法 |
CN103940433A (zh) * | 2014-05-12 | 2014-07-23 | 哈尔滨工业大学 | 一种基于改进的自适应平方根ukf算法的卫星姿态确定方法 |
Cited By (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106275508A (zh) * | 2016-08-15 | 2017-01-04 | 上海航天控制技术研究所 | 一种卫星绕空间轴的最短路径姿态机动控制方法 |
CN106767767A (zh) * | 2016-11-23 | 2017-05-31 | 上海航天控制技术研究所 | 一种微纳多模星敏感器***及其数据融合方法 |
CN107389069A (zh) * | 2017-07-25 | 2017-11-24 | 上海航天控制技术研究所 | 基于双向卡尔曼滤波的地面姿态处理方法 |
CN107389069B (zh) * | 2017-07-25 | 2020-08-21 | 上海航天控制技术研究所 | 基于双向卡尔曼滤波的地面姿态处理方法 |
CN107588768A (zh) * | 2017-08-21 | 2018-01-16 | 中国科学院长春光学精密机械与物理研究所 | 基于星图的帧间角速度计算方法 |
CN107588768B (zh) * | 2017-08-21 | 2020-07-07 | 中国科学院长春光学精密机械与物理研究所 | 基于星图的帧间角速度计算方法 |
CN107702709A (zh) * | 2017-08-31 | 2018-02-16 | 西北工业大学 | 一种非合作目标运动与惯性参数的时频域混合辨识方法 |
CN107702709B (zh) * | 2017-08-31 | 2020-09-25 | 西北工业大学 | 一种非合作目标运动与惯性参数的时频域混合辨识方法 |
CN108195403B (zh) * | 2017-12-28 | 2020-05-22 | 中国人民解放军国防科技大学 | 星敏感器在轨姿态测量数据综合误差模型的构建方法及装置 |
CN108195403A (zh) * | 2017-12-28 | 2018-06-22 | 中国人民解放军国防科技大学 | 星敏感器在轨姿态测量数据综合误差模型的构建方法及装置 |
CN109141394B (zh) * | 2018-07-06 | 2020-07-24 | 中科星图股份有限公司 | 一种基于多种姿态传感器的高精度卫星定姿方法 |
CN109141394A (zh) * | 2018-07-06 | 2019-01-04 | 航天星图科技(北京)有限公司 | 一种基于多种姿态传感器的高精度卫星定姿方法 |
CN108871312A (zh) * | 2018-07-09 | 2018-11-23 | 北京控制工程研究所 | 一种重力梯度仪及星敏感器的联合定姿方法 |
CN111240297A (zh) * | 2018-11-28 | 2020-06-05 | 中国科学院沈阳自动化研究所 | 基于Kalman滤波器的航天器姿控***故障诊断方法 |
CN109741381B (zh) * | 2019-01-23 | 2020-07-03 | 张过 | 基于平行观测的星载推扫式光学传感器高频误差消除方法 |
CN109741381A (zh) * | 2019-01-23 | 2019-05-10 | 张过 | 基于平行观测的星载推扫式光学传感器高频误差消除方法 |
CN110703596A (zh) * | 2019-08-01 | 2020-01-17 | 中国科学院力学研究所 | 一种星-臂耦合***的主星姿态预报方法及*** |
CN110793540A (zh) * | 2019-09-11 | 2020-02-14 | 北京控制工程研究所 | 一种提高多探头星敏感器姿态测量精度的方法 |
CN111649766A (zh) * | 2020-06-01 | 2020-09-11 | 哈尔滨理工大学 | 一种磁电编码器角度值噪声主动抑制方法及装置 |
CN113720330A (zh) * | 2021-11-01 | 2021-11-30 | 武汉大学 | 一种亚角秒级的遥感卫星高精度姿态确定设计与实现方法 |
CN113720330B (zh) * | 2021-11-01 | 2022-02-08 | 武汉大学 | 一种亚角秒级的遥感卫星高精度姿态确定设计与实现方法 |
CN114485574A (zh) * | 2021-12-21 | 2022-05-13 | 武汉大学 | 基于卡尔曼滤波模型的三线阵影像pos辅助对地定位方法 |
CN115507845A (zh) * | 2022-10-18 | 2022-12-23 | 闽江学院 | 一种顾及虚拟观测值的卫星姿态融合估计方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105486312B (zh) | 2018-05-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105486312A (zh) | 一种星敏感器与高频角位移传感器组合定姿方法及*** | |
CN108225337B (zh) | 基于sr-ukf滤波的星敏感器和陀螺组合定姿方法 | |
CN102175241B (zh) | 一种火星探测器巡航段自主天文导航方法 | |
CN105372691B (zh) | 一种模糊度固定的长基线卫星编队gnss相对定位方法 | |
CN103076015B (zh) | 一种基于全面最优校正的sins/cns组合导航***及其导航方法 | |
CN103674030B (zh) | 基于天文姿态基准保持的垂线偏差动态测量装置和方法 | |
CN104034329B (zh) | 采用发射惯性系下的多组合导航处理装置的导航方法 | |
CN101726295A (zh) | 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法 | |
CN108592945A (zh) | 一种惯性/天文组合***误差的在线标定方法 | |
CN109000642A (zh) | 一种改进的强跟踪容积卡尔曼滤波组合导航方法 | |
CN102435763B (zh) | 一种基于星敏感器的航天器姿态角速度测量方法 | |
CN109343550B (zh) | 一种基于滚动时域估计的航天器角速度的估计方法 | |
CN104848862B (zh) | 一种环火探测器精密同步定位守时方法及*** | |
CN103674021A (zh) | 基于捷联惯导与星敏感器的组合导航***及方法 | |
CN105698764A (zh) | 一种光学遥感卫星影像时变***误差建模补偿方法及*** | |
CN111536967A (zh) | 一种基于ekf的多传感器融合温室巡检机器人跟踪方法 | |
CN102297693A (zh) | 测量物***置和方位的方法 | |
CN112325886B (zh) | 一种基于重力梯度仪和陀螺仪组合的航天器自主定姿*** | |
CN105300384A (zh) | 一种用于卫星姿态确定的交互式滤波方法 | |
CN103884340B (zh) | 一种深空探测定点软着陆过程的信息融合导航方法 | |
CN111189442B (zh) | 基于cepf的无人机多源导航信息状态预测方法 | |
CN106772524A (zh) | 一种基于秩滤波的农业机器人组合导航信息融合方法 | |
CN109059907A (zh) | 轨迹数据处理方法、装置、计算机设备和存储介质 | |
CN110906933A (zh) | 一种基于深度神经网络的auv辅助导航方法 | |
CN103871075A (zh) | 一种大椭圆遥感卫星地球背景相对运动估计方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |