CN103852082B - 一种星间测量和陀螺的姿态轨道一体化滤波估计方法 - Google Patents
一种星间测量和陀螺的姿态轨道一体化滤波估计方法 Download PDFInfo
- Publication number
- CN103852082B CN103852082B CN201210501085.2A CN201210501085A CN103852082B CN 103852082 B CN103852082 B CN 103852082B CN 201210501085 A CN201210501085 A CN 201210501085A CN 103852082 B CN103852082 B CN 103852082B
- Authority
- CN
- China
- Prior art keywords
- gyro
- attitude
- satellite
- inter
- measurement
- 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
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/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
Abstract
本发明提供了一种星间测量和陀螺的姿态轨道一体化滤波估计方法,仅依靠陀螺和星间测量信息,由惯性系下误差四元数建立的姿态动力学和追踪星轨道系下建立的相对运动动力学组成的编队卫星姿轨一体化动力学方程,通过大量的星间测量和陀螺测量数据结合卡尔曼滤波算法解决系统的可观性问题,实现对非合作目标的相对导航和姿态确定。本发明与现有技术相比,其效果是:系统配置要求简单,仅需要星间测量和陀螺信息,减少了系统对星敏等定姿系统的依赖,提高了系统可靠性;能够应用于非合作编队卫星;采用间接测量方程,观测阵的耦合特性不强,算法计算简单,易于工程应用。
Description
技术领域
本发明涉及卫星自主编队技术,尤其是一种仅依靠星间测量和陀螺的姿态轨道一体化滤波设计方法。
背景技术
卫星编队飞行是一项重要的技术,但是已不再是一个新理念。中国天宫一号已成功在轨实现交会对接试验。当前卫星编队飞行任务应用于多星立体成像、合成孔径雷达等领域。其中,卫星的编队构型保持和姿态指向确定使其在轨任务完成的主要前提。对于非合作目标卫星,由于缺少对其通信链路,地面测定轨精度较低,卫星姿态轨道的自主确定是实现对其近距离编队、捕获等的唯一途径。
编队卫星姿态轨道的一体化滤波与控制一直是国内外的研究热点。相对姿态轨道的运动学和动力学的耦合使得高精度的姿态轨道一体化滤波和控制难以实现。近年来,国外学者对卫星姿态和相对轨道的一体化滤波也进行了研究,Soo-Goo Kim等在AIAAGuidance Navigation and Control Conference发表文章《Kalman Filtering forRelative Spacecraft Attitude and Position Estimation》研究了合作目标多个电光源(PSD)测量的姿态和相对轨道一体化滤波,滤波算法较复杂,星间测量设备工作复杂,且不能在非合作目标编队应用。Michael s.Andrle等在AIAA/AAS发表《Relative AttitudeDetermination of Formation Flying Spacecraft》研究了提出了分布式卫星三颗星间相对运动的测量进行卫星姿态确定算法,该算法是一种确定性算法,即系统完全可观。国内对编队卫星姿态轨道一体化滤波研究较少。
发明内容
本发明的目的在于提供一种星间测量和陀螺的姿态轨道一体化滤波估计方法,它仅依靠陀螺和星间测量信息实现对非合作目标的相对导航和姿态确定,并且其算法使系统配置简单。
为了达到上述发明目的,本发明的一种星间测量和陀螺的姿态轨道一体化滤波估计方法,包括如下步骤:
步骤一,建立误差四元数姿态动力学
在惯性系下,利用陀螺测量信息,取状态为误差四元数的向量部分和陀螺的零偏,来建立误差四元数姿态动力学;
步骤二,建立相对运动动力学
在追踪星轨道系下,取状态为目标星的相对位置和相对速度,以CW方程建立相对运动动力学方程;
步骤三,将误差四元数动力学和相对运动动力学组成姿轨一体化动力学方程,通过离散化处理,计算一体化动力学的状态转移阵和噪声阵;可采用泰勒两阶展开进行离散化,并计算其动力学状态转移阵和噪声阵;如相对运动采用CW方程,相对运动方程的转移阵和噪声阵的离散化可采用解析方法。联合姿态和相对运动动力学的状态转移阵和噪声阵,组成离散化姿轨一体化动力学方程。
步骤四,将星间测量值转化到追踪星轨道系,光电设备由相机和激光测距仪组成,输出两星间的相对距离和相对角度信息,采用一节泰勒展开实现光电极坐标系下直接测量值到笛卡尔轨道坐标系下的间接测量值。
步骤五,间接测量值对步骤三中的状态求偏导得到观测阵,按照卡尔曼滤波器设计方法,进行动力学和观测值噪声特性整定,进行卡尔曼滤波递推运算实现状态最优估计。
本发明仅光电陀螺信息的姿态轨道一体化滤波估计方法,与现有技术相比,其优点和有益效果是:
1)配置要求简单,提高系统可靠性
陀螺是卫星的常规配置,光电是自主编队卫星的必需配置,仅依靠陀螺和光电信息完成姿态确定和相对导航降低了对系统配置的要求,提高系统可靠性。
2)可用于非合作卫星编队
不需要目标卫星的反馈信息,由光电进行主动测量,能够应用于对非合作目标卫星的编队。
3)观测值姿态轨道耦合特性不强,观测阵计算简单
观测方程采用直角坐标系下的间接测量值,姿轨耦合特性不强,扩展卡尔曼滤波方程的观测阵计算简单。
附图说明
以下将结合附图和实施例对本发明作进一步的说明。
图1是本发明选用的参考直角坐标系;
图2是本发明适用的卫星编队示意图。
具体实施方式
定义误差四元数
式中
——代表惯性系到体坐标系转动的真实姿态四元数
——姿态误差四元数
——姿态四元数估计值
在J2000坐标系下建立误差四元数姿态动力学方程。
其中,是误差四元数的向量部分;是陀螺零偏;,,是陀螺测量值;是陀螺的测量坐标系到卫星本体系的转移矩阵;,分别是陀螺的测量和零漂噪声。
如图1所示,O为卫星质心,Z轴指向地心,Y轴指向轨道面法向反向,X轴指向满足右手定则,即LVLH坐标系,作为参考直角坐标系。在该坐标系下,建立相对运动方程。卫星运行在圆轨道,相对运动方程为CW方程:
其中,为追踪星轨道角速度。,,表示各轴的加速度建模误差等效噪声。为了分析方便,设各轴加速度噪声相同,。
取,,离散化周期T,姿态动力学采用两阶离散化,得:
其中:,
,为式中噪声部分的离散化处理,噪声特性满足:
其中,
如图2所示,追踪星和目标星处于编队飞行状态,目标星位于追踪星的正前方。星间测量设备光电安装在追踪星上,光电伺服机构提供俯仰轴和偏航轴驱动,使其视线轴对准目标星。光电跟踪目标卫星,并输出视线距离、俯仰角、偏航角。与参考系下相对位置关系为:
其中,是星间测量噪声,为高斯白噪声,满足。
将其直接测量数据转换到参考坐标系下,得参考系下间接测量方程:
测量噪声较小,近似线性化处理,参考坐标系下噪声分布特性为:
其中,。
观测阵为:
其中,。
Claims (2)
1.一种星间测量和陀螺的姿态轨道一体化滤波估计方法,其特征在于包括如下步骤:
步骤一,建立误差四元数姿态动力学
在惯性系下,利用陀螺测量信息,取状态为误差四元数的向量部分和陀螺的零偏,来建立误差四元数姿态动力学;
步骤二,建立相对运动动力学
在追踪星轨道系下,取状态为目标星的相对位置和相对速度,以CW方程建立相对运动动力学方程;
步骤三,将误差四元数动力学和相对运动动力学组成姿轨一体化动力学方程,通过离散化处理,得到一体化动力学的状态转移阵和噪声阵;
步骤四,将星间测量值转化到追踪星轨道系,作为间接测量值;
步骤五,间接测量值对步骤三中的状态求偏导得到观测阵,按照卡尔曼滤波器设计方法,进行动力学和观测值噪声特性整定,进行卡尔曼滤波递推运算实现状态最优估计。
2.根据权利要求1所述的星间测量和陀螺的姿态轨道一体化滤波估计方法,其特征在于:所述的步骤五中,观测方程的公式为:
其中:视线距离、俯仰角、偏航角、观测噪声
观测阵为:
其中,,为表示的J2000惯性坐标系到卫星本体系的坐标转换矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210501085.2A CN103852082B (zh) | 2012-11-30 | 2012-11-30 | 一种星间测量和陀螺的姿态轨道一体化滤波估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210501085.2A CN103852082B (zh) | 2012-11-30 | 2012-11-30 | 一种星间测量和陀螺的姿态轨道一体化滤波估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103852082A CN103852082A (zh) | 2014-06-11 |
CN103852082B true CN103852082B (zh) | 2017-04-19 |
Family
ID=50860023
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210501085.2A Active CN103852082B (zh) | 2012-11-30 | 2012-11-30 | 一种星间测量和陀螺的姿态轨道一体化滤波估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103852082B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105486305B (zh) * | 2014-09-17 | 2018-12-28 | 上海新跃仪表厂 | 一种估计加速度计漂移的近程相对导航滤波方法 |
CN105512391B (zh) * | 2015-12-04 | 2018-09-25 | 上海新跃仪表厂 | 基于对偶四元数的多星姿轨动力学建模方法及其验证系统 |
CN106595674B (zh) * | 2016-12-12 | 2019-07-30 | 东南大学 | 基于星敏感器和星间链路的heo卫星编队飞行自主导航方法 |
CN106595673B (zh) * | 2016-12-12 | 2019-12-10 | 东南大学 | 面对地球静止轨道目标操作的空间多机器人自主导航方法 |
CN108958064B (zh) * | 2017-05-17 | 2021-10-01 | 上海微小卫星工程中心 | 姿态导引律误差判断方法、系统及电子设备 |
CN107246875B (zh) * | 2017-07-03 | 2020-07-31 | 上海航天控制技术研究所 | 一种精密编队任务下星间相对姿态确定方法 |
CN107389069B (zh) * | 2017-07-25 | 2020-08-21 | 上海航天控制技术研究所 | 基于双向卡尔曼滤波的地面姿态处理方法 |
CN107883925B (zh) * | 2017-09-11 | 2020-03-24 | 上海航天控制技术研究所 | 一种导航星座星间观测目标卫星图像模拟方法 |
CN107807656B (zh) * | 2017-11-24 | 2020-07-14 | 上海航天控制技术研究所 | 一种双星编队一体化建模方法 |
CN108413986B (zh) * | 2018-03-07 | 2021-11-05 | 北京航空航天大学 | 一种基于Sage-Husa卡尔曼滤波的陀螺仪滤波方法 |
CN110146082B (zh) * | 2019-05-05 | 2021-03-19 | 中国人民解放军63921部队 | 利用测速数据实时估计航天器异常姿态的方法和设备 |
CN111189457B (zh) * | 2020-02-25 | 2021-12-07 | 上海航天控制技术研究所 | 一种基于cw方程的解耦变增益自主相对导航方法 |
CN113022894B (zh) * | 2021-03-08 | 2022-04-19 | 航天科工空间工程发展有限公司 | 一种用于微小卫星的相对姿态确定方法 |
CN114001740B (zh) * | 2021-12-31 | 2022-04-08 | 南京航空航天大学 | 一种基于曲线坐标的无源探测非合作目标定轨方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0910001A2 (en) * | 1997-08-12 | 1999-04-21 | Honeywell Inc. | Satellite attitude determination |
CN101381004A (zh) * | 2008-08-20 | 2009-03-11 | 南京航空航天大学 | 基于大气阻力的微小卫星编队飞行控制方法及控制装置 |
CN101793526A (zh) * | 2010-04-12 | 2010-08-04 | 哈尔滨工业大学 | 一种多信息融合编队航天器自主相对导航方法 |
CN102679985A (zh) * | 2012-05-11 | 2012-09-19 | 北京航空航天大学 | 一种应用星间跟踪的航天器星座分散化自主导航方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2390730C1 (ru) * | 2009-04-06 | 2010-05-27 | Сергей Васильевич Стрельников | Способ эфемеридного обеспечения процесса управления космическими аппаратами глобальной навигационной спутниковой системы |
-
2012
- 2012-11-30 CN CN201210501085.2A patent/CN103852082B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0910001A2 (en) * | 1997-08-12 | 1999-04-21 | Honeywell Inc. | Satellite attitude determination |
CN101381004A (zh) * | 2008-08-20 | 2009-03-11 | 南京航空航天大学 | 基于大气阻力的微小卫星编队飞行控制方法及控制装置 |
CN101793526A (zh) * | 2010-04-12 | 2010-08-04 | 哈尔滨工业大学 | 一种多信息融合编队航天器自主相对导航方法 |
CN102679985A (zh) * | 2012-05-11 | 2012-09-19 | 北京航空航天大学 | 一种应用星间跟踪的航天器星座分散化自主导航方法 |
Non-Patent Citations (3)
Title |
---|
基于鲁棒卡尔曼滤波的编队卫星相对导航;陶久亮等;《航天控制》;20111031;第29卷(第5期);第8-14页 * |
小卫星临近作业轨道和姿态联合控制;张艳召等;《中国空间科学技术》;20081031(第5期);第13-19页 * |
绕飞监测小卫星姿轨联合自适应控制研究;杨佳等;《飞行力学》;20081031;第26卷(第5期);第59-62页 * |
Also Published As
Publication number | Publication date |
---|---|
CN103852082A (zh) | 2014-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103852082B (zh) | 一种星间测量和陀螺的姿态轨道一体化滤波估计方法 | |
CN104316060B (zh) | 空间非合作目标的交会对接方法与装置 | |
CN104567880B (zh) | 一种基于多源信息融合的火星最终接近段自主导航方法 | |
Li et al. | Autonomous navigation and guidance for landing on asteroids | |
Shen et al. | Optical flow sensor/INS/magnetometer integrated navigation system for MAV in GPS-denied environment | |
CN107132542B (zh) | 一种基于光学和多普勒雷达的小天体软着陆自主导航方法 | |
CN109709537A (zh) | 一种基于卫星编队的非合作目标位置速度跟踪方法 | |
CN107806874B (zh) | 一种视觉辅助的捷联惯导极区初始对准方法 | |
CN107621266B (zh) | 基于特征点跟踪的空间非合作目标相对导航方法 | |
CN107144278B (zh) | 一种基于多源特征的着陆器视觉导航方法 | |
CN108663052B (zh) | 一种星上自主空间非合作目标相对导航相机指向控制方法 | |
CN103438890B (zh) | 基于tds与图像测量的行星动力下降段导航方法 | |
CN103968844B (zh) | 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法 | |
Delaune et al. | Extended navigation capabilities for a future mars science helicopter concept | |
CN103017772A (zh) | 一种基于可观性分析的光学和脉冲星融合自主导航方法 | |
Rhudy et al. | Unmanned aerial vehicle navigation using wide-field optical flow and inertial sensors | |
CN110044361A (zh) | 基于目标投影位置的光学载荷星上自主调度方法 | |
CN106672265A (zh) | 一种基于光流信息的小天体定点着陆制导控制方法 | |
Rhudy et al. | Wide-field optical flow aided inertial navigation for unmanned aerial vehicles | |
CN102607563B (zh) | 利用背景天文信息对于航天器进行相对导航的系统 | |
CN110286371A (zh) | 基于雷达点阵数据的小天体着陆器相对位姿确定方法 | |
CN113408623B (zh) | 非合作目标柔性附着多节点融合估计方法 | |
Huang et al. | Design and performance analysis of landmark-based INS/Vision Navigation System for UAV | |
CN113022898B (zh) | 弱引力环境柔性附着系统状态估计方法 | |
CN103950555A (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 |