[发明专利]一种基于偏振光传感器的航姿测定方法

说明书

技术领域

本发明属于飞行器姿态测量与估计技术领域，涉及一种基于偏振光传感器的航姿测定方法。

背景技术

航姿参考系统(AHRS)能够为飞行器提供航向角、滚转角和俯仰角信息。它一般由多个轴向传感器组成，目前主要有两种组合：一种由三轴陀螺仪、三轴加速度计和三轴磁强计组成，另一种由三轴陀螺仪、三轴加速度计和GPS组成。但是以上两种方法的测量均存在各自的缺点：第一种组合的磁强计容易受到周围磁场和其他机载电子设备的影响，从而导致航向误差增大；第二种方法的GPS在静态时不能提供航向角，高机动时易丢星，同样将导致航向误差的增大。为了弥补以上缺点，本发明加入了偏振光传感器，提出基于偏振光传感器的航姿测定方法。

发明内容

本发明旨在采用偏振光传感器测量的偏振光方位角去修正陀螺仪的测量数据，提高姿态捷联矩阵的精确性，已达到提高姿态测量精度的目的。

本发明采用如下技术方案：

一种基于偏振光传感器的航姿测定方法，采用的设备包括三轴陀螺仪、三轴加速度计、偏振光传感器、GPS和飞控计算机。三轴陀螺仪测量飞行器三轴角速率，三轴加速度计测量飞行器的三轴加速度。偏振光传感器测量偏振光方位角。GPS提供当地时间、飞行器所在位置、速度信息。飞控计算机需要实时处理各种传感器传回的数据，还要将处理的结果发送给飞行器的控制单元，以实现对飞行器的机构控制，同时也承担将数据发送到地面站和接受地面控制指令的任务，因此必须考虑信息处理的实时性和数据融合算法的精简程度。通过加速度计测量的数据校正陀螺仪角速率的俯仰角、滚转角误差，偏振光传感器测量数据修正陀螺仪角速率的航向角误差，提高飞行器的姿态测量精度。

该方法具体步骤如下：

(1)采集三轴加速度计、偏振光传感器和GPS的输出数据，确定飞行器的初始滚转角φ、俯仰角θ和航向角ψ，建立导航坐标系到机体坐标系的初始姿态矩阵和机体坐标系到偏振光传感器坐标系的姿态矩阵

(2)根据飞行器所属时区，通过天文历计算方法估算当地太阳高度角h_s、方位角A_s，然后计算得到太阳方向矢量在导航坐标系下的投影

asunn=[cos(hs)sin(As)cos(hs)cos(As)sin(hs)]---(1)]]>

(3)根据偏振光传感器坐标系、机体坐标系、导航坐标系之间关系和瑞利散射原理得到偏振光传感器坐标系下的入射光最大偏振方向矢量的观测值：