CN112810834B - 一种同时考核惯性导航和模拟飞行的地面试验方法 - Google Patents

Abstract

本发明涉及一种同时考核惯性导航和模拟飞行的地面试验方法，步骤包括：确定模拟飞行初始参数；获取初始时刻测试地点导航初始参数；通过推力曲线模拟轨道飞行；根据实测主从惯性测量组合实时输出的数据和测试点的初始速度、位置和姿态信息为初值以及主从惯性导航设备实时测量的陀螺数据和加表数据，主从惯组分别使用一套导航进行惯性导航解算，第一套导航获得主惯性测量组合导航结果，第二套导航获得从惯性测量组合导航结果，用于考核主从惯组的导航精度；由此，获得三套导航结果，第三套导航完成的飞行器推力曲线飞行模拟用于飞行控制。本发明采用推力曲线模拟，既可以模拟真实轨道，又反应了真实的惯组特性，使地面试验更加真实可靠。

Description

一种同时考核惯性导航和模拟飞行的地面试验方法

技术领域

本发明涉及一种同时考核惯性导航和模拟飞行的地面试验方法，属于运载火箭控制技术领域。

背景技术

飞行器研制过程中需要在飞行前对飞行过程中的各项控制过程和惯性测量组合产品进行地面模拟飞行的验证，因此，需要采用模拟飞行试验对飞行器制导控制流程和惯性测量组合硬件系统的全面考核，现有模拟飞行方法主要采用推力曲线或1g模拟飞行方法，而推力曲线模拟飞行主要采用软件计算模拟控制流程，没有考虑真实的惯组信息不能考核惯组精度，1g模拟飞行方法引入了真实的惯组信息，但不能完全模拟制导控制流程，两种方法各有优缺点，无法同时实现高效并采用惯组实测数据考核的目的。

发明内容

本发明解决的技术问题是：克服现有技术的不足，提出一种同时考核惯性导航和模拟飞行的地面试验方法，建立三套导航，主从惯组分别使用一套导航，第三套导航方程参与模拟飞行控制，实现一次同时考核惯组和完成制导控制。

本发明解决技术的方案是：

一种同时考核惯性导航和模拟飞行的地面试验方法，具体步骤如下：

S1、确定模拟飞行初始参数

获取轨道起点的初始速度V₀、位置S₀和姿态信息θ₀；并且获取标准轨道所有点的程序角

ψ_cx、γ_cx和发动机推力P_mf及飞行器质量M_mf0；

S2、获取初始时刻测试地点导航初始参数

根据测试地点的纬度B₀、射向A₀，获得惯性导航初值：初始速度V_G、位置S_G和姿态信息θ_G；

S3、通过推力曲线模拟轨道飞行

采用推力曲线模拟得到飞行器角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}和飞行器体坐标系下的视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}，使用第三套导航完成飞行器推力曲线飞行模拟；

S4、根据实测主从惯性测量组合实时输出的数据和测试点的初始速度、位置和姿态信息为初值以及主从惯性导航设备实时测量的陀螺数据和加表数据，主从惯组分别使用一套导航进行惯性导航解算，第一套导航获得主惯性测量组合导航结果，第二套导航获得从惯性测量组合导航结果，用于考核主从惯组的导航精度；

S5、由此，获得三套导航结果，第三套导航完成的飞行器推力曲线飞行模拟用于飞行控制，第一套导航获得的主惯性测量组合导航结果和第二套导航获得从惯性测量组合导航结果用于考核主从惯组的导航精度。

进一步的，S3中，飞行器体坐标系下角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}通过如下方法得到：

程序角角增量＝本周期程序角－上周期程序角

通过如下公式得到飞行器的程序角角增量：

Δψ_{cx_mf}＝ψ_cx-ψ_cx,-1

Δγ_{cx_mf}＝γ_cx-γ_cx,-1

其中，

ψ_cx、γ_cx分别为导航坐标系下本周期俯仰、偏航、滚动方向的程序角，

ψ_cx，-1、γ_cx，-1为导航坐标系下上周期俯仰、偏航、滚动方向的程序角，

Δψ_{cx_mf}、Δγ_{cx_mf}为导航坐标系下俯仰、偏航、滚动方向的程序角角增量。

进一步的，由飞行器导航坐标系下的程序角角增量

Δψ_{cx_mf}、Δγ_{cx_mf}，通过如下公式得到飞行器体坐标系下的三方向角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}：

