简介这份C语言嵌入式无人机开源项目源代码面向具备一定单片机基础、希望深入理解飞控系统实现的开发者与学生可用于课程设计、毕业设计及飞控学习参考。压缩包共1740个文件约19.23MB涵盖258个C源文件、278个头文件以及STM32工程配置、链接脚本、启动汇编、HTML文档和图像资源完整呈现硬件控制、传感器采集与飞行控制等模块。项目通过微控制器驱动电机、GPS和遥控器模块利用加速度计、陀螺仪、气压计获取姿态与位置数据并以PID算法对姿态、速度与高度进行闭环调节另含图像处理、无线通信与远程控制相关代码。已有870人学习代码注释较丰富、目录层次清楚适合按模块阅读飞控逻辑、移植外设驱动、排查传感器数据处理问题或搭建嵌入式飞控实验平台。1. 先看它能飞什么一套 C 语言嵌入式无人机固件的能力边界前阵子有个做课设的同学抱着自己焊的四轴板子找我说解锁之后电机抖得像筛糠日志里姿态角每秒跳十几度。我把他那份从三个地方抄来的代码翻了一遍毛病很典型姿态解算和电机输出挤在同一个定时器中断里一次浮点运算就把 1kHz 的控制周期撑到 2.3ms周期一变PID 的参数全部失效。后来换成一套结构完整的 C 语言嵌入式无人机开源项目源代码配上它自带的设计文档两天就把悬停调稳了。这套工程真正值得看的地方不在算法有多前沿而在于它把一架能飞的多旋翼该有的模块全摊开摆在明面上传感器驱动、姿态解算、串级 PID、电机混控、通信协议、参数存储每一块都对应一份说明讲清楚为什么这么写、改哪里会出问题。它适合刚接触无人机控制、想先跑通再动手改的开发者也适合当教学骨架。2. 工程骨架拆解从目录结构看飞控固件的分层与调度拿到一份陌生的飞控源码我一般不看 main 函数先看目录。目录结构基本能暴露作者的分层意识——层次乱的工程后面调参一定痛苦。这套工程用的是很经典的五层切法从硬件往上依次是板级支持、芯片外设封装、器件驱动、算法中间件、应用逻辑中间夹一层通信。层与层之间只允许单向依赖应用层不许直接摸寄存器驱动层不许调用控制逻辑。2.1 目录结构与各层职责firmware/ ├── bsp/ 板级支持时钟树、引脚复用、板子差异都收在这里 │ ├── board.c/h 板级初始化入口换板子只改这一层 │ └── board_config.h 引脚定义、外设实例号 ├── drivers/ 器件驱动只负责把寄存器读成物理量 │ ├── imu_spi.c 六轴传感器 SPI 读写含自检和 WHO_AM_I 校验 │ ├── baro_i2c.c 气压计做高度保持时才编进来 │ ├── pwm_out.c 四路电调 PWM/DSHOT 输出 │ └── flash_param.c 参数区读写带 CRC ├── middleware/ 算法中间件纯数学不依赖任何硬件头文件 │ ├── ahrs.c Mahony 互补滤波输出四元数与欧拉角 │ ├── pid.c 通用 PID串级复用同一份实现 │ ├── filter.c 二阶低通、陷波抑制机架共振 │ └── ringbuf.c 串口收发环形缓冲 ├── app/ 应用逻辑飞行状态机与控制律 │ ├── control.c 姿态环 角速度环 混控 │ ├── safety.c 解锁判定、失控保护、低电返航 │ ├── mixer.c X 型/十字型混控矩阵 │ └── scheduler.c 1kHz 主循环与分频任务 ├── comm/ 通信层地面站协议、遥测打包 │ ├── mavlink_lite.c 精简版消息编解码 │ └── telemetry.c 定频下发姿态、电压、模式 ├── lib/ 数学库、printf 重定向 ├── tools/ openocd 配置、参数导出脚本 └── Makefile这份目录最有价值的地方是middleware和drivers之间那条硬边界。ahrs.c里看不到任何一个SPI1或者GPIOA它只吃vec3f_t结构体吐四元数。想把这套滤波搬到另一颗 MCU 上把drivers换掉就行算法一行不用动。反过来说如果哪天你想在姿态解算里加一个温度补偿也别往drivers/imu_spi.c里塞那是最容易把驱动写出玄学 bug 的位置。2.2 主循环与任务调度1kHz 控制周期怎么保住飞控里最忌讳的就是周期不定。控制环的 dt 一旦抖动积分项和微分项都会算错表现出来就是悬停时电机声音忽高忽低、轻微上下起伏。这套工程没有上 RTOS用的是带节拍分频的超级循环靠传感器数据就绪引脚驱动而不是靠软件延时对齐。/* app/main.c —— 1kHz 控制主循环所有耗时不定的操作都被踢出了这条路径 */ int main(void) { board_init(); /* 时钟树、GPIO、SPI/I2C、UART、定时器 */ imu_init(); /* 读 WHO_AM_I失败直接进故障停机不做带病起飞 */ param_load(); /* 从 Flash 读参数CRC 不过就加载编译期默认值 */ comm_init(); safety_init(); /* 解锁开关、蜂鸣器、状态灯 */ uint32_t last_us micros(); for (;;) { if (imu_data_ready()) { /* DRDY 引脚拉高才开始一轮 */ uint32_t now_us micros(); float dt (now_us - last_us) * 1e-6f; last_us now_us; /* dt 异常直接丢弃这一拍避免一次调度抖动污染整个积分器 */ if (dt 0.0005f || dt 0.004f) { continue; } imu_read(raw); imu_apply_calib(raw); /* 减零偏、单位换算到 rad/s 和 g */ ahrs_update(raw.gyro, raw.accel, dt); if (safety_is_armed()) { control_step(dt); /* 外环角度 内环角速度 混控 */ } else { mixer_stop(); /* 未解锁输出最低油门电机保持停转 */ } motor_output(); /* 低频任务按拍数分频绝不在控制周期里做串口发送 */ if (tick_10ms 10) { tick_10ms 0; comm_poll(); led_update(); } if (tick_100ms 100){ tick_100ms 0; battery_monitor(); } } } }这段代码有三个参数值得单独说。dt的合法区间卡在 0.5ms 到 4ms 之间对应 250Hz 到 2kHz 的采样超出就直接丢拍——真实的坑在于主循环里如果意外插入一次 Flash 擦写dt 会突然变成几十毫秒PID 的微分项(err - prev_err)/dt分母极小输出瞬间顶到限幅那就是标准的翻车现场。第二个是imu_data_ready()用传感器硬件中断或者 DRDY 引脚比软件定时器准得多也不受主循环负载影响。第三个是分频计数comm_poll()里可能有上百字节的协议解析放在 1kHz 路径里会把周期撑爆分到 100Hz 就够用了地面站看不出差别。2.3 通信链路DMA 加环形缓冲把串口做成不丢包的通道飞控的串口有两个矛盾需求一是接收地面站随时可能发来的参数修改二是发送遥测不能阻塞控制环。这套工程的做法是发送走 DMA、接收走DMA 空闲中断 环形缓冲两个方向都不占用主循环时间。环形缓冲实现看着简单但里面生产者只改 head、消费者只改 tail这条约定要是破了就会出现随机丢字节而且极难复现。/* middleware/ringbuf.c —— 单生产者单消费者两个指针各改各的不需要临界区 */ #define RB_SIZE 512 /* 必须是 2 的幂取模才能换成位与 */ typedef struct { uint8_t buf[RB_SIZE]; volatile uint16_t head; /* 只在串口中断里推进 */ volatile uint16_t tail; /* 只在主循环里推进 */ } ringbuf_t; static inline uint16_t rb_used(const ringbuf_t *rb) { return (uint16_t)((rb-head - rb-tail) (RB_SIZE - 1)); } uint16_t rb_write(ringbuf_t *rb, const uint8_t *src, uint16_t len) { /* 留一个空位用来区分满和空否则 headtail 有歧义 */ uint16_t free_cnt RB_SIZE - 1 - rb_used(rb); if (len free_cnt) { len free_cnt; } /* 宁可丢新包也不覆盖还没读走的旧数据 */ for (uint16_t i 0; i len; i) { rb-buf[(rb-head i) (RB_SIZE - 1)] src[i]; } rb-head (rb-head len) (RB_SIZE - 1); return len; }RB_SIZE取 512 不是随手写的它必须是 2 的幂才能把% RB_SIZE换成 (RB_SIZE - 1)在 Cortex-M4 上省掉一次除法指令。volatile修饰两个指针防止编译器把它们缓存进寄存器导致另一端看不到更新。rb_used里那次减法依赖无符号整型的回绕特性head比tail小时也能算对这一点在跨平台移植时要注意编译器对无符号回绕的处理是一致的但换成有符号就会炸。真正工程化的做法还要在free_cnt不足时打一个溢出计数通过遥测发下来这个计数一旦不为零说明地面站的波特率或者发送节奏有问题。我见过一个现场地面站每 100ms 发一次心跳但固件里接收环形缓冲只有 64 字节心跳包刚好卡在边界上飞行十分钟丢一次命令查了三天才定位到——这种问题没有计数器就是黑匣子。3. 姿态解算与串级 PID六轴原始数据到四路电机输出的完整链路控制链路是飞控的心脏从传感器寄存器里的原始码值到最终四个电调占空比中间要过校准、滤波、姿态解算、双环 PID、混控五道关。每一道关都有自己的参数和陷阱这一章按数据流顺序拆开讲。3.1 传感器校准陀螺零偏与加速度六面标定六轴传感器的原始数据不能直接用。陀螺有零偏静止时输出不是零而是某个几十毫伏的偏移加速度计有比例误差和轴间耦合。零偏不补姿态会以肉眼可见的速度缓慢旋转起飞三十秒就开始往一边偏。/* drivers/imu_calib.c —— 上电静置采 2000 组陀螺取均值当零偏写进 Flash */ #define CALIB_SAMPLES 2000 #define GYRO_BIAS_LIMIT 0.10f /* rad/s超过这个值基本可以判定校准时板子被碰了 */ int gyro_calibrate(vec3f_t *bias_out) { vec3f_t sum {0}, s; for (int i 0; i CALIB_SAMPLES; i) { if (imu_wait_drdy(5) ! 0) { return -1; } /* 5ms 超时说明传感器没起来 */ imu_read_gyro(s); sum.x s.x; sum.y s.y; sum.z s.z; } bias_out-x sum.x / CALIB_SAMPLES; bias_out-y sum.y / CALIB_SAMPLES; bias_out-z sum.z / CALIB_SAMPLES; /* 零偏超限直接判失败让上层提示用户重新上电不要带着错误零偏起飞 */ if (fabsf(bias_out-x) GYRO_BIAS_LIMIT || fabsf(bias_out-y) GYRO_BIAS_LIMIT || fabsf(bias_out-z) GYRO_BIAS_LIMIT) { return -2; } return 0; }采样点数 2000 和采样率是配套的如果传感器配到 1kHz整个过程约 2 秒用户能接受配到 8kHz 就变成 250ms但要注意这时候 I2C 或 SPI 的读取速率得跟上读不及会出现等待超时。GYRO_BIAS_LIMIT这个阈值是血泪经验——0.1 rad/s 约等于 5.7 度每秒正常器件的零偏都在 0.02 以内一旦超了八成是校准时有人碰了桌子或者板子放在不水平的面上。至于加速度计工程里提供了六面标定的辅助模式把六个面依次朝下静置每一面采一批数据算出每个轴的增益和零偏存进参数区。不做六面标定也能飞但姿态角的绝对精度会差几度。还有一点容易被忽略陀螺零偏随温度漂移。冷机校准完飞三分钟电机发热机内温度上去了零偏就变了。低成本的做法是在 Mahony 里保留积分项让它在线慢慢吃掉这部分漂移讲究一点的做法是加一张温度-零偏补偿表工程文档里给了采集方法需要在恒温箱里跑一遍。3.2 Mahony 互补滤波与四元数姿态更新加速度计低频准、高频噪声大陀螺高频准、低频漂移。互补滤波就是把两者的频段优势拼起来。这套工程选用 Mahony原因是它计算量小、只有一个可调增益、在 Cortex-M4 上跑一次不到 40μs。/* middleware/ahrs.c —— Mahony 互补滤波输入角速度(rad/s)与加速度(g)输出四元数 */ #define KP_AHRS 0.60f /* 加速度计修正权重越大收敛越快、机体振动时抖动越明显 */ #define KI_AHRS 0.02f /* 陀螺零偏在线补偿专治缓慢漂移 */ static float q0 1.f, q1 0.f, q2 0.f, q3 0.f; static float bx 0.f, by 0.f, bz 0.f; /* 陀螺零偏估计 */ void ahrs_update(const vec3f_t *gyro, const vec3f_t *accel, float dt) { float gx gyro-x, gy gyro-y, gz gyro-z; float ax accel-x, ay accel-y, az accel-z; /* 加速度模长明显偏离 1g说明机体在剧烈加减速此时它测的不是重力方向 直接退化为纯陀螺积分否则机动时姿态会被拉歪 */ float a_norm sqrtf(ax*ax ay*ay az*az); if (a_norm 1.30f || a_norm 0.70f) { ax ay az 0.f; } else { ax / a_norm; ay / a_norm; az / a_norm; } /* 由当前四元数推算重力在机体坐标系的方向 */ float vx 2.f * (q1*q3 - q0*q2); float vy 2.f * (q0*q1 q2*q3); float vz q0*q0 - q1*q1 - q2*q2 q3*q3; /* 实测重力与估计重力做叉积得到姿态误差向量 */ float ex ay*vz - az*vy; float ey az*vx - ax*vz; float ez ax*vy - ay*vx; if (ax ! 0.f || ay ! 0.f || az ! 0.f) { bx - KI_AHRS * ex * dt; by - KI_AHRS * ey * dt; bz - KI_AHRS * ez * dt; } gx KP_AHRS * ex bx; gy KP_AHRS * ey by; gz KP_AHRS * ez bz; /* 一阶龙格库塔积分四元数微分方程 */ float dq0 (-q1*gx - q2*gy - q3*gz) * 0.5f * dt; float dq1 ( q0*gx q2*gz - q3*gy) * 0.5f * dt; float dq2 ( q0*gy - q1*gz q3*gx) * 0.5f * dt; float dq3 ( q0*gz q1*gy - q2*gx) * 0.5f * dt; q0 dq0; q1 dq1; q2 dq2; q3 dq3; /* 归一化防止数值误差累积让模长偏离 1久了姿态角会整体缩放 */ float inv 1.f / sqrtf(q0*q0 q1*q1 q2*q2 q3*q3); q0 * inv; q1 * inv; q2 * inv; q3 * inv; }KP_AHRS是最需要现场调的一个参数。给到 0.6静止时姿态收敛大概需要 1 到 2 秒机架振动大时加速度计噪声会顺着这个增益进到姿态里表现出来就是姿态角在小数点后一位持续抖动。给到 0.2 就稳但收敛慢上电后要等好几秒。我的习惯是先用 0.5 试飞如果发现悬停时姿态曲线毛刺明显往下调到 0.3同时把加速度计的二阶低通截止频率从 20Hz 降到 10Hz。KI_AHRS千万别给大0.02 已经够用给到 0.1 以上会引入低频振荡那种振荡周期好几秒看着像无人机自己在慢慢晃非常迷惑。那个模长判据也值得说。0.70 ~ 1.30g这个窗口对应大约 ±30% 的重力偏差超过就认为不可信。如果直接把窗口开成无穷大做快速爬升或者俯冲时加速度计读数会被线性加速度污染姿态角出现几度的瞬时偏差飞手会觉得打杆之后机头回不正。3.3 串级 PID 与电机混控姿态控制用串级外环是角度环输入期望角度和当前角度输出期望角速度内环是角速度环输入期望角速度和陀螺实测角速度输出归一化的力矩指令。串级的好处是外环管飞到哪内环管转多快抗风扰靠内环飞手手感靠外环两个可以分开调。/* middleware/pid.c —— 通用 PID积分限幅和微分先行都在这里做掉 */ typedef struct { float kp, ki, kd; float i_limit; /* 积分限幅防止长时间偏差把积分项喂爆 */ float out_limit; /* 输出限幅对应力矩/油门的物理上限 */ float i_term; float prev_meas; /* 微分作用在测量值上避免目标突变时的微分冲击 */ uint8_t first; } pid_t; float pid_step(pid_t *p, float target, float meas, float dt) { float err target - meas; p-i_term p-ki * err * dt; if (p-i_term p-i_limit) { p-i_term p-i_limit; } if (p-i_term -p-i_limit) { p-i_term -p-i_limit; } /* 微分先行对测量值求导摇杆阶跃时不会打出巨大的 D 项尖峰 */ if (p-first) { p-prev_meas meas; p-first 0; } float d_term -p-kd * (meas - p-prev_meas) / dt; p-prev_meas meas; float out p-kp * err p-i_term d_term; if (out p-out_limit) { out p-out_limit; } if (out -p-out_limit) { out -p-out_limit; } return out; }微分先行这个细节在飞控里几乎是必须的。如果用标准形式Kd * (err - prev_err)/dt飞手猛打一下杆目标角速度瞬间从 0 跳到 200 度每秒微分项直接爆表混控输出顶到限幅电机瞬间满转表现出来就是打杆抽一下。改成对测量值求导冲击就没了。外环和内环的参数差异很大常见量级是这样控制环输入输出Kp 量级说明角度环期望角度 / 当前角度期望角速度4 ~ 8决定回中快慢太大就会来回摆角速度环期望角速度 / 陀螺角速度归一化力矩0.15 ~ 0.6决定抗扰受机架惯量影响大高度环期望高度 / 气压高度油门修正0.5 ~ 2气压计噪声大必须重滤波偏航角速度环期望偏航速率 / 陀螺 Z 轴偏航力矩0.3 ~ 1.0对电机转向一致性最敏感混控是把三个轴的力矩指令合成到四个电机上这一步符号错一个起飞就翻。/* app/mixer.c —— X 型四轴混控电机编号必须与实物位置一一对应 */ void mixer_x4(float thr, float roll, float pitch, float yaw, float out[4]) { /* 0 右前(CW) 1 左前(CCW) 2 左后(CW) 3 右后(CCW) */ out[0] thr - roll pitch - yaw; out[1] thr roll pitch yaw; out[2] thr - roll - pitch yaw; out[3] thr roll - pitch - yaw; /* 归一化任一通道超限时整体缩放保持力矩方向不变 直接截断会改变合力矩方向表现就是打杆时反而往反方向偏 */ float max_v out[0], min_v out[0]; for (int i 1; i 4; i) { if (out[i] max_v) max_v out[i]; if (out[i] min_v) min_v out[i]; } float span max_v - min_v; if (span 1.0f) { for (int i 0; i 4; i) { out[i] (out[i] - min_v) / span; } } for (int i 0; i 4; i) { if (out[i] 0.f) out[i] 0.f; if (out[i] 1.f) out[i] 1.f; } }这套符号约定是roll正向对应右滚pitch正向对应抬头。抄到自己机架上之前务必拿在手里慢慢加油门看机体倾斜方向是不是和杆量一致——这一步用不上桨也就不会出事但不做这一步直接装桨起飞就是拿螺旋桨砍桌子。4. 编译、烧录与首飞从交叉工具链到第一次离地的落地步骤算法看得再明白跑不起来都是零。这一章按实际操作顺序走一遍从装工具链到第一次离地。4.1 工具链与 Makefile 目标工程用的是arm-none-eabi这一套开源交叉工具链不依赖任何商业 IDE命令行能编CI 里也能编。# Ubuntu / Debian 环境一次装齐编译器、构建工具和调试器 sudo apt install gcc-arm-none-eabi binutils-arm-none-eabi make openocd # 用官方压缩包时把 bin 目录加进 PATH注意别和系统包混用 export PATH$PATH:/opt/gcc-arm-none-eabi/bin arm-none-eabi-gcc --version # 确认能打印版本这一步失败后面全白搭 cd firmware make clean make -j8 # 产物在 build/ 下firmware.elf / .bin / .hex make size # 打印 flash 与 ram 占用make size的输出要看一眼text段是烧进 Flash 的代码量bss和data是 RAM 占用。飞控的栈都在 RAM 里如果bss已经占了 80% 以上随便加个 512 字节的缓冲就可能栈溢出症状是运行几分钟后随机死机排查起来极其痛苦。编译选项里-O2是默认值但如果你的姿态解算写在中断里别开-ffast-math它会把浮点比较优化掉if (a_norm 1.3f)这类判据可能失效。4.2 烧录与参数配置烧录用 openocd 配上 ST-Link 或者 DAP-Link 都行配置文件放在tools/下改两行就能换调试器。# 烧录 elfopenocd 会自己解析段地址推荐用这个 openocd -f tools/stlink.cfg \ -c program build/firmware.elf verify reset exit # 只有 bin 文件的情况下必须显式给 flash 起始地址 openocd -f tools/stlink.cfg \ -c program build/firmware.bin 0x08000000 verify reset exitverify这个参数别省它会把烧进去的内容读回来比对。省掉它的后果是烧录过程中接触不良写入了一半就断芯片里跑的是半份固件复位后表现各种诡异——串口有输出但协议不通、LED 闪但电机不响应。这种问题没个十几分钟的怀疑人生是过不去的。参数区独立于固件升级固件不会清参数但也意味着参数结构体一改字段老参数读出来就是乱的。工程在参数区头部放了版本号和 CRC版本对不上就回退到默认值这一点在二次开发改参数结构时能救命。参数项典型值调整影响Kp_angle6.0大了回中快但会过冲摆动Kp_rate0.35大了响应硬机架软会有高频抖Kd_rate0.008抑制超调大了放大振动噪声I_limit_rate0.15抗风能力上限太大会积分饱和ahrs_kp0.50姿态收敛速度与抗振的折中acc_lpf_hz15低了延迟大高了噪声进姿态idle_throttle0.06解锁后电机最低转速过低会停转失步4.3 首飞前的台架验证清单装桨之前有一套固定动作我每次都不会跳。先把桨拆掉上电看蜂鸣器和 LED 的自检序列是否正常走完然后进地面站看传感器曲线静止放平姿态角三条线应该是直线抖动幅度在 0.3 度以内把板子往右倾 45 度roll 稳定在 45 附近。接着是解锁判定——油门拉到最低、解锁开关拨到位电机开始怠速转这时候把板子往右倾右前和左后电机转速应该降低另外两个升高。这一步做对了混控符号才算对上。然后是振动检查。把板子装到机架上电机怠速转看加速度计原始数据的频谱主峰如果在 150Hz 以上就问题不大如果落在 80~120Hz就得加减振棉或者调陷波滤波器否则姿态角在飞行中会持续被振动污染表现是悬停时姿态曲线毛刺、电机声音发毛。最后是低电保护。把供电电压慢慢往下调看保护阈值触发时电机是否平滑降转而不是直接切断——直接切断的结果就是空中停机机子直接掉下来。这些都没问题再去空旷场地装桨起飞第一次只做低空悬停半分钟摸一下电机和电调的温度烫手说明混控或者滤波有问题。5. 避坑与排查解锁失败、姿态漂移、起飞翻车的五个典型现场飞控的问题有个特点症状和根因隔得很远。下面这五条是我在实际调试里反复遇到的按现象 → 原因 → 解决记一遍能省掉不少试错时间。第一种解锁不上电机一点反应都没有。现象是地面站显示姿态正常但拨了解锁开关电机就是不转蜂鸣器连响三声。原因通常是解锁条件里有一条没满足最常见的是油门通道没有真正回到底——遥控器校准时的最小值是 1050而固件判定的门槛写的是 1000差这 50 就没过。另一种可能是角速度没有收敛上电时机体在晃内环检测到角速度超过 20 度每秒安全逻辑拒绝解锁。解决方法是接上地面站看解锁条件那一页的逐项状态工程里已经把每一条判定都映射成了一个标志位。如果看不了地面站就在safety.c的safety_unlock_check()里给每条失败分支打一个不同的 LED 闪码比盲猜快得多。第二种姿态角缓慢朝一个方向漂静止放着十几秒就偏出好几度。现象是平放不动roll 从 0 慢慢爬到 3 度、5 度。原因是陀螺零偏没补或者补错了。先确认校准流程真的跑过——很多工程默认上电即校准但如果上电时板子没放平或者旁边桌子在震校准出来的零偏本身就是错的。再确认零偏有没有被温度漂移带偏冷机校准完飞几分钟机内温度升高二十度零偏能变 0.02 rad/s 以上对应每秒 1 度多的漂移。解决方法是把 Mahony 的KI_AHRS从 0.01 提到 0.02让积分项慢慢吃如果漂移量太大压不住就得回头做温度补偿表。第三种一起飞就往一侧翻或者原地打转。现象是加油门离地瞬间直接侧翻或者升空后缓慢自旋方向舵怎么打都纠正不过来。原因八成在混控符号或者电机转向。四个电机的转向必须是对角同向、相邻反向桨叶也分正反装错了推力往下。这两件事任何一个反了都会产生一个恒定的偏航或滚转力矩姿态环拼命修正也纠不回来。解决方法是拆桨上电单独测试每个电机给 10% 油门用一小片纸靠近桨夹感受风向逆时针转的电机对应的桨必须是把风往下压的那一片。确认转向和混控矩阵的编号一一对应之后再装桨。第四种串口一接地面站就是乱码或者收到一堆看不懂的字节。现象是打开串口助手出现乱码偶尔也能看到几个正常字符。原因按概率从高到低排波特率不匹配、系统时钟配置错导致实际波特率和标称值差一截、DMA 发送和printf重定向抢同一个外设。第二点最隐蔽——外部晶振如果是 8MHz 但代码里按 12MHz 算 PLL串口的分频系数就全错了实际波特率会偏 3% 到 5%短帧能收长帧必丢。解决方法是先拿示波器量一个字节的时间宽度反推实际波特率或者干脆在初始化后发一串固定长度的 0x55用逻辑分析仪看波形周期。第三点的话把printf重定向改到调试串口遥测走独立 USART两者物理分开问题就没了。第五种地面推油门正常一加油门就复位重启。现象是电机一转板子重启日志从头开始。原因是电源跌落。电机启动瞬间电流能到十几安如果电调和飞控共用一路 BEC或者电池内阻偏大5V 轨会被拉到 4V 以下MCU 的欠压复位就触发了。表现出来很像软件 bug因为重启后的日志和上电一模一样。解决办法是给飞控单独一路 BEC或者在电源入口并一个 470μF 以上的低 ESR 电容同时把低压检测的阈值和滤波时间调对。这类问题用示波器抓 5V 轨最直接万用表看不出来因为跌落只持续几毫秒。6. 二次开发换控制律、加传感器、扩通信协议的改造与验证这份工程的扩展性主要体现在middleware是纯数学、app是状态机、comm是协议编解码三块互不依赖。想动手改按下面几条路线走比较稳。改造点涉及文件验证方式替换姿态算法Mahony 换 EKFmiddleware/ahrs.c离线回放录制的 IMU 数据比对欧拉角曲线增加气压计做高度保持drivers/baro_i2c.c、app/control.c台架上手动升降看高度环输出是否平滑扩展通信协议字段comm/mavlink_lite.c、comm/telemetry.c地面站解析不报错字段量纲对齐加飞行模式定高/定点app/safety.c状态机分模式逐一解锁测试先不装桨改姿态算法是最容易翻车的一项。把 Mahony 换成 EKF 之后接口还是ahrs_update(gyro, accel, dt)但 EKF 通常还想要磁力计和气压计单位、坐标系、更新频率全都要对。我的做法是先在 PC 上把录下来的 IMU 原始数据每帧带时间戳跑一遍新算法和原来的欧拉角曲线叠在一起看。工程里tools/下有个回放脚本把串口日志转成 csvPython 那边读进来逐帧喂给算法就行。这一步能省掉大量上机试错。加传感器要注意调度位置。气压计是 I2C 器件一次读寄存器可能耗时几百微秒绝对不能塞进 1kHz 主路径。正确做法是放到 100Hz 的分频任务里读回来之后先过二阶低通再送进高度环。我一般会在scheduler.c里给每个新任务显式标注频率和最大耗时超过预算就报警这个习惯是从一次加了气压计之后遥控延迟变大的事故里养成的。扩协议相对安全只要守住两条一是新字段加在包尾别插在中间否则地面站按固定偏移解析会全部错位二是给协议加版本号固件和地面站版本不匹配时明确拒绝而不是勉强解析。工程里的mavlink_lite.c头部有 2 字节的版本和长度改动时顺手升一下版本号能省掉很多为什么参数写不进去的排查。最后说一句实在话从这个工程改出来的东西我每次上机前都强制走一遍拆桨自检 → 台架混控测试 → 低空悬停 → 定高 → 定点这套流程一步都不跳。第一次省掉台架测试直接装桨起飞桨叶把桌角削掉一块从那以后这个顺序就刻进肌肉记忆了。希望帮到你。本文还有配套的精品资源点击获取
简介这份C语言嵌入式无人机开源项目源代码面向具备一定单片机基础、希望深入理解飞控系统实现的开发者与学生可用于课程设计、毕业设计及飞控学习参考。压缩包共1740个文件约19.23MB涵盖258个C源文件、278个头文件以及STM32工程配置、链接脚本、启动汇编、HTML文档和图像资源完整呈现硬件控制、传感器采集与飞行控制等模块。项目通过微控制器驱动电机、GPS和遥控器模块利用加速度计、陀螺仪、气压计获取姿态与位置数据并以PID算法对姿态、速度与高度进行闭环调节另含图像处理、无线通信与远程控制相关代码。已有870人学习代码注释较丰富、目录层次清楚适合按模块阅读飞控逻辑、移植外设驱动、排查传感器数据处理问题或搭建嵌入式飞控实验平台。1. 先看它能飞什么一套 C 语言嵌入式无人机固件的能力边界前阵子有个做课设的同学抱着自己焊的四轴板子找我说解锁之后电机抖得像筛糠日志里姿态角每秒跳十几度。我把他那份从三个地方抄来的代码翻了一遍毛病很典型姿态解算和电机输出挤在同一个定时器中断里一次浮点运算就把 1kHz 的控制周期撑到 2.3ms周期一变PID 的参数全部失效。后来换成一套结构完整的 C 语言嵌入式无人机开源项目源代码配上它自带的设计文档两天就把悬停调稳了。这套工程真正值得看的地方不在算法有多前沿而在于它把一架能飞的多旋翼该有的模块全摊开摆在明面上传感器驱动、姿态解算、串级 PID、电机混控、通信协议、参数存储每一块都对应一份说明讲清楚为什么这么写、改哪里会出问题。它适合刚接触无人机控制、想先跑通再动手改的开发者也适合当教学骨架。2. 工程骨架拆解从目录结构看飞控固件的分层与调度拿到一份陌生的飞控源码我一般不看 main 函数先看目录。目录结构基本能暴露作者的分层意识——层次乱的工程后面调参一定痛苦。这套工程用的是很经典的五层切法从硬件往上依次是板级支持、芯片外设封装、器件驱动、算法中间件、应用逻辑中间夹一层通信。层与层之间只允许单向依赖应用层不许直接摸寄存器驱动层不许调用控制逻辑。2.1 目录结构与各层职责firmware/ ├── bsp/ 板级支持时钟树、引脚复用、板子差异都收在这里 │ ├── board.c/h 板级初始化入口换板子只改这一层 │ └── board_config.h 引脚定义、外设实例号 ├── drivers/ 器件驱动只负责把寄存器读成物理量 │ ├── imu_spi.c 六轴传感器 SPI 读写含自检和 WHO_AM_I 校验 │ ├── baro_i2c.c 气压计做高度保持时才编进来 │ ├── pwm_out.c 四路电调 PWM/DSHOT 输出 │ └── flash_param.c 参数区读写带 CRC ├── middleware/ 算法中间件纯数学不依赖任何硬件头文件 │ ├── ahrs.c Mahony 互补滤波输出四元数与欧拉角 │ ├── pid.c 通用 PID串级复用同一份实现 │ ├── filter.c 二阶低通、陷波抑制机架共振 │ └── ringbuf.c 串口收发环形缓冲 ├── app/ 应用逻辑飞行状态机与控制律 │ ├── control.c 姿态环 角速度环 混控 │ ├── safety.c 解锁判定、失控保护、低电返航 │ ├── mixer.c X 型/十字型混控矩阵 │ └── scheduler.c 1kHz 主循环与分频任务 ├── comm/ 通信层地面站协议、遥测打包 │ ├── mavlink_lite.c 精简版消息编解码 │ └── telemetry.c 定频下发姿态、电压、模式 ├── lib/ 数学库、printf 重定向 ├── tools/ openocd 配置、参数导出脚本 └── Makefile这份目录最有价值的地方是middleware和drivers之间那条硬边界。ahrs.c里看不到任何一个SPI1或者GPIOA它只吃vec3f_t结构体吐四元数。想把这套滤波搬到另一颗 MCU 上把drivers换掉就行算法一行不用动。反过来说如果哪天你想在姿态解算里加一个温度补偿也别往drivers/imu_spi.c里塞那是最容易把驱动写出玄学 bug 的位置。2.2 主循环与任务调度1kHz 控制周期怎么保住飞控里最忌讳的就是周期不定。控制环的 dt 一旦抖动积分项和微分项都会算错表现出来就是悬停时电机声音忽高忽低、轻微上下起伏。这套工程没有上 RTOS用的是带节拍分频的超级循环靠传感器数据就绪引脚驱动而不是靠软件延时对齐。/* app/main.c —— 1kHz 控制主循环所有耗时不定的操作都被踢出了这条路径 */ int main(void) { board_init(); /* 时钟树、GPIO、SPI/I2C、UART、定时器 */ imu_init(); /* 读 WHO_AM_I失败直接进故障停机不做带病起飞 */ param_load(); /* 从 Flash 读参数CRC 不过就加载编译期默认值 */ comm_init(); safety_init(); /* 解锁开关、蜂鸣器、状态灯 */ uint32_t last_us micros(); for (;;) { if (imu_data_ready()) { /* DRDY 引脚拉高才开始一轮 */ uint32_t now_us micros(); float dt (now_us - last_us) * 1e-6f; last_us now_us; /* dt 异常直接丢弃这一拍避免一次调度抖动污染整个积分器 */ if (dt 0.0005f || dt 0.004f) { continue; } imu_read(raw); imu_apply_calib(raw); /* 减零偏、单位换算到 rad/s 和 g */ ahrs_update(raw.gyro, raw.accel, dt); if (safety_is_armed()) { control_step(dt); /* 外环角度 内环角速度 混控 */ } else { mixer_stop(); /* 未解锁输出最低油门电机保持停转 */ } motor_output(); /* 低频任务按拍数分频绝不在控制周期里做串口发送 */ if (tick_10ms 10) { tick_10ms 0; comm_poll(); led_update(); } if (tick_100ms 100){ tick_100ms 0; battery_monitor(); } } } }这段代码有三个参数值得单独说。dt的合法区间卡在 0.5ms 到 4ms 之间对应 250Hz 到 2kHz 的采样超出就直接丢拍——真实的坑在于主循环里如果意外插入一次 Flash 擦写dt 会突然变成几十毫秒PID 的微分项(err - prev_err)/dt分母极小输出瞬间顶到限幅那就是标准的翻车现场。第二个是imu_data_ready()用传感器硬件中断或者 DRDY 引脚比软件定时器准得多也不受主循环负载影响。第三个是分频计数comm_poll()里可能有上百字节的协议解析放在 1kHz 路径里会把周期撑爆分到 100Hz 就够用了地面站看不出差别。2.3 通信链路DMA 加环形缓冲把串口做成不丢包的通道飞控的串口有两个矛盾需求一是接收地面站随时可能发来的参数修改二是发送遥测不能阻塞控制环。这套工程的做法是发送走 DMA、接收走DMA 空闲中断 环形缓冲两个方向都不占用主循环时间。环形缓冲实现看着简单但里面生产者只改 head、消费者只改 tail这条约定要是破了就会出现随机丢字节而且极难复现。/* middleware/ringbuf.c —— 单生产者单消费者两个指针各改各的不需要临界区 */ #define RB_SIZE 512 /* 必须是 2 的幂取模才能换成位与 */ typedef struct { uint8_t buf[RB_SIZE]; volatile uint16_t head; /* 只在串口中断里推进 */ volatile uint16_t tail; /* 只在主循环里推进 */ } ringbuf_t; static inline uint16_t rb_used(const ringbuf_t *rb) { return (uint16_t)((rb-head - rb-tail) (RB_SIZE - 1)); } uint16_t rb_write(ringbuf_t *rb, const uint8_t *src, uint16_t len) { /* 留一个空位用来区分满和空否则 headtail 有歧义 */ uint16_t free_cnt RB_SIZE - 1 - rb_used(rb); if (len free_cnt) { len free_cnt; } /* 宁可丢新包也不覆盖还没读走的旧数据 */ for (uint16_t i 0; i len; i) { rb-buf[(rb-head i) (RB_SIZE - 1)] src[i]; } rb-head (rb-head len) (RB_SIZE - 1); return len; }RB_SIZE取 512 不是随手写的它必须是 2 的幂才能把% RB_SIZE换成 (RB_SIZE - 1)在 Cortex-M4 上省掉一次除法指令。volatile修饰两个指针防止编译器把它们缓存进寄存器导致另一端看不到更新。rb_used里那次减法依赖无符号整型的回绕特性head比tail小时也能算对这一点在跨平台移植时要注意编译器对无符号回绕的处理是一致的但换成有符号就会炸。真正工程化的做法还要在free_cnt不足时打一个溢出计数通过遥测发下来这个计数一旦不为零说明地面站的波特率或者发送节奏有问题。我见过一个现场地面站每 100ms 发一次心跳但固件里接收环形缓冲只有 64 字节心跳包刚好卡在边界上飞行十分钟丢一次命令查了三天才定位到——这种问题没有计数器就是黑匣子。3. 姿态解算与串级 PID六轴原始数据到四路电机输出的完整链路控制链路是飞控的心脏从传感器寄存器里的原始码值到最终四个电调占空比中间要过校准、滤波、姿态解算、双环 PID、混控五道关。每一道关都有自己的参数和陷阱这一章按数据流顺序拆开讲。3.1 传感器校准陀螺零偏与加速度六面标定六轴传感器的原始数据不能直接用。陀螺有零偏静止时输出不是零而是某个几十毫伏的偏移加速度计有比例误差和轴间耦合。零偏不补姿态会以肉眼可见的速度缓慢旋转起飞三十秒就开始往一边偏。/* drivers/imu_calib.c —— 上电静置采 2000 组陀螺取均值当零偏写进 Flash */ #define CALIB_SAMPLES 2000 #define GYRO_BIAS_LIMIT 0.10f /* rad/s超过这个值基本可以判定校准时板子被碰了 */ int gyro_calibrate(vec3f_t *bias_out) { vec3f_t sum {0}, s; for (int i 0; i CALIB_SAMPLES; i) { if (imu_wait_drdy(5) ! 0) { return -1; } /* 5ms 超时说明传感器没起来 */ imu_read_gyro(s); sum.x s.x; sum.y s.y; sum.z s.z; } bias_out-x sum.x / CALIB_SAMPLES; bias_out-y sum.y / CALIB_SAMPLES; bias_out-z sum.z / CALIB_SAMPLES; /* 零偏超限直接判失败让上层提示用户重新上电不要带着错误零偏起飞 */ if (fabsf(bias_out-x) GYRO_BIAS_LIMIT || fabsf(bias_out-y) GYRO_BIAS_LIMIT || fabsf(bias_out-z) GYRO_BIAS_LIMIT) { return -2; } return 0; }采样点数 2000 和采样率是配套的如果传感器配到 1kHz整个过程约 2 秒用户能接受配到 8kHz 就变成 250ms但要注意这时候 I2C 或 SPI 的读取速率得跟上读不及会出现等待超时。GYRO_BIAS_LIMIT这个阈值是血泪经验——0.1 rad/s 约等于 5.7 度每秒正常器件的零偏都在 0.02 以内一旦超了八成是校准时有人碰了桌子或者板子放在不水平的面上。至于加速度计工程里提供了六面标定的辅助模式把六个面依次朝下静置每一面采一批数据算出每个轴的增益和零偏存进参数区。不做六面标定也能飞但姿态角的绝对精度会差几度。还有一点容易被忽略陀螺零偏随温度漂移。冷机校准完飞三分钟电机发热机内温度上去了零偏就变了。低成本的做法是在 Mahony 里保留积分项让它在线慢慢吃掉这部分漂移讲究一点的做法是加一张温度-零偏补偿表工程文档里给了采集方法需要在恒温箱里跑一遍。3.2 Mahony 互补滤波与四元数姿态更新加速度计低频准、高频噪声大陀螺高频准、低频漂移。互补滤波就是把两者的频段优势拼起来。这套工程选用 Mahony原因是它计算量小、只有一个可调增益、在 Cortex-M4 上跑一次不到 40μs。/* middleware/ahrs.c —— Mahony 互补滤波输入角速度(rad/s)与加速度(g)输出四元数 */ #define KP_AHRS 0.60f /* 加速度计修正权重越大收敛越快、机体振动时抖动越明显 */ #define KI_AHRS 0.02f /* 陀螺零偏在线补偿专治缓慢漂移 */ static float q0 1.f, q1 0.f, q2 0.f, q3 0.f; static float bx 0.f, by 0.f, bz 0.f; /* 陀螺零偏估计 */ void ahrs_update(const vec3f_t *gyro, const vec3f_t *accel, float dt) { float gx gyro-x, gy gyro-y, gz gyro-z; float ax accel-x, ay accel-y, az accel-z; /* 加速度模长明显偏离 1g说明机体在剧烈加减速此时它测的不是重力方向 直接退化为纯陀螺积分否则机动时姿态会被拉歪 */ float a_norm sqrtf(ax*ax ay*ay az*az); if (a_norm 1.30f || a_norm 0.70f) { ax ay az 0.f; } else { ax / a_norm; ay / a_norm; az / a_norm; } /* 由当前四元数推算重力在机体坐标系的方向 */ float vx 2.f * (q1*q3 - q0*q2); float vy 2.f * (q0*q1 q2*q3); float vz q0*q0 - q1*q1 - q2*q2 q3*q3; /* 实测重力与估计重力做叉积得到姿态误差向量 */ float ex ay*vz - az*vy; float ey az*vx - ax*vz; float ez ax*vy - ay*vx; if (ax ! 0.f || ay ! 0.f || az ! 0.f) { bx - KI_AHRS * ex * dt; by - KI_AHRS * ey * dt; bz - KI_AHRS * ez * dt; } gx KP_AHRS * ex bx; gy KP_AHRS * ey by; gz KP_AHRS * ez bz; /* 一阶龙格库塔积分四元数微分方程 */ float dq0 (-q1*gx - q2*gy - q3*gz) * 0.5f * dt; float dq1 ( q0*gx q2*gz - q3*gy) * 0.5f * dt; float dq2 ( q0*gy - q1*gz q3*gx) * 0.5f * dt; float dq3 ( q0*gz q1*gy - q2*gx) * 0.5f * dt; q0 dq0; q1 dq1; q2 dq2; q3 dq3; /* 归一化防止数值误差累积让模长偏离 1久了姿态角会整体缩放 */ float inv 1.f / sqrtf(q0*q0 q1*q1 q2*q2 q3*q3); q0 * inv; q1 * inv; q2 * inv; q3 * inv; }KP_AHRS是最需要现场调的一个参数。给到 0.6静止时姿态收敛大概需要 1 到 2 秒机架振动大时加速度计噪声会顺着这个增益进到姿态里表现出来就是姿态角在小数点后一位持续抖动。给到 0.2 就稳但收敛慢上电后要等好几秒。我的习惯是先用 0.5 试飞如果发现悬停时姿态曲线毛刺明显往下调到 0.3同时把加速度计的二阶低通截止频率从 20Hz 降到 10Hz。KI_AHRS千万别给大0.02 已经够用给到 0.1 以上会引入低频振荡那种振荡周期好几秒看着像无人机自己在慢慢晃非常迷惑。那个模长判据也值得说。0.70 ~ 1.30g这个窗口对应大约 ±30% 的重力偏差超过就认为不可信。如果直接把窗口开成无穷大做快速爬升或者俯冲时加速度计读数会被线性加速度污染姿态角出现几度的瞬时偏差飞手会觉得打杆之后机头回不正。3.3 串级 PID 与电机混控姿态控制用串级外环是角度环输入期望角度和当前角度输出期望角速度内环是角速度环输入期望角速度和陀螺实测角速度输出归一化的力矩指令。串级的好处是外环管飞到哪内环管转多快抗风扰靠内环飞手手感靠外环两个可以分开调。/* middleware/pid.c —— 通用 PID积分限幅和微分先行都在这里做掉 */ typedef struct { float kp, ki, kd; float i_limit; /* 积分限幅防止长时间偏差把积分项喂爆 */ float out_limit; /* 输出限幅对应力矩/油门的物理上限 */ float i_term; float prev_meas; /* 微分作用在测量值上避免目标突变时的微分冲击 */ uint8_t first; } pid_t; float pid_step(pid_t *p, float target, float meas, float dt) { float err target - meas; p-i_term p-ki * err * dt; if (p-i_term p-i_limit) { p-i_term p-i_limit; } if (p-i_term -p-i_limit) { p-i_term -p-i_limit; } /* 微分先行对测量值求导摇杆阶跃时不会打出巨大的 D 项尖峰 */ if (p-first) { p-prev_meas meas; p-first 0; } float d_term -p-kd * (meas - p-prev_meas) / dt; p-prev_meas meas; float out p-kp * err p-i_term d_term; if (out p-out_limit) { out p-out_limit; } if (out -p-out_limit) { out -p-out_limit; } return out; }微分先行这个细节在飞控里几乎是必须的。如果用标准形式Kd * (err - prev_err)/dt飞手猛打一下杆目标角速度瞬间从 0 跳到 200 度每秒微分项直接爆表混控输出顶到限幅电机瞬间满转表现出来就是打杆抽一下。改成对测量值求导冲击就没了。外环和内环的参数差异很大常见量级是这样控制环输入输出Kp 量级说明角度环期望角度 / 当前角度期望角速度4 ~ 8决定回中快慢太大就会来回摆角速度环期望角速度 / 陀螺角速度归一化力矩0.15 ~ 0.6决定抗扰受机架惯量影响大高度环期望高度 / 气压高度油门修正0.5 ~ 2气压计噪声大必须重滤波偏航角速度环期望偏航速率 / 陀螺 Z 轴偏航力矩0.3 ~ 1.0对电机转向一致性最敏感混控是把三个轴的力矩指令合成到四个电机上这一步符号错一个起飞就翻。/* app/mixer.c —— X 型四轴混控电机编号必须与实物位置一一对应 */ void mixer_x4(float thr, float roll, float pitch, float yaw, float out[4]) { /* 0 右前(CW) 1 左前(CCW) 2 左后(CW) 3 右后(CCW) */ out[0] thr - roll pitch - yaw; out[1] thr roll pitch yaw; out[2] thr - roll - pitch yaw; out[3] thr roll - pitch - yaw; /* 归一化任一通道超限时整体缩放保持力矩方向不变 直接截断会改变合力矩方向表现就是打杆时反而往反方向偏 */ float max_v out[0], min_v out[0]; for (int i 1; i 4; i) { if (out[i] max_v) max_v out[i]; if (out[i] min_v) min_v out[i]; } float span max_v - min_v; if (span 1.0f) { for (int i 0; i 4; i) { out[i] (out[i] - min_v) / span; } } for (int i 0; i 4; i) { if (out[i] 0.f) out[i] 0.f; if (out[i] 1.f) out[i] 1.f; } }这套符号约定是roll正向对应右滚pitch正向对应抬头。抄到自己机架上之前务必拿在手里慢慢加油门看机体倾斜方向是不是和杆量一致——这一步用不上桨也就不会出事但不做这一步直接装桨起飞就是拿螺旋桨砍桌子。4. 编译、烧录与首飞从交叉工具链到第一次离地的落地步骤算法看得再明白跑不起来都是零。这一章按实际操作顺序走一遍从装工具链到第一次离地。4.1 工具链与 Makefile 目标工程用的是arm-none-eabi这一套开源交叉工具链不依赖任何商业 IDE命令行能编CI 里也能编。# Ubuntu / Debian 环境一次装齐编译器、构建工具和调试器 sudo apt install gcc-arm-none-eabi binutils-arm-none-eabi make openocd # 用官方压缩包时把 bin 目录加进 PATH注意别和系统包混用 export PATH$PATH:/opt/gcc-arm-none-eabi/bin arm-none-eabi-gcc --version # 确认能打印版本这一步失败后面全白搭 cd firmware make clean make -j8 # 产物在 build/ 下firmware.elf / .bin / .hex make size # 打印 flash 与 ram 占用make size的输出要看一眼text段是烧进 Flash 的代码量bss和data是 RAM 占用。飞控的栈都在 RAM 里如果bss已经占了 80% 以上随便加个 512 字节的缓冲就可能栈溢出症状是运行几分钟后随机死机排查起来极其痛苦。编译选项里-O2是默认值但如果你的姿态解算写在中断里别开-ffast-math它会把浮点比较优化掉if (a_norm 1.3f)这类判据可能失效。4.2 烧录与参数配置烧录用 openocd 配上 ST-Link 或者 DAP-Link 都行配置文件放在tools/下改两行就能换调试器。# 烧录 elfopenocd 会自己解析段地址推荐用这个 openocd -f tools/stlink.cfg \ -c program build/firmware.elf verify reset exit # 只有 bin 文件的情况下必须显式给 flash 起始地址 openocd -f tools/stlink.cfg \ -c program build/firmware.bin 0x08000000 verify reset exitverify这个参数别省它会把烧进去的内容读回来比对。省掉它的后果是烧录过程中接触不良写入了一半就断芯片里跑的是半份固件复位后表现各种诡异——串口有输出但协议不通、LED 闪但电机不响应。这种问题没个十几分钟的怀疑人生是过不去的。参数区独立于固件升级固件不会清参数但也意味着参数结构体一改字段老参数读出来就是乱的。工程在参数区头部放了版本号和 CRC版本对不上就回退到默认值这一点在二次开发改参数结构时能救命。参数项典型值调整影响Kp_angle6.0大了回中快但会过冲摆动Kp_rate0.35大了响应硬机架软会有高频抖Kd_rate0.008抑制超调大了放大振动噪声I_limit_rate0.15抗风能力上限太大会积分饱和ahrs_kp0.50姿态收敛速度与抗振的折中acc_lpf_hz15低了延迟大高了噪声进姿态idle_throttle0.06解锁后电机最低转速过低会停转失步4.3 首飞前的台架验证清单装桨之前有一套固定动作我每次都不会跳。先把桨拆掉上电看蜂鸣器和 LED 的自检序列是否正常走完然后进地面站看传感器曲线静止放平姿态角三条线应该是直线抖动幅度在 0.3 度以内把板子往右倾 45 度roll 稳定在 45 附近。接着是解锁判定——油门拉到最低、解锁开关拨到位电机开始怠速转这时候把板子往右倾右前和左后电机转速应该降低另外两个升高。这一步做对了混控符号才算对上。然后是振动检查。把板子装到机架上电机怠速转看加速度计原始数据的频谱主峰如果在 150Hz 以上就问题不大如果落在 80~120Hz就得加减振棉或者调陷波滤波器否则姿态角在飞行中会持续被振动污染表现是悬停时姿态曲线毛刺、电机声音发毛。最后是低电保护。把供电电压慢慢往下调看保护阈值触发时电机是否平滑降转而不是直接切断——直接切断的结果就是空中停机机子直接掉下来。这些都没问题再去空旷场地装桨起飞第一次只做低空悬停半分钟摸一下电机和电调的温度烫手说明混控或者滤波有问题。5. 避坑与排查解锁失败、姿态漂移、起飞翻车的五个典型现场飞控的问题有个特点症状和根因隔得很远。下面这五条是我在实际调试里反复遇到的按现象 → 原因 → 解决记一遍能省掉不少试错时间。第一种解锁不上电机一点反应都没有。现象是地面站显示姿态正常但拨了解锁开关电机就是不转蜂鸣器连响三声。原因通常是解锁条件里有一条没满足最常见的是油门通道没有真正回到底——遥控器校准时的最小值是 1050而固件判定的门槛写的是 1000差这 50 就没过。另一种可能是角速度没有收敛上电时机体在晃内环检测到角速度超过 20 度每秒安全逻辑拒绝解锁。解决方法是接上地面站看解锁条件那一页的逐项状态工程里已经把每一条判定都映射成了一个标志位。如果看不了地面站就在safety.c的safety_unlock_check()里给每条失败分支打一个不同的 LED 闪码比盲猜快得多。第二种姿态角缓慢朝一个方向漂静止放着十几秒就偏出好几度。现象是平放不动roll 从 0 慢慢爬到 3 度、5 度。原因是陀螺零偏没补或者补错了。先确认校准流程真的跑过——很多工程默认上电即校准但如果上电时板子没放平或者旁边桌子在震校准出来的零偏本身就是错的。再确认零偏有没有被温度漂移带偏冷机校准完飞几分钟机内温度升高二十度零偏能变 0.02 rad/s 以上对应每秒 1 度多的漂移。解决方法是把 Mahony 的KI_AHRS从 0.01 提到 0.02让积分项慢慢吃如果漂移量太大压不住就得回头做温度补偿表。第三种一起飞就往一侧翻或者原地打转。现象是加油门离地瞬间直接侧翻或者升空后缓慢自旋方向舵怎么打都纠正不过来。原因八成在混控符号或者电机转向。四个电机的转向必须是对角同向、相邻反向桨叶也分正反装错了推力往下。这两件事任何一个反了都会产生一个恒定的偏航或滚转力矩姿态环拼命修正也纠不回来。解决方法是拆桨上电单独测试每个电机给 10% 油门用一小片纸靠近桨夹感受风向逆时针转的电机对应的桨必须是把风往下压的那一片。确认转向和混控矩阵的编号一一对应之后再装桨。第四种串口一接地面站就是乱码或者收到一堆看不懂的字节。现象是打开串口助手出现乱码偶尔也能看到几个正常字符。原因按概率从高到低排波特率不匹配、系统时钟配置错导致实际波特率和标称值差一截、DMA 发送和printf重定向抢同一个外设。第二点最隐蔽——外部晶振如果是 8MHz 但代码里按 12MHz 算 PLL串口的分频系数就全错了实际波特率会偏 3% 到 5%短帧能收长帧必丢。解决方法是先拿示波器量一个字节的时间宽度反推实际波特率或者干脆在初始化后发一串固定长度的 0x55用逻辑分析仪看波形周期。第三点的话把printf重定向改到调试串口遥测走独立 USART两者物理分开问题就没了。第五种地面推油门正常一加油门就复位重启。现象是电机一转板子重启日志从头开始。原因是电源跌落。电机启动瞬间电流能到十几安如果电调和飞控共用一路 BEC或者电池内阻偏大5V 轨会被拉到 4V 以下MCU 的欠压复位就触发了。表现出来很像软件 bug因为重启后的日志和上电一模一样。解决办法是给飞控单独一路 BEC或者在电源入口并一个 470μF 以上的低 ESR 电容同时把低压检测的阈值和滤波时间调对。这类问题用示波器抓 5V 轨最直接万用表看不出来因为跌落只持续几毫秒。6. 二次开发换控制律、加传感器、扩通信协议的改造与验证这份工程的扩展性主要体现在middleware是纯数学、app是状态机、comm是协议编解码三块互不依赖。想动手改按下面几条路线走比较稳。改造点涉及文件验证方式替换姿态算法Mahony 换 EKFmiddleware/ahrs.c离线回放录制的 IMU 数据比对欧拉角曲线增加气压计做高度保持drivers/baro_i2c.c、app/control.c台架上手动升降看高度环输出是否平滑扩展通信协议字段comm/mavlink_lite.c、comm/telemetry.c地面站解析不报错字段量纲对齐加飞行模式定高/定点app/safety.c状态机分模式逐一解锁测试先不装桨改姿态算法是最容易翻车的一项。把 Mahony 换成 EKF 之后接口还是ahrs_update(gyro, accel, dt)但 EKF 通常还想要磁力计和气压计单位、坐标系、更新频率全都要对。我的做法是先在 PC 上把录下来的 IMU 原始数据每帧带时间戳跑一遍新算法和原来的欧拉角曲线叠在一起看。工程里tools/下有个回放脚本把串口日志转成 csvPython 那边读进来逐帧喂给算法就行。这一步能省掉大量上机试错。加传感器要注意调度位置。气压计是 I2C 器件一次读寄存器可能耗时几百微秒绝对不能塞进 1kHz 主路径。正确做法是放到 100Hz 的分频任务里读回来之后先过二阶低通再送进高度环。我一般会在scheduler.c里给每个新任务显式标注频率和最大耗时超过预算就报警这个习惯是从一次加了气压计之后遥控延迟变大的事故里养成的。扩协议相对安全只要守住两条一是新字段加在包尾别插在中间否则地面站按固定偏移解析会全部错位二是给协议加版本号固件和地面站版本不匹配时明确拒绝而不是勉强解析。工程里的mavlink_lite.c头部有 2 字节的版本和长度改动时顺手升一下版本号能省掉很多为什么参数写不进去的排查。最后说一句实在话从这个工程改出来的东西我每次上机前都强制走一遍拆桨自检 → 台架混控测试 → 低空悬停 → 定高 → 定点这套流程一步都不跳。第一次省掉台架测试直接装桨起飞桨叶把桌角削掉一块从那以后这个顺序就刻进肌肉记忆了。希望帮到你。本文还有配套的精品资源点击获取
