基于四元数自补偿四旋翼飞行器姿态解算_马敏

基于STM32的四旋翼飞行器设计

摘要 四轴飞行器是一种结构紧凑、飞行方式独特的垂直起降式飞行器，与普通飞行器相比，具有结构简单、故障率低和单位体积能够产生更大升力等优点，所以在军事和民用多个领域都有广阔的应用前景，非常适合在狭小空间内执行任务。 本设计采用stm32f103zet6作为主控芯片，3轴加速度传感器mpu6050作为惯性测量单元，通过2.4G无线模块和遥控板进行通信，最终使用PID控制算法以PWM方式控制电子调速器驱动电机实现了四轴飞行器的设计。 关键词：四轴飞行器,stm32;mpu6050,2.4G无线模块.PID.PWM

Abstract Quadrocopter has broad application prospect in the area of military and civilian because of its advantages of simple structure. Small size, low failure rate, taking off and landing ertically . etc. it is suitable for having task in narrow space. This design uses STM32f103zet6 as the master chip, and triaxial accelerometer mpu6050 inertial measurement unit, via 2.4G wireless module and remote control panel for communication. Finally using pid control algorithm with pwm drives the electronic speed controller to change moto to realize the design of quadrocopter. Key word : quadrocopter,stm32,mpu6050,2.4G wireless module ;pid; pwm

飞控姿态解算理解

姿态解算理解 1、姿态的描述方法 前几天在论坛里偶尔看到一个帖子，帖子的内容是问的为什么不用倾斜角表示姿态，我认为他说的倾斜角是指的斜面与斜面的夹角，或者说是物体与垂线的夹角吧，这种想法可能来源于我们日常生活的思维。 图1立方体 比如有一个立方体，我们放在水平面上的时候它的底面是和水平面平行的，但是当我们把立方体的一个脚垫起一个角度时，这样一来，立方体的一条棱与水平面的垂线就有了一定的夹角了。我们所说倾斜了多少多少度就是指的这个夹角，这是我们直观的反应。我认为这样直观的反应甚至比欧拉角还要来的直观，因为欧拉角是基于旋转的，肯定不会说这个立方体X、Y轴各旋转了多少度（假设Z旋转无效），我们可能也没那个概念，我们直观的反应就是它倾斜了一定度数。 但是我们在姿态解算的时候为啥不用的这种描述方法呢，个人认为是虽然方便我们直观的表达但不适合数学上的计算，还有就是我们仅仅知道这个倾斜角我们怎么施加控制量呢？高中物理学习物体运动的时候我们知道，物体的运动是合运动，我们可以把它的运动矢量正交分解为几个运动的合成（不正交也是可以的，但那不是在自找麻烦吗），同样道理，我们可以把刚体的旋转分解为三个轴上的旋转，这个旋转的角度就是欧拉角，如图2。 图2zxz序规欧拉角 欧拉角 欧拉角的定义不仅仅和旋转角度有关系，还和旋转轴的旋转顺序有关系，任何一种旋转顺序都是合法的。根据定义，欧拉角有12种旋转顺序（维基），一个物体通过任意一个旋转顺序都可以达到同样的姿态，在各个学科里所以为了统一，航空航天领域规定XYZ为欧拉角的旋转顺序。 上面已经说了欧拉角的定义。欧拉角的定义也是很直观而且容易理解的，也利于我们的计算，因为我们用的惯性器件也是按照单个轴向运动来测量的。定义上的欧拉角还和我们所说的Yaw、Pitch、Roll不是一回事。因为定义上的欧拉角就是刚体绕三个轴的旋转角度，

四旋翼设计报告

