深圳天鹰兄弟无人机创新有限公司
Eagle Brothers UAV Innovation
Speaker黄锦山Albert Vol.02 技术分享 · Internal Talks
Vol. 02 · Quadcopter Flight Controller

飞行之脑
藏在一块板上

Flight Controller Principles · 四旋翼无人机的大脑

四旋翼在物理上无法自行保持平衡——它本质就是一支立起来的铅笔,任何扰动都让它倒下。让它稳定悬停、优雅飞行的秘密,是一块手掌大小的电路板:飞行控制器。它在每一毫秒里完成感知、判断、修正的循环。

飞行员控制的从来不是无人机,而是飞控"想要达到的姿态"。 — 控制论的浪漫
N FC M1 M2 M3 M4
Chapter 01

它究竟在做什么

Overview · The Brain in the Sky

飞行控制器是四旋翼无人机的中枢——在人类眨眼的时间里,它已经完成了上百次感知、判断与修正。

想象一个倒立的摆:任何微小的扰动都会让它倾倒。四旋翼本质就是这样——四个向下吹风的螺旋桨撑起一个平台,空气是柔软的、气流是紊乱的,任何一丝不对称都会让它翻滚坠地。

飞控在每一毫秒都在问自己三个问题:我现在处于什么姿态?飞行员希望我处于什么姿态?要从现在到达那里,四个电机应该各自转多快?

它通过 IMU 等多种传感器"感知"机身状态,通过 PID 算法"思考"修正策略,通过电机混控器把决策"分配"给四个螺旋桨。人类的操作只是给它一个目标,剩下的所有细节它自己完成。

感知 Sense 思考 Think 执行 Act loop ∞
Chapter 02

七种感官

Sensors · How the FC Perceives the World

飞控无法直接"看见"天空。它依靠多种传感器各自提供一小片信息,再通过数据融合拼成对世界的理解。每种传感器都有自己擅长的事,也都有自己的盲点。

Sensor · 01

加速度计Accelerometer

— 感知重力的方向
m g TILTED 18° gravity always points "down"

加速度计本质上是一个装在小盒子里的"弹簧+小球"结构——小球因惯性偏移,弹簧的形变被电容式或压电式传感器读取,从而测出三个方向上的加速度。

当无人机静止或匀速时,它上面唯一存在的加速度就是重力(约 9.8 m/s²)。重力永远指向地心,因此加速度计能通过重力矢量在机身三个轴上的分量,反推出机身相对水平面的倾斜角度。这是"水平"这一概念在飞控中的物理来源。

擅长
  • 长期稳定的姿态基准——只要重力存在,它就能永远告诉飞控"哪里是下方",不会漂移。
  • 检测冲击与坠落——突然的大加速度可以触发保护逻辑。
弱点
  • 对振动极度敏感——螺旋桨和电机的高频振动会污染读数,因此飞控必须对加速度计数据做低通滤波。
  • 无法区分重力与机动加速度——急加速、转弯时,机动力和重力会叠加,短时间内读数会"骗人"。
单独使用加速度计,无人机会在任何机动中以为自己"歪了"并疯狂修正。所以它必须和陀螺仪搭档。
Sensor · 02

陀螺仪Gyroscope

— 感知转动的快慢
Roll 滚转 Pitch 俯仰 Yaw 偏航 THREE AXES OF ROTATION

陀螺仪测量的是角速度——也就是机身每秒转动多少度。它不知道"你现在朝哪里",只知道"你正在以多快的速度转"。

现代飞控使用的 MEMS(微机电)陀螺仪,原理是一个以高频振动的微小梳齿结构。当机身转动时,振动方向会因科里奥利力发生偏移,偏移量正比于角速度。

擅长
  • 极短时间内的高精度——每一次采样都非常准,适合捕捉飞机姿态的瞬时变化。
  • 不受加速度干扰——飞机怎么动都没关系,它只关心转得快不快。
