一种基于盒粒子滤波的高能效卫星姿态确定算法

摘要

本发明公开了一种基于盒粒子滤波的高能效卫星姿态确定算法，具体包括以下步骤：通过双矢量算法对磁强计和太阳敏感计的测量数据进行预处理，解算得出卫星姿态四元数；通过预测方程对卫星姿态四元数进行预测，得出卫星姿态预测结果；通过卫星姿态预测结果和卫星姿态四元数进行比较，其交集为残差；根据量测噪声的概率模型和残差得出似然函数；通过残差对卫星姿态预测结果进行收缩，得出收缩后的卫星姿态预测结果；根据前一时刻卫星姿态的权重，结合似然函数计算该时刻的卫星姿态的权重；根据权重估计得出卫星当前的姿态估计值；本发明为后续姿态控制器提供了高精度的量测数据，是姿态控制系统实现有效控制的必要前提。