进一步的，S3中，飞行器体坐标系下视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}通过如下方法得到：

飞行器质量M_mf通过如下公式获得：

M_mf＝M_mf-1-dm_{CD_mf}*T，其中M_mf-1为上一制导周期的飞行器质量，dm_{CD_mf}为飞行器质量消耗率，T为制导周期；质量初值为M_mf0。

进一步的，根据飞行器推力P_mf与飞行器质量M_mf，通过如下公式得到飞行器视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}：

进一步的，S3中，以V_t、S_t、θ_t作为推力曲线段模拟使用的初始惯性导航速度、位置和姿态信息，以及飞行器体坐标系下角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}和飞行器体坐标系下视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}，使用第三套导航进行惯性导航解算，直至飞行结束，获得推力曲线段轨道数据，完成接入推力曲线后飞行模拟。

本发明与现有技术相比的有益效果是：

(1)本发明采用推力曲线模拟，既可以模拟真实轨道，又反应了真实的惯组特性，使地面试验更加真实可靠；

(2)本发明两套惯组的惯性导航可以测试惯性测量组合硬件精度，相比于传统的模拟方法可实现软件复用且完成惯组考核；

(3)本发明的模拟方法简单、效率高。

附图说明

图1为本发明方法流程图。

具体实施方式

下面结合实施例对本发明作进一步阐述。

一种同时考核惯性导航和模拟飞行的地面试验方法，如图1所示，具体步骤如下：

S1、确定模拟飞行初始参数

获取轨道起点的初始速度V₀、位置S₀和姿态信息θ₀；并且获取标准轨道所有点的程序角

ψ_cx、γ_cx和发动机推力P_mf及飞行器质量M_mf0；

S2、获取初始时刻测试地点导航初始参数

根据测试地点的纬度B₀、射向A₀，获得惯性导航初值：初始速度V_G、位置S_G和姿态信息θ_G；

S3、通过推力曲线模拟轨道飞行

采用推力曲线模拟得到飞行器角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}和飞行器体坐标系下的视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}，使用第三套导航完成飞行器推力曲线飞行模拟，其中：

S3.1飞行器体坐标系下角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}通过如下方法得到：

程序角角增量＝本周期程序角－上周期程序角

通过如下公式得到飞行器的程序角角增量：

Δψ_{cx_mf}＝ψ_cx-ψ_cx,-1

Δγ_{cx_mf}＝γ_cx-γ_cx,-1

其中，

ψ_cx、γ_cx分别为导航坐标系下本周期俯仰、偏航、滚动方向的程序角，

ψ_cx，-1、γ_cx，-1为导航坐标系下上周期俯仰、偏航、滚动方向的程序角，

Δψ_{cx_mf}、Δγ_{cx_mf}为导航坐标系下俯仰、偏航、滚动方向的程序角角增量；

由飞行器导航坐标系下的程序角角增量

Δψ_{cx_mf}、Δγ_{cx_mf}通过如下公式得到飞行器体坐标系下的三方向角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}：

S3.2飞行器体坐标系下视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}通过如下方法得到：

飞行器质量M_mf通过如下公式获得：

M_mf＝M_mf-1-dm_{CD_mf}*T，其中M_mf-1为上一制导周期的飞行器质量，dm_{CD_mf}为飞行器质量消耗率，T为制导周期；质量初值为M_mf0；

根据飞行器推力P_mf与飞行器质量M_mf通过如下公式得到飞行器视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}：

S3.3以V_t、S_t、θ_t作为推力曲线段模拟使用的初始惯性导航速度、位置和姿态信息，以及飞行器体坐标系下角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}和飞行器体坐标系下视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}，使用第三套导航进行惯性导航解算，直至飞行结束，获得推力曲线段轨道数据，完成接入推力曲线后飞行模拟；

S4、采用实测主从惯性测量组合输出的飞行模拟

采用实测主从惯性测量组合实时输出的数据和测试点的初始速度、位置和姿态信息为初值，采用主从惯性导航设备实时测量的陀螺数据和加表数据，主从惯组分别使用一套导航进行惯性导航解算，第一套导航获得主惯性测量组合导航结果，第二套导航获得从惯性测量组合导航结果，用于考核主从惯组的导航精度；

