一种小型无人直升机飞行控制系统的制作方法
【专利摘要】本发明公开了一种小型无人直升机飞行控制系统，包括飞行执行单元、状态传感器单元、降落伞单元、飞行控制单元、地面控制终端及遥控器单元。本发明能够提高小型无人直升机的自适应避障飞行能力，使其能在超视距范围内根据预置指令工作，并在突遇发动机空中熄火时能够利用降落伞缓慢降落，保护无人直升机不被损坏，同时在降落时能自动避开水面降落。
【专利说明】一种小型无人直升机飞行控制系统
【技术领域】
[0001]本发明属于飞行器的控制技术，特别是一种小型无人直升机飞行控制系统。
【背景技术】
[0002]随着自适应控制技术的发展，无人直升机自适应飞行已经在世界各地展开了广泛的研究，无人直升机具有无人固定翼飞机所不具备的很多优势，具有独特的飞行性能和使用价值。在军事方面，无人直升机既能执行各种非杀伤性任务，又能执行各种软硬杀伤性任务，包括侦察、监视、目标截获、诱饵、攻击、通信中继等；在民用方面，无人直升机在航拍、大气监测、交通监控、资源勘探、电力巡检、森林防火、农业等方面具有广泛的应用前景。
[0003]无人直升机飞控系统是一个典型的非线性、强耦合、多变量、多驱动系统，各变量对无人直升机的飞行姿态、飞行方向、飞行高度、飞行速度均有影响，无人直升机飞控系统的稳定边界随着飞行条件变化而发生很大改变。无人直升机要实现自适应避障飞行，需要采样飞行状态信息，无人直升机采样的变量有:激光测距传感器、CCD摄像图像处理单元、超声波传感器、方位/俯仰/横滚角速率传感器，俯仰/横滚角度传感器、电子罗盘、GPS、高度计、油量传感器、发动机缸温传感器、测速传感器。由于上述传感器的非线性效应(飞行加速度、阵风干扰、温度变化、大气压变化等都会使传感器的输出产生非线性)，无人直升机飞控软件要处理传感器的非线性，得到正确的飞行参数值，完成自适应避障飞行。
[0004]目前，大型无人直升机采用光纤陀螺组成捷联惯导系统，采用微波雷达探测障碍物已有成熟的方案，但实现成本高，重量重，在小型无人直升机(载荷在40—50Kg，飞行时间在4-5小时)上应用前景不大。目前，小型无人直升机得到了越来越广泛的应用，各种自主飞行控制系统也多有出现，但实现自适应避障飞行和自主避水降落的飞控系统还没有出现。
【发明内容】
[0005]本发明的目的在于提供一种小型无人直升机飞行控制系统，能够提高小型无人直升机的自适应避障飞行能力，使其能在超视距范围内根据预置指令工作，并在突遇发动机空中熄火时能够利用降落伞缓慢降落，保护无人直升机不被损坏，同时在降落时能自动避开水面降落。
[0006]实现本发明目的的技术解决方案为:一种小型无人直升机飞行控制系统，包括飞行执行单元、状态传感器单元、降落伞单元、飞行控制单元、地面控制终端及遥控器单元，飞行执行单元包括升降舵机、左副翼舵机、右副翼舵机、尾舵机、油门舵机、右油箱、发动机、舵机电池；状态传感器单元包括激光测距传感器、CCD摄像头、图像处理单元、超声波测距传感器、方位角速率传感器、俯仰角速率传感器、横滚角速率传感器、俯仰/横滚角度传感器、电子罗盘、GPS、高度计、测速传感器、油量传感器、缸温传感器；降落伞单元由降落伞盒组成；飞行控制单元包括飞控板、飞控板蓝牙模块、信号板、数传电台、遥控接收机和控制电池；托架、数传电台安装在无人直升机主干骨架的前部，飞控盒、右油箱、发动机安装在主干骨架的中部，超声波测距传感器安装在主干骨架的中后部，其探头朝下，电子罗盘、GPS安装在主干骨架的后部，降落伞盒安装在无人直升机芯轴的一端正上方，无人直升机芯轴的另一端与主干骨架连接；激光测距传感器、CCD摄像头安装在托架上；方位角速率传感器、俯仰角速率传感器、横滚角速率传感器、飞控板蓝牙模块分别焊接在飞控板上，高度计焊接在信号板上；图像处理单元、遥控接收机、飞控板、信号板、俯仰/横滚角度传感器、控制电池、舵机电池安装在飞控盒内；油量传感器安装在右油箱的侧面；缸温传感器安装在发动机外壳上；测速传感器探头安装在发动机轴上，测速传感器安装在发动机外壳上；与直升机机头方向相同的方向为左，左副翼舵机、右副翼舵机安装在无人直升机主轴的前后两侧，升降舵机安装在无人直升机主轴的左或右侧，尾舵机安装在无人直升机尾部，油门舵机安装在发动机旁；无人直升机主轴与机翼相连，无人直升机芯轴通过轴承与无人直升机主轴连接。
[0007]本发明与现有技术相比，其显著优点:(1)飞控功能齐全、保护措施完善，本发明集自动飞行、姿态控制、自动避障、降落避水面、油量计算、地面控制终端电子地图界面上作业、降落伞保护、缸温保护等功能。(2)本发明的“捷联惯导”组合采用价格低廉的GPS、磁阻式电子罗盘、气压式高度计、MEMS方位/俯仰/横滚角速率传感器及MEMS俯仰/横滚角度传感器组成，利用软件修正的方法消除角速率积分的误差，使角速率积分值等于真实飞行角度值，使其达到无人直升机自适应飞控的要求。(3)本发明飞行避降采用激光传感器+CCD摄像处理，可靠性高。(4)本发明采用方位/俯仰/横滚三轴角速率传感器形成负反馈稳定回路，实时(20ms间隔)控制升降/左/右副翼/尾舵机，使无人直升机机身保持平衡，不抖动，不晃动。(5)本发明降落伞保护措施使用户对使用无人直升机自适应超视距飞行更加自信。(6)实用性强，本发明可在-25°C?+55°C环境温度下，在海拔3500米内，随无人直升机机型的不同，可携带载荷(摄像机、微波中继站等)40?50公斤，长时间(4?5小时)正常工作。(7)操作简单，本发明操作时只需在地面控制终端显示屏电子地图界面上用鼠标点击飞行路径即可自动生成飞行指令。
[0008]下面结合附图对本发明作进一步详细描述。
【专利附图】
【附图说明】
[0009]图1是本发明小型无人直升机飞行控制系统的安装示意图。
[0010]图2是激光测距传感器和CXD摄像头托架结构示意图。
[0011]图3是飞行避障程序流程图。
[0012]图4是降落避水面程序流程图。
[0013]图5是飞行姿态自适应控制程序流程图。
[0014]图6是无人直升机芯轴结构示意图。
[0015]图7是降落伞盒结构示意图。
[0016]图8是降落伞展开示意图。
[0017]图9是油量传感器安装示意图。
[0018]图10是飞控板电原理结构图。
[0019]图11是飞控板程序流程图。
[0020]图12是信号板电原理结构图。
[0021 ]图13是信号板程序流程图。
[0022]图14是地面控制终端操作程序流程图。【具体实施方式】
[0023]结合图1，本发明的小型无人直升机飞行控制系统，包括飞行执行单元、状态传感器单元、降落伞单元、飞行控制单元、地面控制单元，飞行执行单元包括升降舵机17-1、左副翼舵机17-2、右副翼舵机17-3、尾舵机17-4、油门舵机17_5、右油箱25、发动机26、舵机电池18-2 ;状态传感器单元包括激光测距传感器1、CXD摄像头2、图像处理单元2-1、超声波测距传感器3、方位角速率传感器5-1、俯仰角速率传感器5-2、横滚角速率传感器5-3、俯仰/横滚角度传感器6、电子罗盘7、GPS8、高度计9、测速传感器14、油量传感器15、缸温传感器16 ;降落伞单元由降落伞盒4组成；飞行控制单元包括飞控板10、飞控板蓝牙模块10-1、信号板11、数传电台12、遥控接收机13和控制电池18-1 ;托架21、数传电台12安装在无人直升机主干骨架22的前部，飞控盒24、右油箱25、发动机26安装在主干骨架22的中部，超声波测距传感器3安装在主干骨架22的中后部，其探头朝下，电子罗盘7、GPS8安装在主干骨架22的后部，降落伞盒4安装在无人直升机芯轴23的一端正上方，无人直升机芯轴23的另一端与主干骨架22连接；激光测距传感器1、(XD摄像头2安装在托架21上；方位角速率传感器5-1、俯仰角速率传感器5-2、横滚角速率传感器5-3、飞控板蓝牙模块10-1分别焊接在飞控板10上，高度计9焊接在信号板11上；图像处理单元2-1、遥控接收机13、飞控板10、信号板11、俯仰/横滚角度传感器6、控制电池18-1、舵机电池18-2安装在飞控盒24内；油量传感器15安装在右油箱25的侧面；缸温传感器16安装在发动机26外壳上；测速传感器探头14-1安装在发动机轴27上，测速传感器14安装在发动机26外壳上；与直升机机头方向相同的方向为左，左副翼舵机17-2、右副翼舵机17-3安装在无人直升机主轴23-2的前后两侧，升降舵机17-1安装在无人直升机主轴23-2的左或右侧，尾舵机17-4安装在无人直升机尾部，油门舵机17-5安装在发动机26旁；无人直升机主轴23-2与机翼23_3相连，无人直升机芯轴23通过轴承23-1与无人直升机主轴23-2连接，如图6所示。地面控制单元由地面控制终端19和遥控器20组成。 本发明的小型无人直升机飞行控制系统实现飞行控制过程，具体如下:无人直升机操作员闭合地面控制终端19电源开关后，利用鼠标在地面控制终端19的电子地图显示界面上设置无人直升机的飞行轨迹航点参数(如经度、纬度、飞行高度、是否悬停/悬停时间、是否盘旋/盘旋时间、是否返航或降落)，共支持100个航点(可以根据需要选取);通过地面数传电台19-1将所有飞行轨迹航点参数传输至无人直升机上数传电台12 ;数传电台12与信号板11相连，信号板11将地面控制终端19发送来的飞行轨迹航点参数存贮在飞行参数单元内；信号板11定时将各航点经度、纬度解算成以地理正北为0°，北一东一南一西一北为0°?360°的飞行航向角Ha，并存贮在飞行参数单元内，信号板11定时采样GPS8、高度计9，得到无人直升机经度、纬度即得到无人直升机的航点序号，根据GPS8、高度计9的值得到无人直升机的高度与航点高度的差值Δ H ;飞控板10定时从信号板11得到飞行轨迹航点参数(如航向角Ha、高度差值Λ H、是否悬停/悬停时间、是否盘旋/盘旋时间、是否返航、是否降落)；飞控板10定时(如20_30ms)采样方位角速率传感器5-1、俯仰角速率传感器5-2、横滚角速率传感器5-3值并对采样值积分累加得到飞行方位角Sa、飞行俯仰角Se、飞行横滚角SK、将飞行方位角Sa与飞行航向角HA比较得到无人直升机是否偏航，将飞行俯仰角Se、飞行横滚角Sk与飞行状态比较得到无人直升机是否纵倾、侧倾，根据Λ H确定无人直升机对否爬升/或下降，飞控板10控制左副翼舵机17-2、右副翼舵机17-3、升降舵机17-1、尾舵机17_4动作，使无人直升机按航点轨迹飞行，同时判断方位/俯仰/横滚角速率传感器5-1、5-2、5-3是否有输出，控制升降/左/右副翼/尾舵机17-1、17-2、17-3、17-4向方位/俯仰/横滚角速率传感器5_1、5_2、5_3反向的方向转动一个小角度，使无人直升机机身保持平衡不晃动、不抖动；飞控板10定时(如2-5秒)采样俯仰/横滚角度传感器6，在判断无人直升机机身平衡时，利用俯仰/横滚角度传感器6、电子罗盘7的值对方位速率传感器5-1、俯仰速率传感器5-2、横滚速率传感器5-3的积分值S4、SE、SK进行“清零”(即使Sa=电子罗盘输出值，SE/SE=俯仰/横滚角度传感器输出值)，使上法三个趣速率传感器的积分值真实反映无人直升机的飞行方位角、飞行俯仰角、飞行横滚角，无人直升机在前进飞行时，飞控板10定时采样激光测距传感器1、CCD摄像头2，判断飞行前方是否有障碍物，若飞行前方有障碍物则执行避障飞行；无人直升机在下降飞行时，飞控板10定时采样激光测距传感器1、超声波测距传感器3，判断无人直升机下方是否为水面，若无人直升机下方是水面则执行避水面降落飞行；飞控板10定时采样测速传感器14，判断发动机26是否滑车不转，一旦检测确认发动机26停转，则中断请求信号板11得到无人直升机的高度值，若无人直升机在设定值(如300米)以下，控制飞控板蓝牙模块10-1发出开伞指令，降落伞盒4内伞蓝牙模块4-2收到开伞指令，控制电磁锁4-11打开降落伞盒盖板4-9使引导伞4-7与主伞4-8弹出降落伞盒外，迫使无人直升机缓缓下降，保证无人直升机落地时安全；信号板11定时采样油量传感器，判断油量是否支持无人直升机返航，若油量到达临界值则中断请求飞控板10使无人直升机返航飞行；信号板11定时采样缸温传感器16，判断发动机缸温是否正常，若确认缸温超过临界值，则中断请求飞控板10使无人直升机降落；飞控板10定时将无人直升机姿态参数(如飞行方位角、飞行俯仰角、飞行横滚角、发动机转速、是否避障飞行、是否避水降落、是否开伞)通过232串口传输至信号板11 ;信号板11定时将飞控板10传输至无人直升机的姿态参数及无人直升机高度、经度、纬度、油量、缸温参数通过数传电台12、地面数传电台19-1传输至地面控制终端19，并在地面控制终端19的电子地图显示界面上显示上述参数；无人直升机操作员通过地面控制终端19在数传电台12、地面数传电台19-1的有效通信距离内，可以对无人直升机的飞行轨迹航点参数进行修改，使无人直升机按新飞行轨迹飞行；操作员在遥控接收机13的有效作用范围内，可以对无人直升机的飞行状态自动/遥控进行切换。
[0024]结合图2，本发明小型无人直升机飞行控制系统中，与直升机机头方向相同的方向为左，托架21左侧面安装一个托架齿轮21-1，托架21右侧面安装一个圆板21-2，托架齿轮21-1的中心嵌入第一轴承21-31，圆板21-2的中心嵌入第二轴承21-32，第一、二轴21-41、21-42插入各自的第一、二轴承21-31、21-32中，两个轴21-41、21-42分别固定在主干骨架22的前部，托架舵机21-5固定在主干骨架22的前部，托架舵机21-5轴上安装一个齿数与托架齿轮21-1齿数相同的舵机齿轮21-6，托架齿轮21-1和舵机齿轮21-6互相啮合，托架舵机21-5受飞控板10控制，托架21在0°位置与机头方向一致，机身正上方为+90°，机身正下方为-90°。
[0025]结合图7和图8，本发明小型无人直升机飞行控制系统的降落伞盒4固定在无人直升机芯轴23的正上方，伞电池4-1、伞蓝牙模块4-2安装在降落伞盒4的底部，在伞电池4-1上方安装一块弹簧垫板4-3，伞弹簧4-4固定在弹簧垫板4-3上方，伞弹簧上方固定一块伞垫板4-5,伞电源开关4-6固定在降落伞盒4的外壁下方,引导伞4-7与主伞4_8用尼龙绳相连，主伞4-8用尼龙绳与降落伞盒4内壁相连，引导伞4-7、主伞4-8折叠后放在伞垫板4-5的上方，降落伞盒盖板4-9用盒盖弹簧4-10与降落伞盒4上壁边沿相连，电磁锁
4-11固定在降落伞盒盖板4-9内壁，电磁锁4-11受伞蓝牙模块4-2控制，电磁锁锁扣4_12固定在降落伞盒4的上壁边沿，电磁锁4-11的锁舌4-13插入电磁锁锁扣4-12内，电磁锁
4-11吸合时，锁舌4-13从锁扣4-12中拔出。
[0026]结合图9，本发明小型无人直升机飞行控制系统的油量传感器15固定在右油箱25外侧，而且右油箱25底侧部用一软管与油量传感器15连通,油量传感器15与飞控板10相连。
[0027]结合图10，本发明小型无人直升机飞行控制系统的飞控板10包括第一 ARM单片机、脉冲整形电路、模拟信号放大电路、手摇/自动切换电路、串口通信模块、舵机驱动电路和电源管理模块。飞控板蓝牙模块10-1、激光测距传感器1、CXD摄像处理单元2-1、电子罗盘7、信号板11分别通过串口通信模块与第一 ARM单片机相应的串口连接；超声波测距传感器3、俯仰/横滚角度传感器6、方位角速率传感器5-1、俯仰角速率传感器5-2、横滚角速率传感器5-3为模拟口分别通过模拟信号放大电路与第一 ARM单片机相应的A/D接口连接；遥控接收机13分别与脉冲整形电路、手摇/自动切换电路连接，测速传感器14通过该脉冲整形电路与第一 ARM单片机的脉冲捕获接口连接；第一 ARM单片机的PWM 口与手摇/自动切换电路连接；升降舵机17-1、左副翼舵机17-2、右副翼舵机17-3、尾舵机17_4、油门舵机17-5、托架舵机21-5分别与舵机驱动电路连接，该舵机驱动电路与手摇/自动切换电路连接；控制电池18-1、舵机电池18-2与电源管理模块连接，该电源管理模块给飞行执行单元、状态传感器单元供电。
[0028]结合图12，本发明小型无人直升机飞行控制系统的信号板11包括第二 ARM单片机、串口通信模块、模拟信号放大电路。GPS8、油量传感器15、数传电台12、飞控板10分别通过串口通信模块与第二 ARM单片机相应的串口连接，缸温传感器16通过模拟信号放大电路与第二 ARM单片机A/D 口连接，高度计9与第二 ARM单片机I2C 口连接。
[0029]本发明小型无人直升机飞行控制系统的飞行执行单元控制爬升、下降、定速飞行、悬停、盘旋动作，即爬升/下降动作:飞控板10通过第一 ARM单片机CPU的PWM 口输出左副翼舵机17-2、右副翼舵机17-3、尾舵机17-4、升降舵机17_1角度定值脉宽调制波形值，该波形值经过驱动电路放大后分别作用于左副翼舵机17-2、右副翼舵机17-3、尾舵机17-4、升降舵机17-1。控制左副翼舵机17-2、右副翼舵机17-3产生向上或向下的平衡推力；控制尾舵机17-4使无人直升机不摆动；控制升降舵机17-1使无人直升机机头朝上30°或朝下30 °，产生上升推力或下降推力，使得无人直升机爬升或下降飞行。
[0030]定速飞行动作:飞控板10同上输出角度定值作用于左副翼舵机17-2、右副翼舵机17-3使之产生向前或向后的平衡推力；作用于尾舵机17-4，控制无人直升机不摆动；作用于升降舵机17-1使无人直升机机头朝下10°或朝上10°，产生向前或向后的推力；作用于油门舵机17-5使发动机转速控制在8000转/分，使得无人直升机定速向前或向后飞行。
[0031]悬停动作:飞控板10同上输出角度定值作用于左副翼舵机17-2、右副翼舵机17-3、升降舵机17-1使之产生平衡力控制无人直升机保持机身不晃动；作用于尾舵机17-4控制无人直升机保护机头不摆动，使得无人直升机在空中悬停不动。
[0032]盘悬动作:飞控板10同上输出角度定值作用于左副翼舵机17-2、右副翼舵机17-3使之产生右倾10° (顺时针盘旋)或左倾10° (逆时针盘旋)向前或向后的平衡推力；作用于升降舵机17-1使无人直升机机头朝下10°，产生向前的推力，作用于尾舵机17-4使机头右偏或左偏(无人直升机盘旋直径取决于机头右偏或左偏的角度);作用于油门舵机17-5使发动机转速控制在8000转/分，使得无人直升机在空中顺时针或逆时针转动顺时针:东——南-西-北。
[0033]结合图3，本发明小型无人直升机飞行控制系统的状态传感器单元实现自适应避障的过程为:激光测距传感器I和CXD摄像头2分别安装在托架21的左、右面上。在飞行过程中托架21处于0°位置(与机头方向相同):
[0034]①飞控板定时采样激光测距传感器I及CXD摄像处理单元2-1的信号，一旦发现飞行前方如70米内有障碍物，中断请求信号板11CPU，通知飞行前方有障碍物，控制无人直升机悬停；
[0035]②控制托架21转至+85°位置(在机身上方)，探测机身上方(如70米内)是否有障碍物，若无障碍物，控制无人直升机上升中断请求信号板IlCPU得到飞行高度(约50米)后悬停，再控制托架21转至0°位置，探测机头前方有无障碍物，若无障碍物，中断请求信号板11通知飞行前方无障碍物，无人直升机继续向前飞行，若有障碍物则重复②过程；
[0036]③若探测机身上方有障碍物，则控制托架21转至0°位置，控制无人直升机悬停右转(采样电子罗盘7得到转向角度)90°，探测机头前方是否有障碍物，若无障碍物，控制无人直升机前行安全距离(如100米)后悬停左转90°，重复①过程；
[0037]④在③过程中，若探测机头前方有障碍物，则控制无人直升机悬停左转180°，探测机头前方是否有障碍物，若无障碍物，控制无人直升机前行安全距离(如100米)后悬停右转90°，重复①过程；
[0038]⑤在④过程中，`若探测机头前方有障碍物，则控制无人直升机悬停右转90°，然后向后飞行安全距离(如50米)后悬停，重复②过程。
[0039]本发明小型无人直升机飞行控制系统的状态传感器单元实现降落避水面的原理为:激光光束射入水面会折射入水里，其回波很弱或反射回波的距离大于其实际距离从水底反射而超声波射入水面后大部分能量反射回来，其反射回的距离基本等于真实距离，利用这两个测距传感器对水面的反射波特性，就能判断被测面是否水面，降落避水面采用激光测距传感器值与超声波测距传感器值相比对的方法，无人机下方是水面的判断依据:LS1-Lia>KK，La=激光测距输出值，Le=超声波测距输出值，Kpf=I米(在实验过程中选定)。
[0040]结合图4，本发明降落避水面过程为:无人直升机在下降过程中，激光测距传感器I探头处于-85°位置(探头向下)，飞控板10定时采样超声波测距传感器3和激光测距传感器I的信号，若采不到超声测距传感器3的值，则无人直升机一直下降，一旦采样得到超声波测距传感器3的回波信号Le，马上与激光测距传感器I的回波的信号Lm进行对比，若1^-1^<1^(1^=1米)，控制无人直升机降落，在Le〈IOcm时，关闭发动机，无人直升机降落；若，控制无人直升机悬停，使托架21转至+85°位置，探测机身上方有无障碍物，若无障碍物控制无人直升机上开到安全距离(如30米)后悬停，使托架21转至0°位置，探测机身前方有无障碍物，若无障碍物则控制无人直升机定速向前飞行安全距离(如100米的距离，飞行速度是定值，飞行时间决定飞行距离)后悬停使支架21转至-85°位置，控制无人直升机下降重复上述过程。[0041]本发明小型无人直升机飞行控制系统的状态传感器单元实现姿态调整的原理为:电子罗盘7+方位/俯仰/横滚角速率传感器5-1、5-2、5-3+俯仰/横滚角度传感器6+飞控板10上的CPU+升降舵机17-1/左副翼舵机17-2/右副翼舵机17-3/尾舵机17_4组成无人直升机姿态调整控制回路。本发明采用重量轻、价格低廉的磁阻式电子罗盘、MEMS角速率传感器、MEMS角度传感器，而不采用重量重、价格高的光纤陀螺。但磁阻式电子罗盘在无人直升机转向飞行或飞行速度快时，不能实时输出指北值，在慢稳速直线飞行时，其值是可信的；MEMS角度传感器受重力影响在有加速度情况下机身抖动、风力干扰、转弯、变速飞行时，其角度值不准，在慢稳速飞行时其值是可信的；MEMS角速率传感器由于受温度影响存在零位漂移，其长时间积分累加得到的角度值不准，但MEMS角速率传感器在有加速度或有干扰时，其积分累加值短时间内是可信的，若不断用真实值对MEMS角速率传感器积分累加值“清零”(使积分累加值=真实值)，则在不同工作温度下、在有加速度或有干扰情况下飞行时MEMS角速率传感器积分累加值是可信的。
[0042]结合图5，本发明状态传感器单元实现姿态调整的过程为:飞控板10加电后，①设置周期为20-50ms (可以根据实际情况进行选取和调整)的积分定时器及3-6秒定时器，定时20-50ms采样方位/俯仰/横滚角速率传感器值，并积分20-50ms累加得到方位/俯仰/横滚飞行角度值，若监测到方位/俯仰/横滚角速率值在一段时间(如2-5秒)内变化< 1.5°时，可认为此时无人直升机处于稳态，而且电子罗盘值7、MEMS俯仰/横滚角度传感器6值是真实的，使方位飞行角度值Sa=电子罗盘7的值PA，俯仰/横滚飞行角度值Se/Se=MEMS俯仰/横滚角度传感器6的值PE/PK，实现积分累加值“清零”，如此不断“清零”从而得到无人直升机的真实方位角度Sa、俯仰角度Se、横滚角度Sk ；
[0043]②定时(如3-6秒)中断请求信号板11得到飞行状态(如前进、后退、悬停、盘旋)、飞行航向角Ha (以大地正飞为0°，东南西北顺时针角度增大)及飞行高度差Λ H (无人直升机与航点轨迹的高度差)；
[0044]③定时(20-50ms)将方位积分值Sa与飞行航向角Ha进行比较，若Λ S= | Sa-Ha |>1°则控制尾舵机17-4使机头反向偏转Λ S角度，使得无人直升机始终沿飞行轨迹Ha飞行；若Δ S〈l，则检测方位角速率传感器5-1有无输出，若方位角速率传感器5-1有输出，则控制尾舵机17-4与方位角速率传感器5-1值反向一个小角度，如此不断采样方位角速率传感器
5-1值控制尾舵机17-4，使方位飞行角度与轨迹航向角度相等，达到飞行时航向平衡，同时消除机头晃动，实现“锁尾”；
[0045]④定时20_50ms根据飞行状态判断Sk值(如前进、后退、悬停Sk=O、顺时针盘旋SK=10°、逆时针31；=-10° )，Ssk与飞行状态值不符，则控制左/右副翼舵机，使sK与飞行状态值相符，若Sk与飞行状态相符,贝U检测横滚角速率传感器5-3值有无输出，若有输出，则控制左/右副翼舵机使机身与横滚角速率传感器15-3反向一个小角度；
[0046]⑤定时(如3-6秒)判断Λ H是否小于安全距离值，如30米，若Λ Η>30米，则控制升降舵17-1使机头抬高30°或降低30°，使无人直升机按Λ H反方向爬升或下降至航向轨迹高度(Λ Η=±30米)若Λ Η〈30米，定时(20_50ms)根据飞行状态判断Se值(如前进、盘旋SE=-10°、后退SE=10°、悬停SE=0° )，若Se与飞行状态不符，则控制升降舵机17-1使Se值与飞行状态相符，若Se相符，则检测俯仰传感器5-2值是否有输出，若有输出，则控制升降舵机使机头与俯仰角速率传感器5-2值反向一个小角度，如此不断采样俯仰/横滚角速率传感器值5-2、5-3使无人直升机飞行高度与飞行轨迹相符，同时控制升降/左、右副翼舵机17-1、17-2、17-3，使俯仰/横滚飞行角度与飞行状态的俯仰/横滚角度相等，同时使无人直升机飞行时机身平衡，消除机身抖动。
[0047]结合图9，本发明小型无人直升机飞行控制系统的状态传感器单元实现动力监测的过程为:油量传感器15+缸温传感器16组成无人直升机动力监测回路，信号板11加电后，定时(如3-6秒)采样油量传感器值15及缸温传感器16值并计算返程油量值，公式为:
【权利要求】
1.一种小型无人直升机飞行控制系统，其特征在于包括飞行执行单元、状态传感器单元、降落伞单元、飞行控制单元、地面控制终端及遥控器单元，飞行执行单元包括升降舵机(17-1)、左副翼舵机(17-2 )、右副翼舵机(17-3 )、尾舵机(17-4 )、油门舵机(17-5 )、右油箱(25)、发动机(26)、舵机电池(18-2);状态传感器单元包括激光测距传感器(1)、(XD摄像头(2)、图像处理单元(2-1)、超声波测距传感器(3)、方位角速率传感器(5-1)、俯仰角速率传感器(5-2)、横滚角速率传感器(5-3)、俯仰/横滚角度传感器(6)、电子罗盘(7)、GPS (8)、高度计(9)、测速传感器(14)、油量传感器(15)、缸温传感器(16);降落伞单元由降落伞盒(4)组成；飞行控制单元包括飞控板(10)、飞控板蓝牙模块(10-1)、信号板(11)、数传电台(12)、遥控接收机(13)和控制电池(18-1);托架(21)、数传电台(12)安装在无人直升机主干骨架(22)的前部，飞控盒(24)、右油箱(25)、发动机(26)安装在主干骨架(22)的中部，超声波测距传感器(3)安装在主干骨架(22)的中后部，其探头朝下，电子罗盘(7)、GPS (8)安装在主干骨架(22)的后部，降落伞盒(4)安装在无人直升机芯轴(23)的一端正上方，无人直升机芯轴(23)的另一端与主干骨架(22)连接；激光测距传感器(1 )、(XD摄像头(2)安装在托架(21)上；方位角速率传感器(5-1)、俯仰角速率传感器(5-2)、横滚角速率传感器(5-3)、飞控板蓝牙模块(10-1)分别焊接在飞控板(10)上，高度计(9)焊接在信号板(11)上；图像处理单元(2-1)、遥控接收机(13)、飞控板(10)、信号板(11)、俯仰/横滚角度传感器(6)、控制电池18-1、舵机电池(18-2)安装在飞控盒(24)内；油量传感器(15)安装在右油箱(25)的侧面；缸温传感器(16)安装在发动机(26)外壳上；测速传感器探头(14-1)安装在发动机轴(27)上，测速传感器(14)安装在发动机(26)外壳上；与直升机机头方向相同的方向为左，左副翼舵机(17-2 )、右副翼舵机(17-3 )安装在无人直升机主轴(23-2 )的前后两侧，升降舵机(17-1)安装在无人直升机主轴(23-2)的左或右侧，尾舵机(17-4)安装在无人直升机尾部，油门舵机(17-5)安装在发动机(26)旁；无人直升机主轴(23-2)与机翼(23-3 )相连，无人直升机芯轴(23 )通过轴承(23-1)与无人直升机主轴(23-2 )连接。
2.根据权利要求1所述的小型无人直升机飞行控制系统，其特征在于与直升机机头方向相同的方向为左，托架(21)左侧面安装一个托架齿轮(21-1)，托架(21)右侧面安装一个圆板(21-2)，托架齿轮(21-1)的中心嵌入第一轴承(21-31)，圆板(21-2)的中心嵌入第二轴承(21-32)，第一、二轴(21-41、21-42)插入各自的第一、二轴承(21_31、21_32)中，两个轴(21-41、21-42)分别固定在主干骨架(22)的前部，托架舵机(21_5)固定在主干骨架(22 )的前部，托架舵机(21-5 )轴上安装一个齿数与托架齿轮(21-1)齿数相同的舵机齿轮(21-6)，托架齿轮(21-1)和舵机齿轮(21-6)互相啮合，托架舵机(21_5)受飞控板(10)控制，托架(21)在0°位置与机头方向一致，机身正上方为+90°，机身正下方为-90°。
3.根据权利要求1所述的小型无人直升机飞行控制系统，其特征在于降落伞盒(4)固定在无人直升机芯轴(23 )的正上方，伞电池(4-1)、伞蓝牙模块(4-2 )安装在降落伞盒(4 )的底部，在伞电池(4-1)上方安装一块弹簧垫板(4-3 )，伞弹簧(4-4 )固定在弹簧垫板(4-3 )上方，伞弹簧上方固定一块伞垫板(4-5)，伞电源开关(4-6)固定在降落伞盒(4)的外壁下方，引导伞(4-7)与主伞(4-8)用尼龙绳相连，主伞(4-8)用尼龙绳与降落伞盒(4)内壁相连，引导伞(4-7 )、主伞(4-8 )折叠后放在伞垫板(4-5 )的上方，降落伞盒盖板(4-9 )用盒盖弹簧(4-10)与降落伞盒(4)上壁边沿相连，电磁锁(4-11)固定在降落伞盒盖板(4-9)内壁，电磁锁(4-11)受伞蓝牙模块(4-2)控制，电磁锁锁扣(4-12)固定在降落伞盒(4)的上壁边沿，电磁锁(4-11)的锁舌(4-13)插入电磁锁锁扣(4-12)内，电磁锁(4_11)吸合时，锁舌(4-13)从锁扣(4-12)中拔出。
4.根据权利要求1所述的小型无人直升机飞行控制系统，其特征在于油量传感器(15)固定在右油箱(25)外侧，而且右油箱(25)底侧部用一软管与油量传感器(15)连通，油量传感器(15)与飞控板(10)相连。
5.根据权利要求1所述的小型无人直升机飞行控制系统，其特征在于飞控板(10)包括第一 ARM单片机、脉冲整形电路、模拟信号放大电路、手摇/自动切换电路、串口通信模块、舵机驱动电路和电源管理模块，飞控板蓝牙模块(10-1 )、激光测距传感器(I )、CXD摄像处理单元(2-1)、电子罗盘(7)、信号板(11)分别通过串口通信模块与第一 ARM单片机相应的串口连接；超声波测距传感器(3)、俯仰/横滚角度传感器(6)、方位角速率传感器(5-1)、俯仰角速率传感器(5-2)、横滚角速率传感器(5-3)为模拟口分别通过模拟信号放大电路与第一 ARM单片机相应的A/D接口连接；遥控接收机(13)分别与脉冲整形电路、手摇/自动切换电路连接，测速传感器(14 )通过该脉冲整形电路与第一 ARM单片机的脉冲捕获接口连接；第一 ARM单片机的PWM 口与手摇/自动切换电路连接；升降舵机(17-1)、左副翼舵机(17-2 )、右副翼舵机(17-3)、尾舵机(17-4 )、油门舵机(17_5 )、托架舵机(21-5 )分别与舵机驱动电路连接，该舵机驱动电路与手摇/自动切换电路连接；控制电池(18-1)、舵机电池(18-2 )与电源管理模块连接，该电源管理模块给飞行执行单元、状态传感器单元供电。
6.根据权利要求1所述的小型无人直升机飞行控制系统，其特征在于信号板(11)包括第二 ARM单片机、串口通信模块、模拟信号放大电路，GPS (8)、油量传感器(15)、数传电台(12 )、飞控板(IO )分别通过串口通信模块与第二 ARM单片机相应的串口连接，缸温传感器(16)通过模拟信号放大电 路与第二 ARM单片机A/D 口连接，高度计(9)与第二 ARM单片机I2C 口连接。
【文档编号】G05D1/10GK103744429SQ201410010532
【公开日】2014年4月23日 申请日期:2014年1月9日 优先权日:2013年2月7日
【发明者】曾勇, 童霏, 冯霄军, 龚军, 汪学文, 潘桂琴 申请人:山东英特力光通信开发有限公司