[发明专利]一种基于中心误差熵准则扩展卡尔曼滤波的姿态确定方法

说明书

本发明公开了一种基于中心误差熵准则扩展卡尔曼滤波的姿态确定方法，该方法用于确定航天器姿态，包括：根据航天器的观测数据和航天器姿态动力学模型，建立航天器姿态确定的非线性系统；根据非线性系统和泰勒展开公式，获取航天器对应的状态预测方程和近似观测方程，并对状态预测方程和近似观测方程进行增广处理；基于增广处理后的状态预测方程和近似观测方程，构建中心误差熵准则滤波的代价函数，对代价函数进行最大化处理，确定航天器状态变量的最优估计值。本发明的基于中心误差熵准则扩展卡尔曼滤波的姿态确定方法能够提高处理非高斯噪声时的航天器姿态估计精度和鲁棒性。

技术领域

本发明涉及航天器姿态估计技术领域，具体涉及一种基于中心误差熵准则扩展卡尔曼滤波的姿态确定方法。

背景技术

高精度高可靠的姿态确定是航天器开展空间在轨服务等任务的基础。目前航天器的姿态确定方法按姿态解算方法不同可以分为确定性方法和状态估计法两类，其中，状态估计法采用滤波的方法根据观测信息对航天器状态量进行估计，可以有效的克服参考矢量的不确定性影响。

在高斯噪声假设下，航天器姿态确定主要应用扩展卡尔曼滤波和Sigma点卡尔曼滤波，基于最小均方误差准则的经典卡尔曼滤波和基于最小均方误差准则的各类非线性滤波器在高斯噪声的条件下有着最优或近似最优的滤波效果。然而，在实际工程实践中往往会出现非高斯噪声，在面对工程中经常出现的野值、脉冲等诱导的非高斯噪声时，卡尔曼滤波不具有鲁棒性，而基于最小均方误差准则的各类非线性滤波器也必须满足高斯假设，在面对非高斯环境时会出现精度差甚至滤波发散的现象。

为处理非高斯噪声，目前主要使用非高斯滤波器，非高斯滤波器包括：粒子滤波器(PF)、高斯和滤波器(GSP)、Huber滤波器、Student’s t滤波器、最大相关熵滤波器(MCKF)和最小误差熵滤波器(MEEKF)。其中，粒子滤波器采用序贯重要性采样方法来近似计算后验密度，可以处理任意非高斯噪声；高斯和滤波器将非高斯噪声建模为高斯和分布以处理非高斯噪声；Huber滤波器采用M估计的方法处理非高斯噪声，有着较好的鲁棒性；Student’s t滤波器将非高斯噪声假设为student’s t分布以处理非高斯噪声；最大相关熵滤波器和最小误差熵滤波器分别以最大相关熵准则和最小误差熵准则为最优准则，相比传统的最小均方误差准则有着更好的非高斯噪声的处理效果。

然而，上述的非高斯滤波器中，粒子滤波器具有较高的计算复杂度，且其粒子退化和粒子贫化问题也是很难处理的问题；高斯和滤波器假设噪声的概率密度是已知的，且有着较大的计算量；Huber滤波器的精度有限；Student’s t滤波器只能对特定的非高斯噪声进行处理，环境适应性较差；最大相关熵滤波器虽然可以将概率密度函数的峰值固定到零，但是单独使用时算法的精度有限；最小误差熵滤波器具有平移不变性，不能保证估计误差收敛到零。

发明内容

为解决上述现有技术中存在的部分或全部技术问题，本发明提供一种基于中心误差熵准则扩展卡尔曼滤波的姿态确定方法。

本发明的技术方案如下：

提供了一种基于中心误差熵准则扩展卡尔曼滤波的姿态确定方法，所述方法用于确定航天器姿态，所述方法包括：

根据航天器的观测数据和航天器姿态动力学模型，建立航天器姿态确定的非线性系统；

根据所述非线性系统和泰勒展开公式，获取航天器对应的状态预测方程和近似观测方程，并对状态预测方程和近似观测方程进行增广处理；

基于增广处理后的状态预测方程和近似观测方程，构建中心误差熵准则滤波的代价函数，对所述代价函数进行最大化处理，确定航天器状态变量的最优估计值。

在一些可选的实施方式中，建立航天器姿态确定的非线性系统为：