弱点
  • 会漂移——角速度经过积分得到角度,微小的误差会随时间累积。几秒钟后,"你转了 30 度"可能实际变成了 33 度。
  • 没有绝对参考——它不知道哪里是水平,也不知道哪里是北。
陀螺仪和加速度计是一对黄金搭档。陀螺仪提供短时间的精确变化,加速度计提供长期的重力基准,两者通过卡尔曼滤波或互补滤波融合,得到稳定且精确的姿态估计。
Sensor · 03

磁力计Magnetometer

— 感知地球磁场
N S E W EARTH MAGNETIC FIELD

磁力计是飞控里的"电子罗盘"。它测量的是地球磁场在三个坐标轴上的分量,从而算出机头指向哪个方向——这是陀螺仪无法独自告诉你的信息。

陀螺仪可以告诉飞控"你刚才向左转了 30°",但如果系统一上电时就不知道初始朝向,陀螺仪就永远也算不出"你现在朝哪里"。磁力计提供的正是这个绝对的航向参考。

擅长
  • 提供绝对航向——修正陀螺仪的长期漂移,让飞控知道"正北在哪"。
  • GPS 的伙伴——当 GPS 告诉飞机要向东飞时,磁力计是保证它真的能朝东飞的关键。
弱点
  • 易受电磁干扰——电机电流、电池大电流线都会产生磁场,污染读数。因此磁力计常安装在 GPS 天线杆上,远离机身。
  • 需要校准——每次安装或更换位置后,必须进行"8 字"校准来消除周围铁磁物质的影响。
  • 会被环境欺骗——室内钢筋结构、大型金属物件、高压线附近都会让读数失真。
Sensor · 04

气压计Barometer

— 通过气压推算海拔
700 hPa 850 hPa 950 hPa 1013 hPa 3000m 1500m 500m 0m Δh PRESSURE DECREASES WITH ALTITUDE

随着海拔上升,空气变稀薄、大气压降低——这是一条物理定律,也是气压计工作的基础。飞控通过测量绝对气压,反推出当前的相对海拔高度。

现代 MEMS 气压计可以分辨出低至几帕斯卡的压力变化,对应的高度分辨率可达 10 厘米左右。这在"定高悬停"功能中扮演关键角色。

擅长
  • 提供海拔高度信息——不依赖 GPS,在任何环境都可用。
  • 长期高度基准——只要大气条件稳定,它的测量不会漂移。
弱点
  • 对气流极度敏感——螺旋桨下洗气流会改变传感器附近的压力,因此气压计通常要覆盖一层泡沫防护。
  • 受天气影响——大气压本身会随天气变化而缓慢漂移,几小时内可能导致数米误差。
  • 起飞点即"零点"——它测的是相对高度,不是海平面高度,需要以起飞点为基准。
气压计测到的是"离起飞点有多高",不是"离地面有多高"。如果你从山顶起飞飞到山谷上方,它会告诉你"高度在下降",但你其实离下面的地面更远了。
Sensor · 05

卫星定位GNSS

— 获取在地球上的绝对位置
35.6762°N 139.6503°E GPS · GLONASS · GALILEO · BEIDOU

GNSS(Global Navigation Satellite System)是多种卫星导航系统的统称——包括美国 GPS、俄罗斯 GLONASS、欧盟 Galileo、中国北斗。模块通过接收至少 4 颗卫星的信号,解算出自己在地球上的经度、纬度与高度。

原理是"三球定位":每颗卫星都在广播自己当前的位置和精确时间戳,模块通过信号到达的时间差乘以光速,算出到每颗卫星的距离,再用几何方法求交。

擅长
  • 绝对位置——它是飞控唯一知道"自己在地球的哪里"的传感器,是返航、航点飞行、地理围栏的基础。
  • 精确速度——通过多普勒频移直接测出对地速度,比对位置求导更准。
