中小型无人机建模分析与仿真研究
来源:保捱科技网
第30卷第11期 计算机仿真 2013年11月 文章编号:1006—9348(2013)11—0032—04 中小型无人机建模分析与仿真研究 云超 ,李小民 ,郑宗贵 ,刘 品 (1.军械工程学院无人机工程系,河北石家庄050003;2.第二炮兵研究院,北京100085; 3.西安军代局驻203所军代室,陕西西安710065) 摘要:研究中小型元人机在军事领域中的应用建模问题,由于飞行无人驾驶只靠精确导航控制,为研究低空、低速中小型无 人机的飞行特点及控制规律,用传统c语言形式的无人机运动学模型和动力学模型开发周期长,工作量大等问题,提出l『利 用Matlab环境下的模块化仿真平台的快速的构建方案,并根据中小型无人机的具体气动参数设置了各个仿真模块的具体参 数,通过所建立的仿真模型验证了构建的中小型无人机仿真平台的可行性与有效性,仿真结果表明:所建立的仿真平台不仅 可以快速搭建中小型无人机的动态仿真模型并进行纯数字仿真研究,为将来无人机动态仿真模型的建立奠定基础。 关键词:中小型无人机;模块化;仿真平台;典型参数 中图分类号:V271.4 文献标识码:B Modeling and Simulation Platform Design and Research of Middle and Miniature Unmanned Aerial Vehicle YUN Chao ,LI Xiao—min ,ZHENG Zong—gui ,LIU Pin (1.Department of UAV Engineering,Ordnance Engineering College,Shijiazhuang Hebei 050003,China; 2.Academe of second artillerist,Beijing 100085,China; 3.Military Representation in Xi’an Office of 203 Academe,Xi’an Shanxi 7 10065,China) ABSTRACT:With the increasing damand of miniature and middle UAV in military application,in order to study the lfight characteristic and control law of the miniature and middle UAV which can not fly faster and higher,the paper introduced the UAV aerodynamic characteristic and kinematics model,then established the modularize simulation platform based on data flow in Simulink environment,and set the modularization parameter based on aerodynamic characteristic of the miniature and middle UAV,which can verify the simulation platform validity and feasibility by simulation experiment.The simulation platform can speed the design work of dynamic simulation model and do the numerical simulation researching work,which also can afford basic researching work for navigation and control system design in future. KEYWORDS:Miniature and middle unmanned aerial vehicle(UAV);Modularization;Simulation platform;Typic pa- rameter 1 引言 机。中小型无人机一般活动半径在150kin~350km,这种类 无人机(Unmanned Aeiral Vehicles,UAV)是一种动力驱 型无人机适合陆军的军、师级和海军陆战队的旅级进行 动、机上无人驾驶、可重复使用的航空器简称 。直到20世 战场监视、目标搜索定位以及战场评估等。这类无人机可装 纪80年代才得到日益广泛的应用,并且在几次局部战争中 置电视摄像机、前视红外装置、红外扫描仪或激光测距仪等 发挥了重要的作用。无人机飞速发展使得无人机的种类繁 侦查设备。由于中小型无人机尺寸不大、费用低、使用灵活。 多,型号各异。按照大小和质量分类,可以分成大型、中型、 世界各国都比较青睐,它不仅是无人侦察机中比例最大的机 小型和微型。起飞重量在500kg以上的称为大型无人机, 种,也是实战中使用最多的机种。 200kg~500kg称为中型无人机,小于200kg的称为小型无人 论文针对中小型无人机的模拟训练技术进行前期的数 字仿真平台建立与仿真研究分析,具有重要的现实意义,通 基金项目:“十二五”武器装备预先研究项目(51325050101) 过在PC机上构建了中小型无人机的数字仿真平台,进而进 收稿Et期:2012—12—06修回日期:2013—01—27 行全数字或半物理的仿真试验,所建立的仿真平台不仅可以 —32一 评价飞行品质,模拟中小型无人机飞行全过程,还可以缩短 研制周期,降低研制费用,为后续的无人机飞行控制系统和 模拟训练系统研制奠定基础。 2中小型无人机建模 2.1问题提出 无人机飞行系统的起飞与着陆性能,空中飞行操控性 能、系统自动化性能、飞行安全可靠性能与可维护性能在很 大程度上都取决于飞行控制与导航系统的设计。无人机飞 行仿真平台是无人机飞行控制与导航系统设计的有力工具, 通过构建仿真平台不仅可以验证飞行控制律的设计,导航算 法的正确性,还能够缩短系统的研制周期和降低系统的研制 费用。因此,开发并建立飞行仿真平台课题为无人机飞行控 制与导航系统的前期研究提供一个有力的工具。 传统飞行仿真都是采用C语言方式,这就需要大量的时 间对其空气动力学模型、控制与导航模型进行编程实现,如 果飞机气动布局改变,需要重新建模并使用C语言编写模块 程序,如果采用硬件在回路仿真时,硬件的调试则更为繁琐。 针对采用C语言形式编写与调试的复杂性,本文采用基于 Simulink形式下无人机模块化的设计思想,建立了典型中小 型无人机数字仿真平台,各个仿真子模块可以方便的组合并 用于飞行仿真系统的初期设计,Matlab/Simulink所设计的仿 真平台具有直观、形象且实现代码短,操作维护容易等特点, 还能大大减少了开发时的工作量。 2.2 中小型无人机动力学特性数学模型 无人机在空中飞行时主要受重力、发动机推力和飞机所 受的空气动力的作用 J。由于课题研究的是中小型无人机, 其航程较近、飞行速度和高度较低,所以可以对无人机运动 方程作如下假设: ①假定无人机为刚体且质量为常数,忽略无人机弹性影 响; ②假设无人机质量与质心不发生变化; ③将地球视为惯性系统,即将地面坐标假设为惯性坐 标; ④忽略地球曲率,即采用:“平面地球假设”; ⑤假定重力加速度为常数,即重力加速度不随飞行高度 变化而变化; ⑥假设机体坐标中OX轴和OZ轴处于飞机对称平面 内,因而惯性积 和 为零。 1)重力 设飞机的质量是mkg,重力加速度是g,则飞机所受的重 力分解到机体坐标系上为: r =一mgsin {Gy=一mgcosOcosy (1) I :, c。s si 2)发动机推力 设发动机推力为P,发动机安装角为 。,发动机推力偏 心距为e。,则发动机推力分解到机体坐标系上为: fP =Pcos ̄P {Py=Psimp (2) 【Pz:0 发动机推力及其推力偏心距所产生的俯仰力矩为: M:p=Pe (3) 3)空气动力 无人机飞行时所受的空气动力包括两部分:1)作用于无 人机质心的总空气动力RE(沿气流坐标轴系分解为X、Y、Z 又通常用D:一X表示阻力,L:一Z表示升力);2)绕质心的 总空气动力矩MZ(沿机体坐标轴系分解为 . . )。各 分量表达式为: fD=CDQS f Y=C Qs jl LLA=Cf QQS b (4) IMA=C QS cA LINA:C QS b 其中,C G C 分别为阻力、侧力和升力系数,c 、c 、 C 分别为滚转、俯仰和偏航力矩系数,Q:— 俨为动压,,●●●lIJ【l___.PP .g= l1 为空气密度, 为空速,S 为机翼参考面积,b为机翼展长,( C C为机翼的平均几何弦长。 r r + 一 无人机动力学方程可以表示为式(5)和(6): )g p 2 , Pr 啪+ + 一 =--Ul"+ +gc。s + + (5) . F uq—vp gcosOeos (6) ∑ 一 I 一ly+I:、I I:l I:一I l — ’ ’ 丁’ ’ 1 l 0l 一I +l I ’ — 。 2.3 无人机运动学模型 对于中小型无人机而言,其飞行高度口和运动速度 不 是很大,在建立运动方程时候可以将大地当做平面,即大地 是惯性坐标系。无人机全量运动方程可以采用非线性刚体 运动方程,一般用6自由度的12个运动状态表示为式(7)和 (8): 一33一 .r 【 = ( p 一 )g r + + r妒 P+(rcosgo+qsing ̄)tanO J qc。 一rsi“ (7) 【 = (rcos + n ) g=ucosOcos ̄+ (simpsinOcos ̄b—cos ̄vsinq/)+ W(sin sin +c08 sin cos ) =ucosOsin0+ (sinq ̄sin0sin0一c0s c0s )+ (8) W(一sin ̄cosO+cos sin口sin ) h usin0一vsinq ̄cos0一wcosq ̄cos0 根据无人机相关特征参数即可求解无人机任意时刻运 动状态。飞机运动的微分方程通常为非线性一阶微分方程 组,它不能用普通的解析法解算,只能用相应的数值算法进 行解算。应用数值算法既要考虑有较高的精度,还要考虑计 算速度,从而满足仿真的逼真度和实时性要求。 3 中小型无人机仿真模型建立方案 中小型无人机特性建模与实现技术是中小型无人机飞 行仿真技术的基础,随着计算机仿真技术的发展,无人机对 象特性建模逐步向计算机仿真环境过渡。无人机数学建模 的飞行仿真系统的被控对象是无人机。而在无人机飞行仿 真模型的设计中需要了解无人机的运动特性。在设计过程 中,各种仿真技术为研究无人机飞行仿真系统提供了有效的 支持。 3.1飞行仿真技术 在无人机研制开发中,需要进行大量的地面实验来决定 样机的性能,由于在实物上进行试验具有很大的局限与风 险,所以通常需要一个仿真平台对系统性能进行仿真。对无 人机操作手进行训练时,为了降低不必要的损失,通常也需 要一个仿真平台,能够根据操作手的输入参数,实时反映出 飞机的状态变化,从而达到熟练操作和排除故障的要求。另 外,在无人机设计过程中通常需要实现参数的动态调整,并 实时显示出飞机的运行状态,以便得到最优参数,所以也需 要一一个无人机的通用仿真平台 J。此外,在仿真中引入实物 进行半物理仿真,可方便验证、评估这些真实物理部件的性 能。 在无人机的研制过程中,使用最多的是数学仿真和半物 理仿真。数字仿真就是用数学模型去表述一个系统,并编制 程序在计算机上对实际系统进行研究的过程。数学仿真把 研究对象的结构特征或输入输出特征抽象为一组数学表述 (微分方程、状态方程,可分为解析模型、统计模型)来研究; 半物理仿真又称为混合仿真,它是为了提高仿真的可信度或 针对一些难以建立的模型系统,在系统研究中往往把数学模 型、物理模型和实体结合起来组成一个复杂的仿真系统。这 样可以避免全数字仿真中由于非线性部件建立数学模型的 不准确性所带来的误差,从而大大提高仿真的可信度 。 3.2基于Simulink环境的无人机建模方案 MATLAB/Simulink环境为无人机对象特性建模与无人 机飞行控制律设计提供了集成设计环境,该设计环境大大提 高了无人机飞行控制律的设计效率。Matlab/Simulink具有 强大的数据与函数处理功能,非常适合于无人机研制初期的 飞行控制率设计和模态的飞行仿真。论文采用了Simulink 工具箱进行无人机飞行仿真系统建模,因为基于Simulink的 模块化设计方案具有可重用、操作简单等特点,同时它还能 够通过RTW(Real time workshop)工具箱,生成在不同平台上 运行的可执行代码(即.exe文件)。Simulink含有丰富的工 具箱,包括了用于飞行器建模仿真的Aerospace工具箱 。 利用这些已有的工具箱,可以根据具体需求方便的进行仿真 研究,还能够节省大量的人力和时间。 根据具体需求将模型按照数据流程搭建起来,根据具体 的仿真需求修改模块的相关参数 ,有些通用的模块稍做修 改或不做修改就可以直接使用,例如:地球物理模型、大气环 境模型等,有些模块则需要根据具体对象修改,例如:气动参 数模块、飞机参数模块和初始化模块等。的无人机仿真平台 的数据流程图如图1所示。 图1 无人机仿真数据流程图 4仿真实例 在Simulink环境下搭建无人机仿真模型,其结构如图2 所示,主要包括三部分:输入控制量部分(图左边输入量模 块,如副翼、升降舵、方向舵等);无人机模块(中间的无人机一 UAV模块);无人机状态输出部分(地速、滚转速率、俯仰速 率、偏航速率等)。其中,无人机是中间的无人机一UAV模 块,它是系统的核心部分,它内部包含了图1无人机仿真数 据流程图中各个相关的子模型模块。 图2典型小型无人机结构示意图 针对某典型小型无人机如图2所示,进行仿真分析,此 无人机的重量约为10kg,机翼展长约为3.2m,机翼参考面积 约为0.65m 。在整个系统建模过程中,为增加系统稳定性, 加入了PID控制回路 ,速度稳定值设定为25m/s。在初始 设置相同的基础上,分别对比了理想条件和风干扰条件下飞 行典型输出参数:空速(airspeed)、滚转角(bank angle)、俯仰 速度稳定到25m/s上下,俯仰角逐渐稳定到了1.7。,偏航角 在横侧向风干扰下出现了32。的偏航角。飞行器的典型输出 参数在达到基本稳定后,在风干扰的影响下在稳定值附近出 现了高频震荡现象,这与实际状况也较为相符。真实环境下 无人机典型参数(空速、滚转角、俯仰角和航偏角)输出如图 5所示。 角(pitch angle)、偏航角(yaw angle)的输出。无人机仿真模 型结构框图如图2所示。 臣匡益 | L——J 地速x—axis —研 口 地速y-axis _+ 椎黼重l撒恕 ] 口 地速Z-axis [堑[ 、 口 滚转速率P 曲_气混台比 —+ I 俯仰速率一q l盛 r__. .1..__ 偏航速率r | 四元数e0 一四元数cx 羹[0 o O]l ——.. ’ 风向t曩欧拉角 四元数_ey 四元数ez 口 纬度 口 经度 厂—] 海拔高度 … {I r x 口 燃油质量 口 发动机转速 无人机UAV 飞行器状态 图3无人机仿真模型结构框图 1)理想状况即不考虑风干扰,设风速向量为[0 0 0],设 置仿真初始的速度为23m/s,其舵偏角均为00,速度回路加 入了PID控制,经过一段时间速度稳定到了25m/s上下,俯 仰角逐渐稳定到了1.7。,由于没有风干扰,且没有舵偏角,偏 航角基本保持在0。附近。理想环境下无人机典型参数(空 速、滚转角、俯仰角和航偏角)输出如图4所示。 far ̄ed bank ar ̄le : _一 } 8 J l pitch n e m n } 30o ;200 l00 图4理想大气环境下无人机典型参数输出 2)真实大气环境即考虑风干扰,设风速向量为[20—10 0],即只考虑横侧向的风向量。设置仿真初始的速度是 23m/s,速度回路也加入了PID控制,经过一段时间可以看出 r 。。 }— — fI n /【 图5真实大气环境下无人机典型参数输出 对比分析两种情况下某小型无人机典型飞行参数输出 结果可知,真实大气环境下的飞行参数更贴近实际状况,从 典型参数的输出可以看出风干扰对无人机典型参数的影响。 通过仿真分析可以为下一步飞行控制系统及无人机模拟训 练系统的设计提供工程依据。 5结论 论文介绍了中小型无人机的分类、特点及在现代军事中 的广泛应用,通过分析中小型无人机的动力学特性和运动学 模型,在数字仿真时做出了适合于中小型无人机特点的简化 处理,根据无人机具体气动参数和仿真数据流程建立了基于 Matlab/Simulink环境下模块化的某小型无人机仿真模型,通 过仿真对比理想环境和真实环境下该型无人机的4个典型 飞行参数(空速--airspeed、俯仰角一pitch angle、滚转角一 bank angle、偏航角一yaw angle)的输出值,验证了基于Simu— link模块化形式构建的中小型无人机动态模型的仿真平台 具有快速性和高效性优点,通过仿真平台建立与纯数字仿真 分析可以为下一步无人机模拟训练系统中动态飞行仿真模 型建立与飞行控制、导航系统的研究奠定基础。 参考文献: [1]吴汉平等译.无人机系统导论[M].北京:电子工业出版社, 2003. [2]康凤举.现代仿真技术与应用[M].北京:国防工业出版社, 20o1. [3] 陈欣,夏云程,董小虎.一种全数字半物理飞行控制实时仿真 系统[J].南京航空航天大学学报,2001,33:200—202. (下转第136页) 一35— [4] T A Wenzel,K J Burnham,M V Blundel1.Dual extended Kalman filter for vehicle state and parameter estimation『J].Vehicle Sys. 量 厘 tem Dynamics,2006,44(2):153—171. 蒜 柱 墟 树 [5]G Baffet,A Charara.An observer of tire—road forces and firction orf active seeurity vehicle system『J].IEEE/ASME Trnsaactions on Mechatronics,2007,12(6):651—661. [6]杨财,宋健,黄全安.车身侧偏角实用算法仿真[J].江苏大学 l/s 学报(自然科学版),2008,29(6):482—485. [7] 付皓.汽车电子稳定性系统质心侧偏角估计与控制策略研究 [D].长春:吉林大学,2008. [8] 徐颖.基于信息融合技术的线控汽车状态和路面参数的仿真 估计与试验研究[D].吉林大学,2009. [9] T A Wenzel,K J Burnham,M V Blundell,R A Williams.Ap- proach to Vehicle State and Parameter Estimation using Extended (a)左前轮瓤向力估计 蚕 匣 ・蒜 涩 Kalman Filtering[C].AVEC04,2011:725—730. [1O]T A Wenzel,K J Burnham,M V Blundell and R A Williams. Dual extended Kalman filter for vehicle state and parameter esti— t/s mation[J].Vehicle System Dynamics,2011,144(2):153—171. [11] 郑智忠,等.基于扩展卡尔曼滤波汽车质心侧向速度观测器 [J].农业机械学报,2008,39(5):1—5. [12] 王仁广,等.基于自适应卡尔曼滤波算法确定汽车参考车速 [J].农业机械学报,2006,37(4):9—11. (b)右前轮俩向力估计 图6驱动轮纵向力估计值 estimation of contact force[J].Vehicle System Dynamics,2005, 43(1):403-411. [作者简介] 主建锋(1984一),男(汉族),陕西宝鸡人,博士,讲 师,研究方向:道路交通检测及车载仪器开发; [2] M Satria,M C Best.Comparison between Kalman filter and robust iflter for vehicle handling dynamics state estimation[R].SAE Pa- per 2002一O1—1185,2002. 李平(1981一),男(汉族),陕西安康人,工程师, [3] M A Wilkin.et a1.Designed veriicatifon of an extended Kalman 研究方向:智能控制与检测。 ifher to estimation vehicle tyre force[R].SAE Paper 2006-01— 1285,2006. (上接第35页) [4]张毅,等 仿真系统分析与设计[M].北京:国防工业出版社, 2010. [作者简介】 云 超(1983一),男(汉族),陕西宝鸡市人,博士研 究生,主要研究领域为无人机飞行仿真及模拟训练 技术; [5]杨新,等.飞机六自由度仿真及模型研究[J].系统仿真学报, 2000. [6] 肖业伦.航空航天器运动的建模[M].北京:北京航空航天大 学出版社,2003—6. 李小民(1968一),男(汉族),河北保定市人,教授, -博士研究生导师,主要研究领域为无人机运用工 程;; [7]耿通奋,黄一疏.小型无人机实时仿真系统研究[J].计算机 仿真,2004. 郑宗贵(1969一),男(汉族),北京市人,高工,主要研究领域为导弹 系统仿真技术; 刘 品(1985一),男(汉族),河南南阳市人,助理工程师,主要研究 领域为武器系统仿真技术。 一136一