无人飞艇的半自主飞行控制系统及其控制方法

1.一种无人飞艇的半自主飞行控制系统，包括机载系统(2)和地面系统(1)，其特征在于机载系统(2)的系统结构为：传感器组(3)的输出由串行通讯接口和/或模/数转换接口连接单片机(4)的输入口，单片机(4)的输出由I/O引脚与模拟多路开关(5)输入端连接，模拟多路开关(5)的输出端连接致动器组(6)的输入端，单片机(4)通过串口与机载数传模块(7)相连，并由模块通道连接遥控信号接收机(8)，遥控信号接收机(8)的输出口连接模拟开关(5)；地面系统(1)有PC机(11)通过串口连接一个地面数传模块(9)，并有一个遥控信号发射机(10)；机载系统(2)的机载数传模块(7)和遥控信号接收机(8)分别通过射频信号与地面系统(1)的地面数传模块(9)和遥控信号机(10)联系；所述的单片机(4)电路由一块C8051F020型单片机(U2)、一块双排5×2标准插口(HDR1)、一个24M型晶振(Y1)、十一个电容(C14、C15、C1-C9)和一个电阻(R1)构成；传感器组(3)由一块MAX3232型串口通信接口芯片(U3)、四个电容(C10-C13)、一个HMR3000型数字罗盘(U5)和一块RGM3000型GPS接收机模块(U4)构成。
2. 根据权利要求1所述的无人飞艇的半自主飞行控制系统，其特征在于传感器组(3)、单片机（4)和模拟多路开关（5)制作于一块印刷电路板（12)上，由印 刷电路板（12)上的数传电台接线头（14)、遥控信号接收机接线头（15)和致动 器组接线头（13)分别通过电缆连接机载数传模块（7)，遥控信号接收机（8)和 致动器组（6)。
3. 根据权利要求1或2所述的无人飞艇的半自主飞行控制系统，其特征在于模拟多 路开关（5)为一块MAX333型芯片（Ul)。
4. 根据权利要求2所述的无人飞艇的半自主飞行控制系统，其特征在于数传电台接 线头U4)釆用单排四针标准插口 （CON6)、遥控信号接收机接线头（15)釆用 单排三针标准插口 （CONl—CON5)，致动器组接线头（13)釆用单排三针标准 插口 （CON7—CON10)。
5. 根据权利要求1所述的无人飞艇的半自主飞行控制系统，其特征在于传感器组（3) 包含有位置传感器和姿态传感器，致动器组（6)为舵机。
6. —种用于权利要求1所述的无人飞艇的半自主飞行控制系统的控制方法，其特征 在于控制步骤为：a. 在机载系统（2)中将传感器组（3)感知无人飞艇的姿态与位置的信号传送 至单片机处理；b. 在地面系统中，由遥控者操纵遥控信号发射机（10)发送遥控信号，包括飞 行模式切换信号；c. 地面数传模块（9)接收机载系统中单片机（4)传给机载数传模块（7)的数 据转换成的射频信号，送至地面PC机（11)处理；d. 地面数传模块（9)接收PC机（11)的飞行控制指令，并将其转换为射频信 号送出；e. 机载数传模块（7)接收飞行控制指令传送至单片机（4)处理，包括切换飞 行模式；f. 机载系统（2)中的单片机（4)通过控制与模拟多路开关（5)的控制端连接 的I/0引脚电平，在遥控信号接收机（8)接收地面遥控信号发射机（10)的 遥控信号和单片机（4)发送的飞行控制信号两者之间选一，对致动器组舵机(6)进行控制，实现姿态控制与导航。
7. 根据权利要求6所述的无人飞艇的半自主飞行控制系统的控制方法，其特征在于 通过机载单片机（4)对遥控信号接收机（8)模式通道的状态识别，改变模拟多 路开关（5)相关通道的控制端电平，使对应致动器组（6)信号在遥控信号接收 机（8)信号或单片机（4)信号中选一，从而使飞行控制系统在人工遥控飞行、 局部人工遥控飞行与自动遥控飞行三种模式之间切换。
8. 根据权利要求6所述的无人飞艇的半自主飞行控制系统的控制方法，其特征在于 自主飞行模式中，通过在单片机中预先设置飞行航路点，或在飞行过程中实时设 定飞行航路点，使无人飞艇按航路点飞行。

