无人机飞行控制系统模拟器设计
合集下载
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
由设计原理图可知,飞行控制系统模拟器外部接口较多, 内部功能实现较为复杂,系统实时性强,整个系统对硬件及软 件的设计均有较高的要求。经过研究论证,系统构成思路为:
遥控遥地面检着陆架液压电源前轮转
善
收稿且期:2005—07—14;修回目期:2005一08—27。 作者简介:欧干良(1976一),男,湖北黄冈人,硕士研究生,主要从事 计算机测试与控制方向的研究。
在无人机的开发过程中,飞行控制系统需要反复设计、改 进与优化,才能达到预期目标。另外,无人机系统需要多次联 机调试才能验证其整体功能,在联试过程中,一旦飞行控制系 统出现故障,就会使全机联试工作中断,影响研制进度。因 此,我们设计了一种基于工业控制计算机的无人机飞行控制系 统模拟器,不仅能够真实模拟飞行控制系统的所有功能、动态 特性、输入输出信号及电气物理特性,还能通过实时仿真模拟 无人机的动态飞行,从而满足飞行控制系统设计与验证要求, 可在全机系统联试中代替真实飞行控制系统,极大的提高了研 发效率。
1 设计原理
飞行控制系统模拟器的主要功能就是在特定条件下等效真 实飞行控制系统,而无人机飞行控制系统以飞行控制计算机为 核心,与各种传感器及执行结构共同构成闭环控制系统,并且
与其它子系统之间存在复杂的接口关系[3]。飞行控制系统模拟 器要达到模拟飞行控制系统的目的,必须在总体功能上涵盖这 几大部分。在对飞行控制系统的设计验证以及支持无人机的系 统联试中,要求模拟器系统不仅能够完成飞行控制系统功能, 还要能够连续不断地实时模拟飞机的位置、姿态、速度、加速 度以及飞行环境参数,并复现在飞行控制系统作用下控制舵面 的偏转和飞机的响应,从而可以模拟、验证各种状态下的飞行 控制功能。由于传感器理论输出信号可根据无人机动力学和运 动学模型的输出解算出来,为此考虑引进飞机模型,使飞行控 制系统与飞机模型构成全数字闭合回路,这样既能仿真无人机 的实时飞行,又简化了传感器和执行机构的模拟。根据以上设 计思想,飞行控制系统模拟器构成原理如图1所示。
图2模拟器硬件结构图
(1)工业控制计算机:除选择高性能、数据处理能力强的 CPU外,总线结构也是要考虑的因素。由于计算机与外设通 信处理数据量较大,因此选择的接口板卡全部为PCI总线结 构。系统中工控机需要实时计算无人机飞行特性数学模型,实 时解算传感器输出信息,进行飞行控制律解算,从而完成无人 机内、外回路的控制、制导与导航,模拟飞行控制计算机的各 种功能。
众所周知,Windows系统以其界面友好、美观、易操作 性,吸引着广大用户。因此,这里在Windows2000操作系统 下,以Visual C++6.0为开发工具进行系统软件开发。Visu- al C++6.0是迄今为止最成功的Windows下的C++开发平 台之一,集成了微软基础类库(MFC),具有良好封装性、继 承性、多态性[4]。系统开发中,充分利用了VC中所提供的大 量窗口、控件类及其相应的操作与属性,通过AppWizard、 ClassWizard等可视化向导来自动生成所需要的程序框架和其 他一些程序元素,提高了编程效率。本系统软件要实现的功能 比较复杂,为了提高系统的可维护性、可扩展性,采用模块化 设计思想曲]。根据实现功能软件划分为以下几大模块:
第3期
欧于良,等:无人机飞行控制系统模拟器设计
· 34l ·
态,用户可以根据需要选择飞行控制阶段和显示各种数据页 面,进行实事控制和监视。
以上各模块是系统功能实现的重要组成部分,但各模块问 不是独立的,而是存在着复杂的联系,有着复杂的数据调用。 它们的数据交互关系如图3所示。
在软件编程中用到了几个数学算法,列举如下: (1)龙格一库塔法(Runge—Kutte):四阶龙格一库塔公 式是离线仿真中常用的微分方程算法,本程序在函数rk4() 中实现,用于解算飞机12阶微分方程,形成飞行状态值。该 仿真算法的函数如下: double*CFly::rk4(double t,double*x,double*U, double dt)//入口参数:t当前时间;x当前状态值;u当前控 制量;dt步长//出口参数:12个独立状态值
(4)PCI一7432卡:完成开关量输入/输出,输入/输出通 道各有32路;输入电压为0~24VDC,其中逻辑“高”为3-- 24V,逻辑“低”为0~2.4V;输出电压最低5V,最高可达
35V。
(5)C218Turbo卡:完成串行通信功能;内置RISC— based处理器,可减少主机CPU负担;提供大量的I/0内存; 8个串口可同时传输数据传输速率快,速度可达230.4Kbps。
关键诃:无人机;工控机;飞行控制系统;实时仿真;模拟器
Design of Flight Control System Simulator for Unmanned Aerial Vehicle
0U Ganliang,Chen Xin (College of Automation Engineering,Nanjing University of Aeronautics and Astronautics,Nanjing 210016,China) Abstract:A flight control system simulator based on industrial personal computer(IPC)for unmanned aerial vehicle(UAV)is put for— ward.The design principle of this system is introduced in detail,and the scheme of hardware realization is showed,the module functions and flowchart of software are also given,the test result is analyzed in the end.Using computer technique,automation control technique,system simulation technique and object oriented programming(OOP)technique,this simulator is versatile with characteristics of powerful function, friendly interface and convenient operation.It can be used for system early design and verification,or for the later test and maintenance of UAV.The actual application shows that the system has good performances and the requirements of real~time simulation experimentation used for replacing the real flight control system. Key words:unmanned aerial vehicle;industrial personal computer;flight control system;real—time simulation;simulator
文章编号:1671—4598(z0061 03—0339—04
中圈分类号:TP337;V249
文献标识褐:B
无人机飞行控制系统模拟器设计
欧干良,陈 欣
(南京航空航天大学自动化学院,江苏南京 210016)
摘要:提出了一种基于工业控制计算机开发的某型无人机飞行控制系统模拟器设计;详细介绍了系统设计原理,给出了硬件构成方 案、软件功能模块组成和程序流程图,最后分析了测试结果;该模拟器充分利用了当前计算机技术、自动控制技术、系统实时仿真技术 和面向对象编程技术,具有功能强大、界面友好、操作灵活的特点,可用于无人机系统先期设计验证或后期测试维护;实际使用情况表 明该系统性能良好,完全能够代替真实飞行控制系统进行实时仿真试验。
(2)PCI一9114 A/D卡:进行模拟信号采集,支持32通 道单端或16通道差动输入,分辨率16位;最大±35V的输入 电压保护;可编程增益,具有软件触发与定时器触发等多种触 发模式。
(3)PcI一6216 A/D卡:用于模拟信号输出,共有16通 道模拟量输出,分辨率为16位;输出范围为±lo V。
(3)输入/输出模块:与配置的各种输入/输出接口卡进行 结合,负责完成飞行控制功能模块与外围设备的数据交换,实 时接收外围设备的数据输入,数据格式变换;将相关数据转化 为相应格式,实时输出。
(4)定时模块:定时模块由定时器卡和定时软件共同作
图3软件模块数据交互关系图
c枣嚣1酶辈_l啦测-壮 万壤e辜t方潮e缸数据
(6)P10一D64卡:系统内部定时器,作为系统实时时钟, 具有6路定时器/计数器通道;另外板上具有4个时钟源,分 别为2M,1M,500K和250K,用户可以从焊脚上引用时钟源。 本系统主要利用其定时中断功能。
(7)接口转换箱:集中了所有的硬件输入/输出通道,严 格按照真实飞行控制系统的接口要求,对各种信号统一分配, 并进行输入输出驱动、电气和物理转换,形成无人机系统所需 的标准接口。 3 软件设计
(4)串口信号5路,均为RS422接口,分别为飞行控制 系统与遥控遥测系统、地面检测系统、机载参数记录系统、电 气系统控制计算机和状态监控计算机的接口信号。根据信号的 种类、标准和数量,系统应分别配置相应的A/D接口卡、D/ A接口卡、DI/DO(开关量信号输入输出)接口卡,多串口 卡,以及用作系统定时功能的定时器卡。综合以上考虑,系统 硬件配置及结构如图2所示。其中各部分基本特性简介如下:
开始
i
取当前状态剜
●
取当前控删
●
调用飞机方程 解算子0E程
●
存状态量l
●
存控制量l
眄如
图5 飞机模型模块ቤተ መጻሕፍቲ ባይዱ程图
图6 飞机方程解算子流程图
图4 系统程序总体流程图
用,完成定时卡的初始化、定时间隔的设定、定时启动功能。 系统采用主循环加定时中断以及消息驱动机制,在中断内通过 软计数判断相应任务周期,发送相应消息,驱动相应模块工 作。
O 引言
无人机是一个复杂的综合系统,通常包括飞机机体、发动 机、飞行控制、遥控遥测、状态检测、起飞着陆以及电力电源 等子系统[1]。其中,飞行控制系统是无人机的核心系统,它采 用先进的实时飞行及任务管理、导航和飞行控制技术,在实现 无人机的整个飞行功能的同时,还负责监视和控制无人机的其 它子系统,指挥无人机完成预定的任务[2]。
(1)飞机模型模块:接收飞控功能模块输出的控制量信 号;对飞机空气动力特性进行仿真;解算飞机的六自由度非线 性全量运动方程;形成飞行控制系统模拟器其它模块所需的各 种数据;仿真飞机运动时各种力和力矩,并且进行大气环境对 飞行影响的模拟。
(2)飞行控制功能模块:这部分是系统控制的核心,程序 功能复杂。根据飞机模型的实时输出数据以及外围设备的输 入,实时进行模态管理、飞行控制律和制导律解算,并实时形 成外围设备所需的数据,完成飞行控制系统功能的模拟。
万方数据
图1设计原理图
书榘测攘j网
ehgnoJao.缸辟垂.越
·340·
计算机测量与控制
第3期
系统硬件以工业控制计算机(IPC)为核心平台,充分配置外 围扩展接口模块,与无人机其它真实子系统的电气物理接口相 连;系统软件建立在Windows 2000操作系统平台上,以面向 对象编程的Visual C++6.0为开发工具进行软件设计。 2硬件设计
飞行控制系统模拟器的输入输出信号主要是与无人机其它 子系统的接口信号,分析归纳如下:
(1)模拟量输入信号17路,为刹车系统、液压系统、前 轮转弯系统和电源系统的状态或反馈信号;
(2)模拟量输出信号4路,为速度信号、左右机轮刹车指 令和前轮转弯系统指令信号;
(3)开关量信号40路,其中输入25路,输出15路,为 液压系统、推进系统,着陆架系统和其它子系统的状态信号;
遥控遥地面检着陆架液压电源前轮转
善
收稿且期:2005—07—14;修回目期:2005一08—27。 作者简介:欧干良(1976一),男,湖北黄冈人,硕士研究生,主要从事 计算机测试与控制方向的研究。
在无人机的开发过程中,飞行控制系统需要反复设计、改 进与优化,才能达到预期目标。另外,无人机系统需要多次联 机调试才能验证其整体功能,在联试过程中,一旦飞行控制系 统出现故障,就会使全机联试工作中断,影响研制进度。因 此,我们设计了一种基于工业控制计算机的无人机飞行控制系 统模拟器,不仅能够真实模拟飞行控制系统的所有功能、动态 特性、输入输出信号及电气物理特性,还能通过实时仿真模拟 无人机的动态飞行,从而满足飞行控制系统设计与验证要求, 可在全机系统联试中代替真实飞行控制系统,极大的提高了研 发效率。
1 设计原理
飞行控制系统模拟器的主要功能就是在特定条件下等效真 实飞行控制系统,而无人机飞行控制系统以飞行控制计算机为 核心,与各种传感器及执行结构共同构成闭环控制系统,并且
与其它子系统之间存在复杂的接口关系[3]。飞行控制系统模拟 器要达到模拟飞行控制系统的目的,必须在总体功能上涵盖这 几大部分。在对飞行控制系统的设计验证以及支持无人机的系 统联试中,要求模拟器系统不仅能够完成飞行控制系统功能, 还要能够连续不断地实时模拟飞机的位置、姿态、速度、加速 度以及飞行环境参数,并复现在飞行控制系统作用下控制舵面 的偏转和飞机的响应,从而可以模拟、验证各种状态下的飞行 控制功能。由于传感器理论输出信号可根据无人机动力学和运 动学模型的输出解算出来,为此考虑引进飞机模型,使飞行控 制系统与飞机模型构成全数字闭合回路,这样既能仿真无人机 的实时飞行,又简化了传感器和执行机构的模拟。根据以上设 计思想,飞行控制系统模拟器构成原理如图1所示。
图2模拟器硬件结构图
(1)工业控制计算机:除选择高性能、数据处理能力强的 CPU外,总线结构也是要考虑的因素。由于计算机与外设通 信处理数据量较大,因此选择的接口板卡全部为PCI总线结 构。系统中工控机需要实时计算无人机飞行特性数学模型,实 时解算传感器输出信息,进行飞行控制律解算,从而完成无人 机内、外回路的控制、制导与导航,模拟飞行控制计算机的各 种功能。
众所周知,Windows系统以其界面友好、美观、易操作 性,吸引着广大用户。因此,这里在Windows2000操作系统 下,以Visual C++6.0为开发工具进行系统软件开发。Visu- al C++6.0是迄今为止最成功的Windows下的C++开发平 台之一,集成了微软基础类库(MFC),具有良好封装性、继 承性、多态性[4]。系统开发中,充分利用了VC中所提供的大 量窗口、控件类及其相应的操作与属性,通过AppWizard、 ClassWizard等可视化向导来自动生成所需要的程序框架和其 他一些程序元素,提高了编程效率。本系统软件要实现的功能 比较复杂,为了提高系统的可维护性、可扩展性,采用模块化 设计思想曲]。根据实现功能软件划分为以下几大模块:
第3期
欧于良,等:无人机飞行控制系统模拟器设计
· 34l ·
态,用户可以根据需要选择飞行控制阶段和显示各种数据页 面,进行实事控制和监视。
以上各模块是系统功能实现的重要组成部分,但各模块问 不是独立的,而是存在着复杂的联系,有着复杂的数据调用。 它们的数据交互关系如图3所示。
在软件编程中用到了几个数学算法,列举如下: (1)龙格一库塔法(Runge—Kutte):四阶龙格一库塔公 式是离线仿真中常用的微分方程算法,本程序在函数rk4() 中实现,用于解算飞机12阶微分方程,形成飞行状态值。该 仿真算法的函数如下: double*CFly::rk4(double t,double*x,double*U, double dt)//入口参数:t当前时间;x当前状态值;u当前控 制量;dt步长//出口参数:12个独立状态值
(4)PCI一7432卡:完成开关量输入/输出,输入/输出通 道各有32路;输入电压为0~24VDC,其中逻辑“高”为3-- 24V,逻辑“低”为0~2.4V;输出电压最低5V,最高可达
35V。
(5)C218Turbo卡:完成串行通信功能;内置RISC— based处理器,可减少主机CPU负担;提供大量的I/0内存; 8个串口可同时传输数据传输速率快,速度可达230.4Kbps。
关键诃:无人机;工控机;飞行控制系统;实时仿真;模拟器
Design of Flight Control System Simulator for Unmanned Aerial Vehicle
0U Ganliang,Chen Xin (College of Automation Engineering,Nanjing University of Aeronautics and Astronautics,Nanjing 210016,China) Abstract:A flight control system simulator based on industrial personal computer(IPC)for unmanned aerial vehicle(UAV)is put for— ward.The design principle of this system is introduced in detail,and the scheme of hardware realization is showed,the module functions and flowchart of software are also given,the test result is analyzed in the end.Using computer technique,automation control technique,system simulation technique and object oriented programming(OOP)technique,this simulator is versatile with characteristics of powerful function, friendly interface and convenient operation.It can be used for system early design and verification,or for the later test and maintenance of UAV.The actual application shows that the system has good performances and the requirements of real~time simulation experimentation used for replacing the real flight control system. Key words:unmanned aerial vehicle;industrial personal computer;flight control system;real—time simulation;simulator
文章编号:1671—4598(z0061 03—0339—04
中圈分类号:TP337;V249
文献标识褐:B
无人机飞行控制系统模拟器设计
欧干良,陈 欣
(南京航空航天大学自动化学院,江苏南京 210016)
摘要:提出了一种基于工业控制计算机开发的某型无人机飞行控制系统模拟器设计;详细介绍了系统设计原理,给出了硬件构成方 案、软件功能模块组成和程序流程图,最后分析了测试结果;该模拟器充分利用了当前计算机技术、自动控制技术、系统实时仿真技术 和面向对象编程技术,具有功能强大、界面友好、操作灵活的特点,可用于无人机系统先期设计验证或后期测试维护;实际使用情况表 明该系统性能良好,完全能够代替真实飞行控制系统进行实时仿真试验。
(2)PCI一9114 A/D卡:进行模拟信号采集,支持32通 道单端或16通道差动输入,分辨率16位;最大±35V的输入 电压保护;可编程增益,具有软件触发与定时器触发等多种触 发模式。
(3)PcI一6216 A/D卡:用于模拟信号输出,共有16通 道模拟量输出,分辨率为16位;输出范围为±lo V。
(3)输入/输出模块:与配置的各种输入/输出接口卡进行 结合,负责完成飞行控制功能模块与外围设备的数据交换,实 时接收外围设备的数据输入,数据格式变换;将相关数据转化 为相应格式,实时输出。
(4)定时模块:定时模块由定时器卡和定时软件共同作
图3软件模块数据交互关系图
c枣嚣1酶辈_l啦测-壮 万壤e辜t方潮e缸数据
(6)P10一D64卡:系统内部定时器,作为系统实时时钟, 具有6路定时器/计数器通道;另外板上具有4个时钟源,分 别为2M,1M,500K和250K,用户可以从焊脚上引用时钟源。 本系统主要利用其定时中断功能。
(7)接口转换箱:集中了所有的硬件输入/输出通道,严 格按照真实飞行控制系统的接口要求,对各种信号统一分配, 并进行输入输出驱动、电气和物理转换,形成无人机系统所需 的标准接口。 3 软件设计
(4)串口信号5路,均为RS422接口,分别为飞行控制 系统与遥控遥测系统、地面检测系统、机载参数记录系统、电 气系统控制计算机和状态监控计算机的接口信号。根据信号的 种类、标准和数量,系统应分别配置相应的A/D接口卡、D/ A接口卡、DI/DO(开关量信号输入输出)接口卡,多串口 卡,以及用作系统定时功能的定时器卡。综合以上考虑,系统 硬件配置及结构如图2所示。其中各部分基本特性简介如下:
开始
i
取当前状态剜
●
取当前控删
●
调用飞机方程 解算子0E程
●
存状态量l
●
存控制量l
眄如
图5 飞机模型模块ቤተ መጻሕፍቲ ባይዱ程图
图6 飞机方程解算子流程图
图4 系统程序总体流程图
用,完成定时卡的初始化、定时间隔的设定、定时启动功能。 系统采用主循环加定时中断以及消息驱动机制,在中断内通过 软计数判断相应任务周期,发送相应消息,驱动相应模块工 作。
O 引言
无人机是一个复杂的综合系统,通常包括飞机机体、发动 机、飞行控制、遥控遥测、状态检测、起飞着陆以及电力电源 等子系统[1]。其中,飞行控制系统是无人机的核心系统,它采 用先进的实时飞行及任务管理、导航和飞行控制技术,在实现 无人机的整个飞行功能的同时,还负责监视和控制无人机的其 它子系统,指挥无人机完成预定的任务[2]。
(1)飞机模型模块:接收飞控功能模块输出的控制量信 号;对飞机空气动力特性进行仿真;解算飞机的六自由度非线 性全量运动方程;形成飞行控制系统模拟器其它模块所需的各 种数据;仿真飞机运动时各种力和力矩,并且进行大气环境对 飞行影响的模拟。
(2)飞行控制功能模块:这部分是系统控制的核心,程序 功能复杂。根据飞机模型的实时输出数据以及外围设备的输 入,实时进行模态管理、飞行控制律和制导律解算,并实时形 成外围设备所需的数据,完成飞行控制系统功能的模拟。
万方数据
图1设计原理图
书榘测攘j网
ehgnoJao.缸辟垂.越
·340·
计算机测量与控制
第3期
系统硬件以工业控制计算机(IPC)为核心平台,充分配置外 围扩展接口模块,与无人机其它真实子系统的电气物理接口相 连;系统软件建立在Windows 2000操作系统平台上,以面向 对象编程的Visual C++6.0为开发工具进行软件设计。 2硬件设计
飞行控制系统模拟器的输入输出信号主要是与无人机其它 子系统的接口信号,分析归纳如下:
(1)模拟量输入信号17路,为刹车系统、液压系统、前 轮转弯系统和电源系统的状态或反馈信号;
(2)模拟量输出信号4路,为速度信号、左右机轮刹车指 令和前轮转弯系统指令信号;
(3)开关量信号40路,其中输入25路,输出15路,为 液压系统、推进系统,着陆架系统和其它子系统的状态信号;