企业官网建设流程全解析

刚接触STM32的人，十个有八个是从点灯开始的。等你把GPIO、定时器、串口玩得滚瓜烂熟之后，总会有一个瞬间觉得“这单片机也不过如此”，然后就想找个硬骨头啃。无人机控制绝对是那个让你重新认识STM32的项目。它把传感器读取、数据处理、控制算法、电机驱动、无线通信全串在一条链路上，任何一个环节出问题，飞机要么飞不起来，要么飞起来就翻。

这篇东西主要面向那些已经会用STM32标准库或者HAL库写点简单程序、但对“飞控到底怎么工作的”完全没有概念的朋友。我会从硬件选型讲到姿态解算，再到PID调参与电机混控，最后聊一堆只有实际飞过才会踩到的坑。你不需要有自动控制原理的基础，我会尽量用大白话把逻辑讲清楚。

1. 从零搭一架能飞的STM32四旋翼：系统组成与选型思路

1.1 无人机控制到底是个什么闭环

先说一个很多人初学时的误区：以为控制无人机就是把遥控器的值读进来，然后算出四个电机的转速，输出PWM就行了。真这么简单，淘宝上一百块的玩具四轴早就能稳如老狗了。

实际上，飞控要做的事情是：通过传感器感知飞机的姿态，再根据你想要的姿态（来自遥控器）和当前姿态之间的误差，计算出每个电机需要输出多少力。这个循环每秒钟要执行几百到上千次。飞机的姿态变化很快，如果你控制周期太长，等算完再调整电机，飞机早就翻过去了。

整个系统可以拆成四层：

- 感知层：陀螺仪测角速度（单位：度/秒），加速度计测加速度（单位：g），这两个传感器配合得到当前姿态角。 - 决策层：飞控芯片（我们的STM32）跑姿态解算和控制算法，算出“为了达到目标姿态，每个轴需要多大的修正力矩”。 - 执行层：电调（ESC）接收PWM信号，驱动无刷电机转动，产生升力和扭矩。 - 回馈层：传感器的数据再次进入芯片，形成闭环。

所以你看，STM32在这个系统里的角色相当于大脑，它必须在一个严格的实时周期内完成“读传感器→解算姿态→计算PID→输出PWM”的全部工作。这就是为什么很多学了半年单片机的人，第一次做飞控时会在性能上栽跟头——不是算不快，而是代码写得不够高效，导致整个控制周期抖动很大。

1.2 主控芯片选型：F103C8T6够不够用

很多朋友手上都有一块STM32F103C8T6的小蓝板，也就是传说中的“最小系统板”。这个芯片是Cortex-M3内核，主频72MHz，64KB Flash，20KB RAM。单看参数，可能觉得做无人机有点悬，实际上够用，而且历史上很多开源小四轴（比如Crazepony）用的就是它。

我帮你算一下资源账：

• 姿态解算如果用MPU6050的DMP硬件解算（后面细说），STM32只需要通过I2C读取四元数结果，再做一次四元数转欧拉角，这个计算量很小，大概几十微秒就能搞定。
• 四个电机需要四路PWM输出，F103的定时器完全够用，而且可以做到时钟同步。
• 如果需要显示数据或者调参，还得留一路串口给蓝牙模块或者数传。
• 接收机信号一般是PPM或者SBUS，SBUS是串口信号，PPM需要用输入捕获，这两个F103都支持。

所以我的建议是：别纠结芯片性能，先把系统的软件架构做好，F103C8T6完全能跑一个稳定的双环PID飞控。等你想上更高的控制频率、跑更复杂的滤波算法、或者加光流定位，再换F405甚至F427不迟。

1.3 无人机控制系统的硬件清单与搭配

这里直接给我的配置清单，这套组合性价比高，也足够一个新手把整个逻辑跑通：

有刷电机和MOS管驱动的组合最合适新手折腾，既便宜又不需要电调校准。等你把有刷方案调明白了，换无刷电机+电调只是换执行机构，控制逻辑完全一样。

