四旋翼飞行器建模与仿真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 of reconnaissance mission and monitoring task of near-Earth, so it can be used in a wide range of military and civilian applications. In the dissertati

3、on, the detailed analysis and research on the rack structure and dynamic characteristics of the laboratory four-rotor aircraft is showed in the dissertation. The dynamic model of the four-rotor aircraft areestablished. It also studies on the force in the four-rotor aircraft flight principles and cou

4、rse of the campaign to make the research and analysis. The four-rotor aircraft has many operating status, such as climbing, downing, hovering and rolling movement, pitching movement and yawing movement. The dynamic model is used to describe the four-rotor aircraft in flight in the dissertation. On t

5、he basis of the above analysis, modeling of the 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 reference to the four-rotor aircraft.Then the simulation is done in the software o

6、f Matlab/simulink.Keywords: Quad-rotor，The dynamic mode, Matlab/simulink目录一 引言 . 11.1 简介 . 11.2研究背景 . 21.3目标和内容 . 2二飞行器建模 . 22.1 机体质心运动模型 . 22.2 机体角运动模型 . 4三仿真与分析 . 63.1仿真平台和参数选取 . 63.2仿真过程 . 83.2.1飞行器的升降运动仿真 . 83.2.2飞行器的滚转运动仿真 . 93.2.3飞行器的俯仰运动仿真 . 93.2.4飞行器的偏航运动 . 103.3 仿真结果分析 . 11四结论 . 12参考文献 . 13

7、一引言1.1 简介四旋翼飞行器也称为四轴飞行器，是一种有4个螺旋桨且螺旋桨呈十字形交叉的飞行器，可以实现各种的运行状态,如:爬升、下降、悬停、滚转运动、俯仰运动、偏航运动等 四旋翼飞行器是一种无人机，无人机和有人飞机比较,具有体积相对较小,造价也比载人机低很多,使用非常的方便,在各种复杂的作战环境都可以进行作战等优点。无人机的优点备受世界各国军队的喜爱,在几次局部战争中,无人机都得以应用。无人机的准确度、高效性以及灵便的侦查能力得到了充分的发挥,并且引起了对无人机的军事应用和装备技术等相关问题的研究和发展。在21世纪的陆地战争、海洋战争甚至是在空中的战争,已经出现了很多的无人驾驶的武器,自行进

8、行攻击的武器。无人机在其中占据了一个非常重要的角色,并且会在未来的军事战争中产生巨大的影响。四旋翼飞行器是一种能够实现垂直的起降具有四个旋翼的飞行器,它分为两种，一种是用遥控器进行遥控的,另外一种是可以实现自主控制自主飞行。从总体的布局上来看,四旋翼飞行器是属于非共轴的多旋翼飞行器。与传统的旋翼飞机相比较而言,一方面机体的结构相对更为紧凑,另一方面旋翼的增多会产生更大的升力。由于四旋翼的前后与左右的旋翼转向相反,这样就可以抵消反扭力矩,因此就不需要去设置专门的尾桨来平衡机体的反力矩。小型的多旋翼飞行器可以对近地而的环境进行监视和侦察,利用摄像头可以实现实吋的摄像与航拍。11.2研究背景现在存在

9、的四旋翼飞行器大致分为三类:一种是利用无线电进行遥控的四旋翼飞行器,另外一种是自主控制的中小型的四旋翼飞行器,还有一种是自主控制的微型四旋翼飞行器这几种飞行器都属于小型的无人飞行器。目前针对四旋翼飞行器控制技术的研究主要集中在以下两个方面:一方面是基于惯性导航系统的自主控制,另外一方面是基于视觉的自主飞行控制。国际上对于四旋翼飞行器的研究己经取得了相对比较丰硕的成果,然而在国内这一研究才刚刚起步。只有国防科学技术大学、哈尔滨工业大学以及上海交通大学微纳米科学技术研究院几个已有文献的报导。哈尔滨工业大学建立了四旋翼飞行器的动力学模型,并对模型进行了简化,得出了线性的模型。在此基础上,还设计出了利

10、用PWM波的电机驱动电路,同事还应用H回路设计控制器,仿真验证了这个控制器的有效性和合理性。1.3目标和内容本文旨在研究四旋翼飞行器的运动状态，通过动力学分析，建立出数学模型，并根据所建立的模型在Matlab/simulink中进行仿真，观察飞行器的平动和角运动，总结其控制方法。飞行器建模2.1 机体质心运动模型对飞行器做动力学建模，为了得到飞行器的数学模型，首先建立两个坐标系：惯性坐标系和机体坐标系。如下图（1）所示惯性坐标系E(OXYZ)相对于地球表面不动,取“东北天”建立该坐标系。机体坐标系B（oxyz）系与飞行器固连,原点o为飞行器重心、质心，,横轴ox指向1号电机,规定此方向为正方向

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

12、纵轴指向水平面上方，角为正，反之为负；偏航角：表示为机体坐标系绕oz轴旋转的角度，为飞行器纵轴在水平面内投影与惯性坐标系OX轴之间的夹角，迎角平面观察，若由OX转至投影线是逆时针旋转，则角为正，反之为负。如下图（2）所示图（2）欧拉角取机体坐标系的一组标准正交基为(b1,b2,b3)T，惯性坐标系的一组标准正交基为(i,j,k)T，则两个坐标系之间的转换矩阵为cosycosfP=CxCyCz=sinycosq-sinq即两个坐标系间向量的变换为： cosysinqsinfsinysinqsinfcosqsinfcosysinqcosf+sinysinfsinysinqcosf-sinfcosy

