四旋翼直升机姿态控制设计.docx

四旋翼直升机姿态控 四旋翼直升机姿态控制设计 PAGE PAGE # / 17 四旋翼直升机姿态控 四旋翼直升机姿态控制设计 PAGE PAGE # / 17 四旋翼直升机姿态控制设计 一、课程设计目的 .熟练掌握运用所学的飞行控制系统的基础知识，深入理解前期所学的专业基础课的原理。 .具备独立査阅中英文资料和相应的工程设计手册能力。 .能够掌握典型的飞行器的飞行控制系统的设计过程，包括方案的选择，姿态控制系统, 包括电机伺服系统等方案的设计，误差分析等。 .具备熟练使用matlab语言的技能。 .能够对所设计的系统进行计算机仿真实验，并就仿真结果进行分析研充。 .对造成的系统误差的因素进行分析,改进系统设计。 二、四旋翼直升机的基本工作原理 在无人直升机中，四旋翼直升机凭借其独特的的外形和结构成为国内外机构研究的热点。与 常规的布局的单旋翼直升机相比，四旋翼直升机可以使用相对较小的旋翼。这就减小了直升 机碰到咒他障碍物的可能性，提高了其飞行的安全性。此外，四旋翼直升机没有单旋翼直升 机的自动倾斜器和尾桨，机械结构相对比较简单。 图四旋翼直升机结构示意图 四旋翼直升机的结构如图所示。从图中可见，当前旋翼和尾旋翼顺时针旋转.左旋翼和 右旋翼逆时针旋转，并且四个旋翼转速一致，产生的升力之和等于直升机自重时.直升机可 以实现静态悬停。如果产生的升力同时增加和减少，那么四旋翼直升机可以实现上升或者下 降C当前旋翼和尾旋翼加速且左旋翼和右旋翼减速，同时四个旋翼产生的升力和直升机自重 相等时，由于存在扭矩差，可导致直升机的偏航运动。当前旋翼加速，尾旋翼减速而左旋翼 和右旋翼的旋转速度保持不变时，四旋翼直升机可以实现X轴的滚转运动.即俯仰运动。同 理，也可实现Y轴的滚转运动，即滚转运动。基于如上几种基本运动，四旋翼直升机可以实 现前飞，侧飞以及其他复杂运动。 如图上所示，定义a = {XE,YE,ZE}为地面惯性坐标系，B = {Xb*Zb}为原点在飞机质心 并且与四旋翼飞行器固连的机体坐标系。定义向量月=[寺，屮]丁表示直升机的三个姿态角： 俯仰角。，滚转角中，偏航角屮，这三个欧拉角决定了直升机从惯性坐标系a到机体坐标系的 转换矩阵伝通过欧拉-拉格朗日的方法可以得到四旋翼直升机的非线性姿态运动方程如下: 如0 = + C°（功，）方 + %2邛； $ = 一丁雄0 + % 0?，力）4 +。雄2七； i = 一 、（华方）。+。屮2七； 其中。红。=。。,屮）为阻尼系数，％。=。，00为力矩系数,2=。,心）为科氏项，（包 括陀螺回转效应和离心效应项），q（i = 9,0W）为机体受到的力矩。给可以通过以下公式得 到： 邛=LSF； T4 =— ）; W = k/（A 一无一為 + 疗）； 其中，A为电机到飞机质心的距离，与为力到力矩的比例系数，/；? = 123,4）分别为 前旋翼，左旋翼，尾旋翼，右旋翼产生的升力O AG = 1,2,3,4）的具体表达式如下： 如：戋=知邮1 = 123,4： 其中如为一个正常数，Wi（i= 123,4）分别为四个螺旋桨旋转时的角速度。 三、飞行器姿态控制控制系统 姿态控制系统的主要功能是根据给定的参考姿态角，对飞行器的旋转运动进行控制，使 飞行器姿态角跟踪参考信号。主要的姿态控制方法有比例积分微分控制，多回跻控制等。 1.比例枳分微分控制 比例枳分微分控制（proportional-derivative control, FID控制）是目前飞行器姿态 控制系统设计时常采用的--种控制方法■通过对姿态角，姿态角速度和姿态角积分进行反馈, 实现整个闭环控制系统的稳定。 对于给定的俯仰角，滚转角和偏航角参考信号设计控制输入如下： 如：UQ = -kpg（e -re） - kre f （ 0 - rg）dt - kDe（6 一 而）； W = - 如喧9 一 0）— kip J（?一 七） 一 k“（。- rQ ； up = S9 -企-知 J（屮一 r^dt 一 kDxp（ip -知）； 其中,5g（i = 90W）分别为比例，积分，微分控制増益。 2.多回路控制 对于姿态角和姿态角速度分别设计控制器，构成姿态角闭环控制回路和姿态角速度闭环 控制回路。首先，设计姿态角速度的参考信号由姿态角控制器给岀： 如：r9 = -k61 （0 - rg） - k02 ［（6- r0）dt; 0 = -瞞（。-W）一 郷2 J（。一 心）哉；； F = 一侦1（寸一勺）-知2 J（屮-勺）赤； 其中，如0 =。，申仲Ej = 1,2）为姿态角控制器增益“ 然后，设计姿态角速度控制器使角速度Og分别跟踪W5 如下： = 一如3（。- “）； 雄=一论雄3（6 一勺）； % = -知3（$ - F）；