大疆无人机飞控系统的原理、组成及各传感器的作用_无人机飞控原理与结构图解(1)_大疆惯性管理单元

现将位于四旋翼机身同一对角线上的旋翼归为一组，前后端的旋翼沿顺时针方向旋转，从而可以产生顺时针方向的扭矩；而左右端旋翼沿逆时针方向旋转，从而产生逆时针方向的扭矩，如此四个旋翼旋转所产生的扭矩便可相互之间抵消掉。由此可知，四旋翼飞行器的所有姿态和位置的控制都是通过调节四个驱动电机的速度实现的。一般来说，四旋翼无人机的运动状态主要分为悬停、垂直运动、滚动运动、俯仰运动以及偏航运动五种状态。

悬停

悬停状态是四旋翼无人机具有的一个显著的特点。在悬停状态下，四个旋翼具有相等的转速，产生的上升合力正好与自身重力相等，即。并且因为旋翼转速大小相等，前后端转速和左右端转速方向相反，从而使得飞行器总扭矩为零，使得飞行器静止在空中，实现悬停状态。

垂直运动

垂直运动是五种运动状态中较为简单的一种，在保证四旋翼无人机每个旋转速度大小相等的倩况下，同时对每个旋翼增加或减小大小相等的转速，便可实现飞行器的垂直运动。当同时増加四个旋翼转速时，使得旋翼产生的总升力大小超过四旋翼无人机的重力时，即，四旋翼无人机便会垂直上升；反之，当同时减小旋翼转速时，使得每个旋翼产生的总升力小于自身重力时，即，四旋翼无人机便会垂直下降，从而实现四旋翼无人机的垂直升降控制。

翻滚运动

翻滚运动是在保持四旋翼无人机前后端旋翼转速不变的情况下，通过改变左右端的旋翼转速，使得左右旋翼之间形成一定的升力差，从而使得沿飞行器机体左右对称轴上产生一定力矩，导致在方向上产生角加速度实现控制的。如图2.3所示，增加旋翼1的转速，减小旋翼3的转速，则飞行器倾斜于右侧飞行；相反，减小旋翼４，增加旋翼２，则飞行器向左倾斜飞行。

俯仰运动

四旋翼飞行器的俯仰运动和滚动运动相似，是在保持机身左右端旋翼转速不变的前提下，通过改变前后端旋翼转速形成前后旋翼升力差，从而在机身前后端对称轴上形成一定力矩，引起角方向上的角加速度实现控制的。如图2.4所示，增加旋翼３的转速，减小旋翼１的转速，则飞行器向前倾斜飞行；反之，则飞行器向后倾斜。

偏航运动

四旋翼的偏转运动是通过同时两两控制四个旋翼转速实现控制的。保持前后端或左右端旋翼转速相同时，其便不会发生俯仰或滚动运动；而当每组内的两个旋翼与另一组旋翼转速不同时，由于两组旋翼旋转方向不同，便会导致反扭矩力的不平衡，此时便会产生绕机身中心轴的反作用力，引起沿角角加速度。如图2.3所示，当前后端旋翼的转速相等并大于左右端旋翼转速时，因为前者沿顺时针方向旋转，后者相反，总的反扭矩沿逆时针方向，反作用力作用在机身中心轴上沿逆时针方向，引起逆时针偏航运动；反之，则会引起飞行器的顺时针偏航运动。

综上所述，四旋翼无人机的各个飞行状态的控制是通过控制对称的四个旋翼的转速，形成相应不同的运动组合实现的。但是在飞行过程中却有六个自由度输出，因此它是一种典型的欠驱动，强耦合的非线性系统。例如，旋翼1的转速会导致无人机向左翻滚，同时逆时针转动的力矩会大于顺时针的力矩，从而进一步使得无人机向左偏航，此外翻滚又会导致无人机的向左平移，可以看出，四旋翼无人机的姿态和平动是耦合的。

四旋翼无人机自主飞行的控制

四旋翼无人机的精确航迹跟踪是实现无人机自主飞行的基本要求。由于四旋翼无人机自身存在姿态与平动的耦合关系以及模型参数不确定性与外界扰动，因此只有实现姿态的稳定控制才能完成航迹的有效跟踪。

在四旋翼无人机的自主控制系统中，姿态稳定控制是实现飞行器自主飞行的基础。其任务是控制四旋翼无人机的三个姿态角（俯仰角、滚转角、偏航角）稳定地跟踪期望姿态信号，并保证闭环姿态系统具有期望的动态特性。由于四旋翼无人机姿态与平动的耦合特点，分析可以得知，只有保证姿态达到稳定控制，才使得旋翼总升力在期望的方向上产生分量，进而控制飞行器沿期望的航迹方向飞行。而四旋翼无人机的姿态在实际飞行环境中回受到外界干扰和不精确模型的参数误差、测量噪声等未建模动态对控制效果的影响。所以，需要引入适当的观测器和控制器对总的不确定性进行估计和补偿，并对其估计的误差进行补偿，来保证四旋翼无人机在外界存在干扰下对姿态的有效跟踪。

