四旋翼飞行器程序..

选题编号：C题全国大学生电子设计竞赛设计报告选题名称：多旋翼自主飞行器主办单位：辽宁省教育厅比赛时间：2015年08月12日08时起2015年08月15日20时止摘要多旋翼飞行器也称为多旋翼直升机，是一种有多个螺旋桨的飞行器。

本设计实现基于ATMEGA328P和R5F100LEA的四旋翼飞行器。

本飞行器由飞行控制模块、导航模块、电源模块和航拍携物模块等四部分组成。

主控模块采用ATMEGA328P芯片，负责飞行姿态控制；导航模块以G13MCU为核心，由陀螺仪、声波测距等几部分构成，该模块经过瑞萨芯片处理采集的数据，用PID控制算法对数据进行处理，同时解算出相应电机需要的PWM增减量，及时调整电机，调整飞行姿态，使飞行器的飞行更加稳定；电源模块负责提供持续稳定电流；航拍携物模块由摄像头、电磁铁等构成，负责完成比赛相应动作。

飞行器测试稳定，实现了飞行器运动速度和转向的精准控制，能够完成航拍，触高报警，携物飞行，空中投递等动作要求。

关键词：四旋翼，PID控制，瑞萨目录摘要................................................................................................................................ i i1.题意分析 (1)2.系统方案 (1)2.1 飞行控制模块方案选择 (1)2.2 飞行数据处理方案选择 (1)2.3 电源模块方案选择 (2)2.4 总体方案描述 (2)3.设计与论证 (2)3.1 飞行控制方法 (2)3.2 PID控制算法 (3)3.3 建模参数计算 (3)3.4 建立坐标轴计算 (4)4.电路设计 (5)4.1 系统组成及原理框图 (5)4.2 系统电路图 (5)5.程序设计 (6)5.1 主程序思路图 (6)5.2 PID算法流程图 (7)5.3 系统软件 (7)6. 测试方案 (7)6.1 硬件测试 (7)6.2 软件仿真测试 (7)6.3 测试条件 (8)6.4 软硬件联调 (8)7.测试结果及分析 (8)7.1 测试结果 (8)7.2 结果分析 (9)8.参考文献 (9)1.题意分析设计并制作一架带航拍功能的多旋翼自主飞行器。

四旋翼飞行器搭建教程（译自————加里斯.欧文）本文将带你通过建立自己的飞行控制器（飞空软件），同时教你工作的具体细节。

这些信息很难找到，特别是那些本身就不是航天工程师的人！就我个人而言，我用了六个月，因为我花费了太多的时间查找bug和调试bug，但通过这篇文章你可以短期收获同样的经验。

我会教你避开陷阱，这样你就不会像我一样浪费时间。

第一个关键是你对硬件的选择。

我选择从零开始建立自己系统，在这一阶段的时候我都不知道RC（remote controlled 遥控; radio coding 无线电编码; ）和飞行器是如何飞行的，这是一个巨大错误。

开始我以为，通过自行购买附加电路，芯片和传感器能省很多钱，结果最终我花了一大笔钱！放过自己吧，直接去购买ardupilot 2.5控制板，组装你的直升机，了解遥控，了解飞行原理，然后回到这里。

这个板子本质上是只是一个连有一些传感器Arduino（开源主控板,可查/view/1268436.htm?fr=aladdin），和我们将在这篇文章介绍的程序——我们自己编写的。

你得将所有东西连接起来，你的四旋翼飞机才能得飞：当然你也得会用优秀的arducopter软件。

本项目（ardupilot）由3D Robotics 提供赞助，这意味着他们销售所设计的硬件获利，并将所得利润回馈社区。

该软硬件是完全开源的，所有人可以免费复制下载。

你可以直接从他们那里购买，或者从Hobbyking (named HKPilot) and RCTimer (named ArduFlyer).购买相同的拷贝件。

在这篇文章中，我将假定您有ardupilot硬件——其本质上上是附传感器Arduino。

如果你选择忽视我的建议，并且建立自己的硬件，或使用Arduino电路板，那么您需要更换的底层代码（HAL库）。