1.4 引脚规划：动手之前先画一张分配表

很多新手写飞控代码最大的问题不是算法不会，而是做到一半发现引脚不够用、引脚冲突。开局一张引脚分配表，能省掉后面巨大的返工成本。

我的典型分配表（F103C8T6）：

这里有两个容易踩的坑。第一，SBUS信号是反相的，如果你买了FS-i6的接收机想走SBUS，必须在信号线上加一个反相器（三极管就能实现），否则数据全是乱的。第二，I2C的PB6/PB7如果被你之前调试时复用成普通GPIO，可能导致MPU6050读不出数据，排查半天才发现是初始化顺序的问题。

2. 读懂MPU6050的姿态数据：从寄存器到四元数的直观理解

2.1 陀螺仪和加速度计，为什么两个传感器必须配合

姿态解算是飞控的地基。如果算出来的姿态都不准，后面PID调得再完美也是白搭。

MPU6050内部其实有两套传感器：

陀螺仪（Gyroscope）测量的是角速度，单位是度/秒。比如飞机绕X轴以90度/秒的角速度旋转，陀螺仪就会输出对应的数值。对时间做积分，就能得到角度。比如角速度恒定为90度/秒，持续1秒，那角度就是90度。听起来很简单对吧？但问题在于陀螺仪有零漂——即使飞机完全静止，陀螺仪的输出也不是0，而是一个小幅波动的值。积分10秒可能偏差几度，积分一分钟就不知道偏到哪去了。

加速度计（Accelerometer）测量的是加速度，单位是g。静止的时候，它测到的就是重力加速度1g，方向竖直向下。通过重力向量在三个轴上的分量，可以计算出一个俯仰角和横滚角。这个方法没有漂移，因为重力的方向永远不变。但加速度计很怕抖动，电机震动机架的时候，加速度计读数会剧烈波动，直接用它算角度，姿态会抖得没法看。

这就好比一个考直觉的人（加速度计）没有长远记忆，一个记忆力超强但会累积误差的人（陀螺仪）时间久了会跑偏。聪明的做法是把两者融合：短期跟随陀螺仪的快速变化，长期用加速度计校正漂移。

2.2 用DMP库还是自己写互补滤波

MPU6050内部有一颗DMP（Digital Motion Processor）芯片，它可以帮我们完成姿态解算，直接从寄存器读出四元数，然后你用公式转成欧拉角就行。这是最省力的方案，也是我推荐的方案。

从寄存器读数据这一步，很多教程里天天讲“要设置电源管理寄存器、设置采样率、配置低通滤波”，但说实话，如果你用现成的DMP库（比如InvenSense的官方DMP固件），这些环节都被封装好了，你要做的就是把I2C读写接口对接好。

芯片上的操作逻辑是这样的：

1. 复位MPU6050，等待稳定。
2. 设置电源管理，唤醒传感器。
3. 加载DMP固件到MPU6050的内存中。
4. 使能DMP，让它以200Hz的频率输出四元数。
5. STM32每5ms通过I2C读取DMP的FIFO缓冲区，拿到四元数Q0~Q3。
6. 用四元数转欧拉角公式，得到roll/pitch/yaw三个姿态角。

四元数转欧拉角的公式是：

roll = atan2f(2*(q1*q2 + q0*q3), q0*q0 - q1*q1 - q2*q2 + q3*q3) * 57.29578f; pitch = asinf(-2*(q2*q3 - q1*q0)) * 57.29578f; yaw = atan2f(2*(q1*q3 + q0*q2), q0*q0 + q1*q1 - q2*q2 - q3*q3) * 57.29578f;

其中57.29578是180/π，把弧度转成度。这个公式是固定套路，背下来就完事，不用纠结推导。

2.3 原始数据读取的注意点：I2C速率和FIFO溢出

很多新手用STM32硬件I2C读MPU6050会卡住，要么读出来全0，要么偶尔读到正确的值但马上又乱掉。这个问题绝大多数原因是STM32的硬件I2C本身设计比较脆弱，尤其是对时序要求严格的从设备。