弱点
  • 更新率低——通常只有 5-20 Hz,远不如 IMU 的上千 Hz,所以只适合做"全局参考",不适合做快速控制。
  • 室内或树下失效——信号穿透力弱,高楼之间会"多径干扰"导致位置跳变。
  • 冷启动慢——初次搜星可能需要 30 秒到几分钟,且需要至少 6 颗卫星才能稳定锁定。
消费级 GPS 模块的水平精度约 2-3 米,垂直精度更差。使用 RTK(实时差分)技术可以达到厘米级,这是专业测绘无人机的核心能力。
Sensor · 06

光流Optical Flow

— 通过视觉估计水平速度
frame t frame t+1 DOWNWARD CAMERA

光流传感器是一颗朝下的小型摄像头,配合专用图像处理芯片。它每秒拍摄上百帧地面图像,通过比较相邻两帧之间像素的移动方向和距离,推算出飞机的水平移动速度。

这和人类盯着地面判断自己走得有多快的直觉是一样的——当你看到地面的花纹快速向后掠过,你就知道自己在向前移动。

擅长
  • 无 GPS 时的定点悬停——在室内、树下、桥下这些 GPS 失效的场所,光流是让无人机"站稳"的关键。
  • 更新率高——通常 100-200 Hz,可以参与较快的控制环。
  • 被动、不发射信号——不会和其他设备冲突。
弱点
  • 依赖地面纹理——纯色地板、平静水面、积雪等没有特征的表面会让它"失明"。
  • 对光照敏感——光线太暗或太亮都会影响成像质量。
  • 需要知道高度——同样的像素偏移,高度越高代表实际移动越远。所以光流几乎总是和 TOF 测距仪搭配使用。
Sensor · 07

TOF 测距Time of Flight

— 测量离下方物体的精确距离
d = ? d = c · Δt / 2

TOF(Time of Flight)测距传感器向下发射一束激光或红外光脉冲,测量光击中物体后反射回来的时间差。光速是已知常数,时间乘以光速再除以 2,就是传感器到物体的精确距离。

相比气压计测的"相对起飞点的高度",TOF 测的是"离正下方地面的真实距离"——这个区别在起飞点和地形不一致时至关重要。

擅长
  • 贴地精准高度——低空飞行、自动降落、精准悬停的核心。气压计告诉你"相对起飞点高 50 米",TOF 告诉你"脚下还有 1.2 米"。
  • 地形跟随——在起伏地面上保持恒定离地高度飞行,植保无人机的关键能力。
  • 光流的搭档——给光流提供真实高度,让像素位移能换算成真实速度。
弱点
  • 量程有限——消费级 TOF 一般只能测到 4-8 米,更远的可以到 40 米。超过量程就无效了。
  • 怕强光和特殊表面——阳光直射、镜面、透明物体、深色吸光地面都可能让它读数异常。
  • 只测一个点——它不像相机那样能看见"地面的形状",只能告诉你正下方一小块区域的距离。
光流 + TOF 几乎是室内飞行的黄金组合:TOF 给出高度,光流给出水平速度,共同构建一套不依赖 GPS 的"视觉惯性"定位系统。
Chapter 03

永不停止的循环

Closed Loop · Sense → Decide → Act → Sense Again

飞控的核心逻辑是一个闭环控制系统:测量、比较、修正、再测量。每秒重复数千次。

CLOSED-LOOP CONTROL 目标姿态 setpoint + − 误差 控制算法 PID controller 电机混控 mixer 飞机本体 plant 传感器 sensors feedback · 回传实测姿态
一
读取指令

从遥控器接收机得到飞行员的目标姿态。

二
计算误差

目标值减去当前实测值,得到偏差。

三
控制决策

根据误差,用 PID 等控制算法计算修正量。

四
电机混控

把修正量翻译成四个电机各自的转速指令。

五
重新测量

传感器读取新姿态,作为下一轮的输入。

Chapter 04

PID 的三种时态

P · I · D — Now, Past, Future