我也会以为你在X配置（x型四旋翼），+ / X（两种四旋翼配置）和六/八旋翼飞行器之间切换（只是不同的电机的组合），配置的改变不会让它在本文有任何实质性的区别。

基于Arduino的四旋翼飞行器设计与实现作者：董瑞智李泽文徐振平来源：《电脑知识与技术》2017年第28期摘要：针对四旋翼飞行器姿态数据测量存在误差、控制算法选择较难的问题，该文选用Arduino开发板作为系统控制板，构建基于Arduino的四旋翼飞行器。

选择惯性测量单元六轴组件MPU6050、电子罗盘HMC5883L及气压计BMP085等多个MEMS传感器实时采集飞行器姿态数据，并由双闭环PID控制器实现对两组四路电机的转速控制。

为降低传感器数据的测量误差，该文采用卡尔曼滤波算法对飞行器姿态数据进行滤波与融合，为飞行器的姿态控制提供有利条件。

经飞行实验显示，该文设计的飞行器实现了悬停、升降和转弯等功能，并验证了该文使用卡尔曼滤波算法降低姿态数据测量误差和双闭环PID控制器控制飞行器状态的有效性。

关键词：四旋翼飞行器；MEMS传感器；卡尔曼滤波；姿态解算；PID控制中图分类号：TP391 文献标识码：A 文章编号：1009-3044（2017）28-0263-03Abstract： In order to solve the problem of the measurement error of the attitude data of the four rotor aircraft and the difficulty of the selection of the control algorithm. This paper uses Arduino development board as the system control board to build a Arduino based four rotor aircraft， and select some MEMS sensors， such as the inertial measurement unit six axis components MPU6050，HMC5883L electronic compass and barometer BMP085， to collect aircraft attitude data. Then， use double closed-loop PID controllers to control the speed of two groups of four motors. In order to reduce the measurement error of sensor data， the Calman filtering algorithm is used to filter and fuse the attitude data of aircraft， which provides favorable conditions for attitude control of spacecraft. The flight experiment shows that the design of the aircraft can hovering， lifting and turning function， and verified effectiveness of using the Calman filter algorithm to reduce the measurement error of attitude data and using double closed-loop PID controllers to control the state of the aircraft.Key words： quad-rotor helicopter； MEMS sensor； kalman filtering； attitude calculation；PID controller1 概述四旋翼飞行器，一种由4个转子推动飞行[1]，六自由度垂直起降飞行器[2]，能够完成悬停、飞行、垂直起降等功能。

儿童无人机说明书
1.将四旋翼飞行器的开关调至ON,将遥控器的开关调至ON。

2.把遥控器的摇杆,上下左右摇杆推拉一下,进行配对,如果遥控器鸣一声,则视为配对成功。

3.推动摇杆,进行四旋翼飞行器的控制。

4.拉杆推动练习,将左摇杆推上即为飞机往上向上飞,如果将左摇杆向下推则为下降,右摇杆则为控制左右前进方向。

5.降落,缓缓地将摇杆向下拉,右右摇杆不要动左摇杆慢慢的向下拉直至降落成功。

玩具机遥控器一般都是美国手，都是左边油门，右边方向。

然后图二左边的应该是开灯键，右边的应该是翻滚键。

至于那些小按键，一般都是调飞机起飞后会自动偏移的按键，你可以多试一下。

四旋翼飞行器飞行控制技术综述四旋翼飞行器是一种具有四个独立旋翼的飞行器，也被称为四轴飞行器。

它采用借助电子设备来保持平衡和方向飞行，是一种近年来非常流行的飞行器类型。

四旋翼飞行器飞行控制技术是指通过控制器、传感器和电动机等设备来实现飞行器的稳定飞行和精确控制。

本文将对四旋翼飞行器的飞行控制技术进行综述，包括传感器、飞行控制器、电机及螺旋桨、遥控器等方面。

一、传感器四旋翼飞行器的传感器是实现飞行控制的基础，它主要包括加速度计、陀螺仪、磁力计和气压计等。

加速度计用于测量飞行器的加速度，陀螺仪用于测量飞行器的角速度，磁力计用于测量飞行器的方向，气压计用于测量飞行器的高度。

这些传感器可以实时地将飞行器的状态信息传输给飞行控制器，从而帮助控制器实现飞行器的稳定飞行和精确控制。

