简介这份资源是Simple Bgc开源项目的完整源码面向从事三轴增稳云台开发、嵌入式控制学习以及STM32工程实践的开发者。该项目源自俄版云台方案早期基于Arduino平台后续版本转向STM32控制器可用于研究云台姿态解算、电机驱动与闭环稳定控制等核心逻辑。压缩包共200个文件约580KB以C语言源文件89个和头文件95个为主体另含汇编启动文件、Keil工程文件uvproj、uvopt、批处理脚本及少量配置说明文件构成一套可直接编译的嵌入式工程结构。目前已有3433人学习下载说明其在云台控制领域具有较高的参考价值。读者可从中获取完整的STM32外设驱动代码如定时器、Flash、RCC、ADC等模块、云台控制算法实现以及工程组织方式适合作为二次开发或课程设计的底层参考帮助理解从传感器采集到电机输出的完整控制链路。1. 三轴增稳云台为什么值得从源码啃起很多人第一次接触三轴增稳云台是从一段抖动的航拍画面开始的明明电机转得挺稳镜头却像得了帕金森。Simple BGC 这类开源固件之所以被反复翻出来研究核心就在于它把「姿态解算 无刷电机闭环 云台机械补偿」这条链路完整摊开在源码里而不是封装成一个黑匣子。基于 STM32 的三轴增稳云台开源代码本质上是一套跑在 Cortex-M 内核上的实时控制系统MPU6050 之类的 IMU 出原始角速度与加速度经过互补滤波或卡尔曼滤波融合出姿态角再通过 PID 输出三路 PWM 去驱动三个无刷电机的电调最终让相机在载体晃动时保持指向稳定。它适合谁适合已经会点 STM32、想搞懂闭环控制怎么落地的人也适合做机器人、车载云台、手持稳定器的团队拿来做二次开发底座。这一章先把「它到底在控制什么」讲清楚后面才好动手。2. 从源码结构看三轴增稳云台的控制链路拿到一份基于 STM32 的三轴增稳云台开源代码别急着编译烧录先花二十分钟把目录结构读一遍比盲目改参数省下大量返工。典型工程会分成驱动层、算法层、应用层三块理解这个分层后面调 PID 才知道该动哪个文件。2.1 工程目录与模块职责划分常见做法是下面这种布局不同作者命名略有差异但职责基本一致目录/文件职责改动频率bsp/或hardware/GPIO、定时器、I2C、串口底层驱动低imu/IMU 初始化、原始数据读取、零偏校准中filter/互补滤波、卡尔曼滤波姿态解算中pid/三轴 PID 计算与输出限幅高motor/PWM 输出、电调驱动、方向映射中main.c主循环调度、模式切换、保护逻辑中读代码的顺序建议是先看main.c的主循环周期再看 IMU 采样频率最后看 PID 在哪一步被调用。因为云台是硬实时系统主循环周期直接决定控制带宽周期不稳后面参数怎么调都是玄学。2.2 姿态解算互补滤波与卡尔曼滤波怎么选姿态解算是整条链路的地基。加速度计长期准但短期噪声大陀螺仪短期准但会漂移所以必须融合。互补滤波实现简单、算力占用低适合 STM32F1/F4 这类主频不高的芯片卡尔曼滤波精度更好但矩阵运算吃 CPUF1 上跑三轴容易吃力。互补滤波的核心一行大概是这样// angle: 融合后角度, gyro: 陀螺仪角速度(deg/s), acc: 加速度计解算角度 // dt: 采样周期(s), alpha: 互补系数, 一般取 0.96~0.99 angle alpha * (angle gyro * dt) (1.0f - alpha) * acc;逻辑说明前半段用陀螺仪积分预测角度后半段用加速度计观测值修正漂移。alpha越大越信任陀螺仪动态响应好但会漂越小越信任加速度计静态稳但抖动大。参数说明dt必须和实际采样周期一致如果你在 1kHz 定时器里调用却填了 0.01角度会直接算错这是新手最常见的翻车点。卡尔曼滤波则要维护状态协方差矩阵代码量翻几倍。我的建议是先用互补滤波把云台跑稳确认机械和电机没问题再考虑换卡尔曼。一上来就啃卡尔曼很容易在参数整定阶段迷失。2.3 三轴 PID 与电机输出映射姿态角算出来后目标角度减去当前角度得到误差送进 PID// 单轴 PID 简化实现 float pid_calc(PID_t *pid, float target, float measure, float dt) { float err target - measure; pid-integral err * dt; // 积分项累加 if (pid-integral pid-i_max) // 积分限幅, 防饱和 pid-integral pid-i_max; else if (pid-integral -pid-i_max) pid-integral -pid-i_max; float derivative (err - pid-last_err) / dt; // 微分项 pid-last_err err; return pid-kp * err pid-ki * pid-integral pid-kd * derivative; }逻辑说明比例项决定响应力度积分项消除静态误差微分项抑制超调。参数说明i_max是积分限幅没有它云台被外力顶住时积分会疯狂累加松手瞬间猛甩这就是典型的积分饱和。三轴各自独立一套 PID但 roll 和 yaw 的耦合往往需要额外补偿源码里通常有交叉耦合项别忽略。电机输出映射要注意方向PID 算出的是力矩需求映射到 PWM 时不同电机安装方向不同符号必须对应。映射错了云台会直接自激振荡越调越抖。3. 在 STM32 上把云台跑起来的最小步骤这一章是能照着抄的部分。假设你手上有一块 STM32F405 开发板、一个六轴 IMU、三个无刷电机加电调目标是让云台先「能稳住」不追求性能。3.1 硬件连接与定时器 PWM 配置先确认三路 PWM 分别接哪个定时器通道。以常见做法为例用 TIM1 的 CH1/CH2/CH3 输出三路 50Hz PWM 给电调// TIM1 PWM 初始化(节选), 50Hz, 脉宽 1000~2000us void pwm_init(void) { // 预分频与自动重装值按 84MHz 主频计算 // 50Hz - 周期 20ms, 计数频率 1MHz - ARR 20000-1 TIM1-PSC 84 - 1; // 84MHz / 84 1MHz TIM1-ARR 20000 - 1; // 1MHz / 20000 50Hz TIM1-CCR1 1500; // 中位脉宽 1.5ms, 电调解锁用 TIM1-CCR2 1500; TIM1-CCR3 1500; // 配置 CH1~CH3 为 PWM 模式并使能输出(略) }逻辑说明电调识别的是脉宽而非占空比1ms 对应最小、2ms 对应最大、1.5ms 是中位。参数说明PSC和ARR必须按你实际主频重算主频填错输出频率就偏电调可能直接不响应。上电先给三路 1.5ms 中位等电调完成自检再进控制循环这一步顺序错了电机不会转。3.2 IMU 零偏校准与采样周期设定IMU 上电后必须静止校准零偏否则陀螺仪漂移会让云台缓慢跑偏// 静止采样 500 次求均值作为零偏 void imu_calibrate(void) { int32_t sum[3] {0}; for (int i 0; i 500; i) { imu_read_raw(); sum[0] gyro_raw[0]; sum[1] gyro_raw[1]; sum[2] gyro_raw[2]; delay_ms(2); } gyro_bias[0] sum[0] / 500; gyro_bias[1] sum[1] / 500; gyro_bias[2] sum[2] / 500; }逻辑说明静止时陀螺仪理论输出为零实际有固定偏置采样求均值即可估计。参数说明采样次数 500 次约 1 秒太少噪声大太多上电等待久。校准期间云台必须完全静止手碰一下数据就废了这是血泪经验。采样周期建议 1kHz 读 IMU、200Hz 跑姿态解算、200Hz 跑 PID分层执行能省 CPU。周期用定时器中断保证别用delay凑。3.3 上电顺序与首次通电验证首次通电务必拆桨或卸负载按这个顺序走只给主控供电串口打印 IMU 原始数据确认三轴数值合理。静止校准零偏观察姿态角是否稳定在零附近。接电调但不装电机示波器或逻辑分析仪看三路 PWM 是否为 1.5ms。装电机空载给一个小目标角度看电机是否朝正确方向响应。全部正常后再装相机负载从小角度开始测。跳过第 3、4 步直接上负载一旦方向映射错了云台会瞬间猛甩轻则烧电调重则打坏相机。4. 调参与排错云台抖动的常见坑云台调不好八成不是算法问题而是参数、机械或时序问题。这一章按「现象 → 原因 → 解决」列几条我踩过的坑。4.1 高频抖动与低频摆动的区分现象云台发出高频嗡嗡声并伴随小幅抖动。原因PID 的kp或kd过大系统带宽超过了机械和电机的响应能力。解决先把kd降到零单独调kp到临界振荡再回退 30%最后加kd抑制超调。反过来如果是低频缓慢摆动多半是ki太小或机械重心没配平。4.2 积分饱和导致的松手猛甩现象用手顶住云台一段时间松手瞬间云台猛地弹向一边。原因积分项在受阻期间持续累加超出合理范围。解决给积分加限幅见 2.3 的i_max并在误差过大时暂停积分累加。这是最容易被忽略的一条很多开源代码默认限幅偏大。4.3 姿态角缓慢漂移现象云台静止时角度慢慢往一个方向偏。原因陀螺仪零偏没校准好或互补滤波alpha太大导致加速度计修正不足。解决重新做静止校准把alpha从 0.98 降到 0.95 试试同时检查 IMU 是否离电机太近受振动干扰。4.4 电机发热与异响现象电机空载也发烫或有明显异响。原因PWM 频率与电调不匹配或 PID 输出长期处于大幅振荡。解决确认 PWM 是 50Hz 还是更高频率部分电调支持 400Hz并检查 PID 输出是否在限幅内来回跳。电机发热往往是振荡的副产品别只盯着电机。4.5 主循环周期不稳现象参数明明调好了运行几分钟后开始抖。原因主循环里混入了串口打印、Flash 写入等耗时操作周期被拉长。解决把打印和存储移出控制循环用 DMA 或缓冲方式处理。控制循环里只做采样、解算、PID、输出这四件事。5. 从能跑到好用进阶技巧与验证方法把云台跑稳只是起点真正决定它好不好用的是几个细节。第一是前馈补偿当载体本身有已知运动趋势时纯反馈 PID 总是慢半拍加入角速度前馈能明显提升跟随性源码里通常预留了前馈系数调的时候从小往大加。第二是滤波与延迟的权衡滤波越重姿态越平滑但延迟越大云台响应越迟钝我的习惯是把滤波截止频率设在控制带宽的 3 到 5 倍既压噪声又不拖后腿。验证方法上别只靠肉眼看。可以用串口把目标角度、实际角度、PID 输出三路数据以固定周期打出来导入表格画曲线看超调量和稳态误差。更直接的是给云台一个阶跃目标观察它多久稳定、有没有过冲。下面这段是数据打点的常用写法// 每 5ms 打一帧, 格式: target,actual,output void log_frame(float target, float actual, float output) { static uint32_t cnt 0; if (cnt % 5 0) { // 200Hz 控制, 40Hz 打点 printf(%.2f,%.2f,%.2f\r\n, target, actual, output); } }逻辑说明打点频率要低于控制频率避免占用过多串口带宽。参数说明%.2f精度够用太高反而拖慢打印。拿到数据后重点看三件事稳态时 actual 是否贴着 target、阶跃后有没有等幅振荡、output 是否频繁撞限幅。最后一个习惯每次只改一个参数改完记录现象。云台调参是典型的耦合系统同时动kp和kd你永远不知道是哪个起了作用。我早期图快一次改三个参数结果振荡了整整两天才定位到是kd符号写反。慢就是快希望帮到你。本文还有配套的精品资源点击获取
简介这份资源是Simple Bgc开源项目的完整源码面向从事三轴增稳云台开发、嵌入式控制学习以及STM32工程实践的开发者。该项目源自俄版云台方案早期基于Arduino平台后续版本转向STM32控制器可用于研究云台姿态解算、电机驱动与闭环稳定控制等核心逻辑。压缩包共200个文件约580KB以C语言源文件89个和头文件95个为主体另含汇编启动文件、Keil工程文件uvproj、uvopt、批处理脚本及少量配置说明文件构成一套可直接编译的嵌入式工程结构。目前已有3433人学习下载说明其在云台控制领域具有较高的参考价值。读者可从中获取完整的STM32外设驱动代码如定时器、Flash、RCC、ADC等模块、云台控制算法实现以及工程组织方式适合作为二次开发或课程设计的底层参考帮助理解从传感器采集到电机输出的完整控制链路。1. 三轴增稳云台为什么值得从源码啃起很多人第一次接触三轴增稳云台是从一段抖动的航拍画面开始的明明电机转得挺稳镜头却像得了帕金森。Simple BGC 这类开源固件之所以被反复翻出来研究核心就在于它把「姿态解算 无刷电机闭环 云台机械补偿」这条链路完整摊开在源码里而不是封装成一个黑匣子。基于 STM32 的三轴增稳云台开源代码本质上是一套跑在 Cortex-M 内核上的实时控制系统MPU6050 之类的 IMU 出原始角速度与加速度经过互补滤波或卡尔曼滤波融合出姿态角再通过 PID 输出三路 PWM 去驱动三个无刷电机的电调最终让相机在载体晃动时保持指向稳定。它适合谁适合已经会点 STM32、想搞懂闭环控制怎么落地的人也适合做机器人、车载云台、手持稳定器的团队拿来做二次开发底座。这一章先把「它到底在控制什么」讲清楚后面才好动手。2. 从源码结构看三轴增稳云台的控制链路拿到一份基于 STM32 的三轴增稳云台开源代码别急着编译烧录先花二十分钟把目录结构读一遍比盲目改参数省下大量返工。典型工程会分成驱动层、算法层、应用层三块理解这个分层后面调 PID 才知道该动哪个文件。2.1 工程目录与模块职责划分常见做法是下面这种布局不同作者命名略有差异但职责基本一致目录/文件职责改动频率bsp/或hardware/GPIO、定时器、I2C、串口底层驱动低imu/IMU 初始化、原始数据读取、零偏校准中filter/互补滤波、卡尔曼滤波姿态解算中pid/三轴 PID 计算与输出限幅高motor/PWM 输出、电调驱动、方向映射中main.c主循环调度、模式切换、保护逻辑中读代码的顺序建议是先看main.c的主循环周期再看 IMU 采样频率最后看 PID 在哪一步被调用。因为云台是硬实时系统主循环周期直接决定控制带宽周期不稳后面参数怎么调都是玄学。2.2 姿态解算互补滤波与卡尔曼滤波怎么选姿态解算是整条链路的地基。加速度计长期准但短期噪声大陀螺仪短期准但会漂移所以必须融合。互补滤波实现简单、算力占用低适合 STM32F1/F4 这类主频不高的芯片卡尔曼滤波精度更好但矩阵运算吃 CPUF1 上跑三轴容易吃力。互补滤波的核心一行大概是这样// angle: 融合后角度, gyro: 陀螺仪角速度(deg/s), acc: 加速度计解算角度 // dt: 采样周期(s), alpha: 互补系数, 一般取 0.96~0.99 angle alpha * (angle gyro * dt) (1.0f - alpha) * acc;逻辑说明前半段用陀螺仪积分预测角度后半段用加速度计观测值修正漂移。alpha越大越信任陀螺仪动态响应好但会漂越小越信任加速度计静态稳但抖动大。参数说明dt必须和实际采样周期一致如果你在 1kHz 定时器里调用却填了 0.01角度会直接算错这是新手最常见的翻车点。卡尔曼滤波则要维护状态协方差矩阵代码量翻几倍。我的建议是先用互补滤波把云台跑稳确认机械和电机没问题再考虑换卡尔曼。一上来就啃卡尔曼很容易在参数整定阶段迷失。2.3 三轴 PID 与电机输出映射姿态角算出来后目标角度减去当前角度得到误差送进 PID// 单轴 PID 简化实现 float pid_calc(PID_t *pid, float target, float measure, float dt) { float err target - measure; pid-integral err * dt; // 积分项累加 if (pid-integral pid-i_max) // 积分限幅, 防饱和 pid-integral pid-i_max; else if (pid-integral -pid-i_max) pid-integral -pid-i_max; float derivative (err - pid-last_err) / dt; // 微分项 pid-last_err err; return pid-kp * err pid-ki * pid-integral pid-kd * derivative; }逻辑说明比例项决定响应力度积分项消除静态误差微分项抑制超调。参数说明i_max是积分限幅没有它云台被外力顶住时积分会疯狂累加松手瞬间猛甩这就是典型的积分饱和。三轴各自独立一套 PID但 roll 和 yaw 的耦合往往需要额外补偿源码里通常有交叉耦合项别忽略。电机输出映射要注意方向PID 算出的是力矩需求映射到 PWM 时不同电机安装方向不同符号必须对应。映射错了云台会直接自激振荡越调越抖。3. 在 STM32 上把云台跑起来的最小步骤这一章是能照着抄的部分。假设你手上有一块 STM32F405 开发板、一个六轴 IMU、三个无刷电机加电调目标是让云台先「能稳住」不追求性能。3.1 硬件连接与定时器 PWM 配置先确认三路 PWM 分别接哪个定时器通道。以常见做法为例用 TIM1 的 CH1/CH2/CH3 输出三路 50Hz PWM 给电调// TIM1 PWM 初始化(节选), 50Hz, 脉宽 1000~2000us void pwm_init(void) { // 预分频与自动重装值按 84MHz 主频计算 // 50Hz - 周期 20ms, 计数频率 1MHz - ARR 20000-1 TIM1-PSC 84 - 1; // 84MHz / 84 1MHz TIM1-ARR 20000 - 1; // 1MHz / 20000 50Hz TIM1-CCR1 1500; // 中位脉宽 1.5ms, 电调解锁用 TIM1-CCR2 1500; TIM1-CCR3 1500; // 配置 CH1~CH3 为 PWM 模式并使能输出(略) }逻辑说明电调识别的是脉宽而非占空比1ms 对应最小、2ms 对应最大、1.5ms 是中位。参数说明PSC和ARR必须按你实际主频重算主频填错输出频率就偏电调可能直接不响应。上电先给三路 1.5ms 中位等电调完成自检再进控制循环这一步顺序错了电机不会转。3.2 IMU 零偏校准与采样周期设定IMU 上电后必须静止校准零偏否则陀螺仪漂移会让云台缓慢跑偏// 静止采样 500 次求均值作为零偏 void imu_calibrate(void) { int32_t sum[3] {0}; for (int i 0; i 500; i) { imu_read_raw(); sum[0] gyro_raw[0]; sum[1] gyro_raw[1]; sum[2] gyro_raw[2]; delay_ms(2); } gyro_bias[0] sum[0] / 500; gyro_bias[1] sum[1] / 500; gyro_bias[2] sum[2] / 500; }逻辑说明静止时陀螺仪理论输出为零实际有固定偏置采样求均值即可估计。参数说明采样次数 500 次约 1 秒太少噪声大太多上电等待久。校准期间云台必须完全静止手碰一下数据就废了这是血泪经验。采样周期建议 1kHz 读 IMU、200Hz 跑姿态解算、200Hz 跑 PID分层执行能省 CPU。周期用定时器中断保证别用delay凑。3.3 上电顺序与首次通电验证首次通电务必拆桨或卸负载按这个顺序走只给主控供电串口打印 IMU 原始数据确认三轴数值合理。静止校准零偏观察姿态角是否稳定在零附近。接电调但不装电机示波器或逻辑分析仪看三路 PWM 是否为 1.5ms。装电机空载给一个小目标角度看电机是否朝正确方向响应。全部正常后再装相机负载从小角度开始测。跳过第 3、4 步直接上负载一旦方向映射错了云台会瞬间猛甩轻则烧电调重则打坏相机。4. 调参与排错云台抖动的常见坑云台调不好八成不是算法问题而是参数、机械或时序问题。这一章按「现象 → 原因 → 解决」列几条我踩过的坑。4.1 高频抖动与低频摆动的区分现象云台发出高频嗡嗡声并伴随小幅抖动。原因PID 的kp或kd过大系统带宽超过了机械和电机的响应能力。解决先把kd降到零单独调kp到临界振荡再回退 30%最后加kd抑制超调。反过来如果是低频缓慢摆动多半是ki太小或机械重心没配平。4.2 积分饱和导致的松手猛甩现象用手顶住云台一段时间松手瞬间云台猛地弹向一边。原因积分项在受阻期间持续累加超出合理范围。解决给积分加限幅见 2.3 的i_max并在误差过大时暂停积分累加。这是最容易被忽略的一条很多开源代码默认限幅偏大。4.3 姿态角缓慢漂移现象云台静止时角度慢慢往一个方向偏。原因陀螺仪零偏没校准好或互补滤波alpha太大导致加速度计修正不足。解决重新做静止校准把alpha从 0.98 降到 0.95 试试同时检查 IMU 是否离电机太近受振动干扰。4.4 电机发热与异响现象电机空载也发烫或有明显异响。原因PWM 频率与电调不匹配或 PID 输出长期处于大幅振荡。解决确认 PWM 是 50Hz 还是更高频率部分电调支持 400Hz并检查 PID 输出是否在限幅内来回跳。电机发热往往是振荡的副产品别只盯着电机。4.5 主循环周期不稳现象参数明明调好了运行几分钟后开始抖。原因主循环里混入了串口打印、Flash 写入等耗时操作周期被拉长。解决把打印和存储移出控制循环用 DMA 或缓冲方式处理。控制循环里只做采样、解算、PID、输出这四件事。5. 从能跑到好用进阶技巧与验证方法把云台跑稳只是起点真正决定它好不好用的是几个细节。第一是前馈补偿当载体本身有已知运动趋势时纯反馈 PID 总是慢半拍加入角速度前馈能明显提升跟随性源码里通常预留了前馈系数调的时候从小往大加。第二是滤波与延迟的权衡滤波越重姿态越平滑但延迟越大云台响应越迟钝我的习惯是把滤波截止频率设在控制带宽的 3 到 5 倍既压噪声又不拖后腿。验证方法上别只靠肉眼看。可以用串口把目标角度、实际角度、PID 输出三路数据以固定周期打出来导入表格画曲线看超调量和稳态误差。更直接的是给云台一个阶跃目标观察它多久稳定、有没有过冲。下面这段是数据打点的常用写法// 每 5ms 打一帧, 格式: target,actual,output void log_frame(float target, float actual, float output) { static uint32_t cnt 0; if (cnt % 5 0) { // 200Hz 控制, 40Hz 打点 printf(%.2f,%.2f,%.2f\r\n, target, actual, output); } }逻辑说明打点频率要低于控制频率避免占用过多串口带宽。参数说明%.2f精度够用太高反而拖慢打印。拿到数据后重点看三件事稳态时 actual 是否贴着 target、阶跃后有没有等幅振荡、output 是否频繁撞限幅。最后一个习惯每次只改一个参数改完记录现象。云台调参是典型的耦合系统同时动kp和kd你永远不知道是哪个起了作用。我早期图快一次改三个参数结果振荡了整整两天才定位到是kd符号写反。慢就是快希望帮到你。本文还有配套的精品资源点击获取
