一种基于重力梯度仪和陀螺仪组合的航天器自主定姿系统

摘要

本发明公开了一种利用惯性陀螺仪和星载重力梯度仪组合的航天器自主定姿系统，该系统利用计算机内部存储的重力梯度参考图，生成参考重力梯度信息，将参考重力梯度信息、星载重力梯度仪的真实输出、惯性陀螺仪的角速度输出一同输入乘法扩展卡尔曼滤波器(MEKF)，进行滤波递推解算，同时实现航天器姿态、陀螺仪零偏、重力梯度仪常值误差的估计，从而实现高精度的航天器自主姿态确定。本发明要求航天器搭载了高精度惯性陀螺仪和重力梯度仪，在航天器连续机动下仍能进行高精度姿态测量，同时系统外部参考信息来源于地球重力场，直接获取航天器相对于地球固连坐标系的姿态，是一种稳定的无源自主定姿方式。

说明书

技术领域

本发明涉及一种利用惯性陀螺仪和星载重力梯度仪组合的航天器自主定姿系统。它涉及利用陀螺仪输出的角速度信息和重力梯度仪输出的重力梯度信息直接得到航天器相对于地球固连坐标系的高精度姿态信息。属于航天技术领域。

背景技术

高精度的姿态测量对于某些航天任务来说至关重要。首先，一部分航天任务对姿态控制精度有非常高的要求，而高精度的姿态测量是实现高精度姿态控制的前提。例如，在对地高分辨率成像和敏捷成像任务中，姿态测量的精度影响着姿态控制的精度，最终影响成像性能；在空间天文观测任务中，为实现对宇宙目标长时间高分辨率的观测，需要对航天器进行高精度的姿态测量和高精度的稳定控制；在对地激光通讯任务中，姿态测量和姿态控制的精度直接影响着通讯效率及稳定性。另外，一些科学探测任务对姿态测量本身有着很高的要求，例如对地球重力场和磁场的探测任务，原始测量信息表达在仪器本体坐标系下，需要利用高精度的姿态信息将其变换到地球固连坐标系下。

传统的航天器姿态测量仪器主要有陀螺仪、太阳敏感器、地球敏感器、磁强计、星敏感器等，其中，星敏感器是目前航天应用中最精确的姿态测量设备，它的精度比太阳敏感器高一个数量级，比地球敏感器高两个数量级，目前需要高精度姿态确定的各类卫星都广泛采用星敏感器。利用陀螺仪进行短时姿态预报的精度非常高，但是由于存在误差累积，长时间预报的误差会发散，因此目前普遍采用陀螺仪与星敏感器相组合的自主定姿系统。

由于星敏感器测量的是遥远恒星的方位信息，因此其确定的姿态为航天器相对于惯性系的姿态，然而在某些航天任务中需要获取航天器相对于地球固连系的姿态(例如对地观测和对地激光通讯等任务)，此时需要借助地面站上注的地球旋转参数信息实现姿态转换。利用重力梯度仪进行重力场匹配可以直接获取航天器相对于地球固连系的高精度姿态信息。重力梯度匹配定姿的原理在于重力梯度张量具有方向性，不同坐标系下的重力梯度满足张量变换关系，从而可以通过比较测量值与参考值确定姿态。由于重力梯度参考值表示在地球固连系下，因此利用重力梯度匹配可以得到航天器相对于地球固连系的姿态。

关于重力场导航的研究起源于20世纪60、70年代对惯导系统的误差分析，Levine和Gelb在1968年通过分析地球重力场的不确定度对惯导系统的影响，认为重力场模型精度严重影响着惯导系统的整体精度。1972年，Britting等人提出利用重力梯度仪对重力扰动实时估计，从而补偿惯导系统，仿真表明，当重力梯度仪噪声分别小于1.7E和0.9E，可明显提高对速度和位置的估计精度。2006年，Jekeli指出如果未来能够研制出基于冷原子干涉技术的超高精度惯性器件，利用噪声为0.1E的重力梯度仪对其补偿，水平方向的误差将减小到5m，接近GPS系统的精度。上述研究都是利用重力梯度测量补偿惯导系统的无图导航，即计算机不需要存储重力场模型图，适合短时间高精度自主导航。相对应的有图导航，指将测量的重力场信息与内部存储图比对，从而获得位置、姿态。1990年，Affleck与Jircitano提出利用卡尔曼滤波器处理重力梯度测量值与参考值之差，从而修正导航误差。2008年，马里兰大学Richeson在博士论文中进行惯性/重力梯度匹配组合导航的详细研究，结论得出使用0.001E/√Hz的重力梯度仪可以使组合导航的定位定姿精度接近GPS水平。

关于重力场测量在航天器上的应用，1979年，美国的Zondek研究并论证了重力梯度测量用于改进航天器轨道估计的可行性。2003年，波兰的

来源于重力梯度匹配用于航天器定轨的研究思路，本发明设计了一种利用陀螺仪和星载重力梯度仪组合的航天器自主定姿系统，在该组合定姿系统中，利用陀螺仪的角速度测量进行积分获得姿态的积分预测，进一步基于乘法扩展卡尔曼滤波器(MEKF)，利用重力梯度仪的测量值和重力梯度参考值的差值对姿态误差、陀螺零漂、重力梯度仪常值误差进行估计，最后从姿态的积分预测中去除估计得到的姿态误差，从而获得高精度的姿态信息。

