基于锁相环的高旋飞行体滚转角估计方法

针对高旋飞行体滚转角速率难以直接测量的问题,通过分析高旋飞行体的角运动特征,建立了滚转角运动模型,提出了一种基于地磁信息和锁相跟踪的滚转角估计方法。首先利用最小二乘过零检测方法,提取地磁传感器测量的角频率信息,进而解算得到高旋飞行体的转速信息,再根据高旋飞行体角运动特性和俯仰、偏航轴陀螺测量信号特性确定三阶锁相环环路滤波参数,对提取的角频率信息和转速信息进行锁频锁相跟踪。通过软件仿真和载体试验分别对滚转角估计方法进行了验证。结果表明:利用三阶锁相环方法对高旋飞行体滚转角频率进行有效跟踪,能够获取滚转角速度和滚转角,满足高旋飞行体姿态实时解算要求。