我自己的建议：优先用GPIO模拟I2C。不用纠结这是不是“不专业”，模拟I2C在这个场景下非常稳。MPU6050的I2C速率上限是400kHz，你用GPIO翻转开漏加上拉电阻，忙的时候延时不精确也只是慢一点，但绝不会出现收发错位。飞控项目的核心是稳定可靠，不是炫技。

FIFO溢出是另一个高频问题。DMP输出频率（比如200Hz）和STM32读取频率不一致时，FIFO缓冲区会积压数据，溢出后DMP会自动停止输出。解决方法是每次读完后检查FIFO的剩余数据量，如果异常就调用resetFIFO()。你可以在DMP库的读取函数后面加上这个判断，宁可丢一帧数据，也不能让整个解算流程卡死。

有一个细节我想多说一句：MPU6050的安装方向。不同飞控板的传感器摆放方向不一样，装好后需要根据MPU6050的数据方向校准。比如你把芯片的正方向对准机头方向，那ROLL、PITCH方向基本就是对的。但如果你把芯片装反了，俯仰变横滚，横滚变俯仰，飞机一解锁就侧翻。解决办法是写一个方向映射表，或者在初始化时把对应轴的数据取反，比如：

gyro.y = -gyro.y; accel.z = -accel.z;

我建议在地面阶段先写一小段测试程序，把飞控板拿在手里，翻转不同的方向，在串口监视器里看到roll和pitch的变化方向与你的动作一致，再进入下一步。

3. 控制算法落地：为什么飞控要串级PID，而不是一个环搞定

3.1 单环PID为什么压不住姿态变化

这个问题我问过很多学生，答案千奇百怪。有人说是调节时间不够，有人说是传感器滞后，其实一句话就能解释：只用一个角度环，你控制的对象实际上是二阶系统，而PID里的D项对二阶系统的阻尼效果很弱，根本没有办法让系统稳定。

这样说可能还是抽象，我拿一个具体的场景说明。假设你的飞机向左倾斜了30度，你的期望角度是0度。如果只用一个角度环，控制器计算出需要的修正力矩，让电机转速变化，修正飞机姿态。但问题是，飞机在修正的过程中会获得一个角速度，当它回到0度时，这个角速度还在。角度环没有直接感知角速度的能力，它只见角度偏差，导致回正过头，变成向右倾斜，然后反复震荡，最后炸机。

那串级PID是怎么解决这个问题的？简单说，角度环的输出不是直接给电机，而是作为角速度环的目标值。飞机的角速度由陀螺仪直接测量，角速度环对这个“向目标角度运动的速度”做快速抑制。相当于角度环管“你在哪”，角速度环管“你动得有多快”，只要你回正速度快得有点过头，角速度环就提前刹车。

这个结构就像你开车。角度看偏差，是需要你调整方向盘的幅度；角速度是方向盘调整的速率。你不可能一直猛打方向盘，速率太高会失控，得有内环帮你控制住“打方向盘的快慢”。

3.2 串级PID的结构和参数意义

飞控里最常见的结构是：

外环（角度环）

Angle_Error = Target_Angle - Current_Angle Desired_Rate = Angle_Error * Kp_angle + Angle_Integral * Ki_angle

这个环的输出是一个期望角速度Desired_Rate，比如“你现在偏差20度，我希望你以每秒150度的角速度回到目标”。

内环（角速度环）

Rate_Error = Desired_Rate - Current_Rate Output = Rate_Error * Kp_rate + Rate_Integral * Ki_rate + Rate_Error * Kd_rate

这个环的输出才是真正给电机的油门修正量。内环直接读取陀螺仪的角速度，响应速度非常快，负责“稳住姿态变化趋势”。

既然有内外两个环，调参就必须先调内环，再调外环。如果你外环参数没调明白就动了内环，飞机只会越调越乱，甚至出现高频抖动。

我给出一个经验初值，适合250mm级别、有刷/无刷小四轴：

