[发明专利]一种提高地球敏感器体地心矢量精度的方法

摘要

本发明公开了一种提高地球敏感器体地心矢量精度的方法，包括步骤有：步骤(1)定义B坐标系，使B坐标系方向与地球敏感器体坐标系方向相同，B坐标系的坐标原点与地心惯性系相同；步骤(2)将天文导航的位置矢量和惯性导航的位置矢量均转化到某一时刻的B坐标系下；步骤(3)将B坐标系的惯性导航位置增量与所述天文导航的位置增量做差，计算得到地心矢量偏差估计值；步骤(4)补偿地心矢量偏差估计值，得到补偿后的天文导航的位置矢量。本发明利用惯性导航信息，通过地球敏感器体地心矢量偏差的在线估计与补偿，降低了对地球敏感器体测量精度和地球模型的要求，提高了地球敏感器体的位置精度。

主权项

1.一种提高地球敏感器体地心矢量精度的方法，其特征在于，所述方法包括如下步骤：(1)定义B坐标系，使所述B坐标系方向与地球敏感器体坐标系方向相同，B坐标系的坐标原点与地心惯性系相同；(2)将天文导航的位置矢量和惯性导航的位置矢量均转化到某一时刻的所述B坐标系下；(3)将所述B坐标系的惯性导航位置增量与所述天文导航的位置增量做差，计算得到地心矢量偏差估计值；(4)补偿地心矢量偏差估计值，得到补偿后的天文导航的位置矢量；其中，步骤(2)包括：t₂时刻B坐标系下的天文导航的位置矢量为：t₁时刻的B坐标系到t₂时刻的B坐标系的转化矩阵为：式中，φ_z,φ_y,φ_x分别为沿t₁时刻的B坐标系X,Y,Z轴的旋转角；将t₁时刻B坐标系下的天文导航的位置矢量转换到t₂时刻B坐标系下的天文导航的位置矢量得到：式中，R₁表示t₁时刻地心到飞行器之间的距离，ΔR₁为对应的测量误差；将t₁时刻的惯性导航测量的地心惯性系下的位置矢量[X_i1,Y_i1,Z_i1]转化到t₂时刻的B坐标系得到位置矢量[X'₁,Y'₁,Z'₁]：式中，为地心惯性系到t₁时刻的B系的坐标转化矩阵，[X_b1,Y_b1,Z_b1]^T为t₁时刻的B系下的惯性导位置矢量；将t₂时刻的惯性导航测量的地心惯性系下的位置矢量[X_i2,Y_i2,Z_i2]转化到t₂时刻的B坐标系得到位置矢量[X₂,Y₂,Z₂]：式中，为地心惯性系到t₂时刻的B系的坐标转化矩阵，[X_b2,Y_b2,Z_b2]^T为t₂时刻的B系下的惯性导位置矢量；其中，步骤(3)包括：航天器从t₁时刻飞行到t₂时刻，B坐标系中Y轴方向的天文导航的位置增量为：航天器从t₁时刻飞行到t₂时刻，B坐标系中Y轴方向的惯性导航的位置增量为：Y₁′‑Y₂；航天器从t₁时刻飞行到t₂时刻，t₂时刻的B坐标系Y轴方向的天文导航的位置增量和惯性导航的位置增量的差为：根据惯性导航的特性，简化为：根据简化等式求出地心矢量偏差y₀的估计值航天器从t₁时刻飞行到t₂时刻，t₂时刻的B坐标系中Z轴方向的天文导航的位置增量为：航天器从t₁时刻飞行到t₂时刻，t₂时刻的B坐标系中Z轴方向的惯性导航的位置增量为：(Z'₁‑Z₂)航天器从t₁时刻飞行到t₂时刻，t₂时刻的B坐标系Z轴方向的天文导航的位置增量和惯性导航的位置增量的差为：根据惯性导航的特性，简化为：根据简化等式求出地心矢量偏差x₀的估计值其中，步骤(4)包括：补偿后的t₁时刻、t₂时刻的天文导航的位置矢量为：式中，分别为t₁时刻、t₂时刻的B系到地心惯性系到的坐标转化矩阵；其中，(x₁,y₁)为地心在地球敏感器体像平面中的理想的第一投影位置，(x₂,y₂)为地心在地球敏感器体像平面中的理想的第二投影位置，(x₀,y₀)为地心在地球敏感器体像平面中的投影位置系统偏差；f为焦距；为J2000地心惯性下的天文导航的位置矢量；为地心惯性系到B系的坐标转化矩阵，R_i表示地心到飞行器之间的距离，ΔR_i为测量误差，i＝1,2；为地心矢量偏差x₀的估计值，为地心矢量偏差y₀的估计值。