无人机出筒姿态恢复方法与流程

摘要: 本技术涉及无人机控制,具体为一种无人机出筒姿态恢复方法。背景技术:1、筒射固定翼无人机为缩减储运体积与发射装置尺寸,通常将前翼、后翼折叠收拢约束于发射筒内部;串...
无人机出筒姿态恢复方法与流程

本技术涉及无人机控制,具体为一种无人机出筒姿态恢复方法。

背景技术:

1、筒射固定翼无人机为缩减储运体积与发射装置尺寸,通常将前翼、后翼折叠收拢约束于发射筒内部;串列翼构型无人机的翼面采用弹簧储能释放实现展开,机构上设计为无人机完全出筒后,后翼优先解除机械约束完成展开,前翼滞后解除约束展开,前后翼分别依靠机械锁定机构锁定在预定展开位置。

2、现有筒射无人机出筒控制普遍采用固定时序控制逻辑:收到发射指令后开始计时,依靠预设时间判定离筒,再通过固定延时确认翼面展开完成,随后直接切入正常飞行控制器,采用固定控制增益将无人机姿态拉回目标值。此种方式在实际应用中存在如下缺陷:

3、一、发射压力、环境温度、装载摩擦、发射筒倾角、侧风、发射平台运动状态发生改变时,实际出筒速度、翼面展开耗时、初始角速度均会偏离设计工况,固定时序无法匹配真实飞行阶段,容易出现阶段误判;

4、二、仅依靠离筒开关、固定展开延时或者单一机械锁定信号进行状态判断,无法区分“后翼先行展开、前翼随后展开”的正常机构过程与真实展开故障;机械锁定开关仅代表锁止机构触发,不等于翼面已经稳定展开、具备完整气动承载与控制能力,容易出现翼面展开不到位、左右展开不同步、锁止机构误触发、舵面驱动受阻等情况下提前释放全部控制权限,在气动构型未稳定时输出较大舵面偏转,损伤展开机构;

5、三、出筒初期空速、动压尚未建立,大舵偏无法输出预期控制力矩;而动压快速上升后,沿用固定控制增益又会引发舵面饱和、角速度振荡、姿态过冲,姿态恢复过程剧烈不平稳。

技术实现思路

1、针对现有技术中存在的缺陷,本技术解决的技术问题为:如何实现无人机出筒后平稳有效的姿态恢复。

2、为实现以上目的,本技术实施例提供一种无人机出筒姿态恢复方法,该方法步骤包括:

3、无人机完全出筒后,获取无人机的展翼数据和动压数据;

4、基于无人机的展翼数据,确定无人机符合预设的可控条件时,对无人机进行角速度阻尼控制,直至无人机达到稳态承载状态;

5、对于稳态承载状态的无人机,若处于可信状态的动压数据达到最低辨识阈值,则根据舵面偏转数据和对应的三轴角速度数据,确定无人机不同控制通道的控制效能,并对三轴角速度数据进行归一化处理,获取归一化三轴角速度指标;

6、若归一化三轴角速度指标小于预设角速度阻尼退出阈值,根据展翼数据、动压数据和归一化三轴角速度指标,确定目标综合控制权限系数;

7、根据基准控制效率矩阵、动压数据和控制效能,获取当前控制效率矩阵,以期望三轴控制力矩为输入,在受目标综合控制权限系数约束的舵面偏转边界条件下,生成舵面控制参数。

8、在一实施方式中,所述无人机完全出筒的判定逻辑为:

9、若轴向过载退出发射高值区间、且离筒开关有效、且发射约束解除、且最小飞行时间大于预设阈值、且动压出现增长,则判定无人机处于完全出筒状态。

10、在一实施方式中,所述无人机的展翼数据包括机翼机械约束状态和机翼展开程度;

11、所述基于无人机的展翼数据,确定无人机符合预设的可控条件的流程包括:

12、基于机翼机械约束状态判断无人机的前翼组和后翼组是否完成机械锁定;

13、基于机翼展开程度确定无人机的前翼组左右不对称度和后翼组左右不对称度;

14、若前翼组和后翼组均完成机械锁定、且前翼组左右不对称度和后翼组左右不对称度均小于对应允许阈值、且前后翼展开顺序与预设机翼展开顺序相符,则判定无人机符合预设的可控条件。

15、在一实施方式中,所述无人机达到稳态承载状态的判定流程包括:

16、在对无人机进行角速度阻尼控制时,采集无人机展翼后的三轴角加速度瞬态数据,对其加权求和后,确定展开瞬态指标;

17、若展开瞬态指标小于稳态承载判定阈值,且持续预设稳定时间,则判定无人机处于稳态承载状态。

18、在一实施方式中,所述归一化三轴角速度指标的计算式为:

19、;

20、式中,为归一化三轴角速度指标,为滚转角速度,为滚转角速度的安全限值,为俯仰角速度,为俯仰角速度的安全限值,为偏航角速度,为偏航角速度的安全限值。

21、在一实施方式中,所述处于可信状态的动压数据的判断流程包括:

