四轴飞行器主控
自制四轴飞行器之路
自制四轴飞行器之路
四轴飞行器，又称四旋翼飞行器，简称四轴、四旋翼。
四轴飞行器的四个螺旋桨与电机直接相连，通过改变电机转速获得旋转机身的力，从而调整自身姿态。
四轴的叶片转速极高，有一定的危险性，一般不能在室内飞，特别是在调试过程中更加不稳定，轻则炸鸡撞坏物品，重则伤到人。
我做四轴的主要目的是为了学习飞控算法，这个过程肯定少不了调试，为了安全，我选择做一个小一点的，手掌那么大的四轴，叶片的威力比较小，价格也便宜，即使摔坏也不心疼。
这种小四轴一般采用PCB做机架，用720空心杯电机代替无刷电机，用MOS管代替电调，电池采用3.7v锂聚合物电池（尺寸跟手机电池差不多，但是放电电流要大很多），遥控用2.4G无线模块，或者用蓝牙连接手机，成本100左右，续航时间大概6-7分钟，遥控距离在10米以内。
选择零件
四轴上最重要的就是飞控，所以第一步：选择飞控。
市面上有许多现成飞控，也可以自己用电子元件做一个分控。
有很多有名的开源飞控，例如KK，QQ，匿名，MultiWii/MWC，APM/PIX等。
KK、QQ飞控功能较少，只有基本的四轴飞行功能，甚至不支持GPS。
匿名飞控是国内新出现的飞控，功能比以上两个要多，价格也要贵很多。
MultiWii/MWC飞控是基于arduino的，支持GPS，能路线规划，在线调试。
APM也是基于arduino的，功能更为齐全，硬件也更为复杂，飞控中有两块单片机，分别执行不同功能。
APM已将arduino的性能开发到极限，于是有了升级版PIX，从arduino 转到了STM32，处理速度提升了10倍，同样用了两块不同型号的STM32协同运作，是目前已知的最好的开源飞控。
四轴飞行器姿态控制算法
四轴飞行器姿态控制算法四轴飞行器姿态控制是指通过调整四个电机的转速，使得飞行器能够保持所需的姿态，例如平稳飞行、转弯、盘旋等。
姿态控制算法主要包括传感器采集、姿态估计和控制指令生成等几个部分。
以下将详细介绍四轴飞行器姿态控制的算法原理。
1.传感器采集：四轴飞行器通常会配备三个主要的传感器：加速度计、陀螺仪和磁力计。
加速度计用于测量飞行器的重力加速度，陀螺仪用于测量飞行器的角速度，磁力计用于测量地磁场强度。
这些传感器的数据将用于后续的姿态估计和控制。
2.姿态估计：姿态估计是根据传感器提供的数据计算出飞行器的当前姿态角。
一种常用的姿态估计方法是互补滤波器。
互补滤波器将加速度计和陀螺仪的数据进行融合，通过加速度计估计出的姿态角和陀螺仪估计出的姿态角进行加权平均，从而得到更准确的姿态估计。
3.控制指令生成：姿态控制器的目标是生成适当的转速指令，使得飞行器能够达到所需的姿态。
在四轴飞行器中，姿态控制通常分为俯仰控制、滚转控制和偏航控制三个方向。
俯仰控制用于调整飞行器的前后倾斜角度，滚转控制用于调整飞行器的左右倾斜角度，偏航控制用于调整飞行器的旋转角度。
在控制指令生成中，通常会采用PID控制器。
PID控制器根据目标姿态角和当前姿态角的误差，计算出相应的控制指令。
PID控制器包括三个参数：比例项、积分项和微分项。
比例项用于快速响应误差，积分项用于消除稳态误差，微分项用于抑制系统的振荡。
通过将三个方向的控制指令进行线性叠加，得到最终的转速指令。
转速指令将被发送到四个电机，控制它们的转速，从而实现飞行器的姿态调整。
值得注意的是，四轴飞行器还需要考虑到动力学和非线性因素。
动力学因素包括电机的动态响应和旋转惯量的影响，通常会使用动态模型进行补偿。
非线性因素包括旋翼的非线性动力学和空气动力学特性的影响，通常会采用非线性控制器进行补偿。
综上所述，四轴飞行器姿态控制算法主要包括传感器采集、姿态估计和控制指令生成等几个部分。
四轴飞行器姿态控制系统设计_刘峰
控制技术计算机测量与控制.2011.19(3) Com puter Measurement &C ontrol ·583·收稿日期:2010-07-05; 修回日期:2010-08-15。
作者简介:刘 峰(1987-),男,江西吉安人,在读硕士研究生,主要从事无人机控制技术方向的研究。
吕 强(1963-),男,博士生导师,主要从事机器人控制技术方向的研究。
文章编号:1671-4598(2011)03-0583-03 中图分类号:TP249文献标识码:A四轴飞行器姿态控制系统设计刘 峰,吕 强,王国胜,王东来(装甲兵工程学院控制工程系,北京 100072)摘要:四轴飞行器具有不稳定、非线性、强耦合等特性,姿态控制是四轴飞行器飞行控制系统的核心;通过分析四轴飞行器的飞行原理,根据其数学模型和系统的功能要求,设计了四轴飞行器的姿态控制系统;该系统采用stm32系列32位处理器作为主控制器,使用ADIS16355惯性测量单元等传感器用于姿态信息检测;系统基于模块化设计的思想,各传感器都使用数字接口进行数据交换,结构简单;使用PID 控制算法进行姿态角的闭环控制,实验结果表明,飞行器能较好的稳定在实验平台上,系统满足四轴飞行器室内飞行姿态控制的要求。
关键词:四轴飞行器;姿态控制;ST M 32Design of Attitude Control System for Q uadrotorLiu Feng ,Lv Qiang ,Wang Guo sheng ,Wang Donglai(Depar tme nt o f Co ntrol Eng ineering ,A cademy of A rmo red Fo rce Enginee ring ,Beijing 100072,China )Abstract :Quadrotor is a complex sy stem with instability ,nonlin ear and high coupling .The attitude control s ystem is the key of quadro -tor .Th e flight theory of qu adrotor is analyzed firs tly .Based on th e math ematical m odel and fligh t control requirement ,the attitu de control system of quadrotor is p roposed .A 32bits microp roces sor of S TM 32series is u sed as th e main p roces sor .The ADIS16355initial m easu re -ment unit and oth er sensors are used for attitude information detection .Based on the m odu larized des ign m ethod ,all th e sensors poss es s of digital interfaces ,w hich are simple and easy to commu nicate w ith th e m ain processor .The PID control method w as u sed for attitu de control -ling .The test results show that the qu adrotor is flyin g s table on the test bed and the sy stem is capab le of indoor attitude con trolling .Key words :quadrotor ;attitu de control ;ST M 320 引言四轴飞行器是一种具有4个对称旋翼的直升机,具有垂直起降、结构简单、操纵方便及机动灵活等优点。
四轴飞行器原理、设计与控制
四轴飞行器原理、设计与控制四轴飞行器设计与用途学院：广东白云技师学院专业：电子信息工程与电气技术（技师本科）制作学生：邹剑平指导老师：廖高灵四轴飞行器简介配置：单片机AVRATMEGA168PA三轴数字陀螺仪MPU—3050电机（无刷）XXD22121000KV电子调速器（无刷）好盈天行者40A螺旋桨1045电池格氏2200mAh11.1V25C机架DIY机架材料玻璃纤维铝合金四轴飞行器飞行原理重心的距离相等,当对角两个轴产生的升力相同时能够保证力矩的平衡,四轴不会向任何一个四轴飞行器有四个电机呈十字形排列,驱动四片桨旋转产生推力;四个电机轴距几何中方向倾转;而四个电机一对正转,一对反转的方式使得绕竖直轴方向旋转的反扭矩平衡,保证了四轴航向的稳定.此飞行控制板规定四轴电机的排布方式如图所示:前(1号),后(4号),右(3号),左(2号).1,4号电机顺时针方向旋转,2,3号电机逆时针方向旋转.四个电机的转速做相应的变化即可实现四轴横向、纵向、竖直方向和偏航方向上的运动:当四轴需要向前方运动时,2,3号电机保持转速不变,1号电机转速下降,4号电机转速上升,此时4号电机产生的升力大于1号电机的升力,四轴就会沿几何中心向前倾转,桨叶升力沿纵向的分力驱动四轴向前运动.当四轴要转向左转向时,1,4号电机转速上升,2,3号电机转速下降,使向左的反扭距大于向右的反扭矩,四轴在反扭距的作用下向左旋转.四个桨产生的推力,超过或者低于四轴本身重力的时候能够实现竖直方向上升与下降的运动,当桨的升力与四轴本身的重力相等的时候即实现悬停.其他方式的运动原理与以上过程类似.四轴飞行原理虽然简单,但实现起来还需很多工作要做.四轴飞行器控制流程图四轴飞行器的优点四轴飞行器与其他飞机比较相对稳定性高；四轴飞行器与其他飞机比较相对抗风能力强；载重量大(本机最大安全载重1100g);姿态灵活，反应速度快；可超低空飞行；四轴飞行器主要用途可做无人侦察机，空中航拍（FPV），可作为新型微型机器人。
四轴飞行器运动控制系统设计和仿真
四轴飞行器运动控制系统设计和仿真随着科技的发展，四轴飞行器这种机器在日常生活中变得越来越常见。
从无人机的航拍、救援到消防，四轴飞行器的应用越来越广泛。
但是，控制飞行器的姿态和运动依然是一个挑战。
这里将对四轴飞行器的运动控制系统进行设计和仿真。
1. 系统分析先对四轴飞行器进行简单的系统分析。
四轴飞行器有四个电机，每个电机都有一个螺旋桨。
通过改变电机的转速和螺旋桨的旋转方向，可以控制飞行器的姿态和运动。
四轴飞行器有三个自由度的旋转运动，分别是偏航、俯仰和横滚，还有三个自由度的平移运动，分别是上下、左右和前后。
控制这些运动需要一个运动控制系统。
运动控制系统分为两部分：飞行器的传感器和飞行控制器。
传感器用于测量飞行器的状态，例如角速度、角度和线性加速度等。
飞行控制器根据传感器的数据进行控制，以达到控制飞行器运动的目的。
2. 控制算法运动控制系统的重点在于控制算法。
幸运的是，我们可以使用开源的四轴飞行控制器（例如 Pixhawk 和 APM）来控制飞行器。
这些控制器具有成熟的控制算法，可实现飞行器的稳定飞行和自动飞行。
在四轴飞行器的运动控制中，最重要的算法是控制飞行器的姿态。
姿态控制是通过测量三个轴上的角度和角速度实现的。
姿态控制经常使用 PID 控制器。
PID 控制器使用比例、积分和微分三个控制项来控制飞行器的姿态。
3. 系统设计接下来，我们将设计一个四轴飞行器的运动控制系统。
这里主要讨论的是控制器的硬件和软件设计。
3.1 硬件设计飞行控制器通常使用 Arduino 或者其他类似的微控制器。
这些微控制器轻便、可编程并且能够进行必要的计算。
除了微控制器，飞行控制器还应该包含其他必要的硬件，例如传感器、接收器和电池等。
传感器是测量飞行器状态的重要组成部分。
飞行器通常使用加速度计、陀螺仪和罗盘。
加速度计可以测量飞行器在三个轴上的线性加速度，陀螺仪可以测量飞行器在三个轴上的角速度，罗盘可以测量飞行器的方向。
接收器则负责接收运动控制器发出的指令，例如俯仰、横滚和油门等。
四轴无人机飞控及航拍应用解决方案
Mini54ZDE
ARM Cortex-M0 ,24MHz 16K Flash/2KRAM
TSSOP20封装
低阶玩具小四轴
入门航模小四轴
Cortex-M0
Cortex-M4
新唐无人机系统
2.4G 无线收发
电机控制
遥控手把 N79E814
飞控主板 M452
BLDC 电调 Mini54
新唐无人机飞控主板特点
256kB
M452
ARM Cortex-M4 ,84MHz 256K Flash/32KRAM
Mini58ZDE
32kB
ARM Cortex-M0 ,50MHz 32K Flash/4KRAM
高阶航模飞控 提供完整参考设计与源代码
中阶航模小四轴
Mini54FHC
16kB
ARM Cortex-M0 ,24MHz 16K Flash/2KRAM
采用新唐 Cortex®-M4 单片机 M452 支持线上飞行姿态 PID 调适与传感器校准 10 轴传感器运算、500Hz 传感器融合更新率 支持定高 (气压计)、无头模式 (电子罗盘) 支持 2.4G 专用遥控模块、市售通用发射机接收机 支持失控保护、自动降落 支持各式大小轴距机架
4.5cm
5.8G 模拟调变 • 320*240 • 640*480
盲拍 NA
•可另加模块，达成手 机观看功能
• N32905
• 640*480 (MJPEG) •支持本地储存 • 720P (H264)
• N32901 • N32903
2.5cm
4.5cm
新唐航拍系统方块图 轻易完成 简洁、小型系统
N329
新唐无人机开发工具
tb509四轴飞行器操作说明
tb509四轴飞行器操作说明一、前言tb509四轴飞行器是一款智能无人机，具有飞行稳定、控制灵活、操作简单等特点。
本文将为您介绍如何操作tb509四轴飞行器，以帮助您快速上手并享受飞行乐趣。
二、准备工作在操作tb509四轴飞行器之前，您需要做一些准备工作：1. 确保四轴飞行器电量充足，可通过充电器将电池充满。
2. 根据实际情况选择飞行器的飞行模式，如室内模式或室外模式。
3. 找到一个开阔平坦的地方进行飞行，远离人群和障碍物。
三、操作步骤1. 打开遥控器电源，并将遥控器与四轴飞行器进行配对。
通常情况下，遥控器与飞行器的配对方式是通过按下遥控器上的配对按钮，并同时按下飞行器上的配对按钮，直到指示灯闪烁表示配对成功。
2. 将遥控器上的油门杆推到最低位置，此时四轴飞行器处于待机状态。
3. 将飞行器放在离地面约1米左右的位置，确保四轴飞行器周围没有人或障碍物。
4. 缓慢将遥控器上的油门杆推到最高位置，四轴飞行器将开始起飞。
在起飞过程中，您可以通过遥控器上的方向杆控制飞行器的方向，左右移动方向杆可使飞行器左右平移，前后移动方向杆可使飞行器前进或后退。
5. 在飞行过程中，您可以通过遥控器上的油门杆控制飞行器的高度，将油门杆推到合适的位置，飞行器将保持稳定的飞行高度。
6. 当您想要降落时，将遥控器上的油门杆缓慢推到最低位置，四轴飞行器将自动降落。
在降落过程中，您可以通过遥控器上的方向杆控制飞行器的位置，确保飞行器安全降落。
7. 在飞行过程中，如果遇到紧急情况或需要停止飞行，您可以通过按下遥控器上的紧急停止按钮，四轴飞行器将立即停止飞行并降落。
四、注意事项在操作tb509四轴飞行器时，需要注意以下事项：1. 在刚开始操作时，建议选择较为开阔的地方进行飞行，避免飞行器与障碍物碰撞。
2. 飞行器飞行高度不宜过高，以免造成飞行器失控或掉落。
3. 飞行器飞行距离不宜过远，以免失去遥控信号，导致飞行器无法控制。
4. 飞行器飞行时间有限，一般在10至15分钟左右，建议及时降落更换电池。
四轴飞行器的飞行原理
四轴飞行器的飞行原理一、概述四轴飞行器是一种利用四个电动机驱动的飞行设备，通过对电动机的速度和方向进行控制，能够实现稳定飞行、悬停、俯仰、横滚等动作。
它的飞行原理基于空气动力学和运动控制理论，结合先进的传感器和控制算法，能够实现精准控制和灵活操控。
二、四轴飞行器的构造四轴飞行器由四个电动机、电调、螺旋桨、机架、飞控系统和电源等组成。
其中，电动机通过螺旋桨产生升力，同时通过电调控制电机的转速，实现飞行器的稳定和动作控制。
机架起到支撑和保护的作用，飞控系统则是飞行器的大脑，负责接收传感器数据并进行处理，输出控制指令。
三、飞行原理四轴飞行器的飞行原理主要基于以下两个关键概念：升力和稳定控制。
3.1 升力四轴飞行器通过改变四个电动机的转速来调整升力的大小和方向。
电动机通过螺旋桨产生的气流，根据牛顿第三定律，产生一个与气流方向相反的反作用力，即升力。
通过改变四个电动机的转速，可以调整螺旋桨产生的气流的大小和方向，从而调整升力。
当升力大于重力时，飞行器就能够向上飞行；当升力等于重力时，飞行器就能够悬停在空中；当升力小于重力时，飞行器就会下降。
3.2 稳定控制四轴飞行器在飞行过程中需要保持稳定，即能够自动调整姿态并抵消外部扰动。
为了实现稳定控制，需要借助传感器和控制算法。
3.2.1 传感器四轴飞行器通常配备了加速度计、陀螺仪、磁力计和气压计等传感器。
加速度计用于测量飞行器的加速度，陀螺仪用于测量飞行器的角速度，磁力计用于测量地磁场的方向，气压计用于测量大气压强。
通过获取这些传感器数据，可以实时监测飞行器的状态。
3.2.2 控制算法通过对传感器数据的分析和处理，结合控制算法，可以实现飞行器的稳定控制。
常用的控制算法有PID控制算法和模糊控制算法等。
PID控制算法通过比较实际姿态和期望姿态之间的差异，计算出控制指令，从而调整电机的转速，保持飞行器的稳定。
模糊控制算法则通过模糊推理，根据一系列规则和输入输出的关系，计算出控制指令。
以STM32F4为控制核心的四轴航拍飞行器的设计与实现
以STM32F4为控制核心的四轴航拍飞行器的设计与实现摘要本设计是基于STM32F4的四轴航拍平台。
以STM32F407为控制核心，四轴飞行器为载体，辅以云台的航拍系统。
硬件上由飞控电路，电源管理，通信模块，动力系统，机架，云台伺服系统组成。
算法上采用简洁稳定的四元数加互补滤波作为姿态解算算法，PID作为控制器，实现飞行，云台增稳等功能。
具有灵活轻盈，延展性，适应性强好等特点。
1.引言四轴飞行器是一种利用四个旋翼作为飞行引擎来进行空中飞行的飞行器。
进入20世纪以来，电子技术飞速发展四轴飞行器开始走向小型化，并融入了人工智能，使其发展趋于无人机，智能机器人。
四轴飞行器不但实现了直升机的垂直升降的飞行性能，同时也在一定程度上降低了飞行器机械结构的设计难度。
四轴飞行器的平衡控制系统由各类惯性传感器组成。
在制作过程中，对整体机身的中心、对称性以及电机性能要求较低，这也正是制作四轴飞行器的优势所在，而且相较于固定翼飞机，四轴也有着可垂直起降，机动性好，易维护等优点。
在实际应用方面，四轴飞行器可以在复杂、危险的环境下可以完成特定的飞行任务，也可以用于监控交通，环境等。
比如，在四轴飞行器上安装甲烷等有害气体的检测装置，则可以在高空定点地检测有害气体；进入辐射区检查核设施；做军事侦察；甚至搬运材料，搭建房屋等等。
本设计利用四轴搭载云台实现航拍任务，当然经过改装也可以执行其他任务。
本设计主要研究了四轴飞行器的姿态结算和飞行控制，并设计制作了一架四轴飞行器，对关键传感器做了标定，并利用用matlab分析数据，设计算法，还进行了单通道平衡试验调试，进行试飞实验取得了一定的效果。
2.系统方案本设计采用STM32F4作为核心处理器，该处理器内核架构ARM Cortex-M4，具有高性能、低成本、低功耗等特点。
主控板包括传感器MPU6050电路模块、无线蓝牙模块、电机启动模块，电源管理模块等；遥控使用商品遥控及接收机。
控制芯片捕获接收机的PPM命令信号，传感器与控制芯片之间采用IIC总线连接，MCU与电调之间用PWM传递控制信号。
四轴飞行器简介
temp10[i][j]=Kg[i]*H[j];
for(i=0;i<2;i++)
for(j=0;j<2;j++)
temp11[i][j]=1-temp10[i][j];
for(i=0;i<2;i++)
for(j=0;j<2;j++)
{
for(k=0;k<2;k++)
P_optimal[i][j]+=temp11[i][k]*P_estimate[k][j];
Q为系统过程中的协方差
至此，已经有了现在状态的预测结果，接下来收集现在状态的测量值，结合预测值和测量值最后得出现在K时刻的最优估计值X(K|K)
第三步：
得到最优估计值之前需要将卡尔曼增益求出来：
第四步：
求出K时刻的最优估计值X(K|K)：
X(K|K)=X(K|K-1)+ *[Z(K)-H*X(K|K-1)]
CNC碳管固定座4个
3k 12MM全碳碳管4根
铝合金机身板2块
塑料脚架1对
效果图如下：
图2.1四轴飞行器效果图
第三章
硬件的基本模块主要包括：控制模块、传感器模块、通讯模块、电机驱动模块这四大模块。
4.1控制模块
控制模块这部分需要处理数据，并作出控制决策。控制器只用过单片机，由于缺乏经验，要参考老师的意见。
第五步：
计算最优估计值的协方差P(K|K)：
P(K|K)=[I- *H]*P(K|K-1)
试着编了一下程序：其中输入参数为经过处理转化后的加速度的角度，陀螺仪的角速度