无人飞艇的半自主飞行控制系统及其控制方法\n技术领域\n本发明涉及一种飞行器的控制系统及其控制方法，特别是一种无人飞艇的半自主 飞行控制系统及其控制方法。 背景技术\n飞艇是一种轻于空气（Lighter Than Air, LTA)的飞行器，其主要组成部分有 充满轻质气体的气囊、 一台或数台产生推力的发动机、吊舱、尾翼和操纵系统等。与 重于空气的飞行器的主要不同在于：飞艇依靠密封于气囊内的轻于空气的气体（如氢 气、氦气或热空气等）提供全部或绝大部分升力，将飞艇及其载荷支持在空中，该升 力与飞行速度无关。飞艇与其他轻于空气飞行器的主要不同在于：飞艇是有动力、可 操控的，发动机为其提供动力，通过操纵尾翼上的升降舵和方向舵控制飞艇的俯仰和 方向运动。无人飞艇的特征尺寸约为20m以下，可以携带一定的任务负载，续航时间 —般在2h以内。\n与无人固定翼飞行器和无人旋翼飞行器相比，无人飞艇具有制造维护成本低、商 载-自重比大、续航时间长、操纵性强、控制简单安全、可实现低空低速飞行等优点。 自20世纪80年代，许多国家开展了无人飞艇的研究，主要目的是以其为平台，开展 交通监视、城市规划、电线与管道架设与检测、矿场或考古地点勘测与保护、法律实 施、通讯中继、以及环境、生物多样性、气候监测和研究等。近年来，超小型无人飞 艇得到了越来越多的应用，正成为国际上的一个研究热点。\n无人飞艇的绝大多数采用遥控方式，遥控距离一般为视距范围以内。显然，遥控 方式存在不足，如遥控距离有限，当目标地点处于遥控者难以到达的地方（如大森林、 沼泽）时，无人飞艇无法飞行；遥控者劳动强度大，遥控者一直仰头边看飞艇边操作, 尤其在一些长时间飞行情况下容易疲劳等。\n半自主/自主无人飞艇飞行控制系统的目的在于部分地取代人工操纵，使飞艇具 有一定的自主性。在这方面，巴西的AURORA计划项目、法国国家科学研究中心系统 结构与分析实验室等研究机构做了大量的工作，但其研究是基于高成本传感器组的， 不利于实现商业化。\n发明内容\n本发明的目的在于提供一种无人飞艇的半自主飞行控制系统及其控制方法，提高 无人飞艇飞行的自主性能，减轻遥控操作者的劳动强度，拓宽无人飞艇的应用范围。 为达到上述目的，本发明的构思是：本无人飞艇的半自主飞行控制系统包括 机载系统和地面系统两部分，其中机载系统由传感器组（包括位置传感器和姿态传感 器)、单片机、遥控信号接收机、模拟多玲开关、致动器、机载数传模块组成。单片 机信号和遥控信号接收机信号经模拟多路开关与致动器信号线相连，单片机引脚与模\n拟多路开关的控制端相连；单片机通过串行通信接口和（或）模/数转换接口获取传 感器组信号；单片机的通用I/O引脚与遥控信号接收机相关控制通道的信号线相连； 单片机通过串口与数传模块相连。地面系统包括遥控信号发射机、PC机、地面数传 模块；遥控信号发射机由遥控者操作；地面数传模块通过串口与PC机相连。\n为了使该控制系统能满足多种用户需求，按如下几点设计了该系统的控制方法。\n1. 单片机通过对接收机模式通道信号进行识别，通过控制模拟多路幵关的控制 端，使控制系统在人工遥控、局部人工遥控及自主飞行这三种模式进行切换，从 而既能实现无人飞艇的自主飞行，又可在特殊情况下及时切换到遥控模式下，提 高了无人飞艇的安全性。\n2. 单片机通过中断程序采集无人飞艇的姿态、位置、速度、方向等传感信,，经 处理后依控制算法计算出当前飞行控制模式下所要求控制的各通道的控制量，由I/O 口发出、经模拟多路开关至致动器控制无人飞艇的相关舵面，从而控制飞艇的飞行。\n3. 通过预先设置或在飞行过程中实时设定航路点，使自主地按设定的路径飞行。 4，为了避免因数据模块数据出错而带来的不利影响，对数传模块所传送的数据\n设定严格的格式并设置校验，使机载系统和地面系统能方便地辨别传送数据i否正确。\n根据上述构思，本发明采用下述技术方案-\n—种无人飞艇的半自主飞行控制系统，包括机载系统和地面系统，其特征在于机 载系统的系统结构为：传感器组的输出由串行通讯接口和/或模/数转换接口连接单片 机的输入口，单片机的输出由I/0引脚与模拟多路开关输入端連接，模拟多路开关的 输出端连接致动器组的输入端，单片机通过串口与机载数传模块相连，并由模块通道 连接遥控信号接收机，遥控信号接收机的输出口连接模拟开关；地面系统有PC机通 过串口连接一个地面数传模块，并有一个遥控信号发射机；机载系统的机载数传模块\n和遥控信号接收机分别通过射频信号与地面系统的地面数传模块和遥控信号机联系；\n上述的单片机电路由一块C8051F020型单片机、 一块双排5X2标准插口、 一个 24M型晶振、H^—个电容和一个电阻构成。\n上述的传感器组由一块MAX3232型串口通信接口芯片、四个电容、一个HMR3000 型数字罗盘和一块RGM3000型GPS接收机模块构成。\n上述的传感器组、单片机和模拟多路开关制作于一块印刷电路板上，由印刷电路 板上的数传电台接线头、遥控信号接收机接线头和致动器组接线头分别通过电缆连接 机载数传模块，遥控信号接收机和致动器组。\n上述的模拟多路开关为一块MAX333型芯片。\n上述的数传电台接线头采用单排四针标准插口、遥控信号接收机接线头采用单排\n三针标准插口，致动器组接线头采用单排三针标准插口。\n上述的传感器组包含有位置传感器和姿态传感器，致动器组为舵机。 一种用于权利要求1所述的无人飞艇的半自主飞行控制系统的控制方法，其特征\n在于控制步骤为：\na. 在机载系统中将传感器组感知无人飞艇的姿态与位置的信号传送至单片机处 理；\nb. 在地面系统中，有遥控者操纵遥控信号发射机发送遥控信号，包括飞行模式 切换信号；\nc. 地面数传模块接收机载系统中单片机传给机载数传模块的数据转换成的射频 信号，送至地面PC机处理；\nd. 地面数传模块接收PC机的飞行控制指令，并将其转换为射频信号送出；\ne. 机载数传模块接收飞行控制指令传送至单片机处理，包括切换飞行模式；\nf. 机载系统中的单片机通过控制与模拟多路开关的控制端连接的I/O引脚电平， 在遥控信号接收机接收地面遥控信号发射机的遥控信号和单片机发送的飞行 控制信号两者之间选一，对致动器组舵机进行控制，实现姿态控制与导航。\n在上述的控制方法中，通过机载单片机对遥控信号接收机模式通道的状态识别， 改变模拟多路开关相关通道的控制端电平，使对应致动器组信号在遥控信号接收机信 号或单片机信号中选一，从而使飞行控制系统在人工遥控飞行、局部人工遥控飞行与 自动遥控飞行三种模式之间切换。\n在上述的自主飞行模式中，通过在单片机中预先设置飞行航路点，或在飞行过程\n中实时设定飞行航路点，使无人飞艇按航路点飞行。\n本发明与现有技术相比，具有如下显而易见的突出特点和显著特优点：在本发明 设计的控制系统中，单片机对遥控接收机模式通道信号进行识别，使遥控系统魄在人 工遥控、局部人工遥控及自主飞行三种模式进行切换：能通过预先设置或在飞行过程 中实时设定航路点，使自主地按设定路线飞行，执行预设任务；地面可通过遥控信号 发射机发送指令无人飞艇，操空方便：可通过地面数传模块获得无人飞艇的各种飞行 数据，便于实时遥控。本发明提高了飞艇的自主性能，减轻了遥控者的劳动强度，同 时可拓宽无人飞艇的应用范围。 附图说明\n图1是本发明一个实施例的系统结构框图 图2是图1示例的系统结构示意图 图3是图2中印刷电路板的电路原理图 图4是单刀双掷模拟开关的原理示意图 图5是图1示例中单片机的程序流程图 图6是图1示例中飞行模式切换程序流程图 图7是图1示例中的控制框图 图8是图1示例中数传模块传送数据的格式图 具体实施方式\n本发明的一个优选实施例如下详述：\n参见图1和图2，本无人飞艇的半自主飞行控制系统，包括机载系统2和地面系 统1,机载系统2的系统结构为：传感器组3的输出由串行通讯接口和/或模/数转换 接口连接单片机4的输入口，单片机4的输出由I/O引脚与模拟多路开关5输入端连 接，模拟多路开关5的输出端连接致动器组6的输入端，单片机4通过串口与机载数 传模块7相连，并由模块通道连接遥控信号接收机8，遥控信号接收机8的输出口连 接模拟开关5:地面系统1有PC机11通过串口连接一个地面数传模块9，并有一个 遥控信号发射机10;机载系统2的机载数传模块7和遥控信号接收机8分别通过射 频信号与地面系统1的地面数传模块9和遥控信号机10联系。上述的传感器組3、 单片机4和模拟多路开关5制作于一块印刷电路板12上，由印刷电路板12上的数传 电台接线头14、遥控信号接收机接线头15和致动器组接线头13分别通过电缆连接 机载数传模块7,遥控信号接收机8和致动器组6。传感器组3包含有位置传感器和\n姿态传感器，位置传感器采用RoyalTek公司的RGM3000型GPS接收机，姿态传感器 为HoneyWell公司的HMR3000数字罗盘，这两个传感器均通过串口与单片机4通信， 另外，由于数传电台和数字罗盘的串口为RS232电平，故需利用串口接口芯片将其转 换为单片机4可接受的TTL电平，本例中采用了 MAX3232,作为传感器的接口芯下以实 现此功能；单片机4为Cygnal公司出品的C8051F020型单片机：模拟多路开关5为 MAXIUM公司制造的Max333型元件；遥控信号接收机8为Futaba公司出品的RH9DP 型9通道接收机：致动器6为Futaba公司出品的FutabaS9204型舵机。地面系统1 中遥控信号发射机10为Futaba公司出品的T9CAP型发射机，地面PC机11可为通用 的便携式膝上机。地面系统1和机载系统2中的数传模块7、 9为泰达鑫公司出品的 TDX-230型双工数传电台，均通过串口与单片机4或PC机11相连。为了辑高系统的 集成度，在该实例中将传感器组及其接口 3电路、单片机模块4、模拟多路开关5等 集成在一印刷电路板12中，并在该电路板上留出了与机载数传电台的串口的接线头 14,留出了与遥控信号接收机8的第二、三、四、六、八通道信号接口的接线头15, 留出了与四个舵机6的接口 13。\n参见图4，上述印刷电路板12电路的各部分分别为：\n单片机模块4含有：U2~Cygnal公司出品的C8051F020型单片机；Yl—24M晶振； C14与C15—27pF电容；C1~C9~0. luF电容；HDR1—双排5X2标准插口 ，单片机程 序烧写JTAG插口。\n遥控信号接收机接头8含有：C0N广C0N5—单排三针标准插口，分别连至接收机 的通道2、通道3、通道4、通道6、通道8, C0N5与单片机P3.4引脚连接。\n模拟多路开关5含有:Ul—模拟多路开关MAX333,其各路的连接关系如表1所示。\n舵机接线头13含有：CON7^CON10—单排三针标准插口，分别连至无人飞艇升降 舵舵机、左发动机风门舵机、方向舵舵机、右发动机风门舵机。\n传感器组及其接口电路3含有：U3—串行通信接口芯片MAX3232; U4~GPS接收 机模块RGM3000; U5—数字罗盘HMR3000; C10〜C13—1. OuF钽电容。\n数传电台接线头14含有：C0N6—单排四针标准插口。\n图2是单刀双掷型模拟开关的示意图。当控制端为低电平时，公共端与常合端导 通；否则当控制端为髙电平时，公共端与常合端导通。在本实施例中釆用的MAX1UM 公司制造的Max333型元件有四路这样的独立的模拟开关，把遥控信号接收机的第二、 三、四、六通道（分别对应飞艇的升降舵、左发动机风门舵、方向舵、右发动机风门\n舵）分别与Max333的常合端连接，其常开端、控制端分别与相应的单片机的引脚连 通，公共端与致动器信号线连通。故通过改变控制端的电平，单片机可以控制致动器\n信号的来源。\n表1模拟开关各路连接情况\ntable see original document page 9\n\n本无人飞艇的半自主飞行控制系统的控制方法如下所述：本控制方法的控制步骤\n为：\na. 在机载系统2中将传感器组3感知无人飞艇的姿态与位置的信号传送至单片\n机处理；\nb. 在地面系统中，有遥控者操纵遥控信号发射机10发送遥控信号，包括飞行模 式切换信号：\nc. 地面数传模块9接受机载系统中单片机4传给机载数传模块7的数据转换成\n的射频信号，送至地面PC机11处理；\nd. 地面数传模块9接受PC机11的飞行控制指令，并将其转换为射频信号送出；\ne. 机载数传模块7接受飞行控制指令传送至单片机4处理，包括切换飞行模式:\nf. 机载系统2中的模拟多路开关5在遥控信号接收机8接受地面遥控信号发射 机10的遥控信号和单片机4发送飞行控制信号,对致动器组舵机6进行控制，\n实现姿态控制与导航。\n上述的控制方法中，通过机载单片机4对遥控信号接收机8模式通道的状态识别， 改良模拟多路开关5相关通道的控制端电平，使对应致动器组6信号在遥控信号接收 机8信号或单片机4信号中选一，从而使飞行控制系统在人工遥控飞行、局部人工遥 控飞行与自动遥控飞行三种模式之间切换。\n上述的自主飞行模式中，通过在单片机中预先设置飞行航路点，或在飞行过程中\n实时设定飞行航路点，使无人飞艇按航路点飞行。\n图5给出本无人飞艇飞控系统机载单片机的程序流程图。程序初始化后，塡过与\n人工交互设置无人飞艇的飞行航路点，然后进行循环控制中。在循环控制中，利用单 片机4的中断程序处理经串口传入的GPS和数字罗盘3的信号语句以及地面PC机11 上传的控制指令，如果一个语句接收并处理完毕，则写对应的标识。在一个循环中， 首先判断无人飞艇的飞行模式；然后査询中断处理是否完成的标识，如果某传感器信 号处理完毕标识为l,则将该传感器数据按一定的格式传送至地面，然后将对库的标 识清0;地面PC机11控制指令接收及处理后，与传感器数据一起被用于控制算法中， 控制算法通过当前飞行状态和目标状态，计算出各舵机6所需的控制量，发送给多路 开关5。\n图6的虚线框中是飞行模式切换程序流程图。在本实施例中P3. 4引脚与遥控信 号接收机8的通道8连通，由于所有通道的信号均是脉宽调制（PWM)信号，因此单 片机4通过定时器/计数器计算一个周期内PWM波的高电平时间t,即可获知遥控者 设定的飞行模式。在实施例中，设定当700〈tS1200时，表明操作者希望无人飞艇处 于遥控飞行模式，此时，单片机4控制P2.0、 P2.1、 P2.2、 P2.3即模拟开关5的四 个通道的控制端的电平均为低，使各路常合端与公共端导通，即所有致动器6的输入 信号为接收机8的信号，从而遥控者可遥控轻于空气飞行器的所有通道。当1200