四旋翼无人机的姿态控制应根据其实际的工作特性以及动力学模型，进而针对姿态的三个通道（俯仰，翻滚和偏航）分别设计姿态控制器，每个通道中都对应引入相应的控制器，其流程如下所示。

此方法可以基本保证每个通道的实际姿态值跟踪上期望值。但是，在只考虑对模型本身进行控制时，没有考虑到外部不确定性对闭环系统的影响。微小型无人机在飞行时，由于机体较小，电机的振动较强，很容易受到外界环境的干扰。因此，整个通道中必然存在不确定因素，比如模型误差、环境干扰、观测误差等，这些不确定性将降低系统的闭环性能。所以在设计无人机控制系统时，必须要考虑系统的抗干扰性能，即闭环系统的鲁棒性。因此需要设计一定的干扰补偿器对干扰进行逼近和补偿，以实现姿态角的稳定跟踪。

只有在保证飞机姿态可以保持稳定才能进一步讨论如何控制路径保持稳定，在时间尺度上进行分析，飞机的姿态角变化的频率要大于飞机位置的频率。所以，针对轨迹跟踪应当使用内外双环控制，内环控制姿态角，外环控制位置。

无人机飞控系统组成及作用

IMU惯性测量单元

现在的飞控内部使用的都是由三轴陀螺仪，三轴加速度计，三轴地磁传感器和气压计组成的一个IMU，也称惯性测量单元。那么什么是三轴陀螺仪，什么是三轴加速度计，什么是三轴地磁传感器呢，什么是气压计呢？它们在飞机上起到的是什么作用呢，这三轴又是哪三个轴呢？

三轴陀螺仪，三轴加速度计，三轴地磁传感器中的三轴指的就是飞机左右，前后垂直方向上下这三个轴，一般都用XYZ来代表。左右方向在飞机中叫做横滚，前后方向在飞机中叫做俯仰，垂直方向就是Z轴。陀螺都知道，小时候基本上都玩过，在不转动的情况下它很难站在地上，只有转动起来了，它才会站立在地上，或者说自行车，轮子越大越重的车子就越稳定，转弯的时候明显能够感觉到一股阻力，这就是陀螺效应，根据陀螺效应，聪明的人们发明出的陀螺仪。最早的陀螺仪是一个高速旋转的陀螺，通过三个灵活的轴将这个陀螺固定在一个框架中，无论外部框架怎么转动，中间高速旋转的陀螺始终保持一个姿态。通过三个轴上的传感器就能够计算出外部框架旋转的度数等数据。

由于成本高，机械结构的复杂，现在都被电子陀螺仪代替，电子陀螺仪的优势就是成本低，体积小重量轻，只有几克重，稳定性还有精度都比机械陀螺高。说道这，大家也就明白陀螺仪在飞控中起到的作用了吧，它就是测量XYZ三个轴的倾角的。

那么三轴加速度计时干什么的呢？刚刚说道三轴陀螺仪就是XYZ三个轴，现在不用说也就明白三轴加速度计也是XYZ三个轴。当我们开车起步的一瞬间就会感到背后有一股推力，这股推力呢就是加速度，加速度是速度变化量与发生这一变化时间的比值，是描述物体变化快慢的物理量，米每二次方秒，例如一辆车在停止状态下，它的加速度是0，起步后，从每秒0米到每秒10米，用时10秒，这就是这辆车的加速度，如果车速每秒10米的速度行驶，它的加速度就是0，同样，用10秒的时间减速，从每秒10米减速到每秒5米，那么它的加速就是负数。三轴加速度计就是测量飞机XYZ三个轴的加速度。