四旋翼自主飞行器(A题) 摘要 四旋翼飞行器是无人飞行器中一个热门的研究分支，随着惯性导航技术的发展与惯导传感器精度的提高，四旋翼飞行器在近些年得到了快速的发展。 为了满足四旋翼飞行的设计要求，系统以STM32F103VET6作为四旋翼自主飞行器控制的核心，处理器内核为ARM32位Cortex-M3 CPU，最高72MHz工作频率，工作电压3.3V-5.5V。该四旋翼由电源模块、电机电调调速控制模块、传感器检测模块、飞行器控制模块等构成。飞行姿态检测模块是通过采用MPU-6050模块，整合3轴陀螺仪、3轴加速度计，检测飞行器实时飞行姿态，实现飞行器运动速度和转向的精准控制。传感器检测模块包括红外障碍传感器、超声波测距模块，在动力学模 型的基础上，将四旋翼飞行器实时控制算法分为两个PID 控制回路，即位置控制回 路和姿态控制回路。测试结果表明系统可通过各个模块的配合实现对电机的精确控制，具有平均速度快、定位误差小、运行较为稳定等特点。 关键词：四旋翼飞行器；STM32；飞行姿态控制；串口PID

目录 1 系统方案论证与控制方案的选择...................................................................- 2 - 1.1 地面黑线检测传感器...................................................................... .............- 2 - 1.2 电机的选择与论证...................................................................... .................- 2 - 1.3 电机驱动方案的选择与论证...................................................................... .- 2 - 2 四旋翼自主飞行器控制算法设计...................................................................- 3 -

电子设计大赛四旋翼设计报告最终版

四旋翼飞行器（A 题）参赛队号：20140057号

四旋翼飞行器 设计摘要： 四旋翼作为一种具有结构特殊的旋转翼无人飞行器，与固定翼无人机相比，它具有体积小，垂直起降，具有很强的机动性，负载能力强，能快速、灵活的在各个方向进行机动，结构简单，易于控制，且能执行各种特殊、危险任务等特点。 因此在军用和民用领域具有广泛的应用前景如低空侦察、灾害现场监视与救援等。多旋翼无人机飞行原理上比较简单，但涉及的科技领域比较广，从机体的优化设计、传感器算法、软件及控制系统的设计都需要高科技的支持。 四旋翼无人机的飞行控制技术是无人机研究的重点之一。它使用直接力矩，实现六自由度（位置与姿态）控制，具有多变量、非线性、强耦合和干扰敏感的特性。此外，由于飞行过程中，微型飞行器同时受到多种物理效应的作用，还很容易受到气流等外部环境的干扰，模型准确性和传感器精度也将对控制器性能产生影响，这些都使得飞行控制系统的设计变得非常困难。 因此，研究既能精确控制飞行姿态，又具有较强抗干扰和环境自适应能力的姿态控制器是微小型四旋翼飞行器飞行控制系统研究的当务之急。

一、引言： 1.1 题目理解：四旋翼飞行器，顾名思义，其四只旋转的翅膀为飞行的动力来源。四只旋转翼是无刷电机，因此对于无刷电机的控制调速系统对飞行器的飞行性能起着决定性的作用。在本次大赛中，需要利用四旋翼飞行器平台，实现四旋翼的起飞，悬停，姿态控制，以及四旋翼和地面之间的测距等功能。 1.2 设计思路：为了满足飞行器的设计要求，要使用以微控制器为核心的控制系统，使本系统以MC9S12XS128模拟出控制信号，用STM32 MMC10接收模拟信号，然后翻译出模拟信号，利用加速度与陀螺仪传感器采集飞行器的飞行数据，加以闭环调控和精准的控制算法。进行上升、下降以及悬停等动作。 1.3 特点：本飞行器脱离遥控器控制，用微处理器实现整个飞行过程全自动控制，控制精度高。 二、方案设计： 系统主要由STM32模块，微处理器MC9S12XS128模块，电源模块，电机模块，超声波模块，加速度陀螺仪模块等构成。 系统总体框图如下图（图2.0）： STM32 MMC10 四路 PWM 通道 电调 无刷电机 高度显示数码管 信号接收 MC9S12XS128 GPIO 模块 时钟 模块 超声波传 感器 电源 图2.0 其中微处理器MC9S12XS128模块的外围电路见附录一2.1 控制系统选择方案：

2015年全国大学生电子设计大赛四旋翼飞行器论文

2015年全国大学生电子设计竞赛多旋翼自主飞行器（C题） 2015年8月15日