二、飞行控制器飞行控制器是四旋翼飞行器的大脑，它通过接收传感器传来的信息，计算飞行器的状态，再根据飞行器的状态信息来控制电机的转速和螺旋桨的转动角度，从而实现飞行器的稳定悬停、方向飞行、姿态调整等功能。

目前市面上比较常见的飞行控制器有OpenPilot、Pixhawk、Naze32等，它们都能够提供强大的飞行控制功能，同时还支持GPS导航、航点飞行、自动返航等高级功能。

三、电机及螺旋桨四旋翼飞行器通常采用无刷电机驱动螺旋桨进行飞行，电机及螺旋桨的选择直接影响飞行器的性能和稳定性。

在选择电机时需要考虑电机的功率、转速、推力、以及电机的重量和尺寸等参数，同时还需要考虑螺旋桨的直径、螺距、材质等参数。

合理的电机及螺旋桨搭配可以为飞行器提供足够的推力和稳定性，从而保证飞行器的良好飞行表现。

四、遥控器遥控器是飞行器的操控装置，通过遥控器可以实现飞行器的起飞、降落、悬停、前进、后退、左转、右转等操作。

目前市面上比较常见的遥控器有Futaba、FrSky、Spektrum等，它们都能够提供可靠的无线控制信号，从而保证飞行器的操控精准和稳定。

在实际的飞行控制中，通常采用PID控制算法来实现对飞行器的姿态调整和稳定飞行。

简述f450四旋翼飞行器组装流程Assembling a F450 quadcopter can be an exciting and rewarding experience for hobbyists and enthusiasts who are interested in building their own drone.组装F450四旋翼飞行器可以成为对于喜欢制作无人机的爱好者和热衷者来说一个令人兴奋且有回报的体验。

First and foremost, it is important to gather all the necessary components and tools before starting the assembly process. This includes the F450 frame kit, motors, electronic speed controllers (ESCs), flight controller, propellers, radio transmitter and receiver, battery, and various hardware such as screws and standoffs.首先也是最重要的是，在开始组装过程之前，需要先收集好所有必要的部件和工具。

这包括F450机架套件、电机、电子速度控制器（ESC）、飞行控制器、螺旋桨、无线电发射器和接收器、电池，以及各种螺丝和支撑物等硬件。

Once all the components are gathered, the next step is to carefully follow the assembly instructions provided with the F450 frame kit. It is crucial to pay close attention to the details and ensure that each component is installed correctly and securely. This will not only ensure the safety and stability of the quadcopter but also contribute to its overall performance and longevity.一旦所有部件收集完成，下一步就是仔细按照F450机架套件中提供的组装说明进行组装。

动态系统建模（四旋翼飞行器仿真）实验报告:动态系统建模（四旋翼飞行器仿真）实验报告院（系）名称大飞机班学号学生姓名任课教师2021年 _月四旋翼飞行器的建模与仿真一、实验原理 I．四旋翼飞行器简介四旋翼飞行器通过四个螺旋桨产生的升力实现飞行，原理与直升机类似。

四个旋翼位于一个几何对称的十字支架前、后、左、右四端，如图1-1所示。

旋翼由电机控制；整个飞行器依靠改变每个电机的转速来实现飞行姿态控制。

在图1-1中，前端旋翼1 和后端旋翼3 逆时针旋转，而左端旋翼2 和右端的旋翼4 顺时针旋转，以平衡旋翼旋转所产生的反扭转矩。

由此可知，悬停时，四只旋翼的转速应该相等，以相互抵消反扭力矩；同时等量地增大或减小四只旋翼的转速，会引起上升或下降运动；增大某一只旋翼的转速，同时等量地减小同组另一只旋翼的转速，则产生俯仰、横滚运动；增大某一组旋翼的转速，同时等量减小另一组旋翼的转速，将产生偏航运动。

图1-1 四旋翼飞行器旋翼旋转方向示意图从动力学角度分析，四旋翼飞行器系统本身是不稳定的，因此，使系统稳定的控制算法的设计显得尤为关键。

由于四旋翼飞行器为六自由度的系统（三个角位移量，三个线位移量），而其控制量只有四个（4 个旋翼的转速），这就意味着被控量之间存在耦合关系。