[外链图片转存失败,源站可能有防盗链机制,建议将图片保存下来直接上传(img-8rJYPCQm-1655011314509)(https://raw.githubusercontent.com/xkyvvv/blogpic3/main/img/202206121320058.jpeg)]

我们日常出行都是根据路标或记忆来寻找自己的面向的，地磁传感器就是感知地磁的，就是一个电子指南针，它可以让飞机知道自己的飞行朝向，机头朝向，找到任务位置和家的位置。气压计呢就是测量当前位置的大气压，都知道高度越高，气压越低，这就是人到高原之后为什么会有高原反应了，气压计是通过测量不同位置的气压，计算压差获得到当前的高度，这就是整个IMU惯性测量单元，它在飞机中起到的作用就是感知飞机姿态的变化，例如飞机当前是前倾还是左右倾斜，机头朝向、高度等最基本的姿态数据，那么这些数据在飞控中起到的作用是什么呢？

飞控最基本的功能控制一架飞机在空中飞行时的平衡，是由IMU测量，感知飞机当前的倾角数据通过编译器编译成电子信号，将这个信号通过信号新时时传输给飞控内部的单片机，单片机负责的是运算，根据飞机当前的数据，计算出一个补偿方向，补偿角，然后将这个补偿数据编译成电子信号，传输给舵机或电机，电机或舵机在去执行命令，完成补偿动作，然后传感器感知到飞机平稳了，将实时数据再次给单片机，单片机会停止补偿信号，这就形成了一个循环，大部分飞控基本上都是10HZ的内循环，也就是1秒刷新十次。

这就是飞控最基本的功能，如果没有此功能，当一个角一旦倾斜，那么飞机就会快速的失去平衡导致坠机，或者说没有气压计测量不到自己的高度位置就会一直加油门或者一直降油门。其次，固定翼飞控还有空速传感器，空速传感器一般位于机翼上或机头，但不会在螺旋桨后边，空速传感器就是两路测量气压的传感器，一路测量静止气压，一路测量迎风气压，在计算迎风气压与静止气压的压差就可以算出当前的空气流速。

[外链图片转存失败,源站可能有防盗链机制,建议将图片保存下来直接上传(img-9YIG5Cca-1655011314509)(https://raw.githubusercontent.com/xkyvvv/blogpic3/main/img/202206121320382.jpeg)]

有了最基本的平衡、定高和指南针等功能，还不足以让一家飞机能够自主导航，就像我们去某个商场一样，首先我们需要知道商场的所在位置，知道自己所在的位置，然后根据交通情况规划路线。飞控也亦然，首先飞控需要知道自己所在位置，那就需要定位的，也就是我们常说的GPS，现在定位的有GPS、北斗、手机网络等定位系统，但是这里面手机网络定位是最差的，误差好的话几十米，不好的话上千米，这种误差是飞控无法接受的，由于GPS定位系统较早，在加上是开放的，所以大部分飞控采用的都是GPS，也有少数采用的北斗定位。精度基本都在3米内，一般开阔地都是50厘米左右，因环境干扰，或建筑物、树木之类的遮挡，定位可能会差，很有可能定位的是虚假信号。这也就是为什么民用无人机频频坠机、飞丢的一个主要原因。

GPS定位

GPS定位原理就是三点定位，天上的GPS定位卫星距离地球表面22500千米处，它们所运动的轨道正好形成一个网状面，也就是说在地球上的任意一点，都有可以同时收到3颗以上的卫星信号。卫星在运动的过程中会一直不断的发出电波信号，信号中包含数据包，其中就有时间信号。GPS接收机通过解算来自多颗卫星的数据包，以及时间信号，可以清楚的计算出自己与每一颗卫星的距离，使用三角向量关系计算出自己所在的位置。GPS也定位了，数据也有了，这个信号也会通过一个编译器在次编译成一个电子信号传给飞控，让飞控知道自己所在的位置、任务的位置和距离、家的位置和距离以及当前的速度和高度，然后再由飞控驾驶飞机飞向任务位置或回家。

[外链图片转存失败,源站可能有防盗链机制,建议将图片保存下来直接上传(img-y0ZjmNuD-1655011314510)(https://raw.githubusercontent.com/xkyvvv/blogpic3/main/img/202206121320440.jpeg)]

刚刚我们也说了，GPS能够测速也能够测高度，为什么要有气压计和空速计呢？这就是为了消除误差，飞机飞起来是不与地面接触的，直接接触的是空气，假设飞行环境是无风的环境，飞机在地面滑跑加速，加速到每秒20米的速度然后再拉升降舵起飞，这样GPS测量到的数值是准确的，但是要是逆风呢，是因为机翼与空气相对的运动达到了一定的速度才能够产生一定的升力让飞机起飞，如果在逆风环境下，风速每秒10米，飞机只需要加速到每秒10米就可以正常离地了，如果加速到每秒20米，相对空气的速度已经达到了每秒30米，或者说顺风起飞，风速每秒20米，飞机GPS测速也达到了20m/s的速度，这个时候拉升降舵，飞机动都不会动，因为相对空气速度是0米，达不到起飞条件，必须加速到每秒40米的时候才能达到升力起飞。

这就是空速计的作用，GPS测量的只是地速，刚刚降到，GPS也可以定高，第一GPS定位精度是3米内，也就是说飞控能感知到的是平面方向的两倍误差，信号不好的话十几米都有可能，还有GPS不定位的时候，另外GPS定高数据是海拔高度并不是地面垂直高度，所以GPS定高在飞控中不管用。有了GPS飞控也知道飞机位置了，也知道家的位置和任务位置，但是飞控上的任务以及家的位置飞控是怎么知道的呢，这就是地面站的作用。

地面站

地面站，就是在地面的基站，也就是指挥飞机的，地面站可以分为单点地面站或者多点地面站，像民航机场就是地面站，全国甚至全球所有的地面站都在时时联网，它们能够清楚的知道天上在飞行的飞机，并能时时监测到飞机当前的飞行路线，状况，以及飞机的时时调度等。像我们用的无人机大部分都是单点地面站，单点地面站一般由一到多个人值守，有技术员，场务人员，后勤员，通信员，指挥员等人组成。像玩家一般都是一个人。

地面站设备组成一般都是由遥控器、电脑、视频显示器，电源系统，电台等设备组成，一般简单的来说就是一台电脑，一个电台，一个遥控，电脑上装有控制飞机的软件，通过航线规划工具规划飞机飞行的线路，并设定飞行高度，飞行速度，飞行地点，飞行任务等通过数据口连接的数传电台将任务数据编译传送至飞控中，这里就有讲到数传电台，数传电台就是数据传输电台，类似我们最和耳朵一样，好比领导说今天做什么任务，我们接受到任务并回答然后再去执行任务，执行任务的时候时实情况实时汇报给领导，这其中通信就是嘴巴和耳朵。

数传电台就是飞机与地面站通信的一个主要工具，一般的数传电台采用的接口协议有TTL接口、RS485接口和RS232接口，的不过也有一些CAN-BUS总线接口，频率有2.4GHZ、433MHZ、900MHZ、915MHZ，一般433MHZ的较多，因为433MHZ是个开放的频段，再加上433MHZ波长较长，穿透力强等优势所以大部分民用用户一般都是用的433MHZ，距离在5千米到15千米不等，甚至更远。最终达到的就是飞机与电脑间的通讯，电脑给飞机的任务，飞机时时飞行高度，速度等很多数据都会通过它来传输。以方便我们时时监控飞机情况，根据需要随时修改飞机航向。

整套无人机飞控工作原理就是地面站开机，规划航线，给飞控开机，上传航线至飞控，再设置自动起飞及降落参数，如起飞时离地速度，抬头角度（起飞攻角，也称迎角），爬升高度，结束高度，盘旋半径或直径，清空空速计等，然后检查飞控中的错误、报警，一切正常，开始起飞，盘旋几周后在开始飞向任务点，执行任务，最后在降落，一般郊外建议伞降或手动滑降，根据场地选择。飞机在飞行过程中如果偏离航线，飞控就会一直纠正这个错误，一直修正，直到复位为止。

自我介绍一下，小编13年上海交大毕业，曾经在小公司待过，也去过华为、OPPO等大厂，18年进入阿里一直到现在。

深知大多数Go语言工程师，想要提升技能，往往是自己摸索成长或者是报班学习，但对于培训机构动则几千的学费，着实压力不小。自己不成体系的自学效果低效又漫长，而且极易碰到天花板技术停滞不前！

因此收集整理了一份《2024年Go语言全套学习资料》，初衷也很简单，就是希望能够帮助到想自学提升又不知道该从何学起的朋友，同时减轻大家的负担。

既有适合小白学习的零基础资料，也有适合3年以上经验的小伙伴深入学习提升的进阶课程，基本涵盖了95%以上Golang知识点，真正体系化！

由于文件比较大，这里只是将部分目录大纲截图出来，每个节点里面都包含大厂面经、学习笔记、源码讲义、实战项目、讲解视频，并且后续会持续更新

如果你觉得这些内容对你有帮助，可以添加V获取：vip1024b （备注Go）

一个人可以走的很快，但一群人才能走的更远。不论你是正从事IT行业的老鸟或是对IT行业感兴趣的新人，都欢迎扫码加入我们的的圈子（技术交流、学习资源、职场吐槽、大厂内推、面试辅导），让我们一起学习成长！

添加V获取：vip1024b （备注Go）**
[外链图片转存中…(img-xJqqCHEk-1713023212220)]

一个人可以走的很快，但一群人才能走的更远。不论你是正从事IT行业的老鸟或是对IT行业感兴趣的新人，都欢迎扫码加入我们的的圈子（技术交流、学习资源、职场吐槽、大厂内推、面试辅导），让我们一起学习成长！