摘要 本文对四旋翼碟形飞行器进行了初步的研究和设计。首先，对飞行器各旋翼的电机选择做了论证，分析了实际升力效率与PWM的关系并选择了此样机的最优工作频率，并重点对飞行器进行了硬件和软件的设计。 本飞行器采用瑞萨R5F100LEA单片机为主控制器，通过四元数算法处理传感器MPU6000采集机身平衡信息并进行闭环的PID控制来保持机身的平衡。整个控制系统包括电源模块、传感器检测模块、电机调速模块、飞行控制模块及微处理器模块等。角度传感器和角速率传感模块为整个系统提供飞行器当前姿态和角速率信号，构成飞行器的增稳系统。本系统经过飞行测试，可以达到设计要求。关键字：R5F100LEA单片机、传感器、PWM、PID控制。

目录 1系统方案 (1) 1.1电机的论证与选择 (1) 1.2红外对管检测传感器的论证与选择 (1) 1.3电机驱动方案的论证与选择 (2) 2系统控制理论分析 (2) 2.1控制方式 (2) 2.2 PID模糊控制算法 (2) 3控制系统硬件与软件设计 (4) 3.1系统硬件电路设计 (4) 3.1.1系统总体框图 (4) 3.1.2 飞行控制电路原理图 (4) 3.1.3电机驱动模块子系统 (5) 3.1.4电源 (5) 3.1.5简易电子示高模块电路原理图 (6) 3.2系统软件设计 (6) 3.2.1程序功能描述与设计思路 (6) 3.2.2程序流程图 (6) 4测试条件与测试结果 (7) 4.1 测试条件与仪器 (7) 4.2 测试结果及分析 (7) 4.2.1测试结果(数据) (7) 4.2.2测试分析与结论 (8) 附录1：电路图原理 (9) 附录2：源程序 (10)

四旋翼飞行器建模与仿真Matlab

四轴飞行器的建模与仿真 摘要 四旋翼飞行器是一种能够垂直起降的多旋翼飞行器,它非常适合近地侦察、监视的任务,具有广泛的军事和民事应用前景。本文根据对四旋翼飞行器的机架结构和动力学特性做详尽的分析和研究,在此基础上建立四旋翼飞行器的动力学模型。四旋翼飞行器有各种的运行状态,比如:爬升、下降、悬停、滚转运动、俯仰运动、偏航运动等。本文采用动力学模型来描述四旋翼飞行器的飞行姿态。在上述研究和分析的基础上,进行飞行器的建模。动力学建模是通过对飞行器的飞行原理和各种运动状态下的受力关系以及参考牛顿-欧拉模型建立的仿真模型，模型建立后在Matlab/simulink软件中进行仿真。 关键字:四旋翼飞行器,动力学模型，Matlab/simulink Modeling and Simulating for a quad-rotor aircraft ABSTRACT The 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 dissertation, 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 course 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 the 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

四旋翼飞行器论文(原理图 程序)..

四旋翼自主飞行器(B题) 摘要 系统以R5F100LE作为四旋翼自主飞行器控制的核心，由电源模块、电机调速控制模块、传感器检测模块、飞行器控制模块等构成。飞行控制模块包括角度传感器、陀螺仪，传感器检测模块包括红外障碍传感器、超声波测距模块、TLS1401-LF模块，瑞萨MCU综合飞行器模块和传感器检测模块的信息，通过控制4个直流无刷电机转速来实现飞行器的欠驱动系统飞行。在动力学模型的基础上，将小型四旋翼飞行器实时控制算法分为两个PID控制回路，即位置控制回路和姿态控制回路。测试结果表明系统可通过各个模块的配合实现对电机的精确控制，具有平均速度快、定位误差小、运行较为稳定等特点。

