无人机应急控制信号输出电路及其控制方法与流程

摘要: 本发明涉及无人机控制,具体涉及一种无人机应急控制信号输出电路及其控制方法。背景技术:1、无人机通常由飞行控制系统根据传感器信息及控制指令计算控制量,并由数字主域...
无人机应急控制信号输出电路及其控制方法与流程

本发明涉及无人机控制,具体涉及一种无人机应急控制信号输出电路及其控制方法。

背景技术:

1、无人机通常由飞行控制系统根据传感器信息及控制指令计算控制量,并由数字主域向电机电调、舵机等动作执行单元输出控制信号。当数字主域因供电异常、时钟异常或处理器运行异常而失效时,正常控制信号可能中断或无法更新,影响无人机的运行安全。

2、为应对上述故障,可以通过备用数字控制器或硬件信号生成电路提供应急控制信号。备用数字控制器的运行依赖相应的处理器、存储器和时钟资源;硬件信号生成电路虽然能够降低对数字主域的依赖,但采用固定应急输出策略时,难以适应不同工况下的故障处置需求。

3、无人机在地面工况下持续输出动力控制信号,可能造成电机持续运转或无人机意外移动;在空中工况下停止输出控制信号,则可能导致动力或操纵能力丧失。因此,统一的持续输出策略或固定延时停止策略,难以兼顾地面工况和空中工况的安全需求。

技术实现思路

1、本发明提供一种无人机应急控制信号输出电路及其控制方法,旨在解决数字主域失效后固定应急输出策略难以兼顾地面工况和空中工况下不同故障处置需求的技术问题。

2、第一方面,本发明提供一种无人机应急控制信号输出电路,所述无人机应急控制信号输出电路包括工况保持单元、失效检测单元、应急控制信号生成单元以及输出控制单元;所述工况保持单元与无人机的数字主域的工况标识输出端连接,用于以模拟电平形式存储并保持所述数字主域写入的工况标识,并在所述数字主域失效后继续输出所保持的工况标识,其中,所述工况标识用于表征所述无人机处于地面工况或空中工况;所述失效检测单元与所述数字主域的控制信号输出端连接,用于检测所述数字主域输出的控制信号,并在所述控制信号满足失效判定条件时产生失效指示信号;所述应急控制信号生成单元包括使能控制端和控制信号输出端,用于在所述使能控制端被激活时生成应急控制信号,并通过所述控制信号输出端向所述无人机的动作执行单元输出所述应急控制信号;所述输出控制单元分别与所述数字主域的控制信号输出端、所述失效检测单元、所述工况保持单元以及所述应急控制信号生成单元的使能控制端连接,用于在所述数字主域正常工作时,根据所述控制信号禁止所述应急控制信号生成单元输出,并在接收到所述失效指示信号后,激活所述使能控制端,根据所述工况保持单元输出的工况标识,控制所述应急控制信号生成单元在地面工况下经预设延时后停止输出所述应急控制信号,在空中工况下持续输出所述应急控制信号。

3、进一步地,所述输出控制单元包括门控电路、模拟比较器阵列和延时电路;所述门控电路的输入端与所述控制信号输出端连接,所述门控电路的输出端与所述使能控制端连接,用于根据所述控制信号控制所述应急控制信号生成单元的使能状态;所述模拟比较器阵列的第一输入端与所述失效检测单元的输出端连接,所述模拟比较器阵列的第二输入端与所述工况保持单元的输出端连接,所述模拟比较器阵列的输出端分别与所述延时电路的输入端和所述应急控制信号生成单元的工况选择端连接,用于在接收到所述失效指示信号后,根据所述工况标识对应的模拟电平生成工况判定结果;所述延时电路的输出端与所述应急控制信号生成单元的切断控制端连接,用于在所述工况判定结果表征地面工况时启动延时计时,并在达到所述预设延时后向所述切断控制端输出切断信号,在所述工况判定结果表征空中工况时保持不启动。

4、进一步地,所述延时电路包括电阻电容串联延时支路和延时比较器;所述电阻电容串联延时支路的输入端与所述模拟比较器阵列的输出端连接;所述延时比较器的第一输入端与所述电阻电容串联延时支路的电容节点连接,所述延时比较器的第二输入端与延时阈值电压源连接,所述延时比较器的输出端与所述切断控制端连接。

