[发明专利]一种发射坐标系下微型自寻的导弹捷联导航方法

权利要求书

1.一种发射坐标系下微型自寻的导弹捷联导航方法，其特征在于，所述导航方法包括：

步骤100：建立地理坐标系、地球坐标系、载体坐标系和发射坐标系；

以微型自寻的导弹的质心为原点建立地理坐标系n，OX_n轴指向正东，OY_n轴指向正北，OZ_n轴垂直于当地水平面，沿当地垂线向上；采用地理坐标系n作为导航坐标系；

以地球的中心为原点建立地球坐标系e，OX_e轴和OY_e轴在地球赤道平面内，OX_e轴指向本初子午线，OZ_e轴为地球自转轴，OY_e轴与OX_e轴、OZ_e轴构成右手坐标系，地球坐标系e与地球固连；

以导弹的质心为原点建立载体坐标系b，OX_b轴与弹体纵轴重合，指向头部为正，OY_b轴在弹体纵轴对称平面内，垂直于OX_b轴，向上为正，OZ_b轴垂直于X_bOY_b平面，方向按右手定则确定；

导弹控制系统使用发射坐标系下参数作为控制参数，以发射点为原点建立发射坐标系f，OX_f轴是发射点到目标点的连线，指向目标方向，OY_f轴沿原点O_f处的铅垂线指向上，OZ_f轴垂直于X_fOY_f平面，方向按右手定则确定，OX_f轴与北向夹角定义为方位角α，沿OY_f轴正方向看去，逆时针为正，顺时针为负，弹上控制系统需要的实时速度和位置均是发射坐标下的速度和位置(X_f,Y_f,Z_f)；

步骤200：根据微型自寻的导弹的初始信息，以东北天地理坐标系作为导航坐标系，建立导航初始信息，包括所述发射坐标系和所述地理坐标系之间的初始方向余弦矩阵和初始四元数Q；

步骤300：根据初始装订的发射点O_f位置和方位角α，得到所述地球坐标系和所述发射坐标系之间的方向余弦矩阵逐步计算指令角速率

步骤400：根据所述初始方向余弦矩阵确定姿态转换矩阵并得到地理坐标系到惯性系的角速率在载体坐标系上的投影和所述载体坐标系到地理坐标系的角速率在所述载体坐标系上的投影

步骤500：根据所述载体坐标系到地理坐标系的角速率在所述载体坐标系上的投影更新四元数Q；

步骤600：根据所述四元数Q计算所述初始方向余弦矩阵

步骤700：根据矩阵转换原理，经过3次坐标旋转，推导出所述发射坐标系和所述载体坐标系直接的转换关系为

所述发射坐标系和所述载体坐标系直接的转换关系为具体包括：

式中，θ_f、γ_f是载体坐标系相对于发射坐标系的姿态角，分别为航向角，俯仰角和横滚角；

同时，推导得到，

根据的各个元素值，计算出载体坐标系相对于发射坐标系的三个姿态角为：

偏航角

俯仰角

横滚角γ_f＝atan(F₃₂/F₃₃)     (17)

步骤800：推导速度更新；

步骤900：根据地理坐标系下的东北天速度，得到所述发射坐标系下的速度；转换公式如下：

步骤1000：推导位置更新；公式如下：

步骤1100：根据所述地理坐标系下的位置，计算得到所述地球坐标系下的位置，从而得到发射坐标系下的速度。