STM32自平衡小车工程实战：从姿态解算到串级PID调试

简介这份资料包面向嵌入式初学者与DIY爱好者围绕基于STM32微控制器的两轮自平衡小车展开提供从硬件设计到软件实现的完整制作参考。包内共1430个文件以C源码与头文件、Keil工程配置、编译中间产物及固件烧录文件为主辅以原理图、PDF文档与使用说明压缩包约53.19MB目录按原理图、源码、使用说明、开发笔记等模块组织便于按需检索。已有4138人学习下载说明其在自平衡小车学习群体中具有一定参考价值。读者可从中获取传感器数据采集与PID控制算法的实现思路、电机驱动电路设计要点、固件烧录与调试流程以及作者在故障排查和性能优化方面的经验记录适合希望系统掌握STM32实时控制与自平衡系统开发的读者对照实践。1. 从“站不住”到“稳如老狗”一套 STM32 自平衡小车的完整工程该怎么搭调过两轮自平衡小车的人都懂那种玄学感代码一行没改早上还能勉强立三秒下午上电直接往一边栽PID 参数在示波器上看着挺漂亮一放到地板上就开始高频抖动。问题往往不在某一个参数而在于整套工程没有按“能复现、能排查、能验收”的方式搭起来。这套基于 STM32 的两轮自平衡小车制作资料解决的正是这件事——它把机械装配、姿态解算、串级控制、电机驱动和调试流程串成一条完整链路适合正在做毕设、课设或者想从零吃透倒立摆控制的人直接照着走。下面按需求、设计、实现、避坑、验收的顺序把这份资料里的工程骨架拆开讲清楚。2. 需求与总体方案两轮自平衡小车到底要解决哪几个核心问题2.1 先把需求翻译成可测量的指标很多人一上来就焊板子、抄 PID做到一半才发现“能站住”这个目标根本没法验收。合格的做法是先把需求拆成可测量的指标我一般会按下面这张表来定基线指标项目标值测量方式静态直立保持时间≥ 60 s 不倒地秒表计时重复 5 次取中位数倾角稳态误差≤ ±1.5°串口回传角度静止采样 10 s抗扰动恢复时间≤ 1.5 s 回到平衡位轻推车身后观察回正过程直线行驶偏移5 m 内横向偏移 ≤ 30 cm地面贴胶带做参照续航≥ 30 min 连续运行满电到低压报警这张表的意义在于后面每调一个参数你都知道自己在逼近哪个指标而不是凭感觉说“好像稳了一点”。资料里的调试章节也是围绕这些可观测项展开的先让车“站住”再让它“站得准”最后才谈“走得直”。2.2 总体架构三层结构加五个功能模块整套系统按职责切成三层模块边界清晰出问题时能快速定位是哪一层的事感知层MPU6050 六轴传感器采集加速度与角速度编码器采集轮速电池分压采集电压。控制层STM32 主控跑姿态融合互补滤波或卡尔曼、串级 PID直立环 速度环 转向环、PWM 输出。执行层TB6612 或 L298N 驱动直流减速电机配合编码器形成速度闭环。五个功能模块分别是电源管理、姿态解算、串级控制、电机驱动、调试通信串口/蓝牙回传。这个划分不是摆设——调试时你只要判断“角度漂不漂”就知道是感知层还是控制层的问题判断“轮子转不转”就知道是驱动层还是控制层的问题排查效率差好几倍。2.3 技术选型为什么是 STM32 而不是别的选 STM32 做这类项目核心原因是它同时具备三样东西足够多的定时器编码器接口、PWM 输出、系统滴答互不打架、硬件浮点或足够快的定点运算姿态融合和 PID 都在毫秒级循环里跑、成熟的 HAL/标准库生态资料里的工程直接可编译。相比之下8 位机跑串级 PID 加姿态融合会明显吃力主频和 RAM 都紧张而用更高端的应用处理器又属于杀鸡用牛刀电源和调试复杂度都上去了。对毕设和课设来说STM32 是“性能够用、资料够多、答辩讲得清”的平衡点。3. 姿态解算与串级控制让车“知道自己在哪、该往哪用力”3.1 姿态融合互补滤波为什么够用自平衡小车的控制周期通常在 510 ms姿态角的实时性和稳定性直接决定车能不能站住。加速度计静态准但动态噪声大陀螺仪动态好但会积分漂移两者融合是必选项。资料里主推互补滤波原因是它计算量小、参数物理意义明确调起来不玄学// 互补滤波陀螺仪积分 加速度计校正 // dt 为采样周期秒alpha 为高通权重通常取 0.96~0.98 float complementary_filter(float acc_angle, float gyro_rate, float dt, float alpha) { static float angle 0.0f; // 陀螺仪积分得到预测角权重 alpha 抑制漂移 float gyro_angle angle gyro_rate * dt; // 加速度计角度做低通校正权重 (1-alpha) angle alpha * gyro_angle (1.0f - alpha) * acc_angle; return angle; }这段代码的关键在alpha取值越大越信任陀螺仪响应快但漂移抑制弱取值越小越信任加速度计静态稳但动态滞后明显。我一般从 0.98 起调观察静止时角度是否缓慢漂移、快速倾斜时是否跟得上再微调。dt必须用实际定时器周期不能拍脑袋写 0.01否则积分项比例失真这是很多人翻车的第一处。3.2 串级 PID三个环各管什么自平衡小车的控制不是单个 PID 能搞定的标准做法是串级结构直立环内环输入是倾角误差输出是 PWM 基础量负责“别倒”。速度环外环输入是编码器测得的轮速与目标速度之差输出叠加到直立环的倾角目标上负责“别跑”。转向环输入是两轮速度差或陀螺仪 Z 轴角速度输出差速量负责“别转”。// 串级 PID 主循环简化示意周期 5ms void balance_control_loop(void) { float angle get_filtered_angle(); // 融合后的倾角 float speed get_encoder_speed(); // 编码器换算的轮速 // 速度环输出作为直立环的角度修正量 float speed_out pid_calc(pid_speed, target_speed, speed); float angle_target balance_zero speed_out; // 直立环角度误差转 PWM float angle_out pid_calc(pid_angle, angle_target, angle); // 转向环差速修正 float turn_out pid_calc(pid_turn, target_turn, get_gyro_z()); set_motor_pwm(angle_out turn_out, angle_out - turn_out); }调参顺序有讲究先只开直立环把车调到能勉强站住会缓慢前后移动是正常的再加速度环抑制漂移最后加转向环。反过来先调速度环车根本站不住参数无从谈起。balance_zero是机械中值必须实测——把车放在水平面上读角度而不是默认写 0机械装配误差会让它偏好几度。3.3 电机驱动与编码器执行层的两个细节驱动层最容易忽略的是死区和方向一致性。PWM 占空比低于某个阈值时电机不转这个死区要在代码里补偿否则小角度修正时车会“卡顿式”响应。编码器则要确认计数方向与电机转向一致两轮装反了速度环会变成正反馈车会越跑越快直到撞墙——这是血泪经验第一次上电务必架空轮子先验证方向。4. 工程落地从原理图到可编译工程的实现路径4.1 硬件连接与引脚分配资料里的工程按“一个外设一组引脚”的方式组织避免定时器冲突。典型分配如下功能外设说明MPU6050I2C1SCL/SDA 加上拉电阻编码器左/右TIM2/TIM3 编码器模式硬件计数不占 CPU电机 PWMTIM4 CH1~CH4两路电机各两通道串口调试USART1115200 波特率回传角度电池检测ADC1分压后采样引脚分配的原则是编码器和 PWM 优先用硬件定时器软件模拟在高速下会丢步I2C 上拉电阻不能省省了就是随机通信失败表现为角度偶尔跳变极难排查。4.2 主循环时序为什么控制周期必须固定// 主循环5ms 控制周期用定时器中断保证节拍 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim-Instance TIM6) { // 5ms 定时中断 imu_update(); // 读传感器 融合 balance_control_loop(); // 串级 PID debug_send(); // 串口回传可降频 } }控制周期抖动是隐形的性能杀手。如果用while(1)里加delay的方式周期会随代码分支变化PID 的积分和微分项全部失真表现为“参数怎么调都不对”。用定时器中断固定节拍是让控制律可复现的前提。串口回传建议降频到 2050 ms 一次否则打印本身就会拖慢控制循环。4.3 调试通信把“黑匣子”打开自平衡小车最难的是“看不见内部状态”。资料里的做法是通过串口按固定格式回传角度、角速度、PWM、轮速上位机用波形工具实时看曲线。回传格式建议用简单的文本协议方便抓包和肉眼读// 回传格式angle,gyro,pwm_left,pwm_right,speed printf(%.2f,%.2f,%d,%d,%.2f\r\n, angle, gyro_z, pwm_l, pwm_r, speed);有了这条数据流调参就从“盲调”变成“看曲线调”直立环振荡看角度曲线的高频毛刺速度环发散看轮速是否单调增长转向环问题看两轮 PWM 是否对称。这一步做扎实后面答辩演示时心里也有底。5. 避坑与排查这类项目最容易翻车的五个点5.1 现象上电就猛冲或原地打转原因通常是编码器方向或电机接线反了速度环变成正反馈。解决架空车轮手动正转轮子看编码器计数是增是减与 PWM 正方向对齐两轮分别验证后再落地。5.2 现象角度静止时缓慢漂移几分钟后车自己倒原因是互补滤波的alpha偏大或陀螺仪零偏未校准。解决上电静止采样几百次求陀螺仪零偏均值并在积分前扣除alpha适当调小到 0.96 附近观察漂移是否收敛。5.3 现象参数怎么调都高频抖动原因是控制周期不稳定或 PWM 死区未补偿。解决确认控制跑在固定定时器中断里实测电机启动的最小占空比在输出端做死区补偿避免小修正量被“吃掉”。5.4 现象串口数据偶尔跳变、角度突变原因是 I2C 上拉电阻缺失或电源纹波大。解决补 4.7k 上拉电机电源与控制电源分开走线电机端加滤波电容避免大电流拉低主控电压导致复位。5.5 现象能站住但一走就倒原因是速度环与直立环耦合过强或机械中值不准。解决先单独标定balance_zero速度环积分限幅输出叠加到角度目标时加饱和保护避免速度环“抢权”把直立环带崩。6. 验收与答辩怎么证明这套小车真的“稳”验收不是看它站了多久而是看你能不能复现和解释。我一般按三步走第一步静态验收——按第 2 章那张指标表逐项测直立时间、稳态误差、恢复时间各测 5 次取中位数数据记在表里第二步动态验收——直线行驶 5 m 看偏移原地转向看两轮差速是否对称轻推扰动看恢复曲线第三步可解释性验收——随机改一个参数比如把直立环 Kp 调大 20%能预测它会振荡加剧并现场验证说明你真的理解这套控制律而不是碰巧调出来的。答辩时最容易被问的三个问题提前准备好答案为什么用互补滤波而不是卡尔曼计算量、参数可解释性、实时性串级 PID 为什么先调内环内环不稳外环无意义控制周期为什么固定PID 离散化前提。演示环节建议准备一段串口波形录屏车在动、曲线在变比口头描述有说服力得多。从那以后我每次做这类控制项目都强制先架空轮子验证方向、先标定机械中值再上电、先开单环再加串级——这三步走完能省掉大半返工。希望这套拆解能帮到你资料里的工程骨架拿去改改就能用剩下的就是把参数一点点磨到位。本文还有配套的精品资源点击获取