目录 1 系统方案论证与控制方案的选择............................................................................................. - 2 - 1.1 地面黑线检测传感器............................................................................................................. - 2 - 1.2 电机的选择与论证................................................................................................................. - 2 - 1.3 电机驱动方案的选择与论证................................................................................................. - 3 - 2 四旋翼自主飞行器控制算法设计............................................................................................. - 3 - 2.1 四旋翼飞行器动力学模型..................................................................................................... - 3 - 2.2 PID控制算法结构分析.......................................................................................................... - 3 - 3 硬件电路设计与实现................................................................................................................. - 5 - 3.1飞行控制电路设计.................................................................................................................. - 5 - 3.2 电源模块................................................................................................................................. - 6 - 3.3 电机驱动模块......................................................................................................................... - 6 - 3.4 传感器检测模块..................................................................................................................... - 7 - 4 系统的程序设计......................................................................................................................... - 8 - 5 测试与结果分析......................................................................................................................... - 9 - 5.1 测试设备................................................................................................................................. - 9 - 5.2 测试结果................................................................................................................................. - 9 - 6 总结........................................................................................................................................... - 10 - 附录A 部分程序清单.................................................................................................................. - 11 -

捷联式姿态解算过程

（1）加速度记测得载体相对惯性空间比力b ib a ，经过误差补偿之后的b ib a 经过姿态矩阵n b C 的变换得到n ib a ：n n b ib b ib =C a a 将n ib a 进行误差补偿之后通过积分运算得到速度分量n en V 。n en V 一方面作 为系统的输出，一方面作为输入用来求解位置角速率n en W 。 （2）陀螺仪测得载体相对惯性空间角速率b i b W ， 首先通过速度分量n en V 求得位移角速率n en W ，因为n eny W =0， n enx n eny W W ????????=22yt xt 22y yt xt yt t x x t t sin cos ()R R sin cos R 11sin cos R R 11sin cos R R R αααααααα?? -???????? -???-++? -（）（）n x n y V V ?? ?????? 这样就根据陀螺仪测得的角速率b i b W ，上面所求得的位移角速率n en W ， 加上已知的地球角速率e i e W 来求的姿态角速率b n b W 。 b b n b n e i e n i e n e i e W =C W =C C W 且 b b n e n n e n W =C W b b b b n b i b i e e n W =W W W --=b i b W b n e n n e i e e n C C W +W -（） 。 然后根据姿态角速率利用四元数微分方程求出四元数中的元素a,b,c,d. 四元数描述了一个坐标系或一个矢量相对某一个坐标系的旋转。a 是标量部分表示了转角的一半余弦值，b ，c ，d 是矢量部分表示瞬时转轴的方向，瞬时转动轴与参考坐标系轴间方向的余弦值。 表达式A=a+bi+cj+dk 。

四旋翼飞行器的结构形式和工作原理

四旋翼飞行器的结构形式和工作原理 1.结构形式 直升机在巧妙使用总距控制和周期变距控制之前，四旋翼结构被认为是一种最简单和最直观的稳定控制形式。但由于这种形式必须同时协调控制四个旋翼的状态参数，这对驾驶员认为操纵来说是一件非常困难的事，所以该方案始终没有真正在大型直升机设计中被采用。这里四旋翼飞行器重新考虑采用这种结构形式，主要是因为总距控制和周期变距控制虽然设计精巧，控制灵活，但其复杂的机械结构却使它无法再小型四旋翼飞行器设计中应用。另外，四旋翼飞行器的旋翼效率相对很低，从单个旋翼上增加拉力的空间是非常有限的，所以采用多旋翼结构形式无疑是一种提高四旋翼飞行器负载能力的最有效手段之一。至于四旋翼结构存在控制量较多的问题，则有望通过设计自动飞行控制系统来解决。四旋翼飞行器采用四个旋翼作为飞行的直接动力源，旋翼对称分布在机体的前后、左右四个方向，四个旋翼处于同一高度平面，且四个旋翼的结构和半径都相同，旋翼1和旋翼3逆时针旋转，旋翼2和旋翼4顺时针旋转，四个电机对称的安装在飞行器的支架端，支架中间空间安放飞行控制计算机和外部设备。四旋翼飞行器的结构形式如图1.1所示。

图1.1四旋翼飞行器的结构形式 2.工作原理 典型的传统直升机配备有一个主转子和一个尾桨。他们是通过控制舵机来改变螺旋桨的桨距角，从而控制直升机的姿态和位置。四旋翼飞行器与此不同，是通过调节四个电机转速来改变旋翼转速，实现升力的变化，从而控制飞行器的姿态和位置。由于飞行器是通过改变旋翼转速实现升力变化，这样会导致其动力部稳定，所以需要一种能够长期保稳定的控制方法。四旋翼飞行器是一种六自由度的垂直升降机，因此非常适合静态和准静态条件下飞行。但是四旋翼飞行器只有四个输入力，同时却有六个状态输出，所以它又是一种欠驱动系统。