13、cosqcosfb1ib2=Pj b3k四旋翼飞行器受力分析如图 （1） 所示，旋翼机体所受外力和力矩为： 重力mg , 机体受到重力沿OZ负方向； 四个旋翼旋转所产生的升力F i(i= 1 , 2 , 3 , 4)，旋翼升力沿oz方 3向；旋翼旋转会产生扭转力矩Mi (i= 1 , 2 , 3 , 4)。Mi垂直于叶片的旋翼平面，与旋转矢量相反。由牛顿第二定律F=ma对飞行器进行动力学分析有：dvd2F=ma=m=m2rdtdt （1）F=(Fi)e3-mgk=mi=1i=4dr=m2idt2xyjkz （2）Fi是单个其中，F为作用在四旋翼飞行器上的外力和，m为飞行器的质量，v为飞行速度，

14、2wF=Kwiti旋翼的升力，且，i为机翼转速由变换矩阵P知：b3=i代入到式（2）有： cosysinqcosf+sinysinfsinysinqcosf-sinfcosy jkcosqcosfxyjkz (Fi)ii=1i=4cosysinqcosf+sinysinfsinysinqcosf-sinfcosy-mgk=mijkcosqcosf4由矩阵对应元素相等，得：x=Ktwi2(cosysinqcosf+sinysinf)/mi=14y=Ktwi2(sinysinqcosf-sinfcosy)/mi=14z=Ktwi2(cosqcosf)/m-gi=1 （3）这就是质心运动的数学模型2

15、.2 机体角运动模型由质心运动的角动量定理M=将上式在机体坐标系上表示，则有相对导数： dHdt4M=由于：dH+wHdtb（4）M=M1+M2其中：H是动量矩，M为飞行器所受合外力矩，M1是升力产生的力矩，M2是空气阻力对螺旋桨产生的力矩，且M2i=KdwiKdwi为相应电机转速。，为阻力矩系数，所以有：2M1=riFi=l(F3-F1)b2+l(F4-F2)b1i=14222M2=Kd(w12+w2+w3+w4)b3l(F4-F2) （5）l(F-F) M=M1+M2=(b1,b2,b3)312222Kd(w1+w2+w3+w4)又由于飞行器为对称的刚体，所以其惯性力矩为一对角阵，即：Jx

16、J=00飞行器的角动量矩为：Jy000JzJxwxH=(b1,b2,b3)JwyyJzwzJxwx+(Jz-Jy)wywzdH+wH=(b1,b2,b3)Jywy+(Jx-Jz)wxwz （6） dtbJzwz+(Jy-Jx)wxwz将（5）式和（6）式代入式（4）可得：Jxwx+(Jz-Jy)wywzl(F4-F2)(b1,b2,b3)Jywy+(Jx-Jz)wxwz=(b1,b2,b3)l(F-F)312222Jzwz+(Jy-Jx)wxwzKd(w1+w2+w3+w4)由向量对应元素相等可得：wx=wy=l(F4-F2)+(Jz-Jy)wywzl(F3-F1)+(Jz-Jx)wxwzx(

17、7)Jy5由欧拉动力学方程：wxysinfsinq+qcosf=ycosfsinq-qsinfwwyf+ycosqwz小角度变化时，可将wx,wy,wz在平衡位置线性化，平衡位置为f=0,y=0,q=性化后，得到： p2于是线wxf=ywwywzf线性化后姿态角和角速度之间就有了简单的积分关系定义U1、U2、U3、U4为四旋翼飞行器的四个控制通道的控制输入量，可简化飞行器的控制分析:42KwF+F+F+FU11ti234i=1UF4-F222=2=Kt(w4-w2)U3F3-F12Kt(w3-w12)U4F2+F4-F1-F3K(w2+w2-w2-w2)324d1 (8)其中U1为垂直方向的输

18、入控制量，U2为翻滚输入控制量，U3为俯仰控制量，U4为偏航控制量,wi为螺旋桨转速，Fi为机翼所受拉力综合式（3）、（7）、（8）可得飞行器的数学模型为：x=(cosysinqcosf+sinysinf)U1/my=(sinysinqcosf-sinfcosy)U1/mz=(cosqcosf)U1/m-glU2+qy(Jz-Jx)f=yJx （9） lU3+fy(Jy-Jz)wx=wz=U4+fq(Jx-Jy)z三仿真与分析3.1仿真平台和参数选取由于未进行实物测量，所以直接从现有的研究成果中选取一组飞行器的参数，如下表所 6示：表（1）飞行器参数表以此参数数值代入式（9）所建立数学模型中，

19、得到如下结果：x=(cosysinqcosf+sinysinf)U1/0.25y=(sinysinqcosf-sinfcosy)U1/0.25z=(cosqcosf)U1/0.25-9.8f=(0.25U2-0.28qy)/0.033wx=(0.25U3+0.028fy)/0.033wz=U4/0.061（10）仿真在Matlab/simulink中进行，以所建立的数学模型在simulink中构建仿真回路，结果如下：(图3)Simulink仿真模型其中以四个机翼角速度做为输入信号，三个坐标的位移和三个偏转角为输出，仿真过程中以改变w1、w2、w3、w4四个机翼角速度的值，观察位移和偏转角的变化

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

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