简介面向四轴飞行器入门玩家的开源飞控自制项目以STC51内核主控为核心配套原理图、源码和技术文档适合单片机爱好者以及想从底层理解飞控姿态解算、亲手装机调试的玩家。压缩包内共29个文件包含C源码、头文件、原理图、使用说明、工程配置文件以及编译好的固件整体仅795KB便于浏览和烧录。目前已有2287人学习项目专注纯姿态飞行控制不含GPS、电子罗盘、气压计等定高定点模块PID参数经过实际装机验证可匹配二百五十毫米至七百五十毫米轴距机架配合常规四轴机架与六通道遥控器即可完成入门级组装。代码中可重点研读六轴传感器数据读取、遥控信号解析、电机输出及姿态控制逻辑对照原理图和使用说明还能梳理从硬件连接、固件烧录到试飞调参的完整流程为后续扩展测距、光流或气压计等功能打下基础。1. STC51四轴飞控入门级DIY为什么一个“过时”芯片能让你真正学会飞控标题里的“STC51四轴飞控开源项目原理图与源码”解压后往往就是一张原理图 PDF、一套 PCB 封装库和几个 .c 源文件。很多人第一次看到会觉得不现实8051 内核的算力怎么跑得动四轴需要的姿态结算和 PID但入门级 DIY 的意义恰恰在于用 8 位 MCU 的匮乏资源逼你把每一个控制周期、每一路 PWM、每一次 I2C 应答都吃透。这个开源项目不是让你做商品级飞控而是用最低门槛把飞控原理图、传感器时序、电机驱动和 PID 调参串成一条完整链路。它适合刚看完单片机教程、想从闪灯跨到飞行器的人也适合想搞明白“姿态环和角速度环到底怎么配合”的嵌入式工程师。2. 飞控原理与资源边界STC51 跑四轴到底在算些什么2.1 四轴稳定的核心姿态环和角速度环四轴飞行器是个强耦合、非线性的被控对象全油门推起来的一瞬间就会翻。飞控的任务是以固定周期读取陀螺仪和加速度计估算出当前横滚、俯仰、偏航角再通过四个电机的差速推力把姿态拉回目标。这个闭环由内向外可以拆成两层内环是角速度环周期短、响应快负责给系统增加阻尼外环是角度环负责修正积分漂移和外部扰动。在 STC51 上这两个环通常合并进同一个控制周期周期 2ms 到 5ms对应刷新率 200Hz 到 500Hz。8051 内核没有任何浮点单元Keil C51 默认的 long 是 32 位、int 是 16 位。如果控制代码直接写浮点乘法ROM 会膨胀。开源项目普遍把互补滤波系数和 PID 参数全部放大成整数例如把 0.95 写成 243/256用移位和整数乘法完成既保留精度又不拖慢主循环。典型的主循环结构就是下面这样while (1) { // 1. 软件I2C读取MPU6050六轴原始数据 // 实际代码里通常一次读0x3B开始的14字节 if (mpu6050_read_sensor(ax, ay, az, gx, gy, gz) ! 0) { continue; // 读取失败就跳过本周期 } // 2. 一阶互补滤波陀螺仪积分 加速度计修正 roll (243 * (roll gx * dt) 13 * accel_roll) 8; pitch (243 * (pitch gy * dt) 13 * accel_pitch) 8; // 3. 外环角度PID 内环角速度PID pid_roll_out pid_update(pid_roll, target_roll, roll, gx); pid_pitch_out pid_update(pid_pitch, target_pitch, pitch, gy); pid_yaw_out pid_update(pid_yaw, target_yaw, 0, gz); // 4. X型机架混控油门叠加三轴修正量 motor_pwm[0] throttle - pid_roll_out pid_pitch_out - pid_yaw_out; motor_pwm[1] throttle - pid_roll_out - pid_pitch_out pid_yaw_out; motor_pwm[2] throttle pid_roll_out pid_pitch_out pid_yaw_out; motor_pwm[3] throttle pid_roll_out - pid_pitch_out - pid_yaw_out; // 5. 更新四路PWM占空比 pwm_set_duty(0, motor_pwm[0]); pwm_set_duty(1, motor_pwm[1]); pwm_set_duty(2, motor_pwm[2]); pwm_set_duty(3, motor_pwm[3]); delay_ms(2); // 控制周期2ms约500Hz }这段代码里的混控矩阵是 X 型机架的基础写法横滚修正量让左右电机差速俯仰修正量让前后电机差速偏航修正量让两组对角线电机反转。要注意四个电机的桨叶旋转方向必须按“正反装”设计否则偏航修正会失效。代码里的dt是两次控制周期的间隔建议直接用定时器累加计算不要用delay_ms去推否则中断抖动会让姿态角漂移。2.2 传感器选型与硬件资源占用对照这个级别的开源项目几乎绕不开 MPU6050它把三轴陀螺仪和三轴加速度计封装在一起通过 I2C 输出硬件接口简单。移植时最麻烦的不是读数据而是寄存器初始化顺序和 I2C 应答检测。下表是常见的硬件模块与 STC51 资源占用方便你在拿到原理图后快速核对外设接口占用 MCU 资源设计注意点MPU6050I2C 400kHz2 个 GPIO 2 个上拉电阻上电后必须等待内部时钟稳定约 100ms空心杯电机 x4PWM 低端驱动4 路 PWM 或 1 个定时器软分时每路 PWM 频率建议 1kHz~8kHz遥控接收机PPM / PWM / SBUS1 路输入捕获 串口PPM 解码最省引脚但需要输入捕获功能电池电压检测ADC1 路 ADC 分压电阻经过 1kΩ/10kΩ 分压避免超过 ADC 参考电压蓝牙调参模块UARTP3.0/P3.1 串口注意 TX/RX 交叉不能直接接同一电平STC15W4K 系列自带硬件 PWM 和 ADC比 STC89C52 适合做四轴。STC89C52 只有两个定时器要产生四路同频率 PWM只能用一个定时器固定频率溢出再在中断里按比较值翻转电机的四个 IO 口。这种软分时方案不是不能飞但中断里不能再做传感器读取否则控制周期会被拉长到 10ms 以上。拿到源码后先看用的是哪种 MCU基本就能判断这个项目的完成度是“能演示”还是“能悬停”。2.3 8 位机上的冗余预算哪些功能必须砍哪些不能省在 12MHz 晶振下用软件 I2C 读一次 MPU6050 六轴数据大约需要 460us姿态融合经过整体函数优化后约 120usPID 计算约 100us剩下时间要给遥控解码、串口输出和低电压检测。如果把控制周期设定为 2ms整个主循环空闲时间不到一半改成 1ms 就基本没有余量了。因此凡是需要大量内存的卡尔曼滤波、需要文件系统的 SD 卡日志、需要复杂协议解析的 SBUS在这个平台上都会因为资源不足被砍掉。这不是缺陷而是入门四轴的合理取舍。开源项目的价值就在这一段极限空间中如何用一次性中断处理四路 PWM如何在 I2C 读取失败时快速恢复如何用查表代替三角函数。后续所有代码优化本质都是在跟这 2ms 预算赛跑。3. 原理图设计要点从 STC51 最小系统到电机驱动电路3.1 电源拓扑先把电池电压和逻辑电压分开看原理图时先看电源树。入门级四轴普遍使用 1S 锂电池供电电池电压 3.7V 到 4.2V。STC51 的工作电压通常可以在 2.4V 到 5.5V 之间因此很多项目直接用 LDO 把电池电压降到 3.3V 给 MCU、传感器和蓝牙供电。但要注意普通 AMS1117-3.3 的压差是 1V 左右输入低于 4.2V 时输出就可能掉出 3.3V所以推荐选压差更小的 ME6211 或 RT9193。电机则直接接电池正极不经过 LDO否则电流稍大就复位。MCU、传感器和电机必须有共同的地这一点在原理图中经常被忽略。如果模拟地 AGND 和电源地 PGND 在原理图上分开画最终必须通过一点单点接地汇合否则电机 PWM 产生的噪声会通过地环路直接灌进 MPU6050 的 I2C 时序里导致姿态跳变。看到原理图里还有一组 RC 或 LC 滤波给 MPU6050 供电那是正常设计不是让你拆掉的。3.2 电机驱动电路N-MOS 低端驱动的选型与接线直流有刷空心杯电机的驱动相当简单一个 N-MOS 做低端开关PWM 信号控制栅极电机正极接电池负极接 MOS 漏极。原理图上常见的型号是 AO3400 或 SI2302前者 Vgs 阈值约 1.4VSTC51 的 IO 高电平可以直接导通但为了保证 MOS 完全关断栅极到地必须加 10kΩ 下拉电阻。上电时 STC51 的 IO 口处于高阻态如果没有下拉电阻栅极悬空电机可能在上电瞬间偷转一下。续流二极管也不能省。电机是感性负载MOS 关断瞬间会产生反向电动势原理图上通常会在电机两端反向并联一个 SS34 肖特基二极管。如果设计里用了一个 H 桥或半桥驱动芯片那多半是为了以后换有刷双向调速而入门四轴只需要单向调速低端 MOS 是最省成本的方案。下面这段代码对应的是 STC15W4K 的硬件 PWM 初始化思路// STC15W4K PWM初始化片段细节以芯片数据手册为准 void pwm_init(void) { P_SW2 | 0x80; // 访问扩展RAM数据手册要求 PWMCFG 0x00; // 选择中心对齐模式 PWMCKS 0x00; // 时钟源选择系统时钟 PWMC 1000; // PWM周期 1000个时钟周期 // 若系统时钟24MHz则PWM频率 24000000 / 1000 24kHz for (i 0; i 4; i) { PWMxB 0; // 占空比初始为0 // 启用对应PWM通道并选择输出引脚 } }PWM 频率并不是越高越好。频率超过 20kHz 会超出人耳听觉范围但 MOS 开关损耗也会随之上升频率太低电机会发出明显噪音。推荐从 8kHz 起步电机电感较大的空心杯电机可以降到 4kHz。代码里的PWMC直接决定频率而每路PWMxB决定占空比占空比越小转速越低。3.3 冷启动下载电路CH340 与 STC51 的握手逻辑STC51 在原理图里必须保留一组串口下载接口。最常见的是通过 CH340 芯片把 USB 转成 TTL 电平CH340 的 TXD 接 MCU 的 RXDP3.0RXD 接 MCU 的 TXDP3.1。下载过程要求 MCU 上电时检测到串口有下载指令也就是常说的“冷启动”。实际操作顺序是先用烧录软件打开 HEX 文件并点击下载然后给飞行控制板通电STC 的 ISP 引导程序才会进入下载模式。如果用 STC89C52RC原理图上还需要一个 11.0592MHz 晶振和两个 22pF 电容原因是这个频率能使串口波特率没有误差。STC15 系列内部有高精度时钟很多开源原理图已经省去了外部晶振IO 口也得以多释放两个。判断一个设计是否成熟可以看它有没有在 USB 和 CH340 之间放 ESD 保护以及是否用 0Ω 电阻把 CH340 的 3.3V 和 MCU 的 3.3V 隔离开。3.4 PCB 布线大电流回路尽量短传感器区避开通断原理图看明白后PCB 布局决定了这套飞控能不能稳定工作。电机电流脉冲很大电源线和 MOS 漏极到电机的连线必须短而粗最好在电机两端直接放 100nF 陶瓷电容吸收换向尖峰。单片机最小系统、MPU6050 晶振不要放在电机下方或大电流走线旁边否则电机启动瞬间PCB 板形变都会传递到陀螺仪。MPU6050 附近要尽量少走高频信号I2C 的两根线在原理图上可以任意交换但到 PCB 上要避免平行走线过长最好加 4.7kΩ 上拉到 VCC保证信号快速上升沿。若项目里的 PCB 使用了四层板中间层放完整地平面对 I2C 时序和 ADC 采样稳定性都有肉眼可见的提升。4. 源码级拆解姿态融合、PID 与混控输出4.1 源码框架与中断优先级把控制周期锁进定时器很多 STM32 开源项目习惯用 RTOS 管理任务而 STC51 的源码更接近裸机调度的内核源码一个main函数里初始化外设然后进入死循环。既然 MCU 资源有限控制周期最好不要依赖while循环里的延时而是放在定时器中断里触发。做法是定时器每 2ms 置一个标志位主循环检测到标志后才执行一次姿态解算和 PID 更新。这样即使某次 I2C 读取超时也不会让控制周期漂移。volatile uint8_t control_flag 0; // 定时器0中断每2ms进入一次 void Timer0_ISR(void) interrupt 1 { TH0 0xD8; TL0 0xF0; // 重装定时初值12MHz下定时2ms control_flag 1; // 主循环轮询此标志 } void main(void) { sys_init(); sensor_init(); while (1) { if (control_flag) { control_flag 0; flight_loop(); // 姿态解算、PID、混控 } } }这段代码的好处是控制频率固定不受delay_ms值误差影响。注意control_flag必须用volatile修饰防止编译器把它优化进寄存器。定时器初值要根据晶振频率重算如果换成 STC15 的 1T 模式TH0/TL0的重装值完全不一样直接照抄网上 STC89C52 的代码会导致控制频率变快好几倍。4.2 软件 I2C 读 MPU6050 的时序与容错STC51 没有硬件 I2C 或项目里没有复用相关引脚时就要用两个普通 IO 口模拟 I2C。模拟 I2C 的核心是处理好起始位、应答位和时钟线的高低电平时序。MPU6050 的 I2C 从机地址是 0x68读和写各占一个位。常见卡死点是在等待从机应答时SCL 拉高后 SDA 一直不变成低电平这一般是上拉电阻缺失或从机没有正常上电。void I2C_Delay(void) { _nop_(); _nop_(); _nop_(); _nop_(); // 延时4个机器周期 } bit I2C_Start(void) { SDA 1; SCL 1; I2C_Delay(); SDA 0; // SCL高电平期间SDA由高变低产生起始位 I2C_Delay(); SCL 0; // 拉低SCL释放总线 return 1; } void I2C_Stop(void) { SDA 0; SCL 1; I2C_Delay(); SDA 1; // SCL高电平期间SDA由低变高产生停止位 I2C_Delay(); }时序的正确性必须用逻辑分析仪或示波器验证。SCL 高电平时SDA 改变会产生起始或停止信号SCL 低电平时SDA 才能改变数据。常见的错误是数据变化和时钟沿重合导致从机把数据位当成起始位。在调试时可以先把 I2C 时钟降到 100kHz即把I2C_Delay中的空指令增加一倍排除线路电容导致的时序问题。4.3 定点整数 PID 的参数与实现STC51 源码里的 PID 控制器通常不采用标准浮点结构而是把比例、积分、微分系数放大成整数。下面是一个可移植的结构体定义typedef struct { int16_t target; // 目标角度或角速度 int16_t current; // 当前测量值 int16_t last_error; // 上一次误差 int32_t integral; // 积分累计用32位防溢出 int16_t kp; int16_t ki; int16_t kd; int16_t out; // 输出作为混控输入 } pid_t; int16_t pid_update(pid_t *p, int16_t target, int16_t current, int16_t gyro_rate) { int32_t error target - current; p-integral error; // 积分限幅防止积分饱和后恢复缓慢 if (p-integral 2000) p-integral 2000; if (p-integral -2000) p-integral -2000; // 微分项直接用陀螺仪角速度可以减少高频噪声放大 int32_t derivate gyro_rate; p-out (p-kp * error p-ki * p-integral p-kd * derivate) 8; p-last_error error; return p-out; }这里输出结果右移 8 位等于把放大的参数缩回到实际值。PID 参数初值可以参考下表参数初始值调试方向P比例80 到 120加大到实际角度响应快但出现持续抖动则回退I积分1 到 10用于消除静态误差过大容易低频振荡D微分20 到 40加大能抑制超调太大会让电机发出尖锐噪音实际试飞时先在桌面固定飞机只给油门 30% 往一个方向拨杆观察响应。P 从 0 一点一点加直到姿态能回中但又不过冲然后加 I 消除回中的残余误差最后加 D 减小过冲。每次只改一个参数并记录波形变化。4.4 混控输出和遥控信号映射混控输出是把 PID 的三个轴修正量叠加到油门上的过程。代码里通常先做限幅防止某个电机输出超过 PWM 最大值。更要紧的是油门映射遥控器摇杆中位代表油门 50%对应 PWM 比较值 500摇杆最低不代表电机完全停止而应该对应一个怠速启动值否则轻推油门时电机还没转推过某一阈值后突然全速旋转机体猛地抖动。对于 PPM 遥控信号STC51 通过输入捕获功能测量一个周期内高电平的宽度也就是每个通道的脉宽。典型宽度是 1000us 到 2000us中位 1500us。如果遥控器没有校准先把这个中位值计算出来当成控制目标角度的零点。不然飞机飞起来会往一边倾斜。5. 让 STC51 飞控更稳波形验证、串口调试与失控保护5.1 用逻辑分析仪校准 PWM 和 I2C 波形把逻辑分析仪的通道接到电机 PWM 引脚和 I2C SCL、SDA 线上先确认上电瞬间电机不会误转再确认 PWM 频率和占空比符合初始化代码。逻辑分析仪还能看出控制周期是否稳定如果 PWM 中断里执行时间过长PWM 次数的间距会忽长忽短导致电机噪音明显变大。这一项检查要在固定油门空转状态下做不要在装机后手拿螺旋桨测试。5.2 串口输出飞行数据尽量用二进制帧很多开源源码用printf输出调试信息但这很费时间和 ROM。更好的办法是自己定义一个 8 字节的二进制帧把横滚角、俯仰角、油门值和 PID 输出按固定格式发送上位机再解析。例如用0xAA 0x55做帧头后面依次放三个 int16 和一个 CRC 校验字节。解析端用同样的算法循环冗余校验能避开文本转浮点的开销也不会让串口成为主循环瓶颈。// 发送六字节调试帧 void debug_send(void) { uint8_t buf[8]; buf[0] 0xAA; buf[1] 0x55; buf[2] roll 8; buf[3] roll 0xFF; buf[4] pitch 8; buf[5] pitch 0xFF; buf[6] throttle 8; buf[7] throttle 0xFF; uart_send(buf, 8); }发送前对roll、pitch做一次限幅防止异常值把上位机波形坐标轴拉到不可读状态。调参时重点关注横滚和俯仰的曲线是否从零快速、平滑地回到目标。5.3 失控保护和低电压下降油门最后给飞控加一个有限状态机遥控信号丢失超过 1 秒油门强制归零并锁定电机电池电压低于阈值时只允许油门继续下降不允许再上升。实现时把这两个判断放进控制周期开头优先级高于 PID 输出。判断遥控丢失可以用输入捕获超时标志若 500ms 内没有新的 PPM 脉冲就认为信号丢失。电压检测则利用 ADC 采样经过分压电阻换算后与阈值比较。电压低于 3.5V 时将油门限幅值按线性降低这样降落时不会瞬间断电摔机。本文还有配套的精品资源点击获取