P 看现在,I 看过去,D 看未来。三个简单的数学运算加在一起,构成了控制论中最优雅也最实用的算法。

目标 P 过大 · 振荡 P 过小 · 迟钝 调校良好 t₀ t θ STEP RESPONSE · 阶跃响应
P

比例 Proportional · 现在

误差有多大,修正就有多猛。P 值决定了飞机"追目标"的积极程度——太小会懒洋洋,太大会冲过头。

I

积分 Integral · 过去

把所有历史误差累加起来。专门对付那些微小但持续存在的偏差,比如重心不正或持续的侧风——让飞机不会"差一点就到位"。

D

微分 Derivative · 未来

观察误差变化的速度。当误差正在快速缩小时,提前踩一点"刹车",防止冲过头——让飞机沉稳而不飘。

四旋翼的每个轴——滚转、俯仰、偏航——都独立运行一套 PID。现代飞控(如 Betaflight)还常常采用双层嵌套:外环控制姿态角度,内环控制角速度。这样的结构让飞机既能稳定悬停,也能干脆利落地响应快速机动。
Chapter 05

四个电机如何协同

Motor Mixing · Translating Commands to Throttle

四旋翼只有四个旋翼,却需要控制四个自由度:油门、滚转、俯仰、偏航。电机混控就是把这四个指令翻译成四个电机各自转速的数学游戏。

向前 ↑ FC M1 −20% 前左 M2 −20% 前右 M3 +20% 后右 M4 +20% 后左 FORWARD PITCH · 向前俯冲示例

想象飞机要向前飞。飞控需要让机身向前倾斜一个小角度,这样螺旋桨产生的推力就会有一个向前的水平分量,推动飞机前进。

要让机身向前倾,就让前面两个电机(M1、M2)转速减小,同时让后面两个(M3、M4)转速增大。前轻后重,机身自然前倾。

偏航(转向)则利用反扭矩:一对电机顺时针转、另一对逆时针转,它们对机身的反扭矩相互抵消。当想要向右转时,让两个顺时针电机加速、两个逆时针电机减速,反扭矩失衡,机身就被"拧"向一侧。

下面是 X 型四旋翼的混控矩阵。每个电机的最终油门是四个通道按系数的加权和:

Motor Mixing Matrix · X Config
通道M1 前左M2 前右M3 后右M4 后左
油门+1+1+1+1
滚转 →−1+1+1−1
俯仰 ↑−1−1+1+1
偏航 ↻−1+1−1+1
Chapter 06

不同的飞行模式

Flight Modes · A Spectrum from Hands-Off to Full Manual

同一套硬件,切换不同的控制策略。从新手也能安全起降的全自动,到只有经验老练的飞手能驾驭的纯手动,飞控提供一整套从"放手"到"接管"的光谱。

MODE · 01

自稳模式

Angle / Self-Level

摇杆直接对应目标倾角,撒手自动回到水平姿态。新手起飞、航拍悬停的默认选择——飞控全权负责保持平衡。

MODE · 02

手动模式

Acro / Rate

摇杆直接控制角速度,不再自动回正。飞机可以连续翻滚、倒飞悬停——穿越机特技与花式飞行的唯一选择。

MODE · 03

定高模式

Altitude Hold

锁定气压计或 TOF 测得的当前高度。飞手只需关心水平位移,垂直方向由飞控自动维持。

MODE · 04

定点悬停

Position Hold

融合 GPS、气压计甚至光流+TOF,把飞机钉在三维空间中的一个点。遇到侧风时自动修正漂移。

MODE · 05

自动返航

RTH · Return Home

信号丢失或低电量触发:飞机爬升至安全高度,直线飞回起飞点,最终自动降落。关键的安全兜底机制。

MODE · 06

航点任务

Waypoint Mission

预先在地图上画好航线,飞机自主按顺序飞往每个航点。测绘、巡线、农业植保——这时飞控就成了真正的自主机器人。