5、进一步地,还包括供电单元,所述供电单元包括与所述数字主域的内核电源域相隔离的供电电源域和超级电容备用储能回路;所述供电电源域的输出端与所述应急控制信号生成单元的电源端连接,用于为所述应急控制信号生成单元供电;所述超级电容备用储能回路的输入端与所述供电电源域连接,所述超级电容备用储能回路的输出端分别与所述输出控制单元的电源端、所述延时电路的电源端和所述工况保持单元的电源端连接,用于在所述供电电源域断电时维持所述输出控制单元、所述延时电路和所述工况保持单元的供电。

6、进一步地,所述工况保持单元包括模拟保持电容和写入开关管;所述写入开关管的第一端与所述数字主域的工况标识输出端连接,所述写入开关管的第二端与所述模拟保持电容的电压保持节点连接;所述模拟保持电容的电压保持节点作为所述工况保持单元的输出端,用于输出所保持的工况标识对应的模拟电平。

7、进一步地,所述失效检测单元包括电平检测比较器,所述电平检测比较器的第一输入端与所述数字主域的控制信号输出端连接,所述电平检测比较器的第二输入端与参考电压源连接,所述电平检测比较器的输出端与所述输出控制单元连接,用于比较所述控制信号与所述参考电压源提供的参考电压,并在所述控制信号低于所述参考电压时输出所述失效指示信号。

8、进一步地,所述应急控制信号为pwm信号,所述应急控制信号生成单元包括内部振荡器、锯齿波发生器、pwm比较器和电压基准源;所述内部振荡器的输出端与所述锯齿波发生器的时钟输入端连接,用于向所述锯齿波发生器提供独立于所述数字主域主晶振的时钟信号;所述锯齿波发生器的输出端与所述pwm比较器的第一输入端连接,用于根据所述时钟信号生成固定频率的锯齿波信号;所述pwm比较器的第二输入端与所述电压基准源连接,所述pwm比较器的输出端与所述应急控制信号生成单元的控制信号输出端连接,用于比较所述锯齿波信号与所述电压基准源提供的基准电压,生成具有预设占空比的所述pwm信号。

9、进一步地,还包括故障记录单元和硬件计数器;所述硬件计数器的时钟输入端与所述内部振荡器的输出端连接,所述硬件计数器的输出端与所述故障记录单元连接,用于根据所述内部振荡器提供的时钟信号生成硬件时间戳;所述故障记录单元分别与所述失效检测单元和所述输出控制单元连接,用于记录所述失效指示信号的产生事件、根据所述工况标识确定的工况判定结果以及地面工况下停止输出所述应急控制信号的切断事件,并将所述硬件时间戳与相应记录关联存储。

10、第二方面,本发明还提供一种无人机应急控制信号输出电路的控制方法,用于控制上述任一项所述的无人机应急控制信号输出电路,所述方法包括:

11、在所述无人机的数字主域正常工作时,生成工况标识,并将所述工况标识以模拟电平形式存储,并在所述数字主域失效后继续保持所存储的模拟电平,其中,所述工况标识用于表征所述无人机处于地面工况或空中工况;

12、检测所述数字主域输出的控制信号是否满足失效判定条件;

13、若所述控制信号不满足所述失效判定条件,则根据所述控制信号禁止应急控制信号生成单元输出应急控制信号;

14、若所述控制信号满足所述失效判定条件,则产生失效指示信号,并根据所述失效指示信号激活所述应急控制信号生成单元,使其向所述无人机的动作执行单元输出应急控制信号;

15、读取所述工况标识,根据所述工况标识确认所述无人机的当前工况;

16、若所述无人机的当前工况为地面工况,则启动延时计时,并在达到预设延时时间后停止输出所述应急控制信号;

17、若所述无人机的当前工况为空中工况,则不启动所述延时计时,并持续输出所述应急控制信号。

18、本发明公开了一种无人机应急控制信号输出电路及其控制方法,通过工况保持单元以模拟电平形式存储并保持数字主域写入的工况标识,并在数字主域失效后继续输出所保持的工况标识,解决了数字主域失效后工况信息无法获取的问题;通过失效检测单元检测数字主域输出的控制信号,在控制信号满足失效判定条件时产生失效指示信号,使应急控制信号生成单元能够不依赖数字主域的运行状态而生成应急控制信号,降低了应急输出对数字主域及其备用数字资源的依赖;在此基础上,通过输出控制单元在数字主域正常工作时根据控制信号禁止应急控制信号生成单元输出,避免了正常输出与应急输出之间的相互干扰,并在接收到失效指示信号后激活使能控制端,根据工况保持单元输出的工况标识执行差异化控制,即地面工况下经预设延时后停止输出应急控制信号,避免持续输出动力控制信号带来的安全风险,空中工况下持续输出应急控制信号,维持无人机的动力和操纵能力,实现了地面与空中两种工况的自适应处置。