因此，控制算法应能够对这种欠驱动（under-actuated）系统足够有效，用四个控制量对三个角位移量和三个线位移量进行稳态控制。

本实验针对四旋翼飞行器的悬浮飞行状态进行建模。

II．飞行器受力分析及运动模型（1）整体分析如图1-2所示，四旋翼飞行器所受外力和力矩为：Ø重力mg，机体受到重力沿-Zw方向Ø四个旋翼旋转所产生的升力Fi(i=1,2,3,4)，旋翼升力沿ZB方向Ø旋翼旋转会产生扭转力矩Mi (i=1,2,3,4)， Mi垂直于叶片的旋翼平面，与旋转矢量相反。

图1-2 四旋翼飞行器受力分析（2）电机模型Ø力模型（1.1）旋翼通过螺旋桨产生升力。

四旋翼飞行器飞行控制技术综述四旋翼飞行器是一种由四个旋翼组成的无人机，可以垂直起降和定点悬停，具有灵活性和机动性。

它的飞行控制技术可以分为姿态控制和位置控制两种基本类型。

姿态控制是指控制飞行器姿态（包括横滚、俯仰和偏航），而位置控制则是控制飞行器的定点飞行或航线飞行。

下面将对这两种控制技术进行详细介绍。

一、姿态控制技术1. 传统PID控制PID控制是一种经典的控制方法，它通过比例、积分和微分三个分量的组合来调节系统的输出。

在四旋翼飞行器中，PID控制可以用来控制姿态，使飞行器保持平稳的飞行状态。

通过对角速度和角度的反馈控制，可以实现对飞行器姿态的精确控制。

但是PID控制也存在一些问题，比如对于非线性系统和参数变化的系统，PID控制的性能会受到影响。

2. 模糊控制模糊控制是一种可以应对非线性系统和模糊环境的控制方法。

在四旋翼飞行器中，可以利用模糊控制来实现对姿态的精确控制。

通过建立模糊规则库，可以将模糊的输入与输出进行映射，实现对飞行器姿态的控制。

模糊控制可以有效地应对系统的非线性特性，但是对规则库的设计和参数的选择需要较大的经验和技巧。

3. 神经网络控制4. 遗传算法控制遗传算法是一种模拟生物进化的优化算法，可以用来优化系统的控制参数。

在四旋翼飞行器中，可以利用遗传算法来寻找最优的姿态控制参数，从而实现对飞行器姿态的精确控制。

遗传算法能够全局寻优，但是需要大量的计算资源和较长的优化时间。

1. GPS定位控制GPS定位是一种全球定位系统，可以实现对飞行器位置的精确控制。

在四旋翼飞行器中，可以利用GPS定位进行位置控制，实现定点飞行或航线飞行。

通过GPS模块获取飞行器的位置信息，可以实现对飞行器位置的精确控制。

但是GPS在室内或密集城市地区信号可能不太可靠。

3. 惯性导航控制惯性导航是一种通过加速度计和陀螺仪获取飞行器运动信息，并通过积分计算得到飞行器位置信息的导航方法。

在四旋翼飞行器中，可以利用惯性导航进行位置控制，实现对飞行器位置的精确控制。

四旋翼飞行器实验报告(总4页)--本页仅作为文档封面，使用时请直接删除即可----内页可以根据需求调整合适字体及大小--实验报告课程名称：《机械原理课内实验》学生姓名：徐学腾学生学号： 22所在学院：海洋信息工程学院专业：机械设计制造及其自动化报导教师：宫文峰2016年 6 月 26 日实验一四旋翼飞行器实验一、实验目的1.通过对四旋翼无人机结构的分析，了解四旋翼无人机的基本结构、工作的原理和传动控制系统；2. 练习采用手机控制终端来控制无人机飞行，并了解无人机飞行大赛的相关内容，及程序开发变为智能飞行无人机。

二、实验设备和工具1. Parrot公司四旋翼飞行器一架；2. 苹果手机一部；3. 蓝牙数据传输设备一套。

4. 自备铅笔、橡皮、草稿纸。

