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

权利要求书

1.一种基于偏振光传感器的航姿测定方法，其特征在于以下步骤，

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

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

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

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

sinψ~p1cosψ~p10=0-10100000CbmCnbasunn=A1A201×3CbmCnbasunn=A1CbmCnbasunnA2CbmCnbasunn0---(2)]]>

(4)采集偏振光传感器输出的偏振方位角ψ_pl，在偏振光传感器坐标系下，计算入射光的最大偏振方向矢量的测量值：sinψp1cosψp10;]]>

(5)计算航向误差校正矢量，入射光最大偏振方向矢量的观测值与测量值的偏差即为航向角误差，其值为两个矢量的叉乘：

eψ=sinψ~p1cosψ~p10×sinψp1cosψp10---(3)]]>

(6)采集三轴加速度数据g_b和三轴陀螺仪数据ω_b，去掉加速度计测量值中的向心加速度，得到重力加速度矢量参考值；

gr=gb+ωenn×V---(4)]]>

其中速度V由GPS得到，由V经过公式计算得到。

(7)计算俯仰、滚转误差校正矢量，即重力加速度的观测值与实际测量参考值g_r单位矢量的差值，其值为两矢量的叉乘：

eφθ=C13C23C33×gr|gr|---(5)]]>

(8)进行互补滤波，通过反馈控制校正陀螺仪测量角速率，从而提高航向角、俯仰角、滚转角的精度；

ω＝ω_b+k_ψPe_ψ+k_ψIdtΣe_ψ+k_φθPe_φθ+k_φθIdtΣe_φθ  (6)

(9)通过四元数法更新，得到新的姿态矩阵和姿态角；

(10)重复(1)至(9)过程，实现系统实时输出飞行器的航姿信息。