[发明专利]一种航天器姿态确定方法

说明书

技术领域

本发明涉及一种航天飞行器的姿态确定方法，尤其是一种基于扩展卡尔曼滤波的粒子滤波方法。

背景技术

航天器的姿态确定是姿态控制系统的重要部分，高精度的姿态确定系统为姿态控制算法提供了高精度的输入参数，是高精度姿态控制系统的基础。随着现代航天技术的发展，许多任务对姿态控制系统的要求越来越高，这对姿态确定也就提出了更高的要求。而姿态确定的精度由敏感器的精度以及姿态确定算法有关，因此，应用先进的姿态确定算法去确定航天器的姿态，具有十分重要的意义。

目前，较广泛的应用于卫星姿态确定的非线性滤波算法有经典卡尔曼滤波、扩展卡尔曼滤波等方法，它们都是通过对后验密度进行高斯近似而实现系统的状态估计的。这些方法可以有效解决线性高斯或非线性高斯系统的状态估计问题，但是对于实际应用中广泛存在的非线性非高斯系统效果却不理想。而在粒子滤波虽然可应用于任意噪声分布的系统，但由于粒子在状态空间的探索过程中没有用到最新的观测值，所以当似然函数的高似然度区域出现在先验尾部时，退化现象将会比较严重，又因随后的重采样是在离散分布进行的，从而必然导致样本贫化现象。粒子滤波还有一个不容忽视的问题，就是计算量随着粒子数的增大而急剧膨胀，当状态维数比较高的时候，为提高估计精度需要的粒子数将会更多，这就使得此算法很难广泛地应用于动态系统状态的实时估计之中。为了克服粒子滤波的这些缺陷，在应用过程中必须根据实际情况对基本算法做必要的改进。

因此，现提出一种基于扩展卡尔曼滤波方法的改进粒子滤波算法应用于航天器的姿态确定，首先应用传统的扩展卡尔曼滤波算法，通过对后验密度进行高斯近似而实现系统的状态估计的，然后用此近似的后验密度来作为重要性密度函数，实现粒子滤波。此方法由于考虑了最新的观测值，故在一定程度上能够提高了粒子滤波的状态估计性能。

目前没有发现同本发明类似技术的说明或报道，也尚未收集到国内外类似的资料。

发明内容

本发明的目的在于提供一种航天器姿态确定方法，能够解决非高斯分布的噪声问题，还能解决粒子滤波的粒子退化问题。

为了达到上述发明目的，本发明是通过以下的技术方案实现的，一种航天器姿态确定方法，其采用星敏感器、陀螺为姿态敏感器，利用扩展卡尔曼滤波法EKF与粒子滤波法相结合的改进粒子滤波法，实现航天器姿态确定。

所述的航天器姿态确定方法包括如下步骤：

步骤1、根据选定的敏感器测量特性，搭建敏感器模型

为了提高系统的可靠性，采用三个星敏感器同时工作，利用星敏感器的测量数据，通过改进的粒子滤波方法对卫星姿态的估计进行校正，并估计陀螺漂移，因此得到星敏感器测量值为真实值；再确定陀螺测速模型；

步骤2、根据航天器建立姿态运动学模型

采用欧拉角方式，建立姿态运动学模型，星体姿态运动学方程采用312转动方式，得到航天器的姿态运动学模型；

步骤3、根据敏感器测量模型与航天器的姿态运动学模型，得到状态方程与观测方程

以轨道坐标姿态角和陀螺常值漂移为系统状态变量，以陀螺输出角速度的测量值为输入，根据航天器的姿态运动学模型得到状态方程：以姿态控制系统的测量值为星敏感器的输出，获得系统测量方程；

步骤4、采用改进的粒子滤波算法，实现航天器的姿态确定

初始化；用EKF进行粒子更新；计算权值；重新采样，重新采样得到新的粒子集合，并重新分配粒子权值；输出状态估计。

本发明由于采用基于扩展卡尔曼滤波算法的粒子滤波方法，与现有技术相比，其优点和有益效果是：

解决了航天器姿态确定的问题，可用于噪声为任意分布的姿态确定系统，解决了传统的非线性滤波算法应用于姿态确定时的噪声为高斯分布的约束；并将扩展卡尔曼滤波算法与粒子滤波算法结合，利用扩展卡尔曼滤波的最大后验概率估计产生粒子滤波的重要性密度函数，使重要性密度函数能够融入最新观测信息的同时，更加符合真实状态的后验概率分布，故在一定程度上能够提高PF的状态估计性能。

具体实施方式

本发明航天器的姿态确定方法，通过将扩展卡尔曼滤波方法与粒子滤波方法结合。解决非高斯分布的噪声问题，同时解决粒子滤波的粒子退化问题。此种基于EKF粒子滤波的改进算法，通过使用EKF进行先验估计能够更充分利用EKF和粒子滤波的优点，在重要性密度函数中引入了最新的观测量，降低了粒子的退化程度，此种姿态确定方法能够准确估计卫星的姿态及陀螺漂移。

1.根据所选定的敏感器测量特性，搭建敏感器模型