三、实验内容1、了解四旋翼无人机的基本结构；2、了解四旋翼无人机的传动控制路线；3、掌握四旋翼无人机的飞行控制的基本操作；4、了解四旋翼无人机翻转动作的机理；5、能根据指令控制无人机完成特定操作。

四、实验步骤1、学生自行用IPHONE手机下载并安装四旋翼飞行器控制软件。

2、检查飞行器结构是否完好无损；3、安装电沲并装好安全罩；4、连接WIFI，打开手机软件，进入控制界面；5、软件启动，设备连通，即可飞行。

6、启动和停止由TAKE OFF 控制。

五、注意事项1.飞行器在同一时间只能由一部手机终端进行控制；2. 飞行之前，要检查螺旋浆处是否有障碍物干涉；3. 飞行之后禁止用手去接飞行器，以免螺旋浆损伤手部；4. 电量不足时，不可强制启动飞行；5. 翻转特技飞行时，要注意飞行器距地面高度大于4米以上；6. 飞行器不得触水；7. 飞行器最大续航时间10分钟。

六、实验相关问题1. 整理四旋翼飞行器的传动控制路线。

四旋翼飞行器采用四个旋翼作为飞行的直接动力源，旋翼对称分布在机体的前后、左右四个方向，四个旋翼处于同一高度平面，且四个旋翼的结构和半径都相同，对角线方向上的旋翼旋转方向相同，相邻旋翼旋转方向相对，四个电机对称的安装在飞行器的支架端，支架中间空间安放飞行控制计算机和外部设备。

西华大学610039摘要：在对我很感兴趣的项目微型四轴飞行器进行了功能描述的基础上展开了对系统深入研究的方案设计。

该系统（装置）主要由飞控，遥控，蓝牙或WIFI模块，通信模块等组成。

飞控是由stm32f103作为主控，采用MPU6050作为惯性测量单元。

遥控是由arduino作为主控。

通信运用2.4G无线模块。

在AD环境中完成对飞控的的设计。

在keil 5中完成软件的设计。

然后，通过proteus软件完成飞控的模块的仿真与调试。

最后，分析了项目的计划完成情况。

关键词：四轴飞行器控制 stm32 通信设计引言随着社会的发展和科技的进步，我们迎来了新的时代。

在这个高速发展时代，所有的物品都在日新月异的变化。

我们小时候的纸飞机玩具变成了现在的遥控飞机，其中的四轴飞行器备受大众喜欢。

但是四轴飞行器的用处还有多，如林业，侦察，航拍，运输，娱乐观赏等领域，目前热门的航拍就是基于稳定四轴及云台搭建的平台实现，然后其他邻域应用还有相当的潜力。

四轴飞行器将会是很有潜力和未来需求的，代替人类运输，派遣去危险的地方拍摄，或者是交通，个人飞行器等等。

所以四轴飞行器以后一定可以成为主流产品，在生活的方方面面都可能会用到。

1项目1.1 项目描述近年来,国内科技领域对四轴飞行器的研究如火如荼,相关技术得到了迅速的发展。

随着信息化时代的蓬勃发展, 科学技术不断更新, 飞行器被广泛的应用在军事侦查、航拍以及民用快递运输等诸多行业。

四轴飞行器结构简单,操作灵活,单位体积内可提供巨大的升力,适合在狭窄环境中飞行,携带各种电子设备可执行各种任务,例如军事侦察、定位跟踪、农田监测等,在军事、民用等领域均有广泛的应用和广阔的前景。

本项目设计了一种基于STM32的微型四轴飞行器控制系统,以STM32单片机为主控制器,MPU6050为惯性测量单元模块核心,3.7V锂电池供电,通过蓝牙模块或wifi模块实现在手机App上来控制飞行器，或者通过自制遥控器来控制。

四旋翼飞行器飞行控制技术综述四旋翼飞行器是一种利用四个独立旋转的螺旋桨来实现飞行的航空器。

它可以垂直起降，并且具有灵活的飞行能力，因此在无人机、航拍等领域得到了广泛的应用。

要保证四旋翼飞行器的安全飞行，飞行控制技术起着至关重要的作用。

本文将对四旋翼飞行器的飞行控制技术进行综述，包括飞行原理、飞行控制系统、姿态稳定控制、导航控制、避障技术等方面的内容。