电子设计大赛国赛_四旋翼自主飞行器A题

2013年全国大学生电子设计竞赛课题:四旋翼自主飞行器（B 题） 【本科组】 2013年9月7日

摘要 为了满足四旋翼飞行器的设计要求，设计了以微控制器为核心的控制系统和算法。首先进行了各单元电路方案的比较论证，确定了硬件设计方案。四旋翼飞行器采用了固连在刚性十字架交叉结构上的4个电机驱动的一种飞行器，以78K0R CPU內核为基础,围绕新的RL78 CPU內核演化而来的RL78/G13作为控制核心，工作频率高达32MHz，工作电压1.6V-5.5V，适合各种类型的消费类电子和工业应用, 满足8/16位微控制器的需求，有助于降低系统功耗，削减总系统的构建成本。采用9926B MOS管芯片的驱动直流电机，该驱动芯片具有内阻小、负载电流大、且控制简单的特性。通过采用MPU-6050整合的3轴陀螺仪、3轴加速器，并含可藉由第二个I2C端口连接其他厂牌之加速器、磁力传感器、或其他传感器的数位运动处理(DMP: Digital Motion Processor)硬件加速引擎，由主要I2C端口以单一数据流的形式，向应用端输出完整的9轴融合演算技术InvenSense的运动处理资料库，可处理运动感测的复杂数据，降低了运动处理运算对操作系统的负荷，实现了四旋翼飞行器运动速度和转向的精准控制。通过HC-SR04超声波测距模块实现了对四旋翼飞行器飞行高度的准确控制。通过激光传感器，实现了四旋翼飞行器沿黑线前进，在规定区域起降，投放铁片等功能，所采用的设计方案先进有效，完全达到了设计要求。 关键词：四旋翼自主飞行器，E18-D50NK光电传感器，寻线，超声波，单片机。

四旋翼自主飞行器（B 题） 【本科组】 1系统方案 本系统主要由电源模块、电机驱动模块、光电循迹模块模块、超声波测高模块、姿态传感器模块组成，下面分别论证这几个模块的选择。 1.1 电源模块的论证与选择 方案一：采用线性元器件LM7805三端稳压器构成稳压电路，为单片机等其他模块供电，输出纹波小，效率低，容易发热。 方案二：采用元器件2596为开关稳压芯片，效率高，输出的纹波大，不容易发热。 方案三：采用线性元器件2940构成稳压电路，为单片机等其他模块供电，输出纹波小，效率高，不容易发热，综合性能高。 综合以上三种方案，选择方案三。 1.2 电机驱动模块的论证与选择 方案一：采用三极管驱动，由于输出电流很大，容易发热， 方案二：采用L298N电机驱动模块，通过电流大，容易发热，使得电机转速变慢，载重量变小。 方案三：采用场效应管9926B芯片组成的电机驱动模块，驱动能力好。能承受的最大电流为7.5A，符合要求。 综合以上三种方案，选择方案三。 1.3 光电循迹模块的论证与选择 方案一：采用CCD摄像头采集图片经过算法处理循迹，前瞻性比较好、循迹效果好，但是处理程序复杂、成本高。 方案二：采用红外对管，有效距离太短，不能满足实际循迹要求。 方案三：采用E18-D50NK光电传感器，这是一种集发射与接收于一体的光电传感器, 检测距离可以根据要求进行调节。探测距离远、受可见光干扰小、前瞻性较好、抗干扰性较好。

四轴姿态解算

