四轴飞行器建模与仿真-课件

四旋翼飞行器建模与仿真1ppt课件四旋翼飞行器建模与仿真1ppt课件1一.简介四旋翼飞行器也称为四轴飞行器，是一种有4个螺旋桨且螺旋桨呈十字形交叉的飞行器，可以实现各种的运行状态,如:爬升、下降、悬停、滚转运动、俯仰运动、偏航运动等2ppt课件一.简介四旋翼飞行器也称为四轴飞行器，是一种有4个螺2精品资料精品资料3你怎么称呼老师？如果老师最后没有总结一节课的重点的难点，你是否会认为老师的教学方法需要改进？你所经历的课堂，是讲座式还是讨论式？教师的教鞭“不怕太阳晒，也不怕那风雨狂，只怕先生骂我笨，没有学问无颜见爹娘……”“太阳当空照，花儿对我笑，小鸟说早早早……”四轴飞行器建模与仿真--ppt课件4二．飞行器建模对飞行器做动力学建模，为了得到飞行器的数学模型，首先建立两个坐标系：惯性坐标系和机体坐标系。如下图（1）所示惯性坐标系E(OXYZ)相对于地球表面不动,取“东北天”建立该坐标系。5ppt课件二．飞行器建模对飞行器做动力学建模，为了得到飞行器的数学模型5飞行器建模机体坐标系B（oxyz）系与飞行器固连,原点o为飞行器重心、质心，,横轴ox指向1号电机,规定此方向为正方向。纵轴oy指向4号电机。立轴oz垂直于oxy,符合右手法则,正方向垂直Oxy向上。6ppt课件飞行器建模机体坐标系B（oxyz）系与飞行器固连,原点o为飞6飞行器建模为了建立飞行器的动力学模型，不失一般性，对四旋翼飞行器做出如下假设：1，四旋翼飞行器主均匀对称的刚体；2，机体坐标系的原点与飞行器几何中心及质心位于同一位置；3，四旋翼飞行器所受阻力和重力不受飞行高度等因素影响，总保持不变；4，四旋翼飞行器各个方向的拉力与推进器转速的平方成正比7ppt课件飞行器建模为了建立飞行器的动力学模型，不失一般性，对四旋翼飞7飞行器建模滚转角φ表示为机体坐标系的轴与包含飞行器纵轴oz′的铅垂平面的夹角，由飞行器尾部顺纵轴前视，若oz′轴位于铅垂面的右侧（即飞行器向右倾斜），则φ为正，反之为负；俯仰角θ表示为飞行器的纵轴()oz′与水平面OXY间的夹角，飞行器纵轴指向水平面上方，θ角为正，反之为负；偏航角ψ为飞行器纵轴在水平面内投影与地面系OX轴之间的夹角，迎ψ角平面观察，若由OX转至投影线是逆时针旋转，则ψ角为正，反之为负。如下图（2）所示8ppt课件飞行器建模滚转角φ表示为机体坐标系的轴与包含飞行器纵8飞行器建模取机体坐标系的一组标准正交基为，惯性坐标系的一组标准正交基为，则两个坐标系之间的转换矩阵为即两个坐标系间向量的变换为：9ppt课件飞行器建模取机体坐标系的一组标准正交基为92.1质心运动模型机体所受外力为：

重力G

,

重力沿OZ负方向；

四个旋翼旋转所产生的升力F

i(i=

1

,

2

,

3

,

4)，旋翼升力沿oz方向旋翼旋转会产生扭转力矩Mi

(i=

1

,

2

,

3

,

4)。Mi垂直于叶片的旋翼平面，与旋转矢量相反。10ppt课件2.1质心运动模型机体所受外力为：

重力G

,

重力沿OZ102.1质心运动模型由牛顿第二定律对飞行器进行动力学分析有：

(1)

(2)其中，F为作用在四旋翼飞行器上的外力和，m为飞行器的质量，v为飞行速度，Fi是单个旋翼的升力，wi为机翼转速11ppt课件2.1质心运动模型由牛顿第二定律对飞行器进行动力学分析有：112.1质心运动模型由变换矩阵P知:代入到式（2）有：12ppt课件2.1质心运动模型由变换矩阵P知:12ppt课件122.1质心运动模型由矩阵对应元素相等，得：

(3)这就是质心运动的数学模型13ppt课件2.1质心运动模型由矩阵对应元素相等，得：13ppt课件132.2机体角运动模型由质心运动的角动量定理将上式在机体坐标系上表示，则有相对导数：

（4）14ppt课件2.2机体角运动模型由质心运动的角动量定理14ppt课件142.2机体角运动模型由于其中：H是动量矩，M为飞行器所受合外力矩，M1是升力产生的力矩，M2是空气阻力对螺旋桨产生的力矩，且，Kd为阻力矩系数，Wi为相应电机转速。所以有：15ppt课件2.2机体角运动模型由于15ppt课件152.2机体角运动模型两式相加可得：