S5、由此，获得三套导航结果，第三套导航完成的飞行器推力曲线飞行模拟用于飞行控制，第一套导航获得的主惯性测量组合导航结果和第二套导航获得从惯性测量组合导航结果用于考核主从惯组的导航精度。

本发明采用推力曲线模拟，既可以模拟真实轨道，又反应了真实的惯组特性，使地面试验更加真实可靠；

本发明两套惯组的惯性导航可以测试惯性测量组合硬件精度，相比于传统的模拟方法可实现软件复用且完成惯组考核；本发明的模拟方法简单、效率高。

本发明虽然已以较佳实施例公开如上，但其并不是用来限定本发明，任何本领域技术人员在不脱离本发明的精神和范围内，都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改，因此，凡是未脱离本发明技术方案的内容，依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰，均属于本发明技术方案的保护范围。

Claims (4)

1.一种同时考核惯性导航和模拟飞行的地面试验方法，其特征在于，具体步骤如下：

S1、确定模拟飞行初始参数

获取轨道起点的初始速度V₀、位置S₀和姿态信息θ₀；并且获取标准轨道所有点的程序角

ψ_cx、γ_cx和发动机推力P_mf及飞行器质量M_mf0；

S2、获取初始时刻测试地点导航初始参数

根据测试地点的纬度B₀、射向A₀，获得惯性导航初值：初始速度V_G、位置S_G和姿态信息θ_G；

S3、通过推力曲线模拟轨道飞行

采用推力曲线模拟得到飞行器角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}和飞行器体坐标系下的视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}，使用第三套导航完成飞行器推力曲线飞行模拟；

S4、根据实测主从惯性测量组合实时输出的数据和测试点的初始速度、位置和姿态信息为初值以及主从惯性导航设备实时测量的陀螺数据和加表数据，主从惯组分别使用一套导航进行惯性导航解算，第一套导航获得主惯性测量组合导航结果，第二套导航获得从惯性测量组合导航结果，用于考核主从惯组的导航精度；

S5、由此，获得三套导航结果，第三套导航完成的飞行器推力曲线飞行模拟用于飞行控制，第一套导航获得的主惯性测量组合导航结果和第二套导航获得从惯性测量组合导航结果用于考核主从惯组的导航精度；

S3中，飞行器体坐标系下角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}通过如下方法得到：

程序角角增量＝本周期程序角－上周期程序角

通过如下公式得到飞行器的程序角角增量：

Δψ_{cx_mf}＝ψ_cx-ψ_cx,-1

Δγ_{cx_mf}＝γ_cx-γ_cx,-1

其中，

ψ_cx、γ_cx分别为导航坐标系下本周期俯仰、偏航、滚动方向的程序角，

ψ_cx，-1、γ_cx，-1为导航坐标系下上周期俯仰、偏航、滚动方向的程序角，

Δψ_{cx_mf}、Δγ_{cx_mf}为导航坐标系下俯仰、偏航、滚动方向的程序角角增量；

由飞行器导航坐标系下的程序角角增量

Δψ_{cx_mf}、Δγ_{cx_mf}，通过如下公式得到飞行器体坐标系下的三方向角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}：

2.根据权利要求1所述的一种同时考核惯性导航和模拟飞行的地面试验方法，其特征在于，S3中，飞行器体坐标系下视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}通过如下方法得到：

飞行器质量M_mf通过如下公式获得：

M_mf＝M_mf-1-dm_{CD_mf}*T，其中M_mf-1为上一制导周期的飞行器质量，dm_{CD_mf}为飞行器质量消耗率，T为制导周期；质量初值为M_mf0。

3.根据权利要求2所述的一种同时考核惯性导航和模拟飞行的地面试验方法，其特征在于，根据飞行器推力P_mf与飞行器质量M_mf，通过如下公式得到飞行器视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}：

4.根据权利要求1所述的一种同时考核惯性导航和模拟飞行的地面试验方法，其特征在于，S3中，以V_t、S_t、θ_t作为推力曲线段模拟使用的初始惯性导航速度、位置和姿态信息，以及飞行器体坐标系下角增量δθ_{x_mf}、δθ_{y_mf}、δθ_{z_mf}和飞行器体坐标系下视速度增量δW_{x1_mf}、δW_{y1_mf}、δW_{z1_mf}，使用第三套导航进行惯性导航解算，直至飞行结束，获得推力曲线段轨道数据，完成接入推力曲线后飞行模拟。

Images