一种基于加表的高可靠性轨控推力器故障判别方法
技术领域
本发明属于在轨推进系统故障诊断技术领域，尤其涉及一种基于加表的高可靠性轨控推力器故障判别方法。
背景技术
现有的在轨推进系统故障诊断方法事先通过大量样本数据建立故障判别模型，再根据过程采集数据获取误差统计量进行故障判别，但在实际应用时，推进系统敏感器的布置数量有限且采集的测量信息计算误差较大，通过现有诊断方法进行判别可能与实际不符，出现错判和虚判，为了在轨控期间进行实时高可靠性判别，需要采取一定的技术途径来保证推力器故障判别的实时性与高可靠性。
发明内容
本发明的技术解决问题：克服现有技术的不足，提供一种了基于加表的高可靠性轨控推力器故障判别方法，实现了对轨控推力器执行故障情况的实时、可靠判别。
为了解决上述技术问题，本发明公开了一种基于加表的高可靠性轨控推力器故障判别方法，包括：
计算测试喷气期间的速度增量和角速度增量；
估计测试喷气期间的轨控推力和干扰力矩；
根据计算得到的测试喷气期间的速度增量和角速度增量、以及估计的测试喷气期间的轨控推力和干扰力矩，进行轨控推力器测试喷气期间的故障判别。
在上述基于加表的高可靠性轨控推力器故障判别方法中，计算测试喷气期间的速度增量和角速度增量，包括：
对轨控推力器测试喷气期间的测量加速度进行积分，得到测试喷气期间的速度增量dvot：
其中，tc表示控制周期时长，i表示测试喷气期间的周期数，k0表示测试喷气开始时的周期数，kn表示测试喷气结束时的周期数，aot(i)表示测试喷气期间轨控推力方向第i周期的加速度测量值；
根据轨控推力器测试喷气前后的Y轴和Z轴的角速度变化量，计算得到Y轴的角速度增量dωot_y和Z轴的角速度增量dωot_z：
dωot_y＝ωot_y(kn)-ωot_y(k0)
dωot_z＝ωot_z(kn)-ωot_z(k0)
其中，ωot_y(i)表示第i周期Y轴角速度测量值，ωot_z(i)表示第i周期的Z轴角速度测量值，轨控推力所在方向为X轴。
在上述基于加表的高可靠性轨控推力器故障判别方法中，估计测试喷气期间的轨控推力和干扰力矩，包括：
由测试喷气开始时的飞行器质量m(k0)和测试喷气期间的速度增量dvot，计算得到测试喷气期间的轨控推力估计值Fot_est：
其中，dtot表示喷气测试的理论喷气输出时长；
由喷气时飞行器惯量、Y轴的角速度增量dωot_y和Z轴的角速度增量dωot_z，计算得到Y轴的干扰力矩估计值Test_y和Z轴的干扰力矩估计值Test_z：
其中，Iyy和Izz分别表示喷气时飞行器Y轴的主惯量和Z轴的主惯量。
在上述基于加表的高可靠性轨控推力器故障判别方法中，根据计算得到的测试喷气期间的速度增量和角速度增量、以及估计的测试喷气期间的轨控推力和干扰力矩，进行轨控推力器测试喷气期间的故障判别，包括：
Fot_est、Test_y和Test_z满足以下任一条件时，确定轨控推力器故障：
条件一：Fot_est<αot·F0；
条件二：Test_y>Ty0；
条件三：Test_z>Tz0；
其中，αot∈(0,1)，表示测试喷气期间的轨控推力故障判断比例阈值；F0表示轨控推力器的额定推力；Ty0表示Y轴的干扰力矩判断阈值；Tz0表示Z轴的干扰力矩判断阈值。
本发明公开了一种基于加表的高可靠性轨控推力器故障判别方法，包括：
计算恒推力轨控期间的动量增量；
估计恒推力轨控期间的轨控推力；
根据计算得到的恒推力轨控期间的动量增量和估计的恒推力轨控期间的轨控推力，进行轨控推力器恒推力轨控期间的故障判别。
在上述基于加表的高可靠性轨控推力器故障判别方法中，计算恒推力轨控期间的动量增量，包括：
根据恒推力轨控期间的飞行器质量和加速度，计算恒推力轨控期间的动量增量dMfc：
其中，tc表示控制周期时长，j表示恒推力轨控期间的周期数，j0表示恒推力轨控开始时的周期数，pn表示恒推力轨控结束时的周期数，mfc(j)表示恒推力轨控期间第j周期的飞行器质量，afc(j)表示恒推力轨控期间轨控推力方向第j周期的加速度测量值。
在上述基于加表的高可靠性轨控推力器故障判别方法中，估计恒推力轨控期间的轨控推力，包括：
确定恒推力轨控期间的轨控时长dtfc：
dtfc＝tc·(j-p0)
由恒推力轨控期间的动量增量dMfc和轨控时长dtfc，计算得到当前轨控推力估计值Ffc_est：
在上述基于加表的高可靠性轨控推力器故障判别方法中，根据计算得到的恒推力轨控期间的动量增量和估计的恒推力轨控期间的轨控推力，进行轨控推力器恒推力轨控期间的故障判别，包括：
Ffc_est满足以下任一条件时，确定轨控推力器故障：
条件一：dtfc1≤dtfc<dtfc2时，Ffc_est<αfc1·Ffc0；
条件二：dtfc2≤dtfc<dtfc3时，Ffc_est<αfc2·Ffc0；
条件三：dtfc3≤dtfc时，Ffc_est<αfc3·Ffc0；
其中，dtfc1、dtfc2和dtfc3分别表示恒推力轨控期间的三级故障判断时间点设定值，0<dtfc1<dtfc2<dtfc3；αfc1、αfc2和αfc3分别表示恒推力轨控期间的三级轨控推力故障判断比例阈值，0<αfc1<αfc2<αfc3<1；Ffc0表示恒推力轨控期间的标称推力。
本发明公开了一种基于加表的高可靠性轨控推力器故障判别方法，包括：
计算恒加速度轨控期间的速度增量；
估计恒加速度轨控期间的平均加速度；
根据计算得到的恒加速度轨控期间的速度增量和估计的恒加速度轨控期间的平均加速度，进行轨控推力器恒加速度轨控期间的故障判别。
在上述基于加表的高可靠性轨控推力器故障判别方法中，计算恒加速度轨控期间的速度增量，包括：
对恒加速度轨控期间的测量加速度进行积分，得到恒加速度轨控期间的速度增量dvac：
其中，tc表示控制周期时长，l表示恒加速度轨控期间的周期数，qo表示恒加速度轨控开始时的周期数，qn表示恒加速度轨控结束时的周期数，aac(l)表示恒加速度轨控期间轨控推力方向第l周期的加速度测量值。
在上述基于加表的高可靠性轨控推力器故障判别方法中，估计恒加速度轨控期间的平均加速度，包括：
确定恒加速度轨控期间的轨控时长dtac：
dtac＝tc·(l-q0)
由恒加速度轨控期间的速度增量dvac和轨控时长dtac，计算得到恒加速度轨控期间的平均加速度估计值aac_est：
在上述基于加表的高可靠性轨控推力器故障判别方法中，根据计算得到的恒加速度轨控期间的速度增量和估计的恒加速度轨控期间的平均加速度，进行轨控推力器恒加速度轨控期间的故障判别，包括：
aac_est满足以下任一条件时，确定轨控推力器故障：
条件一：dtac1≤dtac<dtac2时，aac_est<αac1·aac0；
条件二：dtac2≤dtac<dtac3时，aac_est<αac2·aac0；
条件三：dtac3≤dtac时，aac_est<αac3·aac0；
其中，dtac1、dtac2和dtac3分别表示恒加速度轨控期间的三级故障判断时间点设定值，0<dtac1<dtac2<dtac3；αac1、αac2和αac3分别表示恒加速度轨控期间的三级轨控推力故障判断比例阈值，0<αac1<αac2<αac3<1；表示恒加速度轨控期间的标称加速度值。
本发明具有以下优点：
(1)本发明公开了一种基于加表的高可靠性轨控推力器故障判别方法，基于轨控推力器喷气期间的加速度测量值，通过与标称值进行分级比较，实现高可靠性的快速推力器故障判别，无需基于大量数据样本建立故障判别模型，算法简单；无需在燃料储箱布置敏感器采集储箱温度、压力等物理参数，易于工程应用。
(2)本发明公开了一种基于加表的高可靠性轨控推力器故障判别方法，适用于不同的轨控推力器喷气模式，适用范围广。
(3)本发明公开了一种基于加表的高可靠性轨控推力器故障判别方法，轨控期间，可定义不同的喷气时长和相应阈值进行分级判断，能在实时性和可靠性上进行灵活选择。
附图说明
图1是本发明实施例中一种基于加表的高可靠性轨控推力器故障判别方法的步骤流程图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明公开的实施方式作进一步详细描述。
本发明公开了一种基于加表的高可靠性轨控推力器故障判别方法，具体可以包括如下至少三个方面的判别：1、轨控推力器测试时故障判别；2、恒推力轨控时故障判别；3、恒加速度轨控时故障判别。
如图1，在本实施例中，在进行轨控推力器故障判别之前，需要先对轨控推力器的喷气模式进行判断，根据判断结果选择相应的故障判别方案进行故障判别。
优选的，当轨控推力器的喷气模式为测试喷气模式时，进行轨控推力器测试时故障判别，具体流程如下：
步骤11，计算测试喷气期间的速度增量和角速度增量。
对轨控推力器测试喷气期间的测量加速度进行积分，得到测试喷气期间的速度增量dvot：
根据轨控推力器测试喷气前后的Y轴和Z轴的角速度变化量，计算得到Y轴的角速度增量dωot_y和Z轴的角速度增量dωot_z：
dωot_y＝ωot_y(kn)-ωot_y(k0)dωot_z＝ωot_z(kn)-ωot_z(k0)
其中，tc表示控制周期时长，i表示测试喷气期间的周期数，k0表示测试喷气开始时的周期数，kn表示测试喷气结束时的周期数，aot(i)表示测试喷气期间轨控推力方向第i周期的加速度测量值，ωot_y(i)表示第i周期Y轴角速度测量值，ωot_z(i)表示第i周期的Z轴角速度测量值，轨控推力所在方向为X轴。
步骤12，估计测试喷气期间的轨控推力和干扰力矩。
由测试喷气开始时的飞行器质量m(k0)和测试喷气期间的速度增量dvot，计算得到测试喷气期间的轨控推力估计值Fot_est：
由喷气时飞行器惯量、Y轴的角速度增量dωot_y和Z轴的角速度增量dωot_z，计算得到Y轴的干扰力矩估计值Test_y和Z轴的干扰力矩估计值Test_z：
其中，dtot表示喷气测试的理论喷气输出时长，Iyy和Izz分别表示喷气时飞行器Y轴的主惯量和Z轴的主惯量。
步骤13，根据计算得到的测试喷气期间的速度增量和角速度增量、以及估计的测试喷气期间的轨控推力和干扰力矩，进行轨控推力器测试喷气期间的故障判别。
Fot_est、Test_y和Test_z满足以下任一条件时，确定轨控推力器故障：
条件一：Fot_est<αot·F0；
条件二：Test_y>Ty0；
条件三：Test_z>Tz0；
其中，αot∈(0,1)，表示测试喷气期间的轨控推力故障判断比例阈值；F0表示轨控推力器的额定推力；Ty0表示Y轴的干扰力矩判断阈值；Tz0表示Z轴的干扰力矩判断阈值。
优选的，当轨控推力器的喷气模式为恒推力模式时，进行恒推力轨控时故障判别，具体流程如下：
步骤21，计算恒推力轨控期间的动量增量。
根据恒推力轨控期间的飞行器质量和加速度，计算恒推力轨控期间的动量增量dMfc：
其中，tc表示控制周期时长，j表示恒推力轨控期间的周期数，j0表示恒推力轨控开始时的周期数，pn表示恒推力轨控结束时的周期数，mfc(j)表示恒推力轨控期间第j周期的飞行器质量，afc(j)表示恒推力轨控期间轨控推力方向第j周期的加速度测量值。
步骤22，估计恒推力轨控期间的轨控推力。
确定恒推力轨控期间的轨控时长dtfc：
dtfc＝tc·(j-p0)
由恒推力轨控期间的动量增量dMfc和轨控时长dtfc，计算得到当前轨控推力估计值Ffc_est：
步骤23，根据计算得到的恒推力轨控期间的动量增量和估计的恒推力轨控期间的轨控推力，进行轨控推力器恒推力轨控期间的故障判别。
Ffc_est满足以下任一条件时，确定轨控推力器故障：
条件一：dtfc1≤dtfc<dtfc2时，Ffc_est<αfc1·Ffc0；
条件二：dtfc2≤dtfc<dtfc3时，Ffc_est<αfc2·Ffc0；
条件三：dtfc3≤dtfc时，Ffc_est<αfc3·Ffc0；
其中，dtfc1、dtfc2和dtfc3分别表示恒推力轨控期间的三级故障判断时间点设定值，0<dtfc1<dtfc2<dtfc3；αfc1、αfc2和αfc3分别表示恒推力轨控期间的三级轨控推力故障判断比例阈值，0<αfc1<αfc2<αfc3<1；Ffc0表示恒推力轨控期间的标称推力。
优选的，当轨控推力器的喷气模式为恒加速度模式时，进行恒加速度轨控时故障判别，具体流程如下：
步骤31，计算恒加速度轨控期间的速度增量。
对恒加速度轨控期间的测量加速度进行积分，得到恒加速度轨控期间的速度增量dvac：
其中，tc表示控制周期时长，l表示恒加速度轨控期间的周期数，qo表示恒加速度轨控开始时的周期数，qn表示恒加速度轨控结束时的周期数，aac(l)表示恒加速度轨控期间轨控推力方向第l周期的加速度测量值。
步骤32，估计恒加速度轨控期间的平均加速度。
确定恒加速度轨控期间的轨控时长dtac：
dtac＝tc·(l-q0)
由恒加速度轨控期间的速度增量dvac和轨控时长dtac，计算得到恒加速度轨控期间的平均加速度估计值aac_est：
步骤33，根据计算得到的恒加速度轨控期间的速度增量和估计的恒加速度轨控期间的平均加速度，进行轨控推力器恒加速度轨控期间的故障判别。
aac_est满足以下任一条件时，确定轨控推力器故障：
条件一：dtac1≤dtac<dtac2时，aac_est<αac1·aac0；
条件二：dtac2≤dtac<dtac3时，aac_est<αac2·aac0；
条件三：dtac3≤dtac时，aac_est<αac3·aac0；
其中，dtac1、dtac2和dtac3分别表示恒加速度轨控期间的三级故障判断时间点设定值，0<dtac1<dtac2<dtac3；αac1、αac2和αac3分别表示恒加速度轨控期间的三级轨控推力故障判断比例阈值，0<αac1<αac2<αac3<1；表示恒加速度轨控期间的标称加速度值。
综上所述，本发明公开了一种基于加表的高可靠性轨控推力器故障判别方法，基于轨控推力器喷气期间的加速度测量值，通过与标称值进行分级比较，实现高可靠性的快速推力器故障判别，计算简单，易于工程应用。
本发明虽然已以较佳实施例公开如上，但其并不是用来限定本发明，任何本领域技术人员在不脱离本发明的精神和范围内，都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改，因此，凡是未脱离本发明技术方案的内容，依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰，均属于本发明技术方案的保护范围。
本发明说明书中未作详细描述的内容属于本领域技术人员的公知技术。