22、计算当前时刻采集动压数据与相邻前一时刻采集动压数据的绝对偏差值,若绝对偏差值大于预设可信阈值,则判定当前时刻采集动压数据处于不可信状态;否则,确定处于可信状态;

23、对于处于不可信状态的动压数据,进行当前时刻处于可信状态的动压数据的预测,该预测计算式为:

24、;

25、式中,为当前时刻的动压预测值,为当前时刻的空气密度,为当前时刻的空速预测值,其计算式为:

26、;

27、式中,为与当前时刻相邻前一时刻的空速,为无人机纵向惯性加速度,为当前时刻与相邻前一时刻的绝对时间差。

28、在一实施方式中,所述无人机不同控制通道的控制效能的计算式为:

29、;

30、式中,为当前时刻第个控制通道的控制效能估计值,,其中分别表示滚转通道、俯仰通道和偏航通道,为与当前时刻相邻前一时刻第个控制通道的控制效能估计值,为当前时刻第个控制通道的辨识更新系数,该辨识更新系数的确定逻辑为:

31、;

32、式中,为当前时刻处于可信状态的动压,为正常条件下允许采用的最大辨识更新系数,为允许开始进行控制效能辨识的最低动压,为允许采用正常辨识更新速率的动压阈值,为当前时刻第个控制通道对应的舵面偏转量,为第个控制通道用于判断自然激励是否充分的最小有效舵偏量,为当前时刻第个控制通道的角加速度,为第个控制通道用于判断响应是否有效的最小角加速度响应阈值。

33、在一实施方式中,所述目标综合控制权限系数的计算式为:

34、;

35、式中,为目标综合控制权限系数,且;为翼组结构安全系数,即前翼组和后翼组的结构安全系数的最小值;为动压建立系数,其计算式为:

36、;

37、式中,表示将结果限制在0-1范围内,为当前时刻处于可信状态的动压,为预设置的开始继续释放控制权限的动压,为预设置的允许全部释放权限的动压,且;

38、为角速度安全系数,其确定逻辑为:

39、;

40、式中,为开始降低姿态控制权限的角速度阈值,为停止释放正常姿态控制权限的角速度阈值,且。

41、在一实施方式中,所述前翼组和后翼组的结构安全系数的确定逻辑为:

42、;

43、式中,为翼组的结构安全系数,,其中为前翼组,为后翼组,为翼组机械锁定状态的二值化赋值,若翼组展开到位,取值为1,否则,取值为0,为翼组的左右不对称度,为翼组允许完整释放结构权限的最大左右不对称度,为翼组允许继续保持正常气动控制的最大不对称度,且。

44、在一实施方式中,在受目标综合控制权限系数约束的舵面偏转边界条件下,生成舵面控制参数之前,对目标综合控制权限系数进行变化率限制,该变化率限制的逻辑为:

45、;

46、式中,为当前时刻的目标综合控制权限系数,为当前时刻的实际目标综合控制权限系数,为当前时刻相邻前一时刻的实际目标综合控制权限系数;为时刻间隔时长;为正常状态下的最大权限释放速率;为安全状态恶化时的最大权限回收速率。

47、与现有技术相比,本技术的优点在于:

48、(1)根据展翼数据判断是否符合可控条件,能够适配不同发射工况下机翼展开时序波动,避免构型未建立时过早投入角速度阻尼控制,并且通过先执行角速度阻尼,待达到稳态承载状态后再开展控制效能辨识的方式,有效消除机翼展开瞬态冲击对辨识结果的干扰,提高控制效能辨识精度的同时,利用归一化三轴角速度指标判断机身旋转剧烈程度,仅在角速度降低至阈值以下后计算目标综合控制权限系数,防止高角速度下直接开展姿态控制引发振荡与姿态过冲,并且利用目标综合控制权限系数作为姿态控制的约束,为筒射固定翼无人机出筒后迅速稳定的姿态恢复提供可靠支持。

49、(2)采用多事件融合的方式判断无人机是否完全出筒,避免单一传感器故障、固定计时偏差带来的阶段误切换,实现无人机离筒状态的真实有效判定,更为贴合真实发射物理过程。

50、(3)通过利用实际舵面偏转数据与三轴角速度数据完成控制效能辨识,无需额外施加试探舵偏,避免辨识动作给出筒阶段无人机引入额外扰动,同时仅在动压数据可信且达到最低辨识阈值时启动辨识,能够保证辨识的真实有效。

51、(4)通过实际目标综合控制权限系数约束舵面偏转边界,实现实际目标综合控制权限系数随展翼状态、动压、角速度渐进释放,抑制舵面饱和现象,结合基准控制效率矩阵、动压以及在线辨识得到的控制效能更新当前控制效率矩阵,匹配出筒过程动态变化的气动控制能力,能够提升舵面控制参数求解的合理性。

52、(5)通过对实际目标综合控制权限系数进行变化率限制,实现控制强度跟随翼面构型、动压真实建立过程的平滑过渡,能够适应不同状态判定量的瞬时变化造成的目标综合控制权限系数突变,避免舵面跳变、姿态振荡的情况,进而提升筒射固定翼无人机出筒瞬态过程的控制鲁棒性。