一、飞行原理四旋翼飞行器的飞行原理是利用四个螺旋桨产生的升力来支撑整个飞行器，再通过改变螺旋桨的转速和倾斜角来实现飞行方向和姿态的控制。

螺旋桨的旋转产生的气流通过空气动力学原理产生升力，从而支持飞行器的重量。

通过改变四个螺旋桨的转速和相对倾斜角，可以控制飞行器的上升、下降、向前、向后、向左、向右的运动。

利用螺旋桨的差速旋转可以实现飞行器的姿态控制，从而使得飞行器可以实现各种飞行动作。

二、飞行控制系统飞行控制系统是四旋翼飞行器的核心部件，它由传感器、处理器、执行器等多个部分组成，用于感知环境、执行控制指令，实现飞行器的姿态稳定控制、导航控制和避障等功能。

传感器用于获取飞行器的姿态、位置、速度等信息，包括加速度计、陀螺仪、磁力计、气压计等。

处理器用于处理传感器获取的数据，并根据飞行器的姿态、位置和控制指令来生成执行器的控制信号，执行器包括电动调节器和螺旋桨。

飞行控制系统的核心是飞控芯片，它是飞行控制系统的“大脑”，负责控制飞行器的姿态稳定、导航和飞行动作的执行。

常用的飞控芯片包括Pixhawk、Naze32、Ardupilot等，它们具有强大的计算能力和丰富的控制算法，可以实现飞行器的高度稳定性和精确控制。

三、姿态稳定控制姿态稳定控制是指通过控制飞行器的姿态角度来实现飞行器的稳定飞行。

四旋翼飞行器的姿态包括俯仰角、横滚角和偏航角，分别对应飞行器绕前后轴、左右轴和上下轴的转动姿态。

姿态稳定控制主要通过改变四个螺旋桨的转速和相对倾斜角来实现，可以采用PID控制算法、自适应控制算法等方法来实现。

四旋翼飞行器搭建教程（译自————加里斯.欧文）本文将带你通过建立自己的飞行控制器（飞空软件），同时教你工作的具体细节。

这些信息很难找到，特别是那些本身就不是航天工程师的人！就我个人而言，我用了六个月，因为我花费了太多的时间查找bug和调试bug，但通过这篇文章你可以短期收获同样的经验。

我会教你避开陷阱，这样你就不会像我一样浪费时间。

第一个关键是你对硬件的选择。

我选择从零开始建立自己系统，在这一阶段的时候我都不知道RC（remote controlled 遥控; radio coding 无线电编码; ）和飞行器是如何飞行的，这是一个巨大错误。

开始我以为，通过自行购买附加电路，芯片和传感器能省很多钱，结果最终我花了一大笔钱！放过自己吧，直接去购买ardupilot 2.5控制板，组装你的直升机，了解遥控，了解飞行原理，然后回到这里。

这个板子本质上是只是一个连有一些传感器Arduino（开源主控板,可查/view/1268436.htm?fr=aladdin），和我们将在这篇文章介绍的程序——我们自己编写的。

你得将所有东西连接起来，你的四旋翼飞机才能得飞：当然你也得会用优秀的arducopter软件。

本项目（ardupilot）由3D Robotics 提供赞助，这意味着他们销售所设计的硬件获利，并将所得利润回馈社区。

该软硬件是完全开源的，所有人可以免费复制下载。

你可以直接从他们那里购买，或者从Hobbyking (named HKPilot) and RCTimer (named ArduFlyer).购买相同的拷贝件。

在这篇文章中，我将假定您有ardupilot硬件——其本质上上是附传感器Arduino。

如果你选择忽视我的建议，并且建立自己的硬件，或使用Arduino电路板，那么您需要更换的底层代码（HAL库）。

我也会以为你在X配置（x型四旋翼），+ / X（两种四旋翼配置）和六/八旋翼飞行器之间切换（只是不同的电机的组合），配置的改变不会让它在本文有任何实质性的区别。

基于Arduino兼容的Stm32单片机的四旋翼飞行器设计一、引言四旋翼飞行器是近年来快速发展的一种无人机，它具有灵活、稳定、可控性强等特点，被广泛应用于各个领域，如农业、摄影、救援等。

