[发明专利]利用测速数据实时估计航天器异常姿态的方法和设备

摘要

本发明提出一种利用测速数据实时估计航天器异常姿态的方法和设备，其中方法包括选取航天器姿态参数，联立航天器姿态运动学、姿态动力学方程，建立航天器姿态参数X的动力学方程；建立航天器测速数据的观测方程；推导动力学方程、观测方程对航天器姿态参数的Jacobi矩阵；响应于航天器姿态发生故障，将获取的多个测站对航天器的测速数据作为观测量，采用扩展卡尔曼滤波算法进行航天器姿态参数X的实时估计；以及滤波收敛后，输出航天器姿态参数的估计值。本发明的方案通过航天器测速数据实时估计航天器姿态信息，适应性强且收敛迅速。另外，不需要航天器遥测信息，可为航天器姿态异常情况下的姿态故障诊断和处置提供有效依据。