又花了将近一个星期，终于把姿态解算的框架完成了。仅仅是把陀螺仪、加速度计、罗盘融合在一起，得出旋转姿态，没有对加速度积分，没有用到气压计，几乎没有滤波。算是阶段性的工作吧，把框架设计得合理一点，以后添加/修改就很简单了。 从传感器的读取，到四元数的学习，到空间旋转的处理方法，循序渐进，逐个击破。主要参考了以下资料（按阅读的时间循序）： 《计算机图形学几何工具算法详解》（四元数转矩阵的公式是错的！） 《交互式计算机图形学——基于OpenGL的自顶向下方法》 维基百科——四元数 框框的日记——四元数 青衫湮痕——四元数 Heath's blog——四元数与欧拉角之间的转换 阿莫电子论坛——【原创】姿态估计 下面总结一下“姿态解算”的过程，分为“传感器”、“四元数与旋转”、“姿态解算框架”、“长期融合”、“快速融合”四部分。 1.传感器 我用的是10轴姿态传感器模块，其中陀螺仪是L3G4200D，加速度计是ADXL345，罗盘是HMC5883L，气压计是BMP085。全部都通过一条共用的I2C总线访问，速度都支持400kHz。先讲讲I2C库。要配置、读取传感器，首先把通信做好，这里就是I2C库了。现在大部分单片机都有支持中断的硬件I2C了，可以写个高效的I2C库。我只实现了主机发送和主机接收模式，这里简单介绍一下接口。接口函数主要有2个： uint8_t I2C_transmit (uint8_t which,I2C_transmitCallback cb); void I2C_setNextCallback (uint8_t which,I2C_transmitCallback cb); I2C_transmit()用于触发一次传输（发送或接收），异步执行，调用后马上返回。其中有一个I2C_transmitCallback类型的参数，就是决定发送或接收、如何处理数据的回调函数了，其定义如下： /* 数据传输回调函数。 * 每（准备）传输一个字节都调用一次。 * 参数： * seq =>序号，第一次调用时为0，以后每次调用递增。 * data => seq==0时写(从机地址+W/R)到data。 * seq!=0时data是数据。发送就写data，接收就读data。 * 返回值表示下一步的行为： * I2C_RT_START =>发送开始信号。 * I2C_RT_STOP =>发送停止信号。 * I2C_RT_REPEAT_START_OR_STOP =>如果有下一次传输，就发送RepeatStart，否则发送Stop。 * I2C_RT_ACK =>继续传送，回应ACK。 * I2C_RT_NACK =>继续传送，回应NACK。 */ typedef uint8_t (* I2C_transmitCallback)(uint8_t seq,uint8_t * data); 当用I2C_transmit()成功触发一次传输后，I2C库会根据需要调用回调函数，所以使用这个I2C 库就是写回调函数了。 而I2C_setNextCallback()则是用来设置紧接着的一次传输的。当本次传输结束时，不发送“Stop”

无人机实训报告

关于无人机模拟操控技能实训的报告 目录 一、前言 1.实训背景与意义 (2) 2.无人机的发展现状 (2) 3、本次实训的任务安排与技术要求 (4) 二、实训的基本情况 (5) 三、实训总结 (8)

