一种基于实时气动约束的飞行指令可行域投影与包线守护方法及系统与流程

摘要: 本发明属于无人机飞行控制与飞行安全保护,具体涉及一种基于实时气动约束的飞行指令可行域投影与包线守护方法及系统。背景技术:1、随着无人机在侦察打击一体化任务以及低...
一种基于实时气动约束的飞行指令可行域投影与包线守护方法及系统与流程

本发明属于无人机飞行控制与飞行安全保护,具体涉及一种基于实时气动约束的飞行指令可行域投影与包线守护方法及系统。

背景技术:

1、随着无人机在侦察打击一体化任务以及低空经济飞行器等新型平台中的广泛应用,飞行器在执行高速机动时常常面临极端工况。例如,固定翼无人机在平飞巡航阶段速度约为50m/s,当进入俯冲攻击或快速降高机动时,速度会迅速提升至80–90m/s,动压急剧增加,气动特性和舵面效能随之发生非线性变化。在此过程中,飞行器通常需要执行由外部系统下发的姿态控制输入指令(包括导引头制导的俯仰角、偏航角指令)。若这些指令未经约束直接执行,容易导致以下问题:1.舵面饱和与控制失效:高速下舵效增强,指令阶跃可能超过执行器能力,引发饱和与失控;2.结构超限风险:瞬时法向载荷超过机体设计极限,造成结构损伤或失效;3.迎角尖峰与失速:在拉平过程中,为快速恢复平飞,纵向迎角α突然增大,极易逼近或超过失速迎角;4.外部输入不确定性:导引信息可能受到干扰或出现大幅机动跳变,导致飞行器平台必须承受突发的姿态和速度变化。现有保护措施多为单变量限幅(如限制迎角或过载),或迟滞触发的保护逻辑。这类方法无法处理速度、动压、舵面能力、结构载荷等多约束的耦合问题,也缺乏对外部指令的“最接近可执行映射”。

2、需要一种新的能够在多约束条件下对外部输入指令进行实时映射的控制方法。

技术实现思路

1、本发明的目的是提供一种基于实时气动约束的飞行指令可行域投影与包线守护方法,用于解决现有技术中飞行器在高速机动工况下外部姿态控制输入指令不可执行、舵面饱和、结构超限及失速风险高的技术问题。

2、本发明的目的还在于提供一种基于实时气动约束的飞行指令可行域投影与包线守护方法的系统。

3、本发明解决其技术问题的技术方案为:

4、一种基于实时气动约束的飞行指令可行域投影与包线守护方法,包括以下步骤:

5、s1:采集当前飞行状态的飞行速度、动压、静压、迎角、银行角、舵面能力及结构载荷估计数据,计算最大可用法向载荷及需求过载,判断最大可用法向载荷是否小于需求过载或迎角是否不小于迎角设定值,若是,执行步骤s2;若否,保持当前状态;

6、s2:基于构建的包含法向载荷约束、舵面偏角约束及迎角约束的多约束耦合可行域,采用加权最小二乘法原则将当前飞行状态的输入指令投影至多约束耦合可行域,根据投影情况输出不同级别的可执行指令;

7、s3:根据可执行指令的级别进行不同类型的响应。

8、优选的,步骤s1中的计算最大可用法向载荷及需求过载,具体公式为,

9、;

10、;

11、其中,为速度与动压条件下的最大可用法向载荷,为飞行速度,为动压,为银行角折减因子,为银行角,为需求过载,为重力加速度,为拉平半径;

12、迎角设定值为:,其中,为迎角的失速临界值,为迎角的安全阈值。

13、优选的,所述步骤s2中的多约束耦合可行域具体为:分段线性不等式集合。

14、优选的,所述分段线性不等式集合具体包括:

15、;

16、;

17、;

18、;

19、其中,为当前可用法向载荷,为在当前速度与动压条件下的最大可用法向载荷,为执行器的最大偏角,为限制升降舵最大偏角,为执行器最大偏角速率,为限制副翼最大偏角,为迎角。

20、优选的,所述步骤s2中的加权最小二乘法为:

21、;

22、;

23、其中,为可执行指令,为当前飞行状态的输入指令,为分段线性不等式,为可行域集合,为加权矩阵,为法向载荷权重,为升降舵偏角权重,为副翼偏角权重,且。

24、优选的,所述步骤s2中多约束耦合可行域通过三维网格离线预计算并存储,飞行过程中通过查表与三线性插值获得当前状态下的可行域边界,所述三维网格数据包括:速度、迎角、银行角。

25、优选的,所述步骤s2中采用加权最小二乘法原则将当前飞行状态的输入指令投影至多约束耦合可行域过程中的投影算子通过闭式解法或小规模二次规划求解来实现。

