四翼飞行器设计与实现.docx

四旋翼飞行器设计与实现一、四旋翼飞行器的结构设计 四旋翼飞行器采用四个旋翼作为飞行的直接动力源，旋翼对称分布在机体的前后、左右四个方向，四个旋翼处于同一高度平面，且四个旋翼的结构和半径都相同，旋翼 1 和旋翼 3 逆 时针旋转，旋翼 2 和旋翼 4 顺时针旋转，四个电机对称的安装在飞行器的支架端，支架中间空间安放飞行控制计算机和外部设备。四旋翼飞行器的结构形式如图 1.1 所示。二、工作原理 四旋翼飞行器是通过调节四个电机转速来改变旋翼转速，实现升力的变化，从而控制飞行器的姿态和位置。由于飞行器是通过改变旋翼转速实现升力变化，这样会导致其动力不稳定。所以需要一种能够长期保稳定的控制方法。四旋翼飞行器是一种六自由度的垂直升降机。因此，非常适合静态和准静态条件下飞行。但是四旋翼飞行器只有四个输入力，同时却有六个状态输出。所以它又是一种欠驱动系统。电机 1 和电机 3 逆时针旋转的同时，电机 2 和电机 4 顺时针旋转。因此当飞行器 平衡飞行时，陀螺效应和空气动力扭矩效应均被抵消。四旋翼飞行器在空间共有 6 个自由度(分别沿 3 个坐标轴作平移和旋转动作)，这 6 个自由度的控制都可以通过调节不同电机的转速来实现。基本运动状态分别是：(1)垂直运动；(2)俯仰运动；(3)滚转运动；(4)偏航运动；(5)前后运动；(6)侧向运动。在图 （a） 中，电机 1 和电机 3 作逆时针旋转，电机 2 和电机 4 作顺时针旋转，规定沿 x 轴正方向运动称为向前运动,箭头在旋翼的运动平面上方表示此 电机转速提高，在下方表示此电机转速下降。(1)垂直运动：垂直运动相对来说比较容易。在图中, 因有两对电机转向相反，可以平衡其对机身的反扭矩；当同时增加四个电机的输出功率,旋翼转速增加使得总的拉力增大；当总拉力足以克服整机的重量时,四旋翼飞行器便离地垂直上升；反之，同时减小四个电机的输出功率，四旋翼飞 行器则垂直下降，直至平衡落地，实现了沿 z 轴的垂直运动。 当外界扰动量为零时,在旋翼产生的升力等于飞行器的自重时，飞行器便保持悬停状态。保证四个旋翼转速同步增加或减小是垂直运动的关键。(2)俯仰运动：在图(b)中，电机 1 的转速上升，电 机 3 的转速下降，电机 2、电机 4 的转速保持不变。为了不因为旋翼转速的改变引起四旋翼飞行器整体扭矩及总拉力改变，旋翼 1 与旋翼 3 转速改变量的大小应相等。由于旋翼 1 的升力上升，旋翼 3 的升力下降，产生的不平衡力矩使机身绕 y 轴旋转(方向如图所示)，同理，当电机 1 的转速下 降，电机 3 的转速上升，机身便绕 y 轴向另一个方向旋转，实现飞行器的俯仰运动。(3)滚转运动：与图 b 的原理相同，在图 c 中，改变 电机 2 和电机 4 的转速，保持电机 1 和电机 3 的转速不，则可使机身绕 x 轴旋转(正向和反向)，实现飞行器的滚转运动。(4)偏航运动：四旋翼飞行器偏航运动可以借助旋翼产生的反扭矩来实现。旋翼转动过程中由于空气阻力作用会形成与转动方向相反的反扭矩。为了克服反扭矩影响，可使四个旋翼中的两个正转，两个反转，且对角线上的来年各个 旋翼转动方向相同。反扭矩的大小与旋翼转速有关，当四个电机转速相同时，四个旋翼产生的反扭矩相互平衡，四旋翼飞行器不发生转动；当四个电机转速不完全相同时，不平衡的反扭矩会引起四旋翼飞行器转动。在图 d 中，当电机 1 和 电机 3 的转速上升，电机 2 和电机 4 的转速下降时，旋翼 1 和旋翼 3 对机身的反扭矩大于旋翼 2 和旋翼 4 对机身的反扭矩，机身便在富余反扭矩的作用下绕 z 轴转动，实现飞行器的偏航运动,转向与电机 1、电机 3 的转向相反。(5)前后运动：要想实现飞行器在水平面内前后、左右的运动，必须在水平面内对飞行器施加一定的力。在图 e 中，增加电机 3 转速，使拉力增大，相应减小电机 1 转速，使拉力减小；同时保持其它两个电机转速不变，反扭矩仍然要保持平衡。按图 b 的理论，飞行器首先发生一定程度的倾 斜，从而使旋翼拉力产生水平分量。因此可以实现飞行器的前飞运动。向后飞行与向前飞行正好相反。当然在图 b 图 c 中，飞行器在产生俯仰、翻滚运动的同时也会产生沿 x、y 轴的水平运动。(6)侧向运动：在图 f 中，由于结构对称，所以侧向飞行的工作原理与前后运动完全一样。四翼的控制规律，如表1所示。表1 四翼飞行器旋翼转速控制规律旋翼1旋翼2旋翼3旋翼4升降+（-）+（-）+（-）+（-）俯仰/前后+（-）0-（+）0横滚/左右0+（-）0-（+）偏航+（-）-（+）+（-）-（-）+：加速，-：减速，0：hold三、四翼飞行器组成图3 控制结构图要实现四轴飞行器的稳定飞行以及各个姿态的控制，需要实现对其姿态的感知，位置和高度的测量以及旋翼动力装置的控制。要实现操控人员对飞行器的控制，还要实现无线遥控功能。在四轴飞行器设计中飞行控制器是最基本的组成部分，因此，设计飞行控制器实现对飞行器的控制是本项目的重点之一。飞行控制器配备各种传感器，以实现对飞行器姿态、高度以及位置的测量；配备微控制器经程序设计实现控制系统核心，对传感器测量数据进行融合计算，根据姿态与位置，结合遥控量实现符合要求的控制输出；实现电机控制接口，根据控制器运算输出对电机转速进行控制，实现合适的转速。通过测量、运算、输出完成整个闭环控制系统。1、飞行控制器微控制器实现对传感器的信号进行采样、处理、计算，得到飞行器的姿态、位置等参数，结合遥控器或者地面控制站的控制信号进行控制算法运算，实现控制量输出。微控制器应满足控制器运算的速度与存储容量的要求。2、传感器1）角度传感器（ADXL202）主要是测量飞行器当前姿态，传感器的响应速度要求。2）角速度陀螺仪传感器（日本murata公司ENC系列产品）加入此传感器可以对飞行器动作产生阻尼，保持当前姿态，则可以在增稳系统中加入角速度陀螺仪。日本村田公司生产的ENC-03M是应用科里奥利力原理而制造的角速度传感器。在飞行控制器的电路设计中，使用了3片ENC-03M组成一个3轴电子陀螺仪传感器模块，用于测量三个轴向的角度。在最终的电路板上，三片传感器呈两两垂直的角度，沿空间坐标系的三个轴向安装。3）高度传感器用于测量飞行器离地面的高度，可采用测量空气气压的方法间接测量海拔高度。气压作为一个物理量，其大小具有很深刻的物理含义，与海拔高度之间存在着密切的关系。采用BOSCH公司的BMP085数字气压传感器作为测量海拔高度的传感器3、无线遥控模块（可买现成的模块即可）4、电源模块采用大容量的锂电池供电。由于电机、电子调速器、传感器、控制器，无线接收模块需要不同的工作电压。需要电压转换和稳压、滤波设计。5、电机与功率驱动模块采用无刷电机，无刷直流机的转速控制是通过改变电机电枢电压接通时间和通电周期的比例值(即占空比)来改变平均电压的大小实现的。每一只电机都需要单独的控制逻辑，对于微控制器来讲无疑质疑中较大的负担，因此在本项目中选用专用的无刷直流电机电子调速器对其转速进行调节，微控制器只需将控制信号给每个电机的电子调速器即可。四、四翼飞行器的动力模型1、飞行器姿态解算方程图4 坐标系绕Z轴旋转（偏航角）图5 坐标系绕Y轴旋转（俯仰角）图6 坐标系绕X轴旋转（横滚角）在实际运算中对飞行器的姿态解算采用增量式的方法。n记为第n次解算后的姿态，n+1为第n+1次时的姿态，Rn为第n次解算时的旋转矩阵，则有以下关系(1)由于对角度的采样频率很高，即因此每次解算时飞行器机体转过的角度很小。当横滚角度j，偏航角度y以及俯仰角度q很小时，旋转矩阵R可采用近似值，(2)通过陀螺仪进行姿态解算时，可使用增量式运算如下：(3)2、动力方程使用线角速度和角加速度方程描述四轴飞行器的位置和姿态角。因此控制算法需要实现位置和姿态角的控制。图6 控制结构由于姿态与位置变量中x、y与，之间存在耦合关系，因此，在控制器设计时把和作为间接被控对象，由位置控制环运算输出后，经反解可得到和作为姿态控制环的输入。则整个飞行控制器的输入为四元组(x,y,z,)，控制器的输出为四元组(u1,u2,u3,u4)。注：m：飞行器的质量kgI，I，I 分别飞行器为绕载体坐标系X，Y，Z3个坐标轴的转动惯量。l是四轴飞行器重心到每个旋翼的主轴长度。1）位置控制位置控制的控制量有3个：x，y，z3个位移变量。因此设计3个独立的PID控制器进行3个通道的位置控制。三个通道的控制器输出分别为x，y，z。(4)进而可得到姿态控制环的输入（5）式(5)反映了姿态与位置之间的耦合关系，通过耦合解算得到u1，。其中，与输入四元组中的y作为姿态控制环的输入。飞行器的位置控制结构如图7所示。图7 位置控制结构2）姿态控制进行姿态控制时，不考虑姿态角与位移关系的耦合。其被控量为3轴姿态角度，。分别设计3个独立的PID控制器，其控制器输出分别为，。 (6)(7)若采用PID控制，则可调整PID控制器的参数，使其包含项，则姿态控制回路的最