（5）又由于飞行器为对称的刚体，所以其惯性力矩为一对角阵，即：飞行器的角动量矩为：16ppt课件2.2机体角运动模型两式相加可得：16ppt课件162.2机体角运动模型

（6）将（5）式和（6）式代入式（4）可得：17ppt课件2.2机体角运动模型17ppt课件17机体角运动模型由向量对应元素相等可得：

（7）

18ppt课件机体角运动模型由向量对应元素相等可得：18ppt课件18机体角运动模型由欧拉动力学方程小角度变化时，可将在平衡位置线性化，按图（1）所示，平衡位置为，于是线性化后，得到则姿态角和角速度之间就有了简单的积分关系19ppt课件机体角运动模型由欧拉动力学方程19ppt课件19机体角运动模型定义U1、U2、U3、U4为四旋翼飞行器的四个控制通道的控制输入量，可简化飞行器的控制分析:

（8）其中U1为垂直方向的输入控制量，U2为翻滚输入控制量，U3为俯仰控制量，U4为偏航控制量,w为螺旋桨转速，Fi为机翼所受拉力20ppt课件机体角运动模型定义U1、U2、U3、U4为四旋翼飞行器的四个20飞行器数学模型综合式（3）、（7）、（8）可得飞行器的数学模型为：

（9）21ppt课件飞行器数学模型综合式（3）、（7）、（8）可得飞行器的数学模21三．仿真与分析由于未进行实物测量，所以直接从现有的研究成果中选取一组飞行器的参数，如下表所示：22ppt课件三．仿真与分析由于未进行实物测量，所以直接从现有的研究成果中22仿真与分析以此参数数值代入式（9）所建立数学模型中，得到如下结果：

（10）23ppt课件仿真与分析以此参数数值代入式（9）所建立数学模型中，得到如下23仿真与分析仿真在Matlab/simulink中进行，以所建立的数学模型在simulink中构建仿真回路仿真时以四个机翼角速度做为输入信号，三个坐标的位移和三个偏转角为输出simulink仿真模型结构图如下：24ppt课件仿真与分析仿真在Matlab/simulink中进行，以所建24仿真与分析25ppt课件仿真与分析25ppt课件25仿真与分析1、飞行器的起动当逐渐增加，增大到一定值时，可以实现飞行器的垂直升起和降落，故设置角速度信号源都为斜率为20的斜波信号进行仿真，仿真时间为200s，仿真图像如下

Z方向加速度26ppt课件仿真与分析1、飞行器的起动26ppt课件26仿真与分析

加速时位移坐标变化仿真结果表明：开始时z座标先减小然后在70s左右后增大，说明刚开始时升力较小，飞行器在下降，转速在大于1400r/min左右之后，飞行器才能起飞，且在此过程中3个偏转角一直为零。27ppt课件仿真与分析27ppt课件27仿真与分析2、飞行器的滚转运动仿真当U3=U4=0,U2>0时，可以实现飞行器的滚转运动。设置，以阶跃信号作为信号源进行仿真，时间为5s，仿真结果如下：28ppt课件仿真与分析2、飞行器的滚转运动仿真28ppt课件28仿真与分析滚转角仿真结果表明：滚转角逐渐减小，z坐标发生变化，而其余角度和位移都为零，表示未能保持悬浮状态，但可以实现滚转角的控制。29ppt课件仿真与分析29ppt课件29仿真与分析3、飞行器的俯仰运动飞行器的俯仰运动和滚转运动是相似的设置，以阶跃信号作为信号源进行仿真，时间为5s，仿真结果如下：俯仰角30ppt课件仿真与分析3、飞行器的俯仰运动30ppt课件30仿真与分析俯仰运动时位移仿真结果表明：俯仰角逐渐减大，x、y坐标发生变化，而其余角度和位移都为零，表示在水平面上平动时，实现了俯仰角的控制。31ppt课件仿真与分析31ppt课件31仿真与分析4、飞行器的偏航运动当U2=U3=0、U4>0时，可以实现飞行器的偏航运动。1.设置进行仿真，仿真时间5s，结果如下：32ppt课件仿真与分析4、飞行器的偏航运动32ppt课件32仿真与分析偏航角仿真结果表明：偏航角发生变化，5秒时为－3，其余输出值为零，表示在悬浮状态下实现了偏航角的减小。33ppt课件仿真与分析33ppt课件33仿真与分析2.设置进行仿真，仿真时间为5s，结果如下：偏航时偏转角34ppt课件仿真与分析2.设置34仿真与分析偏航时的位移仿真结果表明：偏航角发生了变化，5s时变为4，z坐标变为2，其余输出值保持为零，表示在上升的情况下实现了偏航角的增大。35ppt课件仿真与分析35ppt课件35仿真与分析仿真结果分析：由以上仿真过程可以看出，该模型模拟了飞行器的垂直升起和降落