需要注意的是，PID参数是量纲相关的，不同控制周期、不同机型大小、不同油门值下的参数可能差异很大。上面给出的只是“开始试飞前可以安全起飞”的保守值。

3.3 电机混控：四个电机的力是怎么分配的

PID算出来的是三个轴上的修正力矩（Roll、Pitch、Yaw），这四个电机的转速到底怎么变，需要一套固定的混控公式。以最常见的是X型四旋翼为例（四根机臂指向飞机的四个角）：

Motor1 = Throttle - PitchPID + RollPID + YawPID // 右前，逆时针旋转 Motor2 = Throttle - PitchPID - RollPID - YawPID // 右后，顺时针旋转 Motor3 = Throttle + PitchPID + RollPID - YawPID // 左后，逆时针旋转 Motor4 = Throttle + PitchPID - RollPID + YawPID // 左前，顺时针旋转

注意Yaw修正力矩的方向：Yaw是偏航角，需要靠反扭矩差实现，所以YawPID在顺时针和逆时针电机上的符号是相反的。如果你把电机旋转方向或者螺旋桨装反了，飞机起飞时会疯狂自旋。

还有一个坑是死区处理。PID输出可能是负数（比如油门很小时，某个修正分量把结果推到负值），电机转速不能为负，所以你的代码里必须有输出限幅和最小值保护。我一般会设置一个最小油门值（比如总油门的15%），低于这个值直接输出0，防止电机在小油门区非线性响应导致控制心跳。

混控输出前一定记得做归一化检查。极端情况下，四个电机的输出可能会超过上限，比如你想要强烈的俯仰修正且油门加满，某个电机要输出超过100%的油门。这时候不能简单截断，否则飞机会因为某个电机失速而剧烈抖动。标准做法是把所有电机输出同比例缩放，保证差值（修正量）不变的前提下压低总油门：

float max_val = max(M1, M2, M3, M4); if (max_val > THROTTLE_MAX) { float scale = THROTTLE_MAX / max_val; M1 *= scale; M2 *= scale; M3 *= scale; M4 *= scale; }

这个逻辑也是所有飞控中油门混控的核心，像Betaflight调“气垫船效果”也是从这层逻辑衍生出来的。

4. 串级PID计算的实时性和主循环架构：别让延时吃掉你的控制质量

4.1 控制周期怎么定，定时器中断怎么设计

姿态解算和控制算法必须在严格的时间节拍里执行。很多新手写的飞控代码长成这样子：

while(1) { read_sensor(); calculate_attitude(); control(); set_pwm(); delay(10); }

这个写法对无人机来说基本是废的。delay(10)会导致主循环的运行频率受每个函数执行时间影响，读取传感器、解算、控制这些步骤相互拖累，整个控制周期可能抖动得厉害。

我的建议是：用定时器中断，固定5ms（即200Hz）执行一次核心控制循环。主循环里只跑一些低优先级的任务，比如LED状态更新、串口调参数据发送。定时器中断里跑关键任务，优先级设为最高。

在F103上，用定时器的更新中断，5ms中断一次，代码骨架大致是：