26、优选的,所述步骤s3中根据可执行指令的级别进行不同类型的响应具体为:允许级对应进行允许级响应,即直接下发可执行指令;修正级对应修正级响应,即按照权重等级顺序依次对法向载荷、升降舵偏角、副翼偏角进行修正后,下发修正后的可执行指令;阻断级对应阻断级响应,即保持当前姿态或进入安全模式;其中,在修正级响应或阻断级响应发生时向上层任务规划器反馈修正理由或阻断原因。

27、一种采用基于实时气动约束的飞行指令可行域投影与包线守护方法的系统,包括:

28、飞行状态采样模块:用于采集当前飞行状态的飞行速度、动压、静压、迎角、银行角、舵面能力及结构载荷估计数据;

29、临界判定模块:用于根据采集的当前飞行状态数据计算最大可用法向载荷及需求过载,判断最大可用法向载荷是否小于需求过载或迎角是否不小于迎角设定值;

30、可行域投影模块:用于基于构建的包含法向载荷约束、舵面偏角约束及迎角约束的多约束耦合可行域,采用加权最小二乘法原则将当前飞行状态的输入指令投影至多约束耦合可行域,根据投影情况输出不同级别的可执行指令;

31、分级守护模块:用于根据可执行指令的级别进行不同类型的响应。

32、优选的,可行域投影模块采用加权最小二乘法原则将当前飞行状态的输入指令投影至多约束耦合可行域过程中的投影算子通过闭式解法或小规模二次规划求解来实现。

33、本发明的有益效果为:通过采集当前飞行状态的飞行速度、动压、静压、迎角、银行角、舵面能力及结构载荷估计数据,计算最大可用法向载荷及需求过载,判断最大可用法向载荷是否小于需求过载或迎角是否不小于迎角设定值,确保在过载可用范围内可靠执行拉平机动。基于构建的包含法向载荷约束、舵面偏角约束及迎角约束的多约束耦合可行域,采用加权最小二乘法原则将当前飞行状态的输入指令投影至多约束耦合可行域,根据投影情况输出不同级别的可执行指令;避免不可执行指令直接下发,降低事故风险系数。根据可执行指令的级别进行不同类型的响应,实现任务性能与飞行安全的平衡。通过临界判定与拉平保护,避免进入失速迎角区,提高极端工况下的鲁棒性、安全性。

1.一种基于实时气动约束的飞行指令可行域投影与包线守护方法,其特征在于,包括以下步骤:

2.根据权利要求1所述的基于实时气动约束的飞行指令可行域投影与包线守护方法,步骤s1中的计算最大可用法向载荷及需求过载,具体公式为,

3.根据权利要求1所述的基于实时气动约束的飞行指令可行域投影与包线守护方法,其特征在于,所述步骤s2中的多约束耦合可行域具体为:分段线性不等式集合。

4.根据权利要求3所述的基于实时气动约束的飞行指令可行域投影与包线守护方法,其特征在于,所述分段线性不等式集合具体包括:

5.根据权利要求4所述的基于实时气动约束的飞行指令可行域投影与包线守护方法,其特征在于:所述步骤s2中的加权最小二乘法为:

6.根据权利要求3所述的基于实时气动约束的飞行指令可行域投影与包线守护方法,其特征在于:所述步骤s2中多约束耦合可行域通过三维网格离线预计算并存储,飞行过程中通过查表与三线性插值获得当前状态下的可行域边界,所述三维网格数据包括:速度、迎角、银行角。

7.根据权利要求6所述的基于实时气动约束的飞行指令可行域投影与包线守护方法,其特征在于:所述步骤s2中采用加权最小二乘法原则将当前飞行状态的输入指令投影至多约束耦合可行域过程中的投影算子通过闭式解法或小规模二次规划求解来实现。

8.根据权利要求5所述的基于实时气动约束的飞行指令可行域投影与包线守护方法,其特征在于:所述步骤s3中根据可执行指令的级别进行不同类型的响应具体为:允许级对应进行允许级响应,即直接下发可执行指令;修正级对应修正级响应,即按照权重等级顺序依次对法向载荷、升降舵偏角、副翼偏角进行修正后,下发修正后的可执行指令;阻断级对应阻断级响应,即保持当前姿态或进入安全模式;其中,在修正级响应或阻断级响应发生时向上层任务规划器反馈修正理由或阻断原因。

9.一种采用权利要求1-8任一项所述的基于实时气动约束的飞行指令可行域投影与包线守护方法的系统,其特征在于,包括:

10.根据权利要求9所述的采用基于实时气动约束的飞行指令可行域投影与包线守护方法的系统,其特征在于,可行域投影模块采用加权最小二乘法原则将当前飞行状态的输入指令投影至多约束耦合可行域过程中的投影算子通过闭式解法或小规模二次规划求解来实现。