一．前言 本次实训主要是通过实体操控四旋翼无人机的不同姿态运动来提升自己对无人机的运动机制、动力原理以及飞行实操的了解。主要要求是使用提供的四旋翼无人机实现无人机在导航模式下实现原地360°旋转、矩形飞行以及固定翼的模拟航线飞行等，需要控制飞机高度方向，指导老师现场考核评分并记录好实训操控时的图像或音频，以完成实训总结报告。 1．实训背景与意义 无人机，是一种不需要有人驾驶，可以通过远程操控来实现某些特定功能的飞行器，具有可持续续航、飞行高度高、可携带外接设备等一系列优点，目前无人机在多个领域取得应用，并且经过行业的不断完善，已经形成初步的产业链。无人机以其自身的突出的优点、高性价比等巨大优势吸引人们的关注，并且在不断地研究中取得了一定的突破，从无人机整个行业的前景来看，无疑是值得肯定的，并且现有技术不断革新的情况下无人机在未来的发展将会越来越好，无人机作为现代的新星宠儿，对它的研究应用无论是对自身发展还是国家技术改革创新都具有很大作用，在无人机势如春笋的发展背景下，通过实训去了解无人机，熟练的操控无人机将对未来就业以及自身发展具有重大意义。 2.无人机的发展现状 20世纪90年代以来，随着信息化技术、轻量化/小型化任务载荷技术、卫星通信技术、复合材料结构技术、高效空气动力技术、新型能源与高效动力技术、起降技术的迅猛发展，无人机性能不断提升、功能不断扩展，各种类型和功能的无人机不断涌现，应用领域也越来越广泛。无人机按规模可分为微型无人机、小型无人机、中型无人机、大型无人机；按飞行高度可分为低空无人机、中空无人机、高空无人机、临近空间无人机；按飞行速度可分为低速无人机、高速无人机；按机动性可分为低机动无人机、高机动无人机；按能源与动力类型可分为螺旋桨式无人机、喷气式无人机、电动无人机、太阳能无人机、燃料电池无人机；按活动半径可分为近程无人机、短程无人机、中程无人机、远程无人机；按起降方式可分为滑跑起降无人机、火箭助推/伞降回收无人机、空投无人机、炮射无人机、潜射无人机等；按功能用途可分为靶标无人机、诱饵无人机、侦察无人机、炮兵校射无人机、电子对抗无人机、电子侦听无人机、心理战无人机、通信中继无人机、测绘无人机、攻击无人机、察打一体无人机、预警无人机…… 人机系统主要包括飞机机体、飞控系统、数据链系统、发射回收系统、电源系统等。飞控系统又称为飞行管理与控制系统，相当于无人机系统的“心脏”部分，对无人机的稳定性、数据传输的可靠性、精确度、实时性等都有重要影响，对其飞行性能起决定性的作用；数据链系统可以保证对遥控指令的准确传输，以及无人机接收、发送信息的实时性和可靠性，以保证信息反馈的及时有效性和顺利、准确的完成任务。发射回收系统保证无人机顺利升空以达到安全的高度和速度飞行，并在执行完任务后从天空安全回落到地面。 无人机主要分为多旋翼无人机、固定翼无人机以及组合式无人机三大类。 多旋翼无人机又有四旋翼、六旋翼、八旋翼甚至十旋翼等，最常见的是四旋翼无人机，以下是常见的多旋翼无人机。

四轴飞行器毕业设计论文

毕业论文 基于单片机的四轴飞行器 夏纯 吉林建筑大学 2015年6月

毕业论文 基于单片机的四轴飞行器学生：夏纯 指导教师：许亮 专业：电子信息工程 所在单位：电气与电子信息工程学院 答辩日期：2015 年6月

目录 摘要 ...................................................................................................................................... ABSTRACT ........................................................................................................................... 第1章绪论......................................................................................................................... 1.1 论文研究背景及意义........................................................................................... 1.2 国内外的发展情况 ............................................................................................... 1.3 本文主要研究内容 ............................................................................................... 第2章总体方案设计....................................................................................................... 2.1 总体设计原理 ........................................................................................................ 2.2 总体设计方案 ........................................................................................................ 2.2.1 系统硬件电路设计方案............................................................................ 2.2.2 各部分功能作用.......................................................................................... 2.2.3 系统软件设计方案 ..................................................................................... 第3章系统硬件电路设计.............................................................................................. 3.1 Altium Designer Summer 09简介........................................................................ 3.2 总体电路设计 ........................................................................................................ 3.2.1 遥控器总体电路设计................................................................................. 3.2.2 飞行器总体电路设计................................................................................. 3.3 各部分电路设计.................................................................................................... 3.3.1 电源电路设计 .............................................................................................. 3.3.2 主控单元电路设计 .....................................................................................

四旋翼飞行器 设计报告

大学生电子设计竞赛 设计报告 摘要：本设计实现基于STM32开发板的十字形四旋翼飞行器，四旋翼由主控制板、陀螺仪、电机模块、超声波测距、电源和投弹打靶模块等六部分组成。其中，控制核心STM32负责飞行器姿态数据接收和飞行姿态控制；陀螺仪采用MPU6050模块，该模块经过卡尔曼滤波处理采集的数据，输出数据，用PID控制算法对数据进行处理，同时，解算出相应电机需要的的PWM增减量，及时调整电机转速，调整飞行姿态，使飞行器的飞行的更加稳定。电机模块通过电调控制无刷直流电机，超声波传感器进行测距，起飞后悬停在一定高度，打靶后降落。 关键词：四旋翼；PID控制；陀螺仪，姿态角，电机控制

