简介这是一份基于STM32F103与MPU6050的直立自平衡小车完整工程源码适用于嵌入式初学者入门PID控制、电机驱动与姿态解调也适合开发者作为二次开发与DIY创新的参考。代码围绕经典PID算法展开通过陀螺仪与加速度计数据实时调节电机转速保持小车直立工程结构涵盖用户代码、启动文件、编译中间产物及输出烧录文件便于对照学习。资源包共56个文件以工程编译类文件为主包括c/h源代码、o/axf/hex等可执行与中间文件、crf/lst/map等编译辅助文件以及uvprojx工程配置zip压缩包整体2.34MB轻量便捷。目前已有303人学习下载。通过分析这套源码可以理解PID三个环节的实际调参方法、STM32外设定时器、ADC、串口等的初始化与数据流处理逻辑并掌握MPU6050数据读取与姿态反馈在嵌入式闭环控制中的落地方式为后续自平衡车、无人机等项目的自主开发打下扎实基础。 老规矩先说实话。自平衡小车这个项目我在大学期间和工作后各做了一遍前后踩了无数坑才把源码彻底吃透。这篇文章我直接以“自平衡小车源码”为主线把从硬件选型到最终调通的代码逻辑、参数整定、常见坑位全部拆开讲。如果你正打算做一辆能稳稳站住的小车或者手里已经有一份源码但不知道怎么改这篇内容可以帮你省下大量试错时间。1. 整体设计与思路拆解1.1 平衡的本质倒立摆模型与源码核心任务自平衡小车本质上是一台“轮式倒立摆”。它的重心在轮轴上方天然不稳定靠电机不断调整车轮位置来让重心保持在支撑点正上方。这个过程在控制论里叫“动态稳定”跟人用手掌顶一根长杆是一个道理——杆子往哪边倒手就往哪边追。源码要解决的核心问题有三个实时读取车身倾角姿态解算根据倾角偏差计算电机输出PID控制让左右轮按目标速度转动电机驱动与闭环很多新手拿到源码第一步就去看main函数结果被一堆初始化代码绕晕。实际上一份结构清晰的自平衡小车源码核心就三个文件姿态解算模块、PID控制模块、电机驱动模块。其他像按键、OLED显示、蓝牙调试都是辅助功能不影响平衡主逻辑。1.2 源码架构与任务划分以最常见的STM32F103C8T6平台为例一份可用的自平衡小车源码通常长这样Project/ ├── USER/ // main.c、中断回调 ├── HARDWARE/ // motor.c、mpu6050.c、oled.c、encoder.c ├── SYSTEM/ // delay.c、usart.c、gpio.c └── CONTROL/ // pid.c、filter.c、balance.c主循环里每2ms执行一次核心控制任务每100ms执行一次OLED显示和蓝牙数据上报。这里最关键的是控制周期必须严格定时不能用delay阻塞否则姿态解算和控制输出的时序一乱车必倒。我在代码里用的是定时器中断做2ms时基中断里只做三件事读MPU6050、互补滤波解算角度、跑PID输出PWM。所有打印、显示、按键扫描全部放主循环。2. 核心源码细节解析与关键算法2.1 姿态解算MPU6050数据读取与滤波自平衡小车最常用IMU芯片就是MPU6050集成了三轴陀螺仪和三轴加速度计。源码里首先要通过I2C总线读取原始数据然后换算成物理单位。陀螺仪量程设成±2000°/s加速度计量程设成±2g。原始数据换算公式gyro_rate raw_gyro / 16.4; // 16.4 LSB/(°/s) acc_angle atan2(raw_acc_y, raw_acc_z) * 57.3; // 弧度转角度为什么要同时用两种传感器因为加速度计测角度没有累积漂移但振动大时噪声明显陀螺仪动态响应快但积分会越积越偏。所以源码里一般会用互补滤波把它们融合起来float complementary_filter(float angle, float gyro_rate, float acc_angle, float dt) { float alpha 0.98; angle alpha * (angle gyro_rate * dt) (1 - alpha) * acc_angle; return angle; }alpha选0.98表示信任陀螺仪预测角度的权重更大只拿加速度计缓慢修正漂移。这个参数不是死的底盘振动大可以降到0.95动态响应要求高可以升到0.99。我实测下来0.98是通用性最好的起点。注意MPU6050的原始输出要等待数据就绪再读否则会读到寄存器更新到一半的“混血数据”。源码里我会在读取前检查INT引脚或状态寄存器确保数据稳定后再取。2.2 PID控制直立环、速度环、转向环自平衡小车源码的灵魂就是三环PID很多调不好车的同学问题都出在这里。先说直立环这是让车不倒的核心。它本质上是PD控制float balance_pid(float angle, float gyro, float target_angle) { float error angle - target_angle; float p_out Kp_balance * error; float d_out Kd_balance * gyro; // 角速度既做微分项也天然带滤波 return p_out d_out; }注意这里微分项直接用陀螺仪角速度而不是对角度求导。这样做的原因有两个一是陀螺仪测量角速度本身就是角度的微分省掉一步运算二是直接用的角速度噪声远小于对角度差分得到的角速度PWM输出更平稳。这是很多开源项目的共识写法建议沿用。速度环是用来防“跑飞”的。如果只让车保持平衡它会在平衡点附近来回窜动然后越走越快直到倒掉。速度环通过编码器测量车轮实际速度和用户目标速度做PID把输出叠加到直立环的目标角度上float speed_pid(int16_t speed, int16_t target_speed) { float error target_speed - speed; speed_i error; // 积分项 speed_i constrain(speed_i, -I_MAX, I_MAX); // 积分限幅 float p_out Kp_speed * error; float i_out Ki_speed * speed_i; return p_out i_out; }这个输出值含义是“让小车稍微倾斜角度来获得速度”。车以很小的倾角前进速度自然就提上来了这是倒立摆运动的本质。转向环则简单得多用遥控器或APP给的转向值叠加上编码器左右轮差速反馈输出到左右电机的PWM差上float turn_pid(int16_t turn_value, float gyro_z) { float error turn_value - gyro_z * 0.3; // 简单P控制 return Kp_turn * error; }三环叠加的顺序有讲究我见过有人直接把三环输出全加到PWM上结果车像癫痫一样抖。正确的做法是直立环输出作为基础PWM速度环输出修正目标角度转向环输出叠加在左右轮的差上。3. 实操过程与关键实现3.1 从零烧录到主动平衡的完整流程拿到一套能跑的源码别急着调参数。先把硬件初始化流程走通再观察传感器的数据是否合理。第一步烧录程序后打开串口助手波特率一般设115200。检查MPU6050的原始数据输出把车静止放平观察绕Z轴的偏航角是否恒定漂移有小漂正常绕X轴的俯仰角是否在0°附近稳定加速度计换算角度与互补滤波角度是否在±0.5°内如果数据异常检查I2C接线和电源稳定性。MPU6050对3.3V纹波敏感如果和电机共用电源建议单独用LDO给传感器供电。第二步让车的PWM输出为0时电机静止。很多源码在初始化阶段会有启动偏置校准电机在静止时发出细微的嗡嗡声属于正常但如果有明显转动检查PWM死区补偿值。这里分享一个很多教程不讲的技巧低速PWM死区补偿。电机在PWM占空比低于某个阈值时不会转动编码器自然没有数据这会导致速度环在低速时经常“空转”。我的处理方式是在PID输出处加一个死区判断if (pwm_out 0) pwm_out DEAD_ZONE; else if (pwm_out 0) pwm_out - DEAD_ZONE;这个DEAD_ZONE值需要在实测中不断调直到电机刚刚停止转动为止。3.2 参数整定先直立后速度最后转向参数整定是自平衡小车源码最耗时的环节。我给出经验值范围和调参顺序你自己跑起来后按这个路子走。直立环的参数Kp_balance是第一位的。先把Kd设为0Kp从小到大加直到车能勉强“抖着站起来”。这个手感的判断很关键如果车疯狂振荡Kp太大如果完全站不住像面条一样软趴趴Kp太小或者控制周期不对。再缓慢加Kd直到振荡感明显减弱。Kd的作用就是阻尼它能抑制振荡但加多了会放大噪声——表现是电机发出刺耳高频声烫手。我可以给你一个标准的参考起点参数参考范围说明Kp_balance200~800角度误差系数STM32平台常用范围Kd_balance5~50角速度系数Kp_speed100~500速度误差系数Ki_speed0.05~0.5速度积分系数I_max限幅100Kp_turn10~100转向系数速度环的整定口诀是“先P后II要给小”。先把I设为0用P让车有“抵抗外力”的能力——用手推一下车它能恢复平衡但会有缓慢偏移然后加I消除稳态偏差让车能回到出发位置附近来回踱步。I过大的表现是车会持续低频振荡周期大概一两秒像在打嗝。重大提醒每次修改PID参数都先把车架起来让轮子悬空。确认PWM输出的极性正确——即轮子往车倒的方向滚而不是相反方向。这是所有参数乱调的根源也是我亲眼见过很多人把车摔坏的最常见原因。4. 调试中的经验与进阶扩展4.1 我用过的几种调试链路很多同学调PID时用的是“改参数-烧录-观察-再改”的笨办法一次循环至少几十秒车还容易摔。我建议在源码里预留无线调参通道——串口蓝牙模块十几块钱一个在代码里加一个响应协议的解析命令格式#P200# // 设置Kp_balance200 #D30# // 设置Kd_balance30 #S120# // 设置Kp_speed120解析函数放在串口中断里这样用手机蓝牙串口助手就能实时修改参数不用反复烧录。实测下来调参效率提升至少3倍。更进阶的做法是在源码里加入无线回传实时数据。把角度、角速度、PWM输出、编码器速度打包成结构化数据通过串口或蓝牙发到PC端再用现成的串口波形软件比如VOFA画曲线。用曲线看系统的收敛过程比用眼睛看车动不动靠谱得多。当Kp从500改到800时你能清楚看到角度曲线的振荡频率变高、幅值变小这就是阻尼比的变化趋势。这种数据化的调试方式才是把自平衡从“玄学”变“科学”的关键。4.2 常见问题速查表我整理了一份自平衡小车源码调试最常见的问题表都是实际踩过坑的经验现象可能原因解决方向上电后电机猛烈震荡直立环Kp过大或极性反了检查PWM极性大幅降低Kp车能站住但持续前后跑速度环未启用或I过弱启用速度环适当增加Ki平衡时间不长逐渐倒下电池电压下降加稳压模块升级动力电池传感器角度缓慢漂移互补滤波alpha过大降低alpha到0.95检查陀螺仪零偏直行时小车往一边歪左右轮编码器不一致统一编码器类型加转向环修正电机通电后启动缓慢PWM死区过大调小死区补偿值信号线过长导致读数跳变线路干扰用双绞线或屏蔽线缩短距离还有一个新手容易忽略的问题电池电压。自平衡小车对电源稳定性要求极高。当电池从8.4V降到7.0V时电机输出特性变化明显而MPU6050的参考电压也会有波动。我见过一辆车满电稳定电量稍降就完全站不住。这种情况往往是源码里的速度环饱和值设得太靠极限建议留出20%余量。4.3 源码的后续扩展方向自平衡小车源码调通后可以加的东西非常多。最值得做的是增加无线遥控和定速巡航。遥控指令通过蓝牙或NRF24L01接收转换成目标速度送入速度环车就能做到直行、后退、小半径转弯。另一个方向是加入上位机PID三维整定界面。用Python写一个简单的串口调试助手把三环参数用滑块在界面上实时调整同时显示实时波形。这个搞出来你的自平衡小车项目就远远超出“课程设计”的水准可以直接拿去做毕业设计甚至面试展示。如果你感兴趣还可以尝试在同样的底盘上换个方案用MPU6050的DMP库输出四元数再转换成欧拉角替代互补滤波。DMP在静态下能保持角度更稳但动态响应要差一点。两种方法各有优劣你自己写一遍对比一下会对姿态解算有更深的理解。最后再分享一个实用的心得源码的注释真的很重要不只是给别人看更是给三个月后的自己看。我在代码里每个PID相关函数都写清楚“这个参数调节什么现象调大调小会怎样”这让我在二次开发时不用从头推演逻辑。自平衡小车的中文教程遍地都是但真正能让你理解技术细节的永远是逐行读源码、亲手调参数的过程。调试得越痛苦学到的就越扎实。本文还有配套的精品资源点击获取
