一种适用于姿态机动工况下的星敏和陀螺数据融合方法与流程

本发明涉及航天器姿轨控系统星敏感器(后面简称“星敏”)和陀螺之间数据融合方法，本方法适用于卫星姿态机动期间星敏和陀螺数据融合。

背景技术：

卡尔曼滤波是信息融合算法中应用最普遍的算法之一，主要用于实时融合动态多敏感器冗余数据。其要点是通过测量手段校正模型的不确定性，以模型的连续性克服测量的离散性，以测量的确定性抑制模型的不确定性。当系统的状态方程和量测方程均为线性并且系统噪声与传感器的测量噪声均为高斯白噪声时，应用经典卡尔曼滤波算法可以为融合数据提供唯一的统计意义下的最优估计。用卡尔曼滤波器对数据进行融合后，既能获得系统的当前状态估计，又可预报系统的未来状态。

经典卡尔曼滤波只适用于系统模型为线性的情况，而实际系统都包含非线性因素，扩展卡尔曼滤波(ekf)利用线性化技巧将非线性滤波问题转化为近似线性滤波问题，具体做法是假设步长足够小，围绕标称状态把状态量和观测量展开成泰勒级数，并取一次近似值。

总之，扩展卡尔曼滤波(ekf)是一种常用的线性化方法，将非线性问题转换为标称状态附近的线性问题。克服了经典卡拉曼滤波仅用于线性估计的不足。

实际工程上，采用扩展卡尔曼滤波的方式对星敏和陀螺数据进行融合，可以获得卫星稳态工作时高精度姿态数据，取得较好的应用效果。但是，随着卫星应用越来越多，卫星任务也越来越复杂，姿态确定精度也越来越高，比如某些卫星要求在姿态机动过程中仍需要进行高精度的星敏和陀螺数据融合，由于姿态机动的存在，不满足扩展卡尔曼滤波线性化的假设前提，即传统扩展卡尔曼滤波不适用于卫星姿态机动期间的星敏和陀螺高精度数据融合问题。

技术实现要素：

本发明的目的在于提供一种适用于任意姿态机动情况下星敏感器和陀螺数据融合的方法，解决现有扩展卡尔曼滤波算法在姿态期间姿态估计不准确的问题。

为了达到上述目的，本发明提供一种适用于姿态机动工况下的星敏和陀螺数据融合方法，其包含以下过程：

第一：基于最小二乘原理，确定星敏测量增益系数；

第二：基于上节拍估计姿态和当前陀螺测量角速度，一步递推得到当前拍姿态；

第三：融合星敏测量姿态数据和陀螺递推姿态数据。

本发明采用最小二乘法，将星敏数据和陀螺积分数据进行融合，利用陀螺积分姿态噪声小的特点提高姿态估计精度，利用星敏测量值准确的特点来保持姿态不发散。

本发明提供了一种针对星敏感器和陀螺联合滤波的改进手段，与现有技术相比，其优点和有益效果是：

1)采用最小二乘法对星敏和陀螺数据进行融合，可同时保证数据融合的准确性和精确性；

2)避免了kalman滤波线性化要求，使得星敏和陀螺数据融合算法不仅适用于稳态，也适用于姿态机动等模式。

3)算法原理简单，参数物理意义清晰，软件实现简单可靠，具备极好的工程可操作性。

附图说明

图1是本发明方法的流程示意图。

具体实施方式

以下将结合实施例对本发明的方法作进一步详细说明。

第一：基于最小二乘原理，确定星敏测量增益系数kxm

其中，σtl为陀螺积分姿态白噪声，σxm为星敏测量姿态白噪声。

说明：σtl和σxm可以根据测量数据在线估计，也可以通过地面上注决定。

特殊地：如果陀螺当前节拍故障，可认为σtl→∞，此时kxm＝1；同理，如果星敏当前节拍故障，可认为σxm→∞，此时kxm＝0

第二：基于上节拍估计姿态和当前陀螺测量角速度一步递推得到当前拍姿态

其中：为的范数，φ为欧拉轴转角，为的函数；分别等于

其中，为的三轴角速度分量，δt为滤波算法的迭代周期。

第三：融合星敏测量姿态数据和陀螺递推姿态数据

化简得：

注：本发明假设星敏和陀螺之间的所有系统误差标定方式很多，这里不再进行详细描述。因此，对于本发明来说，星敏和陀螺的测量数据均只包含白噪声，不包含系统噪声。

尽管本发明的内容已经通过上述优选实施例作了详细介绍，但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后，对于本发明的多种修改和替代都将是显而易见的。因此，本发明的保护范围应由所附的权利要求来限定。