一种基于状态观测器的旋转弹姿态角计算方法

摘要

本发明公开了一种基于状态观测器的旋转弹姿态角计算方法。该方法包括：获取旋转弹在当前时刻相对导航坐标系的角速度，并确定所述角速度在弹体坐标系各轴上的分量；获取旋转弹在当前时刻的滚转角校正分量、滚转角测量分量、俯仰角和偏航角；利用所述角速度分量、滚转角校正分量、滚转角测量分量、俯仰角和偏航角，构建姿态角更新矩阵；利用姿态角更新矩阵，计算反馈增益矩阵；根据姿态角更新矩阵、反馈增益矩阵，以及旋转弹在当前时刻的姿态角，计算旋转弹在下一时刻的姿态角。本发明能够实现高速旋转弹的空中实时对准，提高高速旋转弹的打击精度。