一种面向母机飞控的基于优先级任务调度及离散动作事件同步控制方法及系统与流程

摘要: 本技术涉及无人机飞控,具体是一种面向母机飞控的基于优先级任务调度及离散动作事件同步控制方法及系统。背景技术:1、随着无人机集群与空中投放技术的快速发展,无人子母...
一种面向母机飞控的基于优先级任务调度及离散动作事件同步控制方法及系统与流程

本技术涉及无人机飞控,具体是一种面向母机飞控的基于优先级任务调度及离散动作事件同步控制方法及系统。

背景技术:

1、随着无人机集群与空中投放技术的快速发展,无人子母机系统在协同侦察、精准投送及分布式作战中扮演着日益重要的角色。子母机飞控系统需同时承担两类性质截然不同的控制任务:一类是强实时、高频率的连续闭环控制(如基于imu/gnss的姿态/航迹保持,通常要求毫秒级响应);另一类是逻辑复杂、带严格时序依赖的离散动作控制(如子机挂载状态下的电永磁锁解锁、电磁插销推出、爆炸螺栓起爆以及分离后的任务阶段切换)。

2、对于离散动作来说,需要保证其任务序列的执行顺序。但是目前的子母无人机分离时遇横风或质量突变,机身极易失稳。此时若强行按原计划执行解锁、插销等离散动作,姿态发散将直接导致坠毁,因此必须优先保障姿态控制(引入优先级调度)。然而,高优先级姿态任务抢占cpu会频繁打断离散动作序列,且物理动作不可逆,无法简单回退或重来。因此,亟需一种协同控制方法:在允许姿态优先抢占的同时,通过物理传感器实时状态感知与断点续传机制,确保离散序列中断后能精准接续执行,从而兼顾飞行安全与分离任务的可靠性。

技术实现思路

1、有鉴于此,本技术的目的是提供一种面向母机飞控的基于优先级任务调度及离散动作事件同步控制方法及系统,以解决背景技术中的问题。

2、为了实现上述目的,本技术采用了如下技术方案:

3、本技术的一种面向母机飞控的基于优先级任务调度及离散动作事件同步控制方法,包括步骤:

4、在子母无人机飞行至分离点的过程中,获取子母无人机的传感器数据,其中,所述传感器数据基于预先配置的时效保障机制更新;

5、在所述子母无人机飞行至预设的分离点时,唤醒预先创建的离散动作任务并置于就绪状态,其中,所述离散动作任务内部按步序索引依次生成离散动作指令,经消息队列下发执行;

6、在子母无人机分离过程中,执行抑制质量突变的临界点前馈补偿,并基于所述传感器数据计算用于表征母机失稳风险的综合风险指标,以及在所述综合风险指标表征母机存在失稳风险时,将飞控模块的控制目标由任务跟踪强制切换为优先级最高的飞行姿态控制,其中,在切换期间离散动作任务处于挂起状态,所述前馈补偿包括在电磁插销通电时立即生效的质量前馈项,以及在确认子机脱离后以一阶惯性滤波方式平滑切入的异步推力修正项;

7、在母机恢复稳定状态时,唤醒离散动作任务并基于传感器数据中的反馈定位待执行的下一离散动作指令,并回到基于所述传感器数据计算用于表征母机失稳风险的综合风险指标,直至分离完成。

8、在本技术一实施例中,获取子母无人机的传感器数据,包括:

9、获取子母无人机的当前的原始传感器数据以及原始传感器数据的采集时间戳,其中,所述原始传感器数据定时更新;

10、基于所述原始传感器数据的采集时间戳和当前时刻计算数据时延;

11、在所述数据时延不超过预设的第一时延阈值时,将所述原始传感器数据作为传感器数据;

12、在所述数据时延超过预设的第一时延阈值时,对所述传感器数据进行惯性补偿并冻结子母无人机控制模块的pid积分项,得到补偿后的传感器数据,并将所述补偿后的传感器数据作为传感器数据;

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、本技术还提供一种面向母机飞控的基于优先级任务调度及离散动作事件同步控制系统,包括:

38、获取模块,用于在子母无人机飞行至分离点的过程中,获取子母无人机的传感器数据,所述传感器数据基于预先配置的时效保障机制更新;

39、分离任务唤醒模块,用于在所述子母无人机飞行至预设的分离点时,唤醒预先创建的离散动作任务并置于就绪状态,其中,所述离散动作任务内部按步序索引依次生成离散动作指令,经消息队列下发执行;

40、分离与优先级调度模块,用于在子母无人机分离过程中,执行抑制质量突变的临界点前馈补偿,并基于所述传感器数据计算用于表征母机失稳风险的综合风险指标,以及在所述综合风险指标表征母机存在失稳风险时,将飞控模块的控制目标由任务跟踪强制切换为优先级最高的飞行姿态控制,其中,在切换期间离散动作任务处于挂起状态,所述前馈补偿包括在电磁插销通电时立即生效的质量前馈项,以及在确认子机脱离后以一阶惯性滤波方式平滑切入的异步推力修正项;

41、循环执行模块,用于在母机恢复稳定状态时,唤醒离散动作任务并基于传感器数据中的反馈定位待执行的下一离散动作指令,并回到基于所述传感器数据计算用于表征母机失稳风险的综合风险指标,直至分离完成。

42、本技术的有益效果是:本技术的一种面向母机飞控的基于优先级任务调度及离散动作事件同步控制方法及系统,一方面,通过时效保障机制确保传感器数据时效性,并在检测到失稳风险时将飞控目标切换至最高优先级的姿态控制,同时挂起离散任务,优先保障机体稳定,避免因强行执行离散动作导致坠毁;另一方面,在姿态恢复后,基于物理传感器实时反馈状态精准定位离散动作断点并唤醒接续执行,避免因物理动作不可逆而采用回退或重试策略,从而确保分离动作序列的严格时序性与完整性。此外,临界点前馈补偿有效抑制质量突变引起的瞬时扰动,进一步提升了分离过程的平滑性与成功率。该方法在保障飞行安全的前提下,显著提高了子母机分离任务的执行可靠性与鲁棒性。