简介这是一份面向平衡车DIY爱好者与嵌入式初学者的二轮平衡车全套工程资料适合想从零搭建硬件并理解姿态解算的读者。整套内容基于STM32平台覆盖硬件设计、电路原理图、连线方法以及调试通过的源码源码提供互补滤波、卡尔曼滤波与DMP三种主流姿态解算方案均编译无误可直接对照学习或移植。压缩包为ZIP格式约148.18MB内部按功能整理核心内容包含Keil工程源码、硬件图纸、接线说明与调试记录可省去大量搜集资料和排查问题的时间。目前已有3127人学习下载口碑与实用性经过验证。无论是完成课程设计、准备电子竞赛还是单纯DIY一台属于自己的平衡小车这套资料都能提供清晰完整的参考路径让入门和二次开发都更顺畅。 从标题就能看出来这是一份很多人都在找的“保姆级”资料。二轮平衡车这个项目几乎是每一位嵌入式学习者的必经之路它把传感器读取、数据融合、电机控制、PID算法和实时操作系统这些零散的知识点全部串在了一个可以看得见、摸得着的实物上。这篇文章不打算做那种泛泛的源码罗列而是站在“拿到全套源码后该怎么看、怎么改、怎么调”的角度把里边的门道掰开揉碎了讲清楚希望能帮大家少走一些弯路。1. 控制核心拆解为什么平衡车一定要用PID很多刚接触平衡车的朋友拿到源码第一件事就是搜索“PID”想看看代码里到底是怎么写的。这个方向是对的但仅仅看懂PID的公式还不够得先理解“为什么是PID”以及“为什么平衡车离了PID就玩不转”。1.1 维持平衡的本质是“对抗重力”二轮平衡车从物理模型上看就是一个典型的倒立摆。倒立摆的特点是它的重心在支点上方静止状态极不稳定只要有一点点角度偏差重力就会让它加速倾倒。举个生活化的例子你尝试把一根扫帚立在手掌上。扫帚要倒的时候你的手会跟着往它倒的方向移动同时眼睛盯着扫帚顶端的倾斜角度大脑计算出手掌该移动多快。这个“眼睛看角度、大脑算力度、手执行位移”的闭环过程就是平衡车控制系统的雏形。在平衡车代码里这个闭环被数字化了传感器通常是MPU6050代替眼睛实时输出车身的倾斜角MCU常见的是STM32代替大脑运行PID算法算出控制量电机和驱动芯片代替手按照控制量输出扭矩驱动车轮前后运动。如果这个闭环的周期足够短、响应足够快车身就能在倾倒之前被“扶”回来表现出来就是稳稳地立住了。1.2 串级PID与单级PID的抉择这份“超全”源码里最常见的方案是串级PID。外环是角度环内环是角速度环。为什么不用一个简单的单级PID因为单级PID只对角度偏差做比例、积分、微分运算它对电机响应的滞后无能为力。角速度环相当于给系统加了一个“阻尼”能让车轮的响应更平滑、更快速。我用一句话概括串级PID的思路就是外环让车身保持垂直内环让车轮动作更“跟手”。如果只看内环可以把它理解成一个“速度跟随器”它不关心车倒不倒只关心车轮转得是否符合预期。外环才是“大老板”它发现车身歪了就下发一个期望的车轮速度给内环。提示串级PID的调试顺序有讲究。务必要先调内环角速度环再调外环角度环。内环不稳定外环调得再好也白搭。我在第一次调试时因为图省事同时调两个环结果小车像“抽风”一样疯狂抖动后来静下心把内环参数先稳定住外环很快就收敛了。2. 关键源码模块精读从传感器到电机的完整链路拿到全套源码不要一头扎进main函数里从头读到尾那样容易在几百行代码里迷路。我建议按照“数据流向”来读传感器采集 → 数据融合 → 姿态解算 → 控制算法 → 电机输出。这个过程和现实世界里的血液循环系统很像每一环都有它不可替代的作用。2.1 IMU数据处理与姿态解算绝大多数平衡车源码用的传感器是MPU6050它内部集成了三轴陀螺仪和三轴加速度计。这里有一个新手常见的误区直接用加速度计算出的角度还是直接用陀螺仪积分出的角度两个都不行。加速度计对振动特别敏感稍微有点震动输出的角度就全是噪声陀螺仪虽然动态响应快但会有积分漂移时间一长角度就跑偏了。所以源码里通常会用互补滤波或卡尔曼滤波把两者融合。我在源码里最常见到的简化版互补滤波长这样// 互补滤波加加速度计算出的角度滤掉陀螺仪的长期漂移 float complementary_filter(float acc_angle, float gyro_rate, float dt) { float filtered_angle; float alpha 0.98f; // 权重系数按经验调节 filtered_angle alpha * (filtered_angle gyro_rate * dt) (1.0f - alpha) * acc_angle; return filtered_angle; }这里的alpha取值很关键。它越大代表越信任陀螺仪适合动态响应越小则越信任加速度计适合静态稳定。实测下来alpha在0.95到0.99之间比较合适具体数值取决于你车体的减震结构和电机的振动程度。如果在静止状态下读取到的角度还在小幅跳动那就是alpha取值偏大把加速度计的信任度稍微调高一点就好。2.2 电机控制与PWM输出姿态解算完了控制算法算出了目标占空比最后一步是驱动电机。通常方案是PWM方向引脚。这里容易踩坑的地方是PWM频率的选择。频率太低电机会发出刺耳的啸叫声而且响应迟钝频率太高驱动芯片的开关损耗会增加电机发热明显。我习惯把PWM频率设置在10kHz到20kHz之间这个范围既超出了人耳可听范围又不会给MOS管带来太大负担。// 电机死区补偿示例避免PWM在小占空比下电机不转的“死区”现象 #define MOTOR_DEAD_ZONE 50 int16_t motor_output(int16_t pwm_raw) { if (pwm_raw 0) { pwm_raw MOTOR_DEAD_ZONE; } else if (pwm_raw 0) { pwm_raw - MOTOR_DEAD_ZONE; } return pwm_raw; }这段代码的逻辑很直白但实用性很强。没有它你会发现小车在静止时总有一种“想动又动不了”的乏力感就是因为小占空比输出无法克服电机内部静摩擦。3. 一套完整的平衡车工程需要哪些“基础设施”真正优秀的“全套源码”绝不只有PID那几行核心代码它一定包括了非常完善的基础设施——时钟树、中断优先级、定时器配置、通信协议、上位机调试接口、甚至是RTOS实时操作系统。这些虽然在平时容易被忽略却是决定项目稳不稳定的关键。3.1 MCU资源分配一个典型工程的任务规划我参考过很多开源的平衡车工程它们大多采用STM32F103系列这款芯片虽然不是什么顶级性能但处理平衡车这种计算量绰绰有余。一个清晰的任务分配框架大致如下主控任务1kHz读取MPU6050、姿态融合、串级PID计算、输出PWM。这个任务的优先级最高必须放在定时器中断里执行。调试任务10Hz~50Hz通过串口向上位机发送角度、角速度、PWM占空比等关键数据方便实时观察波形。这个任务优先级低。遥控任务50Hz~100Hz接收蓝牙或者2.4G遥控器数据设定目标速度。它不直接参与平衡控制但影响速度环的期望值。低电量检测任务1Hz周期性地通过ADC读取电池电压电压过低时进行蜂鸣器报警或者关机保护。这种基于时间片轮询的架构比用裸机while(1)死循环写出来的代码更容易维护。尤其是当你想扩展一些额外功能——比如加入OLED显示、手机APP连接时任务化的思维会让你修改起来很从容。主循环调度示意伪代码 - Timer_1kHz_ISR: read_mpu6050() attitude_fusion() cascade_pid_control() set_motor_pwm() - while(1): if (time_ms % 100 0): send_debug_data() // 发送调试数据 if (time_ms % 20 0): read_remote_control() if (time_ms % 1000 0): check_battery_voltage()如果这份源码使用了FreeRTOS这样的嵌入式内核那么任务划分方式就更加清晰可以创建一个高优先级的定时任务负责控制几个低优先级的任务负责显示、通信和逻辑处理。这样做的最大好处是控制周期不会再被其他代码阻塞稳定性会有一个质的飞跃。源码里如果附带了对堆栈大小的配置freertos源码heap的调整那往往意味着作者已经对任务栈做过测量。3.2 数据调试接口波形显示能力比额外的功能更重要很多初学者拿到源码后喜欢先去看蓝牙调速、OLED显示这些“酷炫”的功能。但我的建议恰恰相反先把数据调试接口给摸透。所有的控制参数如果没有波形或者数值的反馈调参就像闭着眼睛开车。通常源码里会预留一个串口打印功能输出格式是JSON、CSV或者直接裸数据。配合VOFA或者SerialPlot这类工具可以直接在电脑上画出角度环的响应曲线。你自己做的时候我建议保留这套调试通道别为了省几个字节的串口开销就把它注释掉。它在后续调参中发挥的作用绝对比省下的那点CPU占用要大得多。4. 调参实战思路从理论参数到稳定骑行调参可以说是平衡车项目中水分最深的部分理论讲得头头是道实际一上手全懵。这里分享一套我屡试不爽的“三步走”调参法配合源码里的变量名你能很快让车体“站起来”。4.1 第一步先让电机“听话”内环PD调参要调内环角速度环前提是让车体处于一个可以自由旋转的状态。我通常会把车轮架起来让悬空的车轮去响应控制指令。给内环一个正弦波或者阶跃输入观察角速度的跟随情况。P值过小角速度响应疲软手感很“肉”P值过大会出现高频的嗡嗡声电机发烫D值加入用来抑制P带来的超调但D值过大会引入噪声车轮会出现颤抖。实操时我会先给一个较小的P值比如从10开始逐步加大直到听到电机开始出现轻微的震荡然后回调一点再慢慢加D值抑制剩余振荡。这个过程类似于拧螺丝拧到滑丝前的一点点然后回半圈。4.2 第二步让车体“站直”外环PD调参内环稳定后开始调外环角度环。外环的参数可以直接决定车身是软绵绵地左右晃动还是硬邦邦地“死磕”平衡。经验公式上外环P值大约是内环P值的1/10到1/5。比如内环P为50外环P可以先从5开始。如果车身出现慢速的、周期性的来回倾倒那是P值偏小如果出现高频微颤那是P值过大需要降低或者检查一下是否内环的阻尼不够。角度环的D值要小心处理它的物理意义是“角度的变化率”说白了就是角速度。所以如果你发现外环D值加不加效果不大很可能是因为内环的角速度反馈已经起到了类似作用。这点在调参时容易让人困惑理解清楚后就能少做很多无用功。4.3 第三步解决“跑偏”问题速度环与转向环车能直立还不算数真正的考验是能静止在原地、能往前直行。纯角度环控制的车就像一个喝醉的人总往一个方向走。这时候就需要速度环出场。速度环的输出不是直接给电机而是作为角度环的期望值输入。比如车身发现自己在往前跑速度环计算出一个让车“往后仰”的期望角度角度环收到这个期望角度后车身就会自主往后倾斜来制动。这套机制是平衡车稳定直行的关键。我在调速度环时遇到过最大的坑是“积分饱和”。当车身被外力强行按住时速度误差会一直积分导致松手后小车疯狂冲出去。解决的办法通常有两个限制积分上限或者设置积分分离条件。// 抗积分饱和的速度环PI实现示意 #define VELOCITY_INTEGRAL_MAX 5000 float velocity_pid(float target_speed, float current_speed) { static float integral 0.0f; float error target_speed - current_speed; float proportional 0.8f * error; integral error * 0.02f; // 关键限制积分累积 if (integral VELOCITY_INTEGRAL_MAX) { integral VELOCITY_INTEGRAL_MAX; } else if (integral -VELOCITY_INTEGRAL_MAX) { integral -VELOCITY_INTEGRAL_MAX; } return proportional integral; }转向环的调试相对简单本质上就是一个PD控制它的输出直接附加在两个电机的PWM差值上实现差速转向。只要转向方向和遥控指令一致参数不需要太精细就能正常工作。5. 常见故障排查实录与经验附录源码再全跑起来还是会出幺蛾子。下面这些问题是群里和评论区里出现频率最高的我按故障现象整理成了一个速查表方便大家遇到问题时快速定位。故障现象可能原因排查/解决方向上电后电机不转电池电压不足 / 电源接触不良检查电压是否在正常范围测量驱动芯片输入引脚波形车身高频剧烈抖动PID参数过激 / 陀螺仪数据被干扰先调小内环P确认滤波alpha是否合理检查电机供电是否稳定静止时电机有“嗡嗡”声PWM频率过低 / 死区补偿过于激进提高PWM频率降低死区补偿值能直立但不停往前/后跑速度环参数不对 / 编码器数据异常检查编码器安装是否松动速度环P是否过小I值是否被削得太狠转向时车身乏力转向环输出限幅过小 / 电机不对称调大转向环限幅检查左右电机响应是否一致RAM占用溢出数组定义过大 / RTOS任务栈分配不足调整FreeRTOS的heap大小精简调试用大数组常见错误典型表现修正建议忽略了控制周期抖动同一套参数时稳时不稳用定时器中断或RTOS高优先级任务固定1ms控制周期陀螺仪滤波过度角度响应滞后车体发飘alpha从0.98降到0.95观察响应变化速度环积分不限制车辆被压住后松手会飞出去增加积分限幅或引入积分分离实际硬件与源码引脚不一致电机不转但代码逻辑正常逐一对照芯片引脚定义用万用表测量PWM输出注意如果你在调试点位时发现角度数据突然跳到异常值先用I2C通信测试脚本检查MPU6050的连接是否稳定。很多时候问题不在算法层而是硬件层的信号接触不良。最后再分享一个小技巧调参不要太贪心一次只改一个参数。我见过不少朋友喜欢同时改P和D结果小车一抖动根本分不清是哪个参数引起的。保持一个变量原则配合上位机波形观察基本半小时内就能把车调稳。这份“二轮平衡车全套源码”的价值不在于你把它烧录进板子能跑起来而在于你能借此把整个嵌入式控制系统里最重要的几个概念吃透。从读取原始传感器数据到最后输出PWM每一行代码背后都是控制理论和工程实践的结合。希望这篇拆解能帮你更快地把源码变成自己的知识储备。本文还有配套的精品资源点击获取
