《动态系统建模实验——四旋翼仿真》由会员分享，可在线阅读，更多相关《动态系统建模实验——四旋翼仿真（18页珍藏版）》请在金锄头文库上搜索。
1、北京航玄航无大爭BEIHANGUNIVERSITY动态系统建模（四旋翼飞行器仿真）实验报告院（系）名称大飞机班ZY11DF120学生姓名叶心宇任课教师马耀飞2011年12月四旋翼飞行器的建模与仿真一、实验原理I.四旋翼飞行器简介四旋翼飞行器通过四个螺旋桨产生的升力实现飞行，原理与直升机类似。四个旋翼位于一个几何对称的十字支架前、后、左、右四端，如图1-1所示。旋翼由电机控制；整个飞行器依靠改变每个电机的转速来实现飞行姿态控制。在图1-1中，前端旋翼1和后端旋翼3逆时针旋转，而左端旋翼2和右端的旋翼4顺时针旋转，以平衡旋翼旋转所产生的反扭转矩。由此可知，悬停时，四只旋翼的转速应该相等，以相互抵消
2、反扭力矩；同时等量地增大或减小四只旋翼的转速，会引起上升或下降运动；增大某一只旋翼的转速，同时等量地减小同组另一只旋翼的转速，则产生俯仰、横滚运动；增大某一组旋翼的转速，同时等量减小另一组旋翼的转速，将产生偏航运动。前端錠翼1右端旋賀图1-1四旋翼飞行器旋翼旋转方向示意图稳定的因此，使系统稳白度的系统(三个角左端旋翼2从动力学角度分析，四旋翼飞行器系统本身曰的控制算法的设计显得尤为关键。由于四旋翼位移量，三个线位移量)，而其控制量只有四个被控量之间存在耦合关系。因此，控制算法应能行器为六自(4芒旋翼的转速甘就意味着这种欠驱动(under-actuated)系统足够有效，用四个控制量对三个角位移
3、量和三个线位移量进行稳态控制。本实验针对四旋翼飞行器的悬浮飞行状态进行建模。II.飞行器受力分析及运动模型1)整体分析如图1-2所示，四旋翼飞行器所受外力和力矩为：重力mg,机体受到重力沿-Z方向w四个旋翼旋转所产生的升力耳炉1,2,3,4）,旋翼升力沿ZB方向旋翼旋转会产生扭转力矩Mj（i=1,2,3,4）,Mj垂直于叶片的旋翼平面，与旋转矢量相反。2）电机模型2M冥FiXbmexw丿Ma图1-2四旋翼飞行器受力分析LJ力模型1.1)旋翼通过螺旋桨产生升力。是电机转动力系数，可取6.11x10,8N/rpm2，为电机转速。力矩模型旋翼旋转产生旋转力矩Mi（i=1,2,3,4），力矩Mi的旋向
4、依据右手定则确定。M二k2（1.2）i Mik是电机转动力系数，可取1.5x10-9Nm/rpm2为电机转速。Mi转速模型当给定期望转速后，电机的实际转速需要经过一段时间才能达到。实际转速与期望转速之间的关系为一阶延迟：k（des）（13）imii（丄3丿响应延迟时间可取0.05s（即k-20）。期望转速des则需要限制在电机的最小msi转速和最大转速之间，范围可分取1200rpm，7800rpm。3）运动方程飞行器受到外界力和力矩的作用，形成线运动和角运动。线运动由合外力引1.4)起，符合牛顿第二定律，如公式（1.4）所示：0-0mr0+R0-mg工F一i一r为飞机的位置矢量。注意：公式（1
5、.4）是在地平面坐标系中进行描述的。角运动由合力矩引起。四旋翼飞行器所受力矩来源于两个方面：1）旋翼升力作用于质心产生的力矩；2）旋翼旋转产生的扭转力矩。角运动方程如公式（1.5）所示。其中，L为旋翼中心建立飞行器质心的距离,I为惯量矩阵。川.控制回路设计pqLr.L(F-F)2 4L(F-F)3 1M-M+M-M1234pqxIpqrr（1.5）控制回路包括内外两层。外回路由PositionControl模块实现。输入为位置误差,输出为期望的滚转、俯仰和偏航角（des（t）、9des（t）、中des（t）。内回路由AttitudeControl模块实现，输入为期望姿态角，输出为期望转速。Mo
6、torDynamics模块模拟电机特性，输入为期望转速（Aw、Aw、Aw）,输出为力和力矩。RigidBody9中Dynamics是被控对象，模拟四旋翼飞行器的运动特性。如图1-3PositionControlMulurRifiidBody严（HAttitudeuontrolynamicsDynamics图1-3包含内外两个控制回路制结构1）内回路：姿态控制回路对四旋翼飞行器，我们唯一可用的控制手段就是四个旋翼的转速。因此，这里首先对转速w产生的作用进行分析。假设我们希望旋翼1的转速达到w汽，那么它的效果可分解成以下几个分量：使飞行器保持悬停的转速分量;hA:除悬停所需之外，产生沿ZB轴的净力
7、；FA:使飞行器负向偏转的转速分量；,A:使飞行器正向偏航的转速分量；中因此，可以将期望转速写成几个分量的线性组合:desA-AA（1.6）1hF，中其它几个旋翼也可进行类似分析，最终得到:des10-1+A1hFdes110-1A2des1011A3,des1-11-1A4一中一1.7）在悬浮状态下，四个旋翼共同的升力应抵消重力，因此:1.8）4K2mgFh此时，可以把旋翼角速度分成几个部分分别控制，通过“比例-微分”控制律建立如下公式:A=k（des（|）k（des（|）（1.9）.epdAk（,des，）+k（,des，）,p,d,Ak帥des中）+k（des中）中p，中d，中综合式（1
8、.7）、（1.8）、（1.9）可得到期望姿态角期望转速之间的关系，即内回路。2）外回路:位置控制回路外回路采用以下控制方式:通过位置偏差计算控制信号（加速度）；建立控制信号与姿态角之间的几何关系；得到期望姿态角，作为内回路的输入。期望位置记为rdes。可通过PID控制器计算控制信号:i（r一rdes）+k（r一r）+k（r一r）+kJ（r一r）=i ,Tid,ii,Tip,ii,Tii,ii,Ti1.10）r是目标悬停位置是我们的目标悬停位置（i=1,2,3）,rdes是期望加速度，即控i,Ti制信号。注意：悬停状态下线速度和加速度均为0即r=竈0。i,Ti,T通过俯仰角和滚转角控制飞行器在X
9、W和YW平面上的运动，通过，控制偏航角，通过，控制飞行器在ZB轴上的运动。对（1.4）进行展开，可得到:Fmr（cossin0+cos0sinsin）工F(1.11)1 imrQinsin0-coscos0sin）乙F2 imr一mg+coscos0乙F3 i根据上式可按照以下原则进行线性化：（1）将俯仰角、滚转角的变化作为小扰动分量，有sin0q0，sinq,cos0Q1，cosQ1;（2）偏航角不变，有=，其中中初始偏航角，为T00T期望偏航角（3）在悬停的稳态附近，有工F沁mgi根据以上原则线性化后，可得到控制信号（期望加速度）与期望姿态角之间的关系：rdesg（0descos+dess
10、in）1 TTrdesg（0dessin-descos）（1.12）2 TT8k.r.-f_hA3 mF根据式（1.10）已经通过PID控制器得到了作为控制信号的期望加速度，因此,将（1.12）式反转，由期望加速度计算期望姿态角，作为内回路的输入：des:1(rdessin-rdescos)g1T2T0des1(rdescos+rdessin)g1T2Tmrdesf8k3Fh(1.13)二、实验步骤I.搭建Simulink仿真控制回路根据实验原理中运动方程及控制回路设计，搭建Simulink控制回路，如图2-1所示。主要分为五个部分：PositionControl（由期望的位置误差通过控制律设
11、计计算出期望的姿态角），AttitudeControl（由姿态角信息和各轴角速度信息通过控制律计算出给电机的控制信号），MotorDynamics（通过给电机的控制信号由电机模型计算出每个电机的输出力和力矩），RigidBodyDynamics为四旋翼飞行器的仿真模型，由产生的力和力矩计算出仿真模型的姿态和位置信息，VRSink为四旋翼飞行器的虚拟显示模型。Yaw_des图2-2PositionControl子系统ConstantxDerivative2Derivative1Derivative4Derivative5zDerivative7Derivative8图2-3位置PID控制器结构I
12、ntegrator2图2-4AttitudeControl子系统图2-5姿态角和三轴角速度之间的转换关系Km4M4图2-6MotorDynamics子系统输出力及力矩模型图2-7RigidBodyDynamics子系统II.利用V-RealmBuilder建立四旋翼飞行器的虚拟模型利用V-RealmBuilder建立四旋翼飞行器的大致虚拟模型，并建立四个父类分别为Simulink输入提供质心位移信息和机体姿态信息，如图2-8所示。图2-8四旋翼飞行器虚拟模型III.利用MATLABGUI建立四旋翼飞行器仿真的控制界面利用MATLABGUI建立仿真控制界面，所建立的控制界面如图2-9所示。图2-
13、9MATLABGUI仿真控制界面界面主要分为四个部分，StructParametersPanel设置飞行器的结构参数和外部变量，DesiredPositionPanel设置期望控制飞行器所到达的位置，ControlParametersPanel设置PID控制律所需的增益参数和仿真时间，PlotPanel显示仿真结果图形并对图形效果进行简单的控制。三、仿真结果运行GUI，输入所需参数或者采用默认参数，点击loaddata按钮分别将三组参数载入，点击Start按钮，仿真开始运行。跳出VR显示，并在仿真结束后绘制飞行器三方向的坐标信息曲线和飞行器位置曲线。VR显示过程中某一时刻如图3-1所示，仿真结束后控制界面显示的曲线如图3-2所示。期望达到的目标点设置为（10,15,20）。
