一种降落伞控制方法、设备及介质与流程
本发明涉及降落伞,尤其涉及一种降落伞控制方法、设备及介质。
背景技术:
1、无人机应急回收系统中,降落伞控制器承担着在飞行器失去动力或姿态失控时可靠引爆火工品以展开伞舱的核心功能,其决策的准确性与时效性直接决定回收成败。进一步地,在典型的飞行任务中,控制器需在飞行全程持续接收来自飞行控制计算机的周期数据帧,从中解析出飞行器的实时高度与垂向运动信息,并依据预设的开伞条件做出点火判断。然而,实际飞行场景呈现出复杂的动态特性,飞行器在动力故障后的下降速率可能因机型、载重、气动外形等因素而存在显著差异,高速坠落与低速飘降两种极端情形对开伞时机的需求截然不同。
2、在现有技术中,大多数控制方案通常仅以固定高度阈值作为唯一点火判据,即在高度下降至某一预设值时触发点火。这种做法隐含了一个假设,即认为同一高度值在不同下降速率下对应的剩余安全时间大致相等,但这一假设在实际中并不成立,因为伞舱从点火指令发出到完全展开需要一定的物理动作时间,若飞行器下降速率过快,即便在安全高度触发点火,伞舱仍可能在触地前无法完成充气;反之,若下降速率过慢,则可能在远高于安全高度的位置过早开伞,增加伞衣与机体吊挂结构的冲击载荷。可见,由于上述局限,现有方案难以在不同飞行器的实际下降动态下均实现安全、平稳的回收。
技术实现思路
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、判断所述存放时长是否达到预设的存放时长阈值,且各所述单体电压是否均高于预设的第一放电电压阈值;
38、若所述存放时长达到所述存放时长阈值且各所述单体电压均高于所述第一放电电压阈值,则向所述电量计发送存放放电指令,控制所述电量计进入存放放电模式;
39、在所述存放放电模式中,持续获取各所述单体电压并记录放电时长;
40、当各所述单体电压均降至预设的第二放电电压阈值时,或者当所述放电时长达到预设的硬超时阈值时,向所述电量计发送终止放电指令;
41、若任一所述单体电压低于预设的保护电压阈值,向所述电量计发送异常终止指令。
42、可选地,所述方法还包括:
43、监测第一通信链路的链路状态和第二通信链路的链路状态,所述第一通信链路为降落伞控制器与飞控计算机之间的有线通信链路,所述第二通信链路为降落伞控制器与地面操作站之间的红外通信链路;
44、基于所述第一通信链路的链路状态和所述第二通信链路的链路状态,判断所述第一通信链路和所述第二通信链路是否可用;
45、当检测到失联事件时,若所述第一通信链路可用,则通过所述第一通信链路向所述飞控计算机发送第一故障上报消息,和/或,若所述第二通信链路可用,则通过所述第一通信链路向所述飞控计算机发送第一故障上报消息;所述第一故障上报消息至少携带失联标志;
46、当检测到电池异常事件时,若所述第一通信链路可用,则通过所述第一通信链路向所述飞控计算机发送第二故障上报消息,和/或,若所述第二通信链路可用,则通过所述第二通信链路向所述飞控计算机发送第二故障上报消息;所述第二故障上报消息至少携带电压异常标志;
47、对于所述第一通信链路接收到的消息,解析所述消息中的目标组件标识;若所述目标组件标识指示非本机组件或广播,且所述第二通信链路可用,则将所述消息经由所述第二通信链路发送至所述地面操作站;
48、对于所述第二通信链路接收到的消息,解析所述消息中的目标组件标识;若所述目标组件标识指示非本机组件或广播,且所述第一通信链路可用,则将所述消息经由所述第一通信链路发送至所述飞控计算机。
49、第二方面,本发明还提供了一种计算机设备,其包括存储器及处理器,所述存储器上存储有计算机程序,所述处理器执行所述计算机程序时实现上述方法。
50、第三方面,本发明还提供了一种计算机可读存储介质,所述存储介质存储有计算机程序,所述计算机程序当被处理器执行时可实现上述方法。
51、本发明提供了一种降落伞控制方法、设备及介质,飞行状态数据包经解析后得到当前高度、垂直速度和心跳信号,并将当前高度和垂直速度分别保存为有效高度和有效速度,为后续失联场景下的点火延迟计算保留了数据基础;进一步地,失联条件的判断将飞控链路状态作为决策路径分流的首要依据:当满足失联条件时,冻结已保存的有效高度和有效速度,利用有效速度作为下降速率参与第一点火延迟量的计算,使点火延迟量随飞行器失联前的实际下降速率反向变化,即下降速率越快则点火延迟量越小,从而实现高速下降时提前点火、低速下降时推迟点火;进一步地,当不满足失联条件时,以当前高度与第一高度阈值的比较结果作为第二条决策分流依据,当前高度低于该阈值时立即点火,形成不依赖通信链路的绝对高度兜底;进一步地,若当前高度不低于该阈值且接收到常规开伞触发指令,则利用最大速度参数作为保守下降速率参与第二点火延迟量的计算,使点火延迟量随当前高度正向变化。上述三路径按优先级依次判定,使点火触发信号在不同的飞行状态和链路状态下均能依据飞行器的实际高度与速度信息动态确定,从而适应不同下降动态以保障开伞时机的合理性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com