void TIM3_IRQHandler(void) { if (TIM_GetITStatus(TIM3, TIM_IT_Update) != RESET) { TIM_ClearITPendingBit(TIM3, TIM_IT_Update); flight_loop(); // 控制主循环 } }

flight_loop里严格按以下顺序执行：

1. 读取MPU6050数据（I2C读取DMP四元数或者原始数据）。
2. 把四元数转换成欧拉角。
3. 读取遥控器信号（SBUS解析），得到目标油门和期望角度。
4. 计算角度环PID，得到期望角速度。
5. 计算角速度环PID，得到修正量。
6. 混控计算，得到四个电机的PWM值。
7. 更新比较寄存器，输出PWM。

这个顺序不能乱。姿态解算必须在控制之前，因为控制算法里需要用到最新解算出来的角度；PWM输出放在最后，确保控制周期内不会因为前序任务耗时导致输出延迟。

4.2 一个常被忽略的致命问题：角度环和角速度环的运行频率

串级PID的内外环不一定要跑在同一个频率。因为内环（角速度）需要快速响应，可以跑200Hz甚至400Hz；外环（角度）姿态变化相对慢，跑100Hz就够。很多人刚学的时候，把内环和外环都放在同一个5ms中断里执行也没问题，数据上完全够用。

但有一个细节需要注意：角度环的输出要经过限幅。角度环算出来的Desired_Rate如果不限幅，极端情况下可能给内环一个“每秒旋转500度”的疯狂目标，内环根本追不上，结果是飞机在飞行中猛摆一下然后炸掉。

一般会把角度环输出限制在150~200度/秒。这样即使你在地下大幅度推杆，飞机也能以一个安全的角速度响应。

4.3 遥控信号解析和PPM/SBUS的RTOS式处理

遥控器输入的解析优先级非常高，因为它决定了“我到底想要飞机怎么飞”。如果解析慢了，飞机的响应会明显延迟，手感全无。

• PPM信号：一帧内有多个通道的脉宽，通常用输入捕获引脚测量。PPM一帧大约20ms，每个通道脉宽范围1000~2000us，需要把所有通道值解析完。用输入捕获中断，在PPM下降沿计时，然后存入一个共享数组。
• SBUS信号：本质是一路100kHz的高速串口，每帧25字节，包含16个通道。F103的串口波特率设置为100000，数据位8位，偶校验，停止位2位。SBUS的信号电平要反相后才能进串口RX。

解析完成后，要把遥控器的原始值映射成实际的飞行指令。这里有个关键点：不能直接把遥控器的油门值当控制目标。遥控器摇杆中间位置不一定对应飞机水平，你需要根据摇杆中性点校准。再加上一个解锁条件（通常用一个拨杆通道），防止一上电电机就转。

我建议在代码里设置一个“飞行状态机”，至少三个状态：

• 未解锁：PID不工作，电机PWM输出0。
• 解锁待飞：电机怠速（输出一个小油门值），PID开始计算，但不响应摇杆角度目标。
• 起飞/飞行：完整控制回路生效。

这个状态机写好后，地面测试和试飞时的安全性会提高一个档次。

5. 从地面调试到首次悬停：参数整定与真实场景里的坑

5.1 地面调试：先用串口把数据“看”明白

飞控是一个一旦上天就极其不稳定的系统，所以第一步必须是地面调试。你需要把飞控板固定在一个支架上，让桨叶远离人和贵重物品，通过USB转TTL连接STM32的串口，用上位机观察状态数据。

我当时用的调试工具很简单：串口打印姿态角和控制数据，然后收进电脑里的匿名上位机或者VOFA+，以波形方式显示。

怎么判断数据对不对？几个基本准则：

• 静止时 roll 和 pitch 的波形应该是两条水平直线，噪声幅度不超过±1度。
• 用手快速晃动飞控，波形响应应该非常快，没有明显滞后。
• 角速度环输出在你手动固定飞机时应该保持很小。如果你发现有人碰了一下飞机，输出就飙升到极大值，说明角速度环参数有问题，先调内环。

光看数据不能完全说明控制质量，但至少能砍掉一半的软件问题。传感器方向反了、I2C数据抖动、DMP初始化失败，这些问题都在串口波形里暴露无遗。

5.2 首次试飞的安全措施：卸桨、绑绳、限油门

很多人第一次试飞的心情是“赶紧解锁，推油，飞起来！”我的建议是：别这么做，先把桨叶拆掉。

不带桨测试的目的是验证电机响应方向和快慢。你用手把飞机拿起来，往一个方向倾斜，感受电机转速的变化。正常情况下，飞机会在手中产生一个往水平方向回正的力。如果你的电机转速变化方向相反，那就是混控公式符号不对，这种情况带桨起飞必炸。

带桨测试也要绑个防撞架和安全绳。找一根结实点的绳子，拴在机架中心，另一端固定在地上，绳子长度三四十厘米就够了。这样飞机即使起飞，也不会失控飞到天花板或者撞到窗户。第一次尝试悬停时，把油门拉到接近50%，然后非常缓慢地增加，观察飞机是往哪边偏。如果微微偏移，可以通过遥控器微调修正；如果瞬间倾覆，立刻收油门，下来查混控方向和PID参数。

5.3 参数整定的完整流程：从内环到外环，从地面到空中

我总结了一套最稳妥的初调顺序，每一步都有明确目的，新手照着做就行：

第一步：调内环Kp_rate 和 Kd_rate（不带桨）

手里拿着飞机，施加一个突然的角度扰动，观察回中速度。如果回中太慢，加大Kp_rate；如果回中过程高频抖动，加大Kd_rate。反复试到“迅速回中、几乎没有超调”。

第二步：加内环Ki_rate（不带桨）

如果飞机静止时始终有一个固定的倾斜漂移（比如总是往左偏），说明有重力或者重心导致的恒定干扰，加一点Ki_rate。不要加太多，积分项的本质是“持续修偏差”，加太多会带来振荡。

第三步：调外环Kp_angle（带桨但绑绳）

把飞机拿起，水平放置，推动它偏离水平位置，期望它自动回中。回中太慢会增加Kp_angle，回中过头再反向摆动说明Kp_angle过大。这步非常考验耐心，我建议每次只改动10%以内的参数，然后通过数传观察波形有没有收敛。

第四步：悬停微调

如果飞机能勉强悬停但低于3秒就慢慢开始“晃荡”，大概率是外环Kp_angle偏低，或者是角速度环Kp_rate过高导致响应过于灵敏。以1~2秒一波动为标准，逐项调整。

第五步：降落测试和异常保护

确保你的代码有超过一定倾角就强制解锁的保护逻辑。比如检测到roll超过45度或pitch超过45度，直接让四个电机输出0，避免在地上翻滚时打伤人。

5.4 真实试飞里最容易被忽略的坑

下面这些不是我编的，全是实际飞过之后才明白的事情：

• 电池电压会显著影响PID参数的感觉。满电时电机响应更猛，Kp_rate微高一点也能稳住；低电时响应变软，同样的参数可能出现漂移。有条件的话，把电池电压也回传到调参界面，避免在低电状态下做大幅调参。
• 重心不居中会让YAW轴特别难调。电池尽量压在机架正中心，不要为了好看斜着放。重心偏的时候，飞机会在快速转弯时出现明显的侧滑，PID很难压住。
• STM32的3.3V和电机电源必须分开地线，只在一点共地。否则电机启动瞬间，电机电流在地线上产生压降，导致STM32复位。这个问题在用小蓝板的时候极其普遍，表现是“飞机一推油门，姿态数据全乱，控制失效”。
• 上电瞬间电机猛转一下又停，多半是某个GPIO在初始化之前处于不确定电平，把PWM输出引脚暂时当成了高电平。解决方法是先初始化所有PWM引脚为低电平，再初始化定时器，最后才配置控制通道。

还有一点想特别提醒：不要一上来就追求极致的姿态控制精度。你的目标是让飞机稳定悬停，而不是像DJI那样纹丝不动。先保证控制循环不崩、不掉姿态、不炸机，再慢慢优化。调参这件事，心态比技术重要。

我在飞第一架STM32四轴时，前两次试飞总共摔了三次，每次都是因为某个小细节没处理好——第一次是螺旋桨方向装反，起飞直接倒扣；第二次是PID参数符号反了，飞机在地上疯狂打转；第三次是电机PWM频率配错（用了50Hz的模拟舵机频率），导致电机声音尖锐、响应迟钝。这些坑都不是什么高深的理论问题，但每一个都会让你重新审视自己的代码和硬件连接。

飞控这个项目最有魅力的地方在于：你需要把单片机、传感器、通信、自动控制、甚至机械结构全部打通。它不是一条容易走的路，但走通之后，你对STM32的理解会提升不止一个档次，因为你已经不是在“点灯”，而是在用每一个时钟周期跟重力较劲。