一种星间测量和陀螺的姿态轨道一体化滤波估计方法
【专利摘要】本发明提供了一种星间测量和陀螺的姿态轨道一体化滤波估计方法，仅依靠陀螺和星间测量信息，由惯性系下误差四元数建立的姿态动力学和追踪星轨道系下建立的相对运动动力学组成的编队卫星姿轨一体化动力学方程，通过大量的星间测量和陀螺测量数据结合卡尔曼滤波算法解决系统的可观性问题，实现对非合作目标的相对导航和姿态确定。本发明与现有技术相比，其效果是：系统配置要求简单，仅需要星间测量和陀螺信息，减少了系统对星敏等定姿系统的依赖，提高了系统可靠性；能够应用于非合作编队卫星；采用间接测量方程，观测阵的耦合特性不强，算法计算简单，易于工程应用。
【专利说明】一种星间测量和陀螺的姿态轨道一体化滤波估计方法
[0001]
【技术领域】
[0002]本发明涉及卫星自主编队技术，尤其是一种仅依靠星间测量和陀螺的姿态轨道一体化滤波设计方法。
[0003]
【背景技术】
[0004]卫星编队飞行是一项重要的技术，但是已不再是一个新理念。中国天宫一号已成功在轨实现交会对接试验。当前卫星编队飞行任务应用于多星立体成像、合成孔径雷达等领域。其中，卫星的编队构型保持和姿态指向确定使其在轨任务完成的主要前提。对于非合作目标卫星，由于缺少对其通信链路，地面测定轨精度较低，卫星姿态轨道的自主确定是实现对其近距离编队、捕获等的唯一途径。
[0005]编队卫星姿态轨道的一体化滤波与控制一直是国内外的研究热点。相对姿态轨道的运动学和动力学的耦合使得高精度的姿态轨道一体化滤波和控制难以实现。近年来，国外学者对卫星姿态和相对轨道的一体化滤波也进行了研究，Soo-Goo Kim等在AIAA Guidance Navigation and Control Conference 发表文章《Kalman Filtering forRelative Spacecraft Attitude and Position Estimation》研究了合作目标多个电光源(PSD)测量的姿态和相对轨道一体化滤波，滤波算法较复杂，星间测量设备工作复杂，且不能在非合作目标编队应用。Michael s.Andrle等在AIAA/AAS发表《Relative AttitudeDetermination of Formation Flying Spacecraft》研究了提出了分布式卫星三颗星间相对运动的测量进行卫星姿态确定算法，该算法是一种确定性算法，即系统完全可观。国内对编队卫星姿态轨道一体化滤波研究较少。
[0006]
【发明内容】
[0007]本发明的目的在于提供一种星间测量和陀螺的姿态轨道一体化滤波估计方法，它仅依靠陀螺和星间测量信息实现对非合作目标的相对导航和姿态确定，并且其算法使系统配置简单。
[0008]为了达到上述发明目的，本发明的一种星间测量和陀螺的姿态轨道一体化滤波估计方法，包括如下步骤:
步骤一，建立误差四元数姿态动力学 在惯性系下，利用陀螺测量信息，取状态为误差四元数的向量部分和陀螺的零偏，来建立误差四元数姿态动力学；
步骤二，建立相对运动动力学
在追踪星轨道系下，取状态为目标星的相对位置和相对速度，以CW方程建立相对运动动力学方程；
步骤三，将误差四元数动力学和相对运动动力学组成姿轨一体化动力学方程，通过离散化处理，计算一体化动力学的状态转移阵和噪声阵；可采用泰勒两阶展开进行离散化，并计算其动力学状态转移阵和噪声阵；如相对运动采用CW方程，相对运动方程的转移阵和噪声阵的离散化可采用解析方法。联合姿态和相对运动动力学的状态转移阵和噪声阵，组成离散化姿轨一体化动力学方程。
[0009]步骤四，将星间测量值转化到追踪星轨道系，光电设备由相机和激光测距仪组成，输出两星间的相对距离和相对角度信息，采用一节泰勒展开实现光电极坐标系下直接测量值到笛卡尔轨道坐标系下的间接测量值。
[0010]步骤五，间接测量值对步骤三中的状态求偏导得到观测阵，按照卡尔曼滤波器设计方法，进行动力学和观测值噪声特性整定，进行卡尔曼滤波递推运算实现状态最优估计。
[0011]本发明仅光电陀螺信息的姿态轨道一体化滤波估计方法，与现有技术相比，其优点和有益效果是:
I)配置要求简单，提高系统可靠性
陀螺是卫星的常规配置，光电是自主编队卫星的必需配置，仅依靠陀螺和光电信息完成姿态确定和相对导航降低了对系统配置的要求，提高系统可靠性。
[0012]2)可用于非合作卫星编队
不需要目标卫星的反馈信息，由光电进行主动测量，能够应用于对非合作目标卫星的编队。
[0013]3)观测值姿态轨道耦合特性不强，观测阵计算简单
观测方程采用直角坐标系下的间接测量值，姿轨耦合特性不强，扩展卡尔曼滤波方程的观测阵计算简单。
[0014]【专利附图】
【附图说明】
[0015]以下将结合附图和实施例对本发明作进一步的说明。
[0016]图1是本发明选用的参考直角坐标系；
图2是本发明适用的卫星编队示意图。
[0017]
【具体实施方式】
[0018]定义误差四元数<i=每 式中
^——代表惯性系到体坐标系转动的真实姿态四元数 <h—姿态误差四元数
?——姿态四元数估计值 在J2000坐标系下建立误差四元数姿态动力学方程。
【权利要求】
1.一种星间测量和陀螺的姿态轨道一体化滤波估计方法，其特征在于包括如下步骤: 步骤一，建立误差四元数姿态动力学 在惯性系下，利用陀螺测量信息，取状态为误差四元数的向量部分和陀螺的零偏，来建立误差四元数姿态动力学； 步骤二，建立相对运动动力学 在追踪星轨道系下，取状态为目标星的相对位置和相对速度，以CW方程建立相对运动动力学方程； 步骤三，将误差四元数动力学和相对运动动力学组成姿轨一体化动力学方程，通过离散化处理，得到一体化动力学的状态转移阵和噪声阵； 步骤四，将星间测量值转化到追踪星轨道系，作为间接测量值； 步骤五，间接测量值对步骤三中的状态求偏导得到观测阵，按照卡尔曼滤波器设计方法，进行动力学和观测值噪声特性整定，进行卡尔曼滤波递推运算实现状态最优估计。
2.根据权利要求1所述的星间测量和陀螺的姿态轨道一体化滤波估计方法，其特征在于:所述的步骤三中，一体化动力学方程的状态为:
3.根据权利要求1所述的星间测量和陀螺的姿态轨道一体化滤波估计方法，其特征在于:所述的步骤五中，观测方程的公式为:
【文档编号】G01C21/24GK103852082SQ201210501085
【公开日】2014年6月11日 申请日期:2012年11月30日 优先权日:2012年11月30日
【发明者】任家栋, 朱虹, 王静吉, 朱文山, 张艳召, 张朝兴, 叶立军 申请人:上海航天控制工程研究所