2

目录 1系统方案 (1) 1.1控制系统选择方案 (1) 1.2飞行姿态控制方案论证 (1) 1.3角度测量模块的方案论证 (2) 1.4高度测量模块方案论证.............................................. 错误！未定义书签。2理论分析与计算 (2) 2.1控制模块 .................................................................... 错误！未定义书签。 2.2机翼电机 .................................................................... 错误！未定义书签。 2.3飞行姿态控制单元 (3) 3电路与程序设计 (4) 3.1系统总体设计思路 (4) 3.2主要元器件清单......................................................... 错误！未定义书签。 3.3系统框图 .................................................................... 错误！未定义书签。 3.3.1系统硬件框图 ..................................................... 错误！未定义书签。 3.3.2系统软件框图 ..................................................... 错误！未定义书签。4测试方案与测试结果.. (5) 5结论 (6) 3

基于四元数方法的姿态解算

基于四元数方法的姿态解算方法分析 摘要:载体的姿态解算算法是实现捷联式惯性导航系统精确导航的核心技术之一。分析了欧拉法、方向余弦法、四元数法求解姿态矩阵的优缺点，采用四元数法与方向余弦法两种解算方法分别计算载体姿态，两种方法的计算结果之差与理论真值比较以得到解算的相对误差，从而验证了四元数法的正确性和有效性。最后，指出提高采样频率和采用高阶计算算法能进一步减小姿态解算误差。数字化仿真与转台试验结果表明，本文提出的载体姿态解算法具有良好的实时性。 1引言 捷联惯导是一种自主式的导航方法。该方法将陀螺仪和加速度计直接安装在载体上，省掉机电式导航平台，利用计算机软件建立一个“数学平台”来代替机电平台实体[1]。由于其结构简单且抗干扰能力强，目前已成为航空航天、航海、机器人、智能交通等领域的研究热点之一。 姿态解算是捷联式惯性导航系统的关键技术，通过姿态矩阵可以得到载体的姿态和导航参数计算需要的数据，是捷联式惯导算法中的重要工作。载体的姿态和航向体现了载体坐标系与导航坐标系之间的方位关系，确定两个坐标系之间的方位关系需要借助矩阵法和力学中的刚体定点运动的位移定理。通过矩阵法推导方向余弦表，而刚体定点运动的位移定理表明，定点运动刚体的任何有限位移都可以绕过定点的某一轴经过一次转动来实现。目前描述动坐标相对参考坐标系方位关系的方法有多种，可简单地将其分为3类，即三参数法、四参数法和九参数法「1-2]。三参数法也叫欧拉角法，四参数法通常指四元数法，九参数法称作方向余弦法。欧拉角法由于不能用于全姿态飞行运载体上而难以广泛用于工程实践，且实时计算困难。方向余弦法避免了欧拉法的“奇点”现象，但方程的计算量大，工作效率低。随着飞行运载体导航控制系统的迅速发展和数字计算机在运动控制中的应用，控制系统要求导航计算环节能更加合理地描述载体的刚体空间运动，四元数法的研究得到了广泛重视。本文全面分析了3种解算方法的特点，通过对比四参法与九参法的计算结果以验证四元数法的正确性和有效性，基于数值仿真和转台实验相结合的分析方法得到进一步减少姿态解算误差的有效途径，为捷联式惯性导航技术的工程实践提供参考。（就是这部分内容需要程序解算，不会搞） 2姿态矩阵的计算方法 由于载体的姿态方位角速率较大，所以针对姿态矩阵的实时计算提出了更高的要求。通常假定捷联系统“数学平台”模拟地理坐标系，即导航坐标系;而确定载体的姿态矩阵即为研究载体坐标系(6)和导航坐标系(E)的空间转动关系，一般用载体坐标系相对导航坐标系的三次转动角确定，习惯上俯仰角和偏航角用B和必表示，滚转角用Y表示。目前主要的研究方法为:欧拉法、方向余弦法与四元数法。图1为捷联式惯性导航原理图。