本文将基于Arduino兼容的Stm32单片机设计一个四旋翼飞行器，包括硬件设计和主控程序编写，并对其进行测试和分析。

二、硬件设计1. 硬件平台选型我们选择Arduino兼容的Stm32单片机作为主控芯片。

Stm32系列单片机具有强大的性能和丰富的外设资源，能够满足四旋翼飞行器的实时控制要求。

2. 四旋翼结构设计我们采用X形结构的四旋翼设计，具有较好的稳定性和操控性。

每个旋翼由一个电动助力机构和一个螺旋桨组成，通过电机控制器控制电机的转速，从而控制飞行器的升降和姿态。

3. 传感器选择为了使飞行器能够感知环境和自身状态，我们选择了加速度计、陀螺仪和磁力计等传感器。

加速度计用于测量飞行器的加速度和姿态角度，陀螺仪用于测量飞行器的角速度，磁力计用于测量地磁场信息，以辅助姿态控制。

4. 通信模块选型我们选择了无线通信模块，可以实现飞行器与地面控制站的数据传输和指令控制。

5. 电源设计为了保证飞行器的稳定供电，我们设计了电源管理模块，包括电池、稳压器和电源选择开关等，以提供所需的电压和电流。

三、主控程序编写1. 启动流程飞行器在上电后，首先要进行初始化操作，包括外设初始化、传感器校准和数据校验等。

接着进入主循环，不断读取传感器数据、执行控制算法、更新电机转速和发送数据等。

2. 姿态控制算法通过读取加速度计和陀螺仪的数据，可以得到飞行器的姿态信息。

我们采用PID控制算法来控制飞行器的姿态，即通过调节电机转速来调整飞行器的姿态角度，使其保持在设定值附近，提高飞行器的稳定性。

3. 飞行控制算法飞行器的飞行控制算法主要包括高度控制、位置控制和姿态控制。

通过读取高度传感器的数据，可以得到飞行器的高度信息。

我们采用模糊控制算法来调节电机转速，控制飞行器的高度和位置。

四旋翼飞控项目日志作者：魏泽宇QQ：344395979人人：/260445660前言在大四下学期完成主体程序，大四毕业的暑假完成嵌入式操作系统的写入，现将程序发到网上开源，希望大家共同学习共同进步。

2013.8时间2013年2月2日11:57:37项目进展了这么久第一次写日志，总结一下这一段时间的经验。

首先，我通过李想的stm32教学视频对stm32进行了简单的了解，发现stm32用起来比51都方便，原来一直被“arm 难学”误导了，单片机只是工具，真正编算法才是难点，所以以后在做项目时不应该过分考虑单片机是否好用这个问题，只要适合项目的单片机就应该拿来用。

李想视频里编译环境是MDK，所以在编程时一直使用MDK编译，感觉和学51时用的keil 一模一样，比较好上手。

由于项目所要做的第一步是要做姿态解算，所以在初步了解stm32原理以后，就开始从MPU6050传感器读数据。

MPU6050是一个集成了加速度计和陀螺仪的传感器，使用I2C和单片机进行通信，总体来说读取数据还是比较简单的。

但是也遇到一些比较烦人的问题，卡了好久。

一个是变量类型搞错了这是一段读取MPU6050陀螺仪x轴数据的程序，先通过I2C函数把陀螺仪X轴数据的低8位和高8位读取出来，分别放入BUF[0]和BUF[1]中，在通过移位把两个数据合成一个数据传入G_X变量，G_X是一个short型变量，而imu_measure.gx是一个double型变量，编译器编译是自动把G_X转成double型除以16.4赋值给imu_measure.gx。

曾经犯过一个错误就是把BUF数组数据相合后直接除以16.4然后赋值给imu_measure.gx，结果通过串口传回来的数据就出现了错误。

以后要避免这种错误。

在新添加文件后要记着把文件添加进工程，否则编译会出错。

至于为什么除以16.4，参考《MPU-6050寄存器映射》第32页在MPU6050初始化时把Full Scale Range设置为±2000°/s，所以灵敏度为16.4 LSB/°/s，所以在读出寄存器值的基础上除以16.4就是角速度。