CN102508447B - 小型无人飞行器用双向切换系统 - Google Patents
小型无人飞行器用双向切换系统 Download PDFInfo
- Publication number
- CN102508447B CN102508447B CN 201110457863 CN201110457863A CN102508447B CN 102508447 B CN102508447 B CN 102508447B CN 201110457863 CN201110457863 CN 201110457863 CN 201110457863 A CN201110457863 A CN 201110457863A CN 102508447 B CN102508447 B CN 102508447B
- Authority
- CN
- China
- Prior art keywords
- flight
- control
- instruction
- aircraft
- management module
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Abstract
本发明公开了一种小型无人飞行器用双向切换系统,能够达到提高飞行器飞行稳定性的目的;该切换系统包括遥控接收机、飞行管理模块、飞行控制模块、切换电路和射频发射/接收机;遥控接收机用于遥控系统分别与飞行管理模块、切换电路进行信息交互;射频发射/接收机用于地面站系统与飞行管理模块之间进行信息交互;切换电路根据切换指令进行内部电路切换,根据内部电路切换结果选择自动飞行指令和遥控飞行指令之一转换为飞行控制信号并传送至舵机;飞行管理模块用于接收切换请求指令,采用预设的判断规则进行切换时机决策产生切换指令,并且生成异常报警指令;飞行控制模块用于产生自动飞行指令,采用基于状态估计的故障诊断方法判断飞行状态。
Description
技术领域
本发明属于飞行器自动控制领域,具体涉及一种小型无人飞行器用双向切换系统。
背景技术
现有的小型无人飞行器一般都携带有两套控制系统,一套是自主飞行控制系统,一套是需要人工实时操作的遥控系统。现阶段的飞行控制系统一般能保证无人飞行器在小扰动下平稳地巡航飞行,但是很难保证无人飞行器安全起降,更主要的是当无人飞行器受到大扰动时,为了保证无人飞行器平稳地飞行,需要在飞行过程中从自主飞行控制系统切换到遥控系统,这一过程需要由人工操作来实现无人飞行器安全起降,并且保证无人飞行器受到大扰动后能恢复平稳飞行。此外,无人飞行器在常规飞行作业的过程中,需要用自主飞行控制系统来控制无人飞行器作业,亦即需要从遥控系统切换到自主飞行控制系统。
目前,北京理工大学宋萍、李科杰和潘越等研制的微小型无人直升机自动驾驶仪和手动遥控飞行切换方法专利,该方法用于实现由自动控制切换到遥控方式,其核心切换控制器模块接收小型无人直升机飞行控制系统的PWM舵机控制信号和传感器信息,采用预设的判断规则对自动飞行控制系统的PWM舵机控制信号和传感器信息进行判断,当检测到飞行状况异常时,可立即切换到手动遥控方式,从而由操作人员遥控直升机飞行,引导直升机安全降落。
清华大学王冠林,屠展和朱纪洪研制无人机自动与遥控切换系统专利,该系统为从遥控方式切换到自动控制方式,其核心内容是实时监测遥控飞行指令,并传送给飞行控制计算机,当该系统由遥控向自动控制切换时,该系统向飞行控制计算机发送遥控/自动控制切换指令,飞行控制计算机以最后得到的遥控指令作为控制的平衡点,并在此基础上进行飞行控制,以实现遥控向自动控制的切换。
由此可见,当前的切换方式只从单向切换,即由自动控制切换到遥控方式或者由遥控方式切换到自动控制,此外,常规的切换控制方式是切换指令一旦发出就立即进行切换操作,而对于小型无人机,若不能良好地判断切换时机,将对无人机造成严重影响,这要求地面操作人员能准确地把握切换时机,实现切换的稳定性,然而切换时机的选择是一个难点,在非视距内操作时尤为突出。
发明内容
有鉴于此,本发明提供了一种小型无人飞行器用双向切换系统,能够达到提高飞行器飞行稳定性的目的。
一种小型无人飞行器用双向切换系统,包括遥控接收机、飞行管理模块、飞行控制模块、切换电路和射频发射/接收机,其中:
各组成部分的连接关系为:
遥控接收机分别与切换电路、飞行管理模块连接,飞行管理模块分别与射频发射/接收机、切换电路、飞行控制模块连接,飞行控制模块通过切换电路与飞行器的舵机连接。
各组成部分的功能为:
遥控接收机,用于接收来自遥控系统的遥控飞行指令和遥控切换请求指令,并发送遥控飞行指令至切换电路,发送遥控切换请求指令至飞行管理模块;
射频发射/接收机,用于地面站系统与飞行管理模块之间进行信息交互。
切换电路,用于接收所述飞行管理模块的切换指令并根据该切换指令进行内部电路切换,接收来自所述遥控接收机的遥控飞行指令和来自所述飞行控制模块的自动飞行指令,并根据内部电路切换结果选择自动飞行指令和遥控飞行指令之一转换为飞行控制信号并传送至舵机。
切换电路进一步地用于,利用当前遥控飞行指令和所接收的来自飞行控制模块预测的自动飞行指令进行加权叠加产生复合飞行指令,在所设定的过渡时间内将复合飞行指令发送给舵机。所述设定的过渡时间范围为2s~3s。
飞行管理模块的功能包括:
当通过射频发射/接收机接收到来自地面站系统的射频切换请求指令,或接收到来自遥控接收机的遥控切换请求指令时,飞行管理模块根据飞行控制模块发来的飞行器当前飞行状态,包括飞行高度、真空速、俯仰角、偏航角、滚转角、俯仰角速度、滚转角速度、偏航角速度、航迹倾角、侧向速度、法向加速度、纵向加速度和侧向加速度,采用预设的判断规则进行切换时机决策,并在决定的切换时机发送切换指令至切换电路以进行工作方式切换,通知飞行控制模块向切换电路提供自动飞行指令。
所述飞行管理模块采用预设的判断规则进行切换时机决策,具体过程为:飞行管理模块根据预设的判断条件进行飞行器当前飞行状态的判断,若满足该判断条件,则飞行管理模块的判定结果为飞行器立刻进行工作方式切换;否则,飞行器暂不进行工作方式切换,等待飞行器飞行状态满足所述判断条件时,再进行工作方式切换。
所述判断条件为:飞行高度不小于25m、俯仰角在±10°范围内、偏航角在±5°范围内、滚转角在±5°范围内、俯仰角速度在±1.8°/s范围内、滚转角速度在±0.12°/s范围内、航迹倾角在±5°范围内、侧向速度小于2m/s以及侧向加速度小于5m/s2。
当飞行器处于自动控制工作方式时,飞行管理模块在接收到来自飞行控制模块的飞行状态异常指令时生成异常报警指令并通过射频发射/接收机发送该异常报警指令至地面站系统,同时发送切换指令至切换电路,该切换指令指示切换电路切换为遥控工作方式;每隔一个固定的时间间隔,飞行管理模块生成控制器监测指令并传送至飞行控制模块,并接收来自飞行控制模块的控制器监测回执指令,若飞行管理模块在超时阈值内接收到所述控制器监测回执指令,则判定飞行控制模块状态正常;若飞行管理模块在超时阈值之外接收到控制器监测回执指令,则判定飞行控制模块状态异常,此时飞行管理模块生成异常报警指令并通过射频发射/接收机发送至地面站系统,同时发送切换指令至切换电路,该切换指令指示切换电路切换为遥控工作方式。所述固定的时间间隔取值范围为20ms~50ms。所述超时阈值的取值范围为10ms~25ms。
飞行控制模块的功能包括:
从所述切换电路采集所述遥控飞行指令并存储,同时通过内部传感器得到飞行器当前飞行状态并发送给飞行管理模块;当飞行器需要由遥控工作方式切换到自动控制工作方式时,根据飞行器当前飞行状态和内部存储的遥控飞行指令中的飞行参数,产生自动飞行指令并传送至切换电路;当飞行器需要由自动控制工作方式切换到遥控工作方式时,飞行控制模块在设定的过渡时间内根据飞行器当前飞行状态和当前的遥控飞行指令中的飞行参数,采用最优预测方法,得到自动飞行指令并传送至切换电路,在所设定的过渡时间结束后停止发送自动飞行指令;
当飞行器处于自动控制工作方式时,飞行控制模块根据飞行器当前飞行状态及发送给切换电路的自动飞行指令中的飞行参数,采用基于状态估计的故障诊断方法判断飞行器下一时刻的飞行状态,当判定飞行器下一时刻的飞行状态异常时,发送飞行状态异常指令至所述飞行管理模块;同时在接收到来自所述飞行管理模块发送的控制器监测指令时,发送控制器监测回执指令至所述飞行管理模块。
所述基于状态估计的故障诊断方法为:所述飞行控制模块根据飞行器当前飞行状态中的参数,包括俯仰角速度、滚转角速度、偏航角速度、真空速、法向加速度、纵向加速度和侧向加速度以及所述自动飞行指令中的飞行参数,包括升降舵偏角、副翼舵偏角、方向舵偏角和油门杆操作量,采用无人飞行器状态空间形式的力矩方程组建立估计模型,根据所建立的估计模型,采用kalman滤波状态估计方法进行估计并得到下一时刻的俯仰角速度、滚转角速度和偏航角速度,依次为:v1、v2和v3,记v1、v2和v3为故障表示参数,设置故障表示参数的信任区域为:-10°/s≤v1≤10°/s,-36°/s≤v2≤36°/s,-18°/s≤v3≤18°/s;当计算得到的故障表示参数不属于所述信任区域时,则判定飞行器下一时刻的飞行状态异常。
有益效果:
(1)本发明所提供的切换系统采用飞行管理模块和飞行控制模块,通过飞行管理模块中预设的判断规则进行切换时机决策并得到判定结果,根据该判定结果,得到飞行器能否在该切换时机状态下进行工作方式的切换。通过飞行管理模块生成控制器监测指令并进行飞行控制模块状态的判断,当飞行控制模块异常时,控制飞行管理模块生成异常报警指令给地面站系统,使飞行器能由自动控制工作方式及时切换到遥控工作方式。此外,通过飞行控制模块中基于状态估计的故障诊断方法,进行飞行器飞行状态的判断,当判定飞行状态异常时,控制飞行管理模块生成异常报警指令给地面站系统,使飞行器能及时由自动控制工作方式切换到遥控工作方式,从而达到了提高飞行稳定性的目的。
(2)本发明所提供的切换系统采用飞行管理模块、飞行控制模块和切换电路,通过采用飞行管理模块切换的判定结果,根据该判定结果并结合切换电路的切换响应,并且通过在飞行控制模块中采用最优理论和最优预测的方法,实现了双向切换。
附图说明
图1为本发明所提供的切换系统的组成框图。
具体实施方式
下面结合附图并举实施例,对本发明进行详细描述。
一种小型无人飞行器用双向切换系统,如图1所示,该切换系统包括遥控接收机、飞行管理模块、飞行控制模块、切换电路和射频发射/接收机,其中:
各组成部分的连接关系为:
遥控接收机分别与切换电路、飞行管理模块连接,飞行管理模块分别与射频发射/接收机、切换电路、飞行控制模块连接,飞行控制模块通过切换电路与飞行器的舵机连接。
各组成部分的功能为:
遥控接收机,用于接收来自遥控系统的遥控飞行指令和遥控切换请求指令,并发送遥控飞行指令至切换电路,发送遥控切换请求指令至飞行管理模块。
射频发射/接收机,负责地面站系统与飞行管理模块之间进行信息交互。
切换电路,用于接收所述飞行管理模块的切换指令并根据该切换指令进行内部电路切换,接收来自所述遥控接收机的遥控飞行指令和来自所述飞行控制模块的自动飞行指令,并根据内部电路切换结果选择自动飞行指令和遥控飞行指令之一通过脉宽调制转换为飞行控制信号并传送至舵机。那么,当飞行器处于遥控工作方式时,遥控飞行指令转换后控制舵机,当飞行器处于自动飞行工作方式时,自动飞行指令转换后控制舵机。
飞行管理模块的功能包括:①当飞行管理模块接收到所述遥控切换请求指令或射频切换请求指令时,飞行管理模块根据飞行控制模块发来的飞行器当前飞行状态,采用预设的判断规则进行切换时机决策,并在决定的切换时机发送切换指令至切换电路以进行工作方式切换,通知飞行控制模块向切换电路提供自动飞行指令;同时根据飞行器当前飞行状态生成状态回执指令通过射频发射/接收机发送到地面站系统,以向地面站系统报告飞行器当前飞行状态。地面站系统可以根据状态回执指令告知的飞行器当前飞行状态判断飞行器是否异常,当判定飞行器异常时,可以发送射频切换请求指令,以切换飞行器的工作方式。
飞行管理模块采用预设的判断规则进行切换时机决策,具体过程为:具体过程为:飞行管理模块根据预设的判断条件进行飞行器当前飞行状态的判断,若满足该判断条件,则飞行管理模块的判定结果为飞行器立刻进行工作方式切换;否则,飞行器暂不进行工作方式切换,等待飞行器飞行状态满足所述判断条件时,再进行工作方式切换。
②当飞行器处于自动控制工作方式时,飞行管理模块在接收到来自飞行控制模块的飞行状态异常指令时生成异常报警指令并通过射频发射/接收机发送至地面站系统,同时发送切换指令至切换电路,该切换指令指示切换电路切换为遥控工作方式。由于遥控系统不断地提供遥控飞行指令,因此切换电路切换后,立刻可以将遥控飞行指令提供给舵机。
③每隔一个固定的时间间隔,飞行管理模块生成控制器监测指令并传送至飞行控制模块,并采用超时同步方法接收来自飞行控制模块的控制器监测回执指令,进行飞行控制模块状态的判断:若飞行管理模块在超时阈值内接收到控制器监测回执指令,则判定飞行控制模块状态正常;若飞行管理模块在超时阈值之外接收到控制器监测回执指令,则判定飞行控制模块状态异常,此时飞行管理模块进行编码,生成异常报警指令通过射频发射/接收机发送至地面站系统,同时发送切换指令至切换电路,该切换指令指示切换电路切换为遥控工作方式。
飞行控制模块的功能包括:①飞行控制模块通过信号捕获,从切换电路获取切换电路收到的遥控飞行指令并存储,同时通过内部传感器得到飞行器当前飞行状态并发送给飞行管理模块。
②当飞行器需要由遥控工作方式切换到自动控制工作方式时,飞行控制模块根据内部存储的上一时刻采集的遥控飞行指令中的飞行参数和飞行器当前飞行状态,采用最优理论,得到自动飞行指令并传送至切换电路,以实现飞行器从遥控工作方式到自动控制工作方式的切换。当飞行器需要由自动控制工作方式切换到遥控工作方式时,飞行控制模块停止提供自动飞行指令。
较佳地,为了在切换过程中保持飞行器的稳定,飞行控制模块在飞行器由自动控制工作方式切换到遥控工作方式时,在一段时间内根据飞行器当前飞行状态和当前的遥控飞行指令中的飞行参数,采用最优预测方法,得到自动飞行指令并传送至切换电路,该段时间结束后停止发送。那么切换电路进一步地利用所接收的预测的自动飞行指令和当前遥控飞行指令进行加权叠加产生复合飞行指令,将复合飞行指令发送给舵机实现飞行控制,从而在一段时间内协助地面遥控系统控制飞行器飞行,以实现飞行器从自动控制工作方式到遥控工作方式的切换。
③当飞行器处于自动控制工作方式时,飞行控制模块根据飞行器当前飞行状态及发送给切换电路的自动飞行指令中的飞行参数,采用基于状态估计的故障诊断方法判断飞行器下一时刻的飞行状态,当判定飞行器下一时刻的飞行状态异常时,发送飞行状态异常指令至飞行管理模块。同时在接收到来自所述飞行管理模块发送的控制器监测指令时,发送控制器监测回执指令至所述飞行管理模块。
舵机,用于接收切换电路的飞行控制信号,该飞行控制信号中承载了飞行参数,包括升降舵偏角、副翼舵偏角、方向舵偏角和油门杆操作量;舵机根据该飞行控制信号操纵飞行控制面,实现对飞行器的控制。
下面进一步详细说明本发明所提供切换系统的工作过程。
整个切换系统上电后,假设飞行器工作过程分三个阶段,依次为遥控方式、自动控制和遥控方式,则在这种情况下,该切换系统的工作流程为:
(1)在遥控方式下,遥控接收机接收来自地面遥控系统的遥控飞行指令并发送至切换电路,同时切换电路根据该遥控飞行指令,通过脉宽调制将该遥控飞行指令转换为飞行控制信号并传送至舵机,同时飞行控制模块通过信号捕获,从切换电路采集该遥控飞行指令并存储(飞行控制模块进行遥控飞行指令的采集是实时的)。舵机控制飞行控制面,使得飞行器按照该飞行控制信号承载的飞行参数飞行。
(2)飞行器在遥控方式下飞行稳定后,可使该飞行器进入自动控制方式,具体为:
遥控系统发送遥控切换请求指令至遥控接收机或者地面站系统发送射频切换请求指令至射频发送/接收机。飞行管理模块接收来自遥控接收机的遥控切换请求指令或来自射频发送/接收机的射频切换请求指令,根据飞行控制模块发来的飞行器当前飞行状态,包括飞行高度、真空速、俯仰角、偏航角、滚转角、俯仰角速度、滚转角速度、偏航角速度、航迹倾角、侧向速度、法向加速度、纵向加速度和侧向加速度,采用预设的判断规则进行切换时机决策,具体过程为:飞行管理模块根据预设的判断条件进行飞行器当前飞行状态的判断,若满足该判断条件,则飞行管理模块的判定结果为飞行器立刻进行工作方式切换;否则,飞行器暂不进行工作方式切换,等待飞行器飞行状态满足所述判断条件时,再进行工作方式切换。
所述判断条件为:飞行高度不小于25m、俯仰角在±10°范围内、偏航角在±5°范围内、滚转角在±5°范围内、俯仰角速度在±1.8°/s范围内、滚转角速度在±0.12°/s范围内、航迹倾角在±5°范围内、侧向速度小于2m/s以及侧向加速度小于5m/s2。
同时,飞行管理模块根据飞行器当前自身状态生成状态回执指令并发送至射频发射/接收机,射频发送/接收机传送该状态回执指令至地面站系统。当飞行管理模块的判定结果为可切换至自动控制方式时,飞行管理模块发送切换指令到切换电路,切换电路根据该切换指令,控制内部物理层电路切换至飞行控制模块连接端使得飞行控制模块与舵机之间的线路接通。同时,飞行控制模块通过内部传感器得到飞行器当前飞行状态并发送给飞行管理模块。
飞行管理模块在发送切换指令的同时,还发送开启控制指令至飞行控制模块,飞行控制模块根据内部存储的上一时刻的遥控飞行指令中的飞行参数以及飞行器当前飞行状态,采用最优理论,得到自动飞行指令并传送至切换电路,切换电路将该自动飞行指令通过脉宽调制转换为飞行控制信号并传送至舵机,舵机控制飞行控制面,使得飞行器按照该飞行控制信号中承载的飞行参数飞行。
在上述自动控制方式下,即当飞行控制模块控制飞行器飞行时,有两个异常源监测过程:
一是飞行控制模块根据所述飞行器当前飞行状态中的参数以及发送给切换电路的自动飞行指令中的飞行参数,采用基于状态估计的故障诊断方法判断飞行器下一时刻的飞行状态,该故障诊断规则具体为:飞行控制模块采用无人飞行器状态空间形式的力矩方程组作为估计模型,将所述飞行器当前飞行状态中的参数,包括俯仰角速度、滚转角速度、偏航角速度、真空速、法向加速度、纵向加速度和侧向加速度作为所述力矩方程组的雅可比矩阵的输入参数,计算并得到该力矩方程组的雅可比矩阵;将所述飞行参数,包括升降舵偏角、副翼舵偏角、方向舵偏角和油门杆操作量作为所述力矩方程组的控制向量;其中,所述力矩方程组的状态量为俯仰角速度、滚转角速度和偏航角速度;飞行控制模块根据所建立的估计模型,采用kalman滤波状态估计方法进行估计并得到下一时刻的俯仰角速度、滚转角速度和偏航角速度,依次为:v1、v2和v3,记v1、v2和v3为故障表示参数,设置故障表示参数的信任区域为:-10°/s≤v1≤10°/s,-36°/s≤v2≤36°/s,-18°/s≤v3≤18°/s。当计算得到的故障表示参数不属于所述信任区域时,则判定飞行器下一时刻的飞行状态异常。
当判定飞行器下一时刻的飞行状态异常时,发送飞行状态异常指令至飞行管理模块,飞行管理模块根据该飞行状态异常指令进行编码,生成异常报警指令并传送至射频发射/接收机,同时飞行管理模块向切换电路发送切换指令,切换电路根据该切换指令,控制内部物理层电路切换至遥控接收机连接端,使得遥控接收机与舵机之间的线路接通。切换电路接收来自地面遥控系统的遥控飞行指令,此时飞行器进入遥控工作方式。
二是每隔一个固定的时间间隔,取值范围为20ms~50ms,飞行管理模块生成控制器监测指令并传送至飞行控制模块,并采用超时同步方法接收飞行控制模块的控制器监测回执指令,进行飞行控制模块状态的判断:若飞行管理模块在超时阈值(该超时阈值的取值范围为10ms~25ms)内接收控制器监测回执指令,则判定飞行控制模块状态正常;若飞行管理模块在超时阈值之外接收控制器监测回执指令,则判定飞行控制模块状态异常,此时飞行管理模块进行编码,生成异常报警指令并发送至射频发射/接收机,同时发送切换指令至切换电路,切换电路根据该切换指令,控制内部物理层电路切换至遥控接收机连接端,使得遥控接收机与舵机之间的线路接通。此时切换电路接收来自地面遥控系统的遥控飞行指令,飞行器进入遥控工作方式。
(3)当自动飞行作业完成时,需要将飞行器从自动控制工作方式切换到遥控工作方式。较佳地,在飞行器切换到遥控工作方式之前,进行2s~3s的过渡期工作过程,具体为:
遥控系统发送遥控切换请求指令至遥控接收机或者地面站系统发送射频切换请求指令至射频发送/接收机。飞行管理模块接收来自遥控接收机的遥控切换请求指令或来自射频发送/接收机的射频切换请求指令,根据飞行控制模块发来的飞行器当前飞行状态,采用预设的判断规则进行切换时机决策并得到判定结果,同时根据飞行器当前自身状态生成状态回执指令并发送至射频发射/接收机,射频发送/接收机传送该状态回执指令至地面站系统。当飞行管理模块的判定结果为可切换至遥控方式时,飞行管理模块发送切换指令到切换电路,切换电路根据该切换指令,控制内部物理层电路切换至飞行控制模块连接端使得遥控接收机与舵机之间的线路接通。切换电路接收来自遥控接收机的遥控飞行指令,同时,飞行控制模块通过内部传感器得到飞行器当前飞行状态并发送给飞行管理模块。飞行控制模块根据飞行器当前飞行状态和当前的遥控飞行指令中的飞行参数,采用最优预测方法,得到自动飞行指令并传送至切换电路,同时切换电路将遥控飞行指令和自动飞行指令进行加权叠加得到复合飞行指令,根据该复合飞行指令,采用脉宽调制转换为飞行控制信号并传送至舵机,舵机控制飞行控制面,使得飞行器按照该飞行控制信号中承载的飞行参数飞行。
在过渡期完成后,即2s~3s之后,飞行管理模块发送关闭控制指令至飞行控制模块,飞行控制模块不进行自动飞行指令的输出。切换电路根据所接收的遥控飞行指令,通过脉宽调制转换为飞行控制信号并传送至舵机,舵机控制飞行控制面,使得飞行器按照该飞行控制信号承载的飞行参数飞行,使得小型无人飞行器在遥控工作方式下飞行。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (7)
1.一种小型无人飞行器用双向切换系统,其特征在于,包括遥控接收机、飞行管理模块、飞行控制模块、切换电路和射频发射/接收机,其中:
该切换系统各组成部分的连接关系为:
遥控接收机分别与切换电路、飞行管理模块连接,飞行管理模块分别与射频发射/接收机、切换电路、飞行控制模块连接,飞行控制模块通过切换电路与飞行器的舵机连接;
该切换系统各组成部分的功能为:
遥控接收机,用于接收来自遥控系统的遥控飞行指令和遥控切换请求指令,并发送遥控飞行指令至切换电路,发送遥控切换请求指令至飞行管理模块;
射频发射/接收机,用于地面站系统与飞行管理模块之间进行信息交互;
切换电路,用于接收所述飞行管理模块的切换指令并根据该切换指令进行内部电路切换,接收来自所述遥控接收机的遥控飞行指令和来自所述飞行控制模块的自动飞行指令,并根据内部电路切换结果选择自动飞行指令和遥控飞行指令之一转换为飞行控制信号并传送至舵机;
飞行管理模块的功能包括:
当通过射频发射/接收机接收到来自地面站系统的射频切换请求指令,或接收到来自遥控接收机的遥控切换请求指令时,飞行管理模块根据飞行控制模块发来的飞行器当前飞行状态,采用预设的判断规则进行切换时机决策,并在决定的切换时机发送切换指令至切换电路以进行工作方式切换,通知飞行控制模块向切换电路提供自动飞行指令;
所述飞行管理模块采用预设的判断规则进行切换时机决策,具体过程为:飞行管理模块根据预设的判断条件进行飞行器当前飞行状态的判断,若满足该判断条件,则飞行管理模块的判定结果为飞行器立刻进行工作方式切换;否则,飞行器暂不进行工作方式切换,等待飞行器飞行状态满足所述判断条件时,再进行工作方式切换;
当飞行器处于自动控制工作方式时,飞行管理模块在接收到来自飞行控制模块的飞行状态异常指令时生成异常报警指令并通过射频发射/接收机发送该异常报警指令至地面站系统,同时发送切换指令至切换电路,该切换指令指示切换电路切换为遥控工作方式;每隔一个固定的时间间隔,飞行管理模块生成控制器监测指令并传送至飞行控制模块,并接收来自飞行控制模块的控制器监测回执指令,若飞行管理模块在超时阈值内接收到所述控制器监测回执指令,则判定飞行控制模块状态正常;若飞行管理模块在超时阈值之外接收到控制器监测回执指令,则判定飞行控制模块状态异常,此时飞行管理模块生成异常报警指令并通过射频发射/接收机发送至地面站系统,同时发送切换指令至切换电路,该切换指令指示切换电路切换为遥控工作方式;
飞行控制模块的功能包括:
从所述切换电路采集所述遥控飞行指令并存储,同时通过内部传感器得到飞行器当前飞行状态并发送给飞行管理模块;当飞行器需要由遥控工作方式切换到自动控制工作方式时,根据飞行器当前飞行状态和内部存储的遥控飞行指令中的飞行参数,产生自动飞行指令并传送至切换电路;当飞行器需要由自动控制工作方式切换到遥控工作方式时,飞行控制模块停止提供自动飞行指令;
当飞行器处于自动控制工作方式时,飞行控制模块根据飞行器当前飞行状态及发送给切换电路的自动飞行指令中的飞行参数,采用基于状态估计的故障诊断方法判断飞行器下一时刻的飞行状态,当判定飞行器下一时刻的飞行状态异常时,发送飞行状态异常指令至所述飞行管理模块;同时在接收到来自所述飞行管理模块发送的控制器监测指令时,发送控制器监测回执指令至所述飞行管理模块。
2.如权利要求1所述的切换系统,其特征在于,所述飞行器当前飞行状态包括飞行高度、真空速、俯仰角、偏航角、滚转角、俯仰角速度、滚转角速度、偏航角速度、航迹倾角、侧向速度、法向加速度、纵向加速度和侧向加速度;
所述判断条件为:飞行高度不小于25m、俯仰角在±10°范围内、偏航角在±5°范围内、滚转角在±5°范围内、俯仰角速度在±1.8°/s范围内、滚转角速度在±0.12°/s范围内、航迹倾角在±5°范围内、侧向速度小于2m/s以及侧向加速度小于5m/s2。
3.如权利要求1所述的切换系统,其特征在于,所述基于状态估计的故障诊断方法为:所述飞行控制模块根据飞行器当前飞行状态中的参数,包括俯仰角速度、滚转角速度、偏航角速度、真空速、法向加速度、纵向加速度和侧向加速度以及所述自动飞行指令中的飞行参数,包括升降舵偏角、副翼舵偏角、方向舵偏角和油门杆操作量,采用无人飞行器状态空间形式的力矩方程组建立估计模型,根据所建立的估计模型,采用kalman滤波状态估计方法进行估计并得到下一时刻的俯仰角速度、滚转角速度和偏航角速度,依次为:v1、v2和v3,记v1、v2和v3为故障表示参数,设置故障表示参数的信任区域为:-10°s≤v1≤10°/s,-36°/s≤v2≤36°/s,-18°/s≤v3≤18°/s;当计算得到的故障表示参数不属于所述信任区域时,则判定飞行器下一时刻的飞行状态异常。
4.如权利要求1所述的切换系统,其特征在于,所述当飞行器需要由自动控制工作方式切换到遥控工作方式时,在飞行控制模块停止提供自动飞行指令之前,飞行控制模块在设定的过渡时间内根据飞行器当前飞行状态和当前的遥控飞行指令中的飞行参数,采用最优预测方法,得到自动飞行指令并传送至切换电路,在所设定的过渡时间结束后停止发送自动飞行指令;
所述切换电路进一步用于,利用所接收的预测的自动飞行指令和当前遥控飞行指令进行加权叠加产生复合飞行指令,在所设定的过渡时间内将复合飞行指令发送给舵机。
5.如权利要求1所述的切换系统,其特征在于,所述固定的时间间隔取值范围为20ms~50ms。
6.如权利要求1所述的切换系统,其特征在于,所述超时阈值的取值范围为10ms~25ms。
7.如权利要求4所述的切换系统,其特征在于,所述设定的过渡时间范围为2s~3s。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110457863 CN102508447B (zh) | 2011-12-30 | 2011-12-30 | 小型无人飞行器用双向切换系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110457863 CN102508447B (zh) | 2011-12-30 | 2011-12-30 | 小型无人飞行器用双向切换系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102508447A CN102508447A (zh) | 2012-06-20 |
CN102508447B true CN102508447B (zh) | 2013-09-04 |
Family
ID=46220548
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201110457863 Expired - Fee Related CN102508447B (zh) | 2011-12-30 | 2011-12-30 | 小型无人飞行器用双向切换系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102508447B (zh) |
Families Citing this family (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103235599A (zh) * | 2013-04-10 | 2013-08-07 | 东南大学 | 基于智能手机的飞行控制系统 |
CN103914077A (zh) * | 2014-04-03 | 2014-07-09 | 江西洪都航空工业集团有限责任公司 | 一种有人/无人可选择双模飞行控制系统 |
CN105556409B (zh) * | 2014-12-15 | 2018-02-02 | 深圳市大疆创新科技有限公司 | 一种飞行器控制方法、装置及飞行器 |
CN104820428B (zh) * | 2015-04-20 | 2017-11-07 | 余江 | 一种无人机的记忆型航迹再现方法及其装置 |
CN105467871A (zh) * | 2015-11-26 | 2016-04-06 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种无人机应急操控切换系统 |
CN105843254A (zh) * | 2016-04-29 | 2016-08-10 | 乐视控股(北京)有限公司 | 一种无人机飞行控制方式切换方法、装置及其无人机 |
CN107463109B (zh) * | 2016-06-03 | 2023-11-14 | 中国科学院沈阳自动化研究所 | 一种通用型水面移动机器人平台 |
CN107065817B (zh) * | 2016-11-30 | 2020-11-06 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种基于参数监控的自动驾驶仪故障检测方法 |
CN106843276A (zh) * | 2017-04-06 | 2017-06-13 | 苏州全翼空智能科技有限公司 | 一种倾转旋翼无人机控制系统 |
CN107450396B (zh) * | 2017-08-16 | 2019-10-11 | 大连海事大学 | 一种无人船的自主航行与遥控航行切换控制模块 |
CN108766003B (zh) * | 2018-04-26 | 2020-10-02 | 上海钛鑫科技有限公司 | 智能车辆及其行驶控制方法 |
CN108885468B (zh) * | 2018-06-14 | 2022-11-11 | 北京小米移动软件有限公司 | 信息传输方法、装置、系统及存储介质 |
US20210253245A1 (en) * | 2018-06-14 | 2021-08-19 | Beijing Xiaomi Mobile Software Co., Ltd. | Method and device for reporting flight mode and method and device for changing control strategy |
US11760480B2 (en) | 2018-06-14 | 2023-09-19 | Beijing Xiaomi Mobile Software Co., Ltd. | Information sending and receiving method and apparatus, device, and storage medium |
CN110703794A (zh) * | 2019-11-29 | 2020-01-17 | 河池学院 | 一种基于ros的多无人机控制系统及其控制方法 |
CN111050079B (zh) * | 2019-12-27 | 2021-09-14 | 成都睿铂科技有限责任公司 | 一种基于无人机的航拍方法 |
CN111862550B (zh) * | 2020-08-13 | 2021-11-30 | 深圳市高巨创新科技开发有限公司 | 编队无人机离群报警方法及系统 |
CN113342044B (zh) * | 2021-06-18 | 2022-07-05 | 北京理工大学 | 一种可重复使用运载器末端能量管理段地面轨迹设计方法 |
CN117092961B (zh) * | 2023-10-19 | 2024-01-30 | 南京航空航天大学 | 基于等价输入干扰的旋翼机过渡段的切换控制方法及系统 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101807051A (zh) * | 2010-01-22 | 2010-08-18 | 清华大学 | 无人机自动与遥控切换系统 |
CN102053619A (zh) * | 2009-11-06 | 2011-05-11 | 北京理工大学 | 微小型无人直升机自动驾驶和手动遥控飞行切换方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2957266B1 (fr) * | 2010-03-11 | 2012-04-20 | Parrot | Procede et appareil de telecommande d'un drone, notamment d'un drone a voilure tournante. |
-
2011
- 2011-12-30 CN CN 201110457863 patent/CN102508447B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102053619A (zh) * | 2009-11-06 | 2011-05-11 | 北京理工大学 | 微小型无人直升机自动驾驶和手动遥控飞行切换方法 |
CN101807051A (zh) * | 2010-01-22 | 2010-08-18 | 清华大学 | 无人机自动与遥控切换系统 |
Also Published As
Publication number | Publication date |
---|---|
CN102508447A (zh) | 2012-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102508447B (zh) | 小型无人飞行器用双向切换系统 | |
US9145212B1 (en) | Parachute control system and method for an aircraft | |
CN110071754B (zh) | Uav测控链路中断故障应急处理方法 | |
CN106919184B (zh) | 双无人机协同作业系统及双无人机协同作业方法 | |
CN100568137C (zh) | 一种无人机遥控链路中断的判断与处理方法 | |
CN104516354A (zh) | 一种无人直升机电力巡线智能返航路径控制方法 | |
CN201364497Y (zh) | 一种遥控远距离监控运载无人直升机系统 | |
CN110531764A (zh) | 一种无人驾驶拖拉机控制系统及控制方法 | |
CN105676860A (zh) | 一种可穿戴设备、无人机控制装置和控制实现方法 | |
CN107765708A (zh) | 一种六旋翼无人机飞行控制系统及控制方法 | |
CN102786002A (zh) | 塔机智能操控系统及塔机 | |
CN107885227A (zh) | 一种无人机自动避障方法 | |
CN203433367U (zh) | 一种小型无人飞行器超视距无线遥控系统 | |
CN102553258B (zh) | 一种航模遥控器切换器 | |
CN101807051A (zh) | 无人机自动与遥控切换系统 | |
CN104906805A (zh) | 一种基于主动式姿态检测的航模飞行器安全遥控方法及系统 | |
CN112748744A (zh) | 变电站两栖巡检装置及其巡检方法 | |
WO2022218219A1 (zh) | 由远程驾驶、能源补给和地面航母组成的飞行器运保体系 | |
CN111874256A (zh) | 太阳能无人机的故障应急处理方法及装置 | |
CN105676873A (zh) | 无人机的自动降落方法及其控制系统 | |
CN106249747A (zh) | 智能化无人机系统 | |
CN106155083A (zh) | 一种复合翼无人机应急操作方法 | |
CN107145159A (zh) | 一种车载系留多旋翼控制系统架构及控制方法 | |
CN107943091A (zh) | 一种无人机避让方法、控制端、通信端、执行端和系统 | |
CN109656269A (zh) | 一种无人机监控系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20130904 Termination date: 20131230 |