主权项 |
一种基于太阳矢量的偏振辅助导航方法,其特征在于,实现步骤如下:(1)利用偏振传感器阵列主偏振传感器获取偏振方位角,即可获得传感器模块下的方位角<img file="FDA0000864740040000011.GIF" wi="101" he="78" />然后利用偏振传感器阵列测量天空中三个观测点,利用三个观测点的偏振信息即可获得太阳高度<img file="FDA0000864740040000012.GIF" wi="94" he="70" />进而得到模块坐标系下单位太阳矢量S<sup>m</sup>;其具体实现如下:利用主偏振传感器获取偏振方位角<img file="FDA0000864740040000013.GIF" wi="71" he="61" />则单位太阳矢量在模块坐标系下的方位角<img file="FDA0000864740040000014.GIF" wi="79" he="77" />可表示为:<img file="FDA0000864740040000015.GIF" wi="317" he="85" />利用偏振传感器阵列获取散射角θ,则单位太阳矢量在模块坐标系下的太阳高度角<img file="FDA0000864740040000016.GIF" wi="71" he="79" />可表示为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msubsup><mi>h</mi><mi>s</mi><mi>m</mi></msubsup><mo>=</mo><mi>π</mi><mo>/</mo><mn>2</mn><mo>-</mo><mi>θ</mi></mrow>]]></math><img file="FDA0000864740040000017.GIF" wi="328" he="78" /></maths>模块坐标系下单位太阳矢量可表示为:<img file="FDA0000864740040000018.GIF" wi="1284" he="295" />(2)利用天文年历根据载体所在的地理位置信息和时间信息确定太阳矢量方向在地理系下的方位角<img file="FDA0000864740040000019.GIF" wi="67" he="79" />和高度角<img file="FDA00008647400400000110.GIF" wi="77" he="78" />进而得到地理系下单位太阳矢量S<sup>t</sup>;(3)利用偏振光观测姿态误差,计算出太阳矢量在地理坐标系下投影<img file="FDA00008647400400000111.GIF" wi="95" he="79" />通过惯性器件得到载体状态方程,偏振观测得到载体观测方程,建立偏振导航线性模型;(4)利用步骤(3)得到的线性模型,采用卡尔曼滤波器得到载体位置、姿态、速度及惯性器件误差的估计值。 |