[发明专利]一种低轨卫星入轨初期定轨方法

权利要求书

1.一种适用于低轨卫星发射初期的自主定轨方法，其特征在于：该方法利用卫星磁强计测量的地球磁场信息作为观测量，利用状态方程和观测方程，在初始条件下，建立起状态量的递推公式，所述状态量为卫星位置、速度、姿态，通过多点信息的迭代和滤波，不断校正输出轨道信息，从而实现卫星全磁自主导航计算。

2.根据权利要求1所述的一种适用于低轨卫星发射初期的自主定轨方法，其特征在于：所述状态方程为：

式中，

其中，x、y、z、v_x、v_y、v_z分别表示卫星在惯性坐标系中的位置和速度分量，在轨道坐标系0XYZ中，地磁场强度记为矢量B，在轨道坐标系下的分量为B_x、B_y、B_z,三轴磁强计沿卫星本体坐标系O_bX_bY_bZ_b三轴方向安装，输出测量值分别为B_bx、B_by、B_bz。

3.根据权利要求1所述的一种适用于低轨卫星发射初期的自主定轨方法，其特征在于：所述观测方程的建立方式为：

根据IGRF地磁场模型建立地磁场矢量与卫星轨道位置关系的观测方程：

h＝H(t)X

其中，t为时间，然后根据卫星姿态，将轨道坐标系下的地磁场矢量分量转换为磁强计测量坐标系下的地磁场矢量分量，最终建立起观测方程；其中

h＝[B_bx B_by B_bz]

地磁场矢量在轨道坐标系和测量坐标系下的转换关系为：

式中，为滚动角，θ为俯仰角，ψ为偏航角。