CN102735265B - 一种基于陀螺漂移估计值的星敏感器周期性故障检测方法 - Google Patents
一种基于陀螺漂移估计值的星敏感器周期性故障检测方法 Download PDFInfo
- Publication number
- CN102735265B CN102735265B CN201210211409.9A CN201210211409A CN102735265B CN 102735265 B CN102735265 B CN 102735265B CN 201210211409 A CN201210211409 A CN 201210211409A CN 102735265 B CN102735265 B CN 102735265B
- Authority
- CN
- China
- Prior art keywords
- star sensor
- estimated value
- gyroscopic drift
- drift estimated
- estimate value
- 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
Landscapes
- Gyroscopes (AREA)
- Navigation (AREA)
Abstract
一种基于陀螺漂移估计值的星敏感器周期性故障检测方法,利用陀螺漂移估计值的谱分析对星敏感器周期性慢变故障进行检测。对于由星敏感器和陀螺构成的卫星姿态确定系统,陀螺漂移估计值是根据星敏感器观测量得到的。当星敏感器观测量中包含具有特定频率的周期性误差信号时,通过卡尔曼滤波获得的陀螺漂移的估计值中也会包含同样频率的周期性误差。因此,星敏感器周期性慢变故障会体现在陀螺漂移的估计值中,可根据陀螺漂移估计值检测星敏感器周期性慢变故障。傅立叶变换法是检测周期信号存在性的有效方法,通过对陀螺漂移估计值进行傅立叶变换,得到其频谱,并对特定谱段的频谱进行监测,可以判断出是否存在星敏感器周期性慢变故障。
Description
技术领域
本发明涉及一种基于陀螺漂移估计值的星敏感器周期性故障检测方法,属于卫星姿态控制领域。
背景技术
随着测绘卫星的飞速发展,对卫星姿态确定系统的要求越来越高。卫星姿态确定系统不仅为卫星控制系统服务,还在有效载荷数据处理中起到至关重要的作用。为了保障对地观测卫星上的有效载荷获取高精度图像,要求卫星姿态确定系统能够准确给出卫星姿态信息。
高精度指向卫星广泛采用由星敏感器和陀螺构成的卫星姿态确定系统。该系统以星敏感器和陀螺作为测量部件,采用卡尔曼滤波算法并结合卫星姿态运动学方程处理传感器测量信息,实现对卫星姿态误差和陀螺漂移误差的实时估计,修正利用陀螺观测量递推得到的卫星姿态数据,提供星体的三轴姿态信息。
星敏感器是用星光方位来确定卫星姿态的精密姿态测量部件,能够根据多颗恒星矢量的观测数据给出星敏感器光轴矢量在惯性系中的坐标。卫星在轨运行过程中受太阳照射角度呈现周期性变化趋势,自身结构受热不均匀,星敏感器及其安装结构会受其影响而产生形变,导致星敏感器测量输出发生动态偏移。星敏感器周期性慢变故障指的是在轨卫星上的星敏感器受冷热交变的空间热环境等因素影响而产生的依轨道周期变化的故障,是影响卫星姿态确定精度的主要因素之一。
实现对星敏感器周期性慢变故障的检测,是对星敏感器周期性慢变故障作进一步估计和补偿的前提。目前星上缺乏对星敏感器周期性慢变故障进行检测的手段。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提出一种基于陀螺漂移估计值谱分析的星敏感器周期性慢变故障检测方法,实现对星敏感器周期性慢变故障的检测,为星敏感器周期性慢变故障的进一步估计和补偿奠定技术基础。
本发明的技术解决方案是:
一种基于陀螺漂移估计值的星敏感器周期性故障检测方法,依托于卫星上安装的陀螺和星敏感器实现,步骤如下:
(1)通过卡尔曼滤波算法处理时间Time内的陀螺和星敏感器的输出观测量,获得卫星姿态估计值和陀螺漂移估计值的时间序列;
(2)通过对步骤(1)中得到的陀螺漂移估计值的时间序列进行离散傅立叶变换,得到陀螺漂移估计值的频谱;
(3)根据步骤(2)中得到的陀螺漂移估计值的频谱产生故障检测残差,如果故障检测残差超过故障检测阈值时,则星敏感器发生了周期性慢变故障,如果故障检测残差未超过故障检测阈值,则星敏感器未发生周期性慢变故障。
所述步骤(1)中的时间Time至少为1个轨道周期。
所述步骤(3)中的故障检测阈值的取值范围为[2×10-4,4×10-4]。
所述步骤(3)中根据陀螺漂移估计值产生故障检测残差是通过如下公式进行:
LD(i,j)=ψx,i(jω),
其中,LD(i,j)表示故障检测残差,ψx,i(jω)表示信号频率为jω时陀螺漂移估计值的频谱,i=1,2,3,j=1,2,3,4,5,ω=2π/T,T表示轨道周期。
本发明与现有技术相比的有益效果是:
目前星上缺乏对星敏感器慢变故障进行检测的手段。本发明所提方法能够实现对星敏感器周期性慢变故障的检测,为星敏感器周期性慢变故障的进一步估计和补偿奠定基础。
附图说明
图1为本发明流程图;
图2为通过卡尔曼滤波算法得到的陀螺漂移估计值;
图3为陀螺漂移估计值的频谱。
具体实施方式
下面结合附图对本发明的具体实施方式进行进一步的详细描述。
如图1所示,本发明提出一种基于陀螺漂移估计值的星敏感器周期性故障检测方法,依托于卫星上安装的陀螺和星敏感器实现,步骤如下:
(1)通过卡尔曼滤波算法处理一个观测时段上(时间Time内)的陀螺和星敏感器的输出观测量,获得卫星姿态估计值和陀螺漂移估计值的时间序列,时间Time至少为1个轨道周期。
利用卡尔曼滤波算法获得卫星姿态估计值和陀螺漂移估计值的公式如下所示;
其中,表示k时刻状态量的预测值,表示k时刻状态量的估计值,可写为如下所示的分量形式,
表示卫星姿态误差的估计值,表示陀螺漂移估计值。F表示状态转移矩阵,其表达式为
τ0表示滤波周期,表示卫星姿态角速率的估计值,可通过陀螺观测量得到,和表示的三个分量。矩阵的形式为
yk表示k时刻的观测量,可表示为
是根据星敏感器观测量得到的误差四元数,H表示测量矩阵,其形式为
H=[I3×3 03×3]
K表示滤波增益阵。滤波增益阵K的计算方法可参见中国宇航出版社1998年出版的由屠善澄主编的《卫星姿态动力学与控制》一书。卡尔曼滤波算法的递推计算过程可参考西北工业大学出版社1998出版的由秦永元、张洪钺、汪叔华编写的《卡尔曼滤波与组合导航原理》一书。
(2)通过对步骤(1)中得到的陀螺漂移估计值的时间序列进行离散傅立叶变换,得到陀螺漂移估计值的频谱,即根据以下公式计算陀螺漂移估计值的频谱:
其中,ψx,l(f)表示陀螺漂移估计值的频谱,l=1,2,3,f表示信号频率,表示陀螺漂移估计值的时间序列,即
表示状态量的估计值的第l+3个分量,表示对时间序列的离散傅立叶变换。
(3)根据陀螺漂移估计值的频谱产生故障检测残差,故障检测残差产生如下式所示:
LD(i,j)=ψx,i(jω)
其中,LD(i,j)表示故障检测残差,Ψx,i(jω)表示信号频率为jω时陀螺漂移估计值的频谱,i=1,2,3,j=1,2,3,4,5,ω=2π/T,T表示轨道周期。监测故障检测残差,如果任意一个故障检测残差超过某个事先给定的故障检测阈值时,则判断星敏感器发生周期性慢变故障,如果故障检测残差均未超过故障检测阈值,则判断星敏感器未发生周期性慢变故障,具体方式如下:如果LD(i,j)≥TD,则判断星敏感器发生周期性慢变故障,其中,TD表示事先给定的故障检测阈值。TD的取值范围为[2×10-4,4×10-4]。
下面,以对地定向的三轴稳定卫星姿态确定系统为诊断对象,通过仿真实例验证本发明所述方法的有效性。设陀螺随机漂移为0.02°/h,星敏感器测量噪声方差为1″,星敏感器周期性慢变故障幅值为0.5″。仿真过程中,取滤波周期为1s。仿真时间(即陀螺漂移估计值时间序列的长度)为5个轨道周期。
通过卡尔曼滤波得到的陀螺漂移估计值如图2所示,从上到下依次对应x轴、y轴和z轴三个陀螺的漂移估计值。纵坐标表示陀螺漂移估计值的大小,单位为″/s,横坐标表示时间,单位为轨道周期。从图中很难直接判断时间序列中是否存在周期信号。
接下来,通过离散傅立叶变换得到陀螺漂移估计值的频谱,如图3所示,图中横坐标为ω的倍数。显然,在频率为2ω和4ω处,陀螺漂移估计值的频谱存在显著的尖峰。采用本发明所述方法,根据陀螺漂移估计值的频谱产生故障检测残差,设置故障检测阈值TD=4×10-4,将故障检测残差与故障检测阈值相比较可以判断出星敏感器存在周期性慢变故障。
仿真结果表明,本发明提出的基于陀螺漂移估计值谱分析的星敏感器周期性慢变故障检测方法能够实现对星敏感器周期性慢变故障的检测。本发明的主要技术内容可应用于高分辨率对地观测卫星的姿态确定系统故障诊断。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。
Claims (3)
1.一种基于陀螺漂移估计值的星敏感器周期性故障检测方法,依托于卫星上安装的陀螺和星敏感器实现,其特征在于步骤如下:
(1)通过卡尔曼滤波算法处理时间Time内的陀螺和星敏感器的输出观测量,获得卫星姿态估计值和陀螺漂移估计值的时间序列;
(2)通过对步骤(1)中得到的陀螺漂移估计值的时间序列进行离散傅立叶变换,得到陀螺漂移估计值的频谱;
(3)根据步骤(2)中得到的陀螺漂移估计值的频谱产生故障检测残差,如果故障检测残差超过故障检测阈值时,则星敏感器发生了周期性慢变故障,如果故障检测残差未超过故障检测阈值,则星敏感器未发生周期性慢变故障;
所述根据陀螺漂移估计值产生故障检测残差是通过如下公式进行:
LD(i,j)=ψx,i(jω),
其中,LD(i,j)表示故障检测残差,ψx,i(jω)表示信号频率为jω时陀螺漂移估计值的频谱,i=1,2,3,j=1,2,3,4,5,ω=2π/T,T表示轨道周期。
2.根据权利要求1所述的一种基于陀螺漂移估计值的星敏感器周期性故障检测方法,其特征在于:所述步骤(1)中的时间Time至少为1个轨道周期。
3.根据权利要求1所述的一种基于陀螺漂移估计值的星敏感器周期性故障检测方法,其特征在于:所述步骤(3)中的故障检测阈值的取值范围为[2×10-4,4×10-4]。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210211409.9A CN102735265B (zh) | 2012-06-18 | 2012-06-18 | 一种基于陀螺漂移估计值的星敏感器周期性故障检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210211409.9A CN102735265B (zh) | 2012-06-18 | 2012-06-18 | 一种基于陀螺漂移估计值的星敏感器周期性故障检测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102735265A CN102735265A (zh) | 2012-10-17 |
CN102735265B true CN102735265B (zh) | 2014-12-17 |
Family
ID=46991187
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210211409.9A Active CN102735265B (zh) | 2012-06-18 | 2012-06-18 | 一种基于陀螺漂移估计值的星敏感器周期性故障检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102735265B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103323026B (zh) * | 2013-05-30 | 2015-08-19 | 北京控制工程研究所 | 星敏感器和有效载荷的姿态基准偏差估计与修正方法 |
CN104729537B (zh) * | 2015-03-19 | 2017-07-28 | 北京控制工程研究所 | 一种星敏感器低频误差在轨实时补偿方法 |
CN106568436B (zh) * | 2016-10-26 | 2019-04-26 | 上海航天控制技术研究所 | 一种利用陀螺修正星敏感器轨道周期系统误差的方法 |
CN108332775A (zh) * | 2017-12-26 | 2018-07-27 | 中国人民解放军国防科技大学 | 提高星敏感器姿态测量精度的方法 |
CN116026367B (zh) * | 2023-03-29 | 2023-07-04 | 中国人民解放军火箭军工程大学 | 基于数字孪生技术的激光惯组故障诊断方法、系统及设备 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6760664B1 (en) * | 2001-06-25 | 2004-07-06 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Autonomous navigation system based on GPS and magnetometer data |
CN101214859A (zh) * | 2007-12-26 | 2008-07-09 | 北京控制工程研究所 | 一种变轨期间自主故障检测恢复控制的方法 |
CN101216319A (zh) * | 2008-01-11 | 2008-07-09 | 南京航空航天大学 | 基于联邦ukf算法的低轨卫星多传感器容错自主导航方法 |
CN102175266A (zh) * | 2011-02-18 | 2011-09-07 | 哈尔滨工业大学 | 一种运动体陀螺惯性组件的故障诊断方法 |
-
2012
- 2012-06-18 CN CN201210211409.9A patent/CN102735265B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6760664B1 (en) * | 2001-06-25 | 2004-07-06 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Autonomous navigation system based on GPS and magnetometer data |
CN101214859A (zh) * | 2007-12-26 | 2008-07-09 | 北京控制工程研究所 | 一种变轨期间自主故障检测恢复控制的方法 |
CN101216319A (zh) * | 2008-01-11 | 2008-07-09 | 南京航空航天大学 | 基于联邦ukf算法的低轨卫星多传感器容错自主导航方法 |
CN102175266A (zh) * | 2011-02-18 | 2011-09-07 | 哈尔滨工业大学 | 一种运动体陀螺惯性组件的故障诊断方法 |
Non-Patent Citations (2)
Title |
---|
基于多敏感器卫星姿态确定系统故障检测方法研究;彭蓉等;《机械强度》;20071231;第29卷(第3期);全文 * |
星上惯性姿态敏感器故障诊断方法评述;王立峰等;《航天器工程》;20090531;第18卷(第3期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN102735265A (zh) | 2012-10-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101726295B (zh) | 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法 | |
Wu et al. | Fast complementary filter for attitude estimation using low-cost MARG sensors | |
CN102735265B (zh) | 一种基于陀螺漂移估计值的星敏感器周期性故障检测方法 | |
CN104792340B (zh) | 一种星敏感器安装误差矩阵与导航系统星地联合标定与校正的方法 | |
Li et al. | An in situ hand calibration method using a pseudo-observation scheme for low-end inertial measurement units | |
Searcy et al. | Magnetometer-only attitude determination using novel two-step Kalman filter approach | |
CN103090870B (zh) | 一种基于mems传感器的航天器姿态测量方法 | |
CN102879014B (zh) | 深空探测接近过程的光学成像自主导航半物理仿真试验系统 | |
CN107478223A (zh) | 一种基于四元数和卡尔曼滤波的人体姿态解算方法 | |
CN104503233B (zh) | 适用于卫星姿态控制的干扰力矩辨识方法 | |
CN101696885A (zh) | 一种提高星敏感器数据处理精度的方法 | |
CN102175260A (zh) | 一种自主导航系统误差校正方法 | |
CN107054697B (zh) | 一种纳卫星磁力矩器空间温度补偿姿态控制方法 | |
CN104833375B (zh) | 一种借助星敏感器的imu两位置对准方法 | |
CN106767925A (zh) | 带双轴转位机构的惯导系统三位置参数辨识对准方法 | |
CN102323450B (zh) | 基于双星相邻能量差分原理的星载加速度计数据标校方法 | |
CN103398725A (zh) | 一种基于星敏感器的捷联惯导系统初始对准的方法 | |
Jafari et al. | Skew redundant MEMS IMU calibration using a Kalman filter | |
CN103019252B (zh) | 一种火星探测器自主对地定向控制方法 | |
Zagorski et al. | Steepest descent quaternion attitude estimator | |
CN105043414A (zh) | 一种三轴惯性稳定平台系统的台体控制参数计算方法 | |
Xiaolin et al. | A tightly coupled rotational SINS/CNS integrated navigation method for aircraft | |
EP2879011B1 (en) | On-board estimation of the nadir attitude of an Earth orbiting spacecraft | |
CN109443378A (zh) | 速度辅助行进间回溯初始对准方法 | |
CN103292810A (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |