四旋翼飞行器建模与仿真Matlab

1、四轴飞行器的建模与仿真摘要四旋翼飞行器是一种能够垂直起降的多旋翼飞行器, 它非常适合近地侦察、 监视的任务 ,具有广泛的军事和民事应用前景。本文根据对四旋翼飞行器的机架结构和动力学特性做详尽的分析和研究 , 在此基础上建立四旋翼飞行器的动力学模型。四旋翼飞行器有各种的运行状态, 比如 : 爬升、下降、悬停、滚转运动、俯仰运动、偏航运动等。本文采用动力学模型来描述四旋翼飞行器的飞行姿态。在上述研究和分析的基础上, 进行飞行器的建模。动力学建模是通过对飞行器的飞行原理和各种运动状态下的受力关系以及参考牛顿- 欧拉模型建立的仿真模型，模型建立后在Matlab/simulink软件中进行仿真。关键字

2、: 四旋翼飞行器 , 动力学模型，Matlab/simulinkModeling and Simulating for a quad-rotoraircraftABSTRACTThe quad-rotor is a VTOL multi-rotor aircraft. It is very fit for the kind ofreconnaissance mission and monitoring task of near-Earth, so it can be used in awiderange of militaryand civilianapplications.Inthediss

3、ertation,thedetailedanalysis and research on the rack structure and dynamic characteristics of thelaboratoryfour-rotoraircraftis showed in the dissertation.The dynamicmodel ofthefour-rotoraircraftareestablished.Italsostudiesontheforceinthefour-rotoraircraftflightprinciplesand courseof the campaign t

4、o make theresearchand analysis.The four-rotoraircrafthas many operatingstatus,such as climbing,downing,hoveringand rollingmovement, pitchingmovement and yawingmovement. Thedynamicmodelisusedtodescribethefour-rotoraircraftinflightinthedissertation. On the basis of the above analysis, modeling of the

5、aircraft can be made. Dynamics modeling is to build models under the principles of flight of the aircraft and a variety of state of motion, and Newton - Euler model with referenceto the four-rotor the simulation is done in the software of Matlab/simulink.Keywords: Quad-rotor， The dynamic mode, Matla

6、b/simulink目录一 引言 .0简介 .0研究背景 .1目标和内容 .1二飞行器建模.1机体质心运动模型.1机体角运动模型.3三仿真与分析.6仿真平台和参数选取.6仿真过程 .7飞行器的升降运动仿真.7飞行器的滚转运动仿真.8飞行器的俯仰运动仿真.9飞行器的偏航运动.10仿真结果分析.11四结论 .11参考文献 .13一引言简介四旋翼飞行器也称为四轴飞行器，是一种有4 个螺旋桨且螺旋桨呈十字形交叉的飞行器，可以实现各种的运行状态, 如 : 爬升、下降、悬停、滚转运动、俯仰运动、偏航运动等四旋翼飞行器是一种无人机，无人机和有人飞机比较, 具有体积相对较小, 造价也比载人机低很多 , 使用非

7、常的方便, 在各种复杂的作战环境都可以进行作战等优点。无人机的优点备受世界各国军队的喜爱, 在几次局部战争中, 无人机都得以应用。无人机的准确度、高效性以及灵便的侦查能力得到了充分的发挥, 并且引起了对无人机的军事应用和装备技术等相关问题的研究和发展。 在 21 世纪的陆地战争、 海洋战争甚至是在空中的战争, 已经出现了很多的无人驾驶的武器 , 自行进行攻击的武器。 无人机在其中占据了一个非常重要的角色, 并且会在未来的军事战争中产生巨大的影响。四旋翼飞行器是一种能够实现垂直的起降具有四个旋翼的飞行器, 它分为两种，一种是用遥控器进行遥控的 , 另外一种是可以实现自主控制自主飞行。从总体的布局

8、上来看, 四旋翼飞行器是属于非共轴的多旋翼飞行器。与传统的旋翼飞机相比较而言, 一方面机体的结构相对更为紧凑 , 另一方面旋翼的增多会产生更大的升力。由于四旋翼的前后与左右的旋翼转向相反 , 这样就可以抵消反扭力矩 , 因此就不需要去设置专门的尾桨来平衡机体的反力矩。小型的多旋翼飞行器可以对近地而的环境进行监视和侦察, 利用摄像头可以实现实吋的摄像与航拍。研究背景现在存在的四旋翼飞行器大致分为三类: 一种是利用无线电进行遥控的四旋翼飞行器,另外一种是自主控制的中小型的四旋翼飞行器, 还有一种是自主控制的微型四旋翼飞行器这几种飞行器都属于小型的无人飞行器。目前针对四旋翼飞行器控制技术的研究主要集

9、中在以下两个方面: 一方面是基于惯性导航系统的自主控制, 另外一方面是基于视觉的自主飞行控制。国际上对于四旋翼飞行器的研究己经取得了相对比较丰硕的成果, 然而在国内这一研究才刚刚起步。 只有国防科学技术大学、哈尔滨工业大学以及上海交通大学微纳米科学技术研究院几个已有文献的报导。哈尔滨工业大学建立了四旋翼飞行器的动力学模型, 并对模型进行了简化 , 得出了线性的模型。在此基础上 , 还设计出了利用 PWM波的电机驱动电路 , 同事还应用 H 回路设计控制器 , 仿真验证了这个控制器的有效性和合理性。目标和内容本文旨在研究四旋翼飞行器的运动状态， 通过动力学分析， 建立出数学模型， 并根据所建立的

10、模型在 Matlab/simulink 中进行仿真， 观察飞行器的平动和角运动， 总结其控制方法。飞行器建模机体质心运动模型对飞行器做动力学建模，为了得到飞行器的数学模型，首先建立两个坐标系：惯性坐标系和机体坐标系。如下图（1）所示惯性坐标系E(OXYZ)相对于地球表面不动, 取“东北天”建立该坐标系。机体坐标系B（ oxyz ）系与飞行器固连, 原点 o 为飞行器重心、质心，, 横轴 ox 指向 1号电机 , 规定此方向为正方向。纵轴oy 指向 4 号电机。立轴oz 垂直于 oxy, 符合右手法则,正方向垂直oxy 向上。图（ 1）坐标系及受力分析为了建立飞行器的动力学模型，不失一般性，对四

11、旋翼飞行器做出如下假设：1，四旋翼飞行器主均匀对称的刚体；2，机体坐标系的原点与飞行器几何中心及质心位于同一位置；3，四旋翼飞行器所受阻力和重力不受飞行高度等因素影响，总保持不变；4，四旋翼飞行器各个方向的拉力与推进器转速的平方成正比在图 1 中定义欧拉角如下：滚转角：表示为机体坐标系绕ox 轴旋转的角度，由飞行器尾部顺纵轴前视，若oz轴位于铅垂面的右侧（即飞行器向右倾斜），则为正，反之为负；俯仰角：表示为机体坐标系绕oy 轴旋转的角度, 旋转后飞行器纵轴指向水平面上方，角为正，反之为负；偏航角：表示为机体坐标系绕oz 轴旋转的角度，为飞行器纵轴在水平面内投影与惯性坐标系 OX轴之间的夹角，

12、迎角平面观察， 若由 OX转至投影线是逆时针旋转， 则角为正，反之为负。如下图（ 2）所示图（ 2）欧拉角取机体坐标系的一组标准正交基为(b1 , b2 , b3)T ，惯性坐标系的一组标准正交基为(i, j, k )T ，则两个坐标系之间的转换矩阵为coscoscossinsincossincossinsinPC xC yCzsincossinsinsinsinsincossincossincossincoscos即两个坐标系间向量的变换为：b1ib2Pjb3k四旋翼飞行器受力分析如图（ 1）所示，旋翼机体所受外力和力矩为：重力mg ,机 体 受 到 重 力 沿 OZ 负 方 向 ；四个旋翼

13、旋转所产生的升力Fi(i=1,2,3,4) ， 旋 翼 升 力 沿 oz方向；旋翼旋转会产生扭转力矩Mi(i=1,2,3,4) 。 Mi 垂直于叶片的旋翼平面，与旋转矢量相反。由牛顿第二定律Fma 对飞行器进行动力学分析有：Fmamdvmd 2rdtdt2（1）i 4m d2xF(Fi )e3mgkrmij kyi 1dt 2z（ 2）其中， F 为作用在四旋翼飞行器上的外力和，m为飞行器的质量，v 为飞行速度， Fi 是单个旋翼的升力，且FK w2，w为机翼转速itii由变换矩阵 P 知：cossincossinsinb3ijksinsincossincoscoscos代入到式（ 2）有：i

14、 4cossincossinsinx( Fi ) ij k sinsincossincosmgk m i j k yi 1coscosz由矩阵对应元素相等，得：4xKt wi2 (cossincossinsin) / mi 14yKt wi2 (sinsincossin cos ) / mi14Kt wi2 (coszcos) / mgi1（ 3）这就是质心运动的数学模型机体角运动模型由质心运动的角动量定理M将上式在机体坐标系上表示，则有相对导数：d HdtMd HHdtb（ 4）由于：MM1M 2其中： H是动量矩， M为飞行器所受合外力矩，M1是升力产生的力矩，M2是空气阻力对螺旋桨产生的

15、力矩，且2M 2iK d i， Kd 为阻力矩系数，i 为相应电机转速。所以有：4M 1riFil (F3F1 )b2l (F4F2 )b1i1M 2K d (22221234 )b3l (F4F2 )M M1M2(b1,b2 , b3 )l (F3 F1 )（ 5）K d (22221234 )又由于飞行器为对称的刚体，所以其惯性力矩为一对角阵，即：Jx00J0J y000J z飞行器的角动量矩为：JxxH (b1, b2 ,b3 ) Jy yJz zd HJx x(J zJ y )y z,b2 , b3) J y( JxJ z ) x（ 6）H (b1yzdt bJ zz( J yJx )

16、xz将（ 5）式和（ 6）式代入式（4）可得：(b , b, bJ x x( JzJ y ) y z(b ,b, b)l (F4F2 ) J y y( JxJ z) x z2l (F3F1 )12313Jz z( JyJ x ) x zK d (2222)1234由向量对应元素相等可得：l (F4F2 ) ( J zJ y ) y zxJxl (F3F1 ) ( JzJx ) x z(7)yJ y由欧拉动力学方程：xsinsincosycossinsinzcos小角度变化时，可将x,y , z在平衡位置线性化，平衡位置为0,0,于是线2性化后，得到：x y z线性化后姿态角和角速度之间就有了简

17、单的积分关系定义 U1、 U2、 U3、 U4 为四旋翼飞行器的四个控制通道的控制输入量，可简化飞行器的控制分析 :4wi2U1F1F2F3F4KtU 2F4F2i 1Kt (w42w22 )U 3F3F1Kt (w32w12 )U 4F2F4F1F3K d (w12w32w22w42 )(8)其中 U1 为垂直方向的输入控制量，U2 为翻滚输入控制量，U3 为俯仰控制量，U4 为偏航控制量 ,wi为螺旋桨转速， Fi 为机翼所受拉力综合式（ 3）、（ 7）、（8）可得飞行器的数学模型为：x(cossincossinsin) U 1 / my(sinsincossincos) U 1 / mz

18、(coscos) U1 / m gl U 2( JzJx )（9）J yl U 3( J yJ z)xJxU 4( J xJ y )zJ z三仿真与分析仿真平台和参数选取由于未进行实物测量，所以直接从现有的研究成果中选取一组飞行器的参数，如下表所示：表（ 1）飞行器参数表参数数值单位参数数值单位mKgJxkg m2lmJ ykg m2Kt3.1 10 7N s2Jzkg m2Kd1.12 10 7N s2gm / s2以此参数数值代入式（9）所建立数学模型中，得到如下结果：x(cossincossinsin) U1 / 0.25y(sinsincossincos) U1 / 0.25z(cos

19、cos) U1 / 0.259.8(0.25 U 20.28) / 0.033x(0.25 U 30.028) / 0.033zU 4/ 0.061（ 10）仿真在 Matlab/simulink中进行，以所建立的数学模型在simulink中构建仿真回路，结果如下：( 图 3)Simulink仿真模型其中以四个机翼角速度做为输入信号，三个坐标的位移和三个偏转角为输出，仿真过程中以改变1、2、3、4 四个机翼角速度的值，观察位移和偏转角的变化进行分析。仿真过程飞行器的升降运动仿真当 12 34 ，即 U10,U2=U3=U4=0时，机翼转速逐渐增加，增大到一定值时，可以实现飞行器的垂直升起和降落

20、，故设置角速度信号源都为斜率为20的斜波信号进行仿真，仿真时间为200s，仿真图像如下：（图 4） Z 方向加速度（图 5）加速时位移变化仿真结果表明： 开始时器在下降， 转速在大于z 座标先减小然后在70s 左右后增大， 说明刚开始时升力较小，飞行1400r/min左右之后， 飞行器才能起飞，且在此过程中3 个偏转角一直为零。经验证，转速在1405r/min时，飞行器可以悬浮。飞行器的滚转运动仿真当 U3=U4=0,U20时，可以实现飞行器的滚转运动。设置131405、21303、41500 ，以阶跃信号作为信号源进行仿真，时间为 5s，仿真结果如下：图（ 6）滚转角仿真结果表明：滚转角逐渐

21、减小，z 坐标发生变化，而其余角度和位移都为零，表示未能保持悬浮状态，但可以实现滚转角的控制。飞行器的俯仰运动仿真飞行器的俯仰运动和滚转运动是相似的。设置11358、41450、241405 ，以阶跃信号作为信号源进行仿真，时间为 5s，仿真结果如下：图（ 7）俯仰角图（ 8）俯仰运动时位移仿真结果表明：俯仰角逐渐减大，x、 y 坐标发生变化，而其余角度和位移都为零，表示在水平面上平动时，实现了俯仰角的控制。飞行器的偏航运动当 U2=U3=0、 U40 时，可以实现飞行器的偏航运动。1. 设置131400、241420 进行仿真，仿真时间 5s，结果如下：图（ 9）偏航角仿真结果表明：偏航角发生变化，5 秒时为 3，其余输出值为零，表示在悬浮状态下实现了偏航角的减小。2. 设置131430、241400 进行仿真，仿真时间为5s，结