发明内容

针对航天器长期自主模式下的高精度对地定姿需求，本发明设计了一种利用陀螺仪和星载重力梯度仪组合的高精度航天器自主定姿系统，本发明的优点在于：组合定姿系统的外部参考信息来源于地球重力场，该信息与地球固连坐标系相关联，可以不依赖地面站支持实现航天器相对于地球固连系的无源高精度自主定姿。

本发明的主要技术方案为：基于星载重力梯度仪测量信息和高精度陀螺仪测量得到的角速度信息，利用MEKF(乘法扩展卡尔曼滤波器)，对航天器姿态、陀螺仪零漂、重力梯度仪常值误差同时滤波估计，实现航天器长时间、高精度的快速组合定姿，其主要步骤如下：

(1)由上一时刻航天器的姿态估计及陀螺仪的角速度测量，获得当前时刻的一步预测姿态四元数；

(2)利用星载计算机内置的重力梯度参考图，根据当前的航天器位置及一步预测姿态，获取地球固连坐标系下的参考重力梯度张量；

(3)将星载重力梯度仪测量及惯性陀螺仪测量输入MEKF(乘法扩展卡尔曼滤波器)，利用滤波器将参考重力梯度、星载重力梯度仪测量及惯性陀螺仪测量三者融合解算，估计姿态误差、螺仪零漂、星载重力梯度仪的常值测量误差；

(4)利用姿态误差的估计值修正一步预测姿态四元数，得到当前时刻的姿态估计值，重复步骤(1)。

基于重力梯度仪和陀螺仪组合的航天器自主定姿系统的主要定义如下：首先，整个系统是一个非线性系统，状态量为航天器本体系相对地球固连坐标系的姿态四元数q＝[q

其中，

星载重力梯度仪由3对高精度加速度计组成，3对加速度计分别安装在3个正交的基线方向上，每对加速度计作差分加速度测量，由于航天器的姿态运动会产生差分加速度，因而星载重力梯度仪输出的是包含了重力梯度信息和角速度信息的一种混合量，数学上表述为

其中，

对系统进行组合导航，首先要进行线性化处理，将原来的状态方程及观测方程转化为误差状态方程及误差观测方程。对于姿态四元数q，其用4个参数描述3个自由度的姿态，而且存在约束||q||＝1，带来数值计算的困难。在MEKF中，首先将姿态四元数转换为对应的姿态旋转矩阵，此时原来的姿态四元数估计误差便转变为了一个小角度的旋转误差，将该小角度旋转误差用欧拉角ψ

Ψ为[ψ

综上所述，误差状态方程中，将欧拉角表示的姿态旋转误差、陀螺仪零漂、重力梯度仪常值测量误差合并为误差状态向量，即X＝[ψ

w为惯性陀螺仪的测量白噪声。

进一步根据(4)式并添加仪器常值测量误差及测量白噪声，可得误差观测方程。

其中

c

v为星载重力梯度仪的测量白噪声。

上述内容基本描述整个组合定姿系统，利用MEKF进行航天器组合定姿的步骤为：

(1)t＝0时刻，状态初始化，包括姿态四元数、陀螺仪零漂、星载重力梯度仪常值测量误差、状态方程噪声、观测方程噪声及初始状态估计方差阵，开始滤波解算；

(2)获取t

(3)根据t

(4)根据卡尔曼滤波的估计方程X

(5)令k＝k+1，重复步骤(2)直至整个航天任务结束。

附图说明

图1是基于重力梯度仪和陀螺仪组合的航天器自主定姿系统的系统方案图。

图2是基于MEKF的组合定姿算法流程图。

具体实施方式

下面将结合附图，对本发明的技术方案及算法流程进行详细完整地说明。

本发明公开了一种基于重力梯度仪和陀螺仪组合的航天器自主定姿系统。如图1所示，航天器在地球固连坐标系下的位置r

星载重力梯度仪输出的为航天器本体系下的重力梯度与角速度的混合量，利用惯性陀螺仪输出的角速度测量及当前姿态估计，便可以得到重力梯度仪输出的计算值

基于重力梯度仪和陀螺仪组合的航天器自主定姿系统是通过乘法扩展卡尔曼滤波器(MEKF)实现的，下面将结合图2具体说明利用MEKF算法实现高精度定姿的流程：

(1)系统初始化，此时k＝0，时刻为t

(2)根据t

计算姿态四元数的一步预测

(3)计算状态变化偏导阵

根据状态变化偏导阵计算误差状态一步转移矩阵

计算一步预测误差状态

X

计算过程噪声Q

(4)计算状态一步预测方差阵

获取t

计算航天器本体系下的参考重力梯度张量

结合t

值

(5)获取星载重力梯度仪的真实输出L

根据误差观测方程(8)式，计算观测矩阵H

获取观测噪声方差阵R＝E(vv

(6)计算滤波修正系数

K＝P

(7)误差状态估计更新

误差状态估计方差阵更新

P

(8)姿态四元数一步预测值修正，令

q

(9)欧拉角姿态误差重置

(10)重复步骤(2)。