下载

法律信息

• 2013-03-20

  未缴年费专利权终止

  IPC(主分类): G05D 1/00 专利号: ZL 200410015793.0 申请日: 2004.01.13 授权公告日: 2009.02.04

• 2009-02-04

  授权

  授权

• 2005-03-02

  实质审查的生效

  实质审查的生效

• 2004-12-29

  公布

  公布

引用专利（该专利引用了哪些专利）

序号	公开(公告)号	公开(公告)日	申请日	专利名称	申请人
1	CN1358650A	2002-07-17	2002-01-29	一种用于共轴双旋翼无人驾驶直升机的遥控系统失效专利	北京航空航天大学
2	CN2532511Y	暂无	2001-07-26	飞行实时仿真监控系统失效专利	北京超翼技术研究所有限公司;中国人民解放军济南军区空军航空中心修理厂;北京睿骊通电子技术有限公司
3	CN2274602Y	暂无	1995-10-05	遥控热气飞艇失效专利	王嘉謇
4	US5904724A	暂无	1996-01-19	Method and apparatus for remotely piloting an aircraft失效专利	Jed Margolin
5	US5716032A	暂无	1996-04-22	Unmanned aerial vehicle automatic landing system失效专利	Pat H. McIngvale

序号	公开(公告)号	公开(公告)日	申请日	专利名称	申请人
该专利没有被任何外部专利所引用！