简介：本资源是一套面向高校嵌入式系统课程设计、毕业设计及期末大作业的高完成度平衡小车实践项目，基于WHEELTEC B570硬件平台，聚焦STM32F1系列主控的传感器融合、PID控制与实时运动调节等核心能力训练。压缩包共315个文件，涵盖44个C源文件（含HAL库驱动与MPU6050姿态解算）、71个头文件（定义硬件抽象与算法接口）、44个编译中间文件（.o/.d）及配套Makefile、链接脚本（.ld）、工程配置（.ioc/.mxproject）和固件输出（.hex/.elf），结构完整，可直接本地编译下载运行。已有130人学习下载，项目经助教审定，评审得分98分，难度适中且覆盖从底层外设初始化（UART/ADC/TIM）、DMP运动驱动到闭环平衡控制的全链路实现。读者可获得可复现的高分项目源码、模块化清晰的工程组织、关键传感器（MPU6050）与电机驱动调试说明，以及适用于教学验收与自主拓展的完整技术文档支撑。
1. 项目概述：从零到一，打造一台能“站起来”的智能小车
如果你正在学习嵌入式系统，尤其是STM32，那么“平衡小车”绝对是一个绕不开的经典项目。它不像点个LED灯那么简单，也不像做个遥控车那样直观，它的核心魅力在于“动态平衡”——让一个只有两个轮子的机器人，像我们人类一样，能够自主地站立、移动，甚至抵抗外界的干扰。这背后，是传感器数据采集、姿态解算、PID控制算法和电机驱动等多个嵌入式核心技术的综合应用。我当年做这个项目时，从一堆零件到小车稳稳立住的那一刻，那种成就感至今难忘。今天，我就以WHEELTEC的B570平衡小车套件为例，结合我自己的实战经验，把这个“高分项目”从里到外、从硬件到软件彻底拆解一遍，希望能为你扫清障碍，直通高分。
WHEELTEC B570是一个相当成熟的平衡小车开源平台，它基于STM32F103C8T6（俗称“蓝桥杯”或“战舰”同款核心芯片），集成了MPU6050六轴传感器、TB6612电机驱动、编码器反馈等关键模块。你拿到的源码和文档，就像一份武功秘籍的“总纲”和“招式图”，但要想真正练成，还得理解内功心法（原理）和实战技巧（调试）。这个项目非常适合作为嵌入式课程设计、毕业设计，或者电子竞赛的练手项目。它不仅考察你的C语言编程、单片机外设使用能力，更是对你系统思维、算法理解和动手调试能力的全面检验。接下来，我将带你深入这个项目的每一个环节。
2. 核心硬件平台与电路设计解析
2.1 主控芯片：STM32F103C8T6的选型与资源分配
为什么是STM32F103C8T6？这颗芯片在平衡小车项目中堪称“性价比之王”。它属于ARM Cortex-M3内核，主频72MHz，拥有64KB Flash和20KB RAM。对于平衡小车来说，其资源绰绰有余。我们需要重点关注它以下几个外设的使用：
- 定时器（TIM）：这是项目的“心脏”。我们需要至少3个定时器：
- TIM2/TIM3/TIM4：用于编码器模式，读取左右电机的转速和方向。这是实现速度闭环控制的基础。
- TIM1/TIM8：高级定时器，用于生成驱动电机的PWM波，控制电机的转速和转向。
- 一个基本定时器（如TIM6/TIM7）：用于产生系统中断，作为整个控制周期的“节拍器”，比如我们常说的“5ms控制周期”就是由它来保障的。
- 串口（USART）：用于调试信息输出（连接电脑串口助手）和后续可能的蓝牙/Wi-Fi模块通信。
- I2C总线：用于与MPU6050姿态传感器通信，读取原始的加速度计和陀螺仪数据。
- ADC（非必需但常用）：可以用于读取电池电压，实现低电量报警或保护。
注意：在规划引脚时，一定要对照芯片数据手册和原理图，避免功能复用冲突。例如，某些定时器的通道引脚可能与串口或I2C引脚复用，需要仔细配置。
2.2 姿态感知核心：MPU6050的工作原理与数据“驯服”
MPU6050是这个项目的“眼睛”和“耳朵”，它决定了小车能否感知自身的倾斜状态。它内部集成了三轴加速度计和三轴陀螺仪。
- 加速度计：测量的是线加速度，包括重力加速度。在静止时，我们可以通过计算各轴重力分量的夹角来估算姿态角（如俯仰角Pitch）。但它对运动（特别是电机振动）非常敏感，动态响应差，数据会“漂”。
- 陀螺仪：测量的是角速度。通过对角速度积分，可以得到角度变化。它的动态响应好，但积分会引入累积误差，时间一长，角度就“飘”到不知道哪里去了。
所以，核心问题就是：如何融合这两组各有优劣的数据，得到一个稳定、准确的姿态角？这就是姿态解算算法要解决的问题。在B570的源码中，最常见的是互补滤波和卡尔曼滤波。
互补滤波（Complementary Filter）：思路简单粗暴且有效。它利用高通滤波器提取陀螺仪的高频（动态）信号，利用低通滤波器提取加速度计的低频（静态）信号，然后将两者按一定权重相加。公式可以简化为：
角度 = α * (上一角度 + 陀螺仪角速度 * dt) + (1 - α) * 加速度计角度其中，α是一个介于0和1之间的系数，dt是采样时间。α越大，信任陀螺仪越多，响应快但易漂移；α越小，信任加速度计越多，静态稳但动态差。通常需要反复调试找到一个平衡点。卡尔曼滤波（Kalman Filter）：这是一种最优估计算法，理论更优美，抗干扰能力更强。它将系统建模为一个状态方程和观测方程，通过预测和更新两个步骤，最优地估计出系统状态（这里就是姿态角）。源码中如果实现了卡尔曼滤波，通常会比互补滤波更稳定，但理解和调参难度也更大。
实操心得：对于初学者，我强烈建议先从互补滤波入手。它的效果已经足够让小车站起来了，而且参数直观（主要调
α和dt），便于理解融合原理。你可以先让小车静止，观察融合后的角度是否跟随加速度计角度；再快速晃动小车，观察角度是否又能快速跟上陀螺仪的变化。
2.3 动力与反馈系统：电机、驱动与编码器
这是小车的“腿”和“肌肉感知”。
- 电机：通常使用N20减速电机或类似的直流减速电机。关键参数是减速比和额定电压，它们决定了小车的扭矩和速度。
- 驱动芯片TB6612：比传统的L298N效率更高、发热更小。它需要两个PWM信号控制一个电机的速度和方向（AIN1/AIN2和PWMA）。接线务必正确，否则电机可能不转或乱转。
- 编码器：这是实现速度闭环和位置闭环的关键。增量式编码器输出A、B两相正交脉冲。STM32的定时器编码器接口模式可以自动根据A、B相的相位关系计数，轻松得到脉冲数和方向。
- 速度计算：在固定的控制周期（如5ms）内，读取编码器计数值的变化量
ΔCnt。速度v = (ΔCnt / 编码器线数) * (轮周长 / 控制周期)。这个速度值将作为速度环PID的反馈量。
- 速度计算：在固定的控制周期（如5ms）内，读取编码器计数值的变化量
电路连接检查清单：
- [ ] MPU6050的SDA、SCL是否正确连接至STM32的I2C引脚（如PB6, PB7），并接上拉电阻。
- [ ] 电机驱动TB6612的PWMA、AIN1、AIN2是否连接至STM32的定时器PWM输出通道和普通GPIO。
- [ ] 编码器的A、B相是否分别接入支持编码器模式的定时器通道（如TIM2的CH1、CH2）。
- [ ] 电池电压是否在电机和芯片的允许范围内（常用7.4V或12V锂电池），且电源模块（如LM2596）能为STM32稳定提供5V或3.3V。
3. 软件架构与核心控制算法深度剖析
拿到源码，不要急于下载。先花时间理清整个程序的骨架，这比盲目调试效率高十倍。一个典型的平衡小车软件架构如下：
3.1 程序主循环与中断服务例程的分工
平衡小车是一个典型的实时控制系统，必须保证控制周期的绝对稳定。因此，普遍采用“前台后台”系统架构。
- 后台（main函数循环）：负责非实时或实时性要求不高的任务，如：
- 初始化所有硬件（GPIO、定时器、I2C、USART等）。
- 读取蓝牙串口指令（如果有的話）。
- 更新系统状态（如待机、运行、故障）。
- 一些慢速的数据显示或记录。
- 前台（定时器中断服务例程）：这是控制系统的核心。由一个基本定时器（如TIM6）触发，每隔固定时间（如5ms）执行一次。在这个中断里，必须完成所有实时控制任务，顺序至关重要：
- 数据采集：通过I2C读取MPU6050的原始数据（加速度、角速度）。
- 姿态解算：调用互补滤波或卡尔曼滤波函数，计算出当前小车的俯仰角（Pitch）和角速度。
- 控制算法计算： a.直立环（角度环）PD控制：根据目标角度（通常为0度，即直立）和当前角度的偏差，以及角速度，计算出一个控制量，目的是让小车“站直”。 b.速度环PI控制：根据目标速度（通常为0，即静止）和编码器测得的速度偏差，计算出另一个控制量，目的是消除直立环带来的静差，让小车能真正静止。 c.转向环P控制：如果小车需要转弯，则根据左右轮速度差或遥控指令，叠加一个控制量。
- 控制量融合与输出：将直立环、速度环、转向环的输出叠加，经过限幅处理后，转换为PWM占空比，通过高级定时器输出给TB6612，驱动电机。
关键点：中断服务函数里的代码必须精简高效，不能有延时函数（如
delay_ms），不能进行复杂的浮点运算（如果必须，确保STM32已启用硬件浮点单元或使用优化后的库）。否则会导致中断执行时间过长，影响下一个控制周期，系统就会失控。
3.2 灵魂所在：PID控制算法的原理与调参实战
PID是让小车保持平衡的“大脑”。我们主要用到两个环：直立环（角度环）和速度环。
3.2.1 直立环（角度环）PD控制器直立环是内环，也是最重要的环。它直接响应小车的倾斜。
- P（比例）项：
P_out = Kp * angle_error。angle_error是目标角度与实际角度的偏差。Kp就像小车的“反应速度”。Kp太小，小车反应慢，软绵绵地倒下；Kp太大，小车会剧烈抖动甚至发散。 - D（微分）项：
D_out = Kd * gyro。这里通常直接用陀螺仪测得的角速度作为微分项，而不是对角度误差求微分（因为噪声大）。Kd代表“阻尼”或“预见性”。它能够抑制P项引起的振荡。没有D项，小车会在平衡点附近来回摇摆；D项太强，系统会反应迟钝。
直立环输出：Vertical_out = P_out + D_out
3.2.2 速度环PI控制器速度环是外环。你会发现，如果只有直立环，小车虽然能站住，但会慢慢地朝一个方向移动，无法静止在一点。这是因为电机阻力、地面不平等因素造成了静差。速度环就是为了消除这个静差。
- P（比例）项：
P_out_speed = Kp_s * speed_error。响应速度偏差。 - I（积分）项：
I_out_speed += Ki_s * speed_error * dt。积分项会累积历史偏差，专门消除静差。但积分项太强会导致“积分饱和”，引起系统超调或振荡。
速度环输出：Speed_out = P_out_speed + I_out_speed
3.2.3 调参步骤与口诀（“先内后外，先P后D最后I”）这是调试成败的关键，务必耐心。
第一步：调直立环PD
- 将速度环和转向环的输出置零。
- 先调Kp：从小值开始（比如1.0），用手扶住小车，给一个轻微倾斜，感受电机是否有正确的抵抗力度（小车往前倾，电机应该往后转）。逐渐增大Kp，直到小车能快速响应倾斜，但开始出现高频抖动。此时，Kp约为临界值的70%-80%。
- 再调Kd：加入一个较小的Kd（比如0.5），观察抖动是否被抑制。增大Kd，直到抖动消失，小车反应依然迅速。Kd太大，小车会变得“僵硬”，反应迟钝。
- 目标：松开手，小车能自己站立2-3秒不倒。此时它会缓慢移动，这是正常的。
第二步：调速度环PI
- 保持直立环参数不变，加入速度环。
- 先调Kp_s：从小值开始（比如0.1）。观察小车是否比之前更“粘地”，移动趋势减弱。逐渐增大Kp_s，直到小车能在你推动后，缓慢回到原位置或在一个小范围内稳定。
- 最后调Ki_s：如果小车仍有缓慢的漂移，加入一个很小的Ki_s（比如0.001）。Ki_s的作用是精细修正。务必给积分项设置一个输出限幅，防止积分饱和（例如，限制其最大输出为直立环输出的20%）。
调试神器：串口绘图。将关键数据（如
angle_error,gyro,Vertical_out,speed_error,Speed_out， 以及最终的PWM值）通过串口发送到电脑，使用SerialPlot、VOFA+等工具实时绘图。观察波形，你能直观地看到每个参数的影响，这是盲调无法比拟的。
3.3 源码关键函数导读
在B570的源码中，你需要重点关注以下几个函数（函数名可能略有不同）：
MPU6050_Read()：I2C读取原始数据函数。Get_Angle()或IMU_update()：姿态解算函数，里面包含了互补滤波或卡尔曼滤波的实现。TIM6_IRQHandler()或SysTick_Handler()：定时中断服务函数，整个控制逻辑的核心。Vertical_Control()：直立环PD计算函数。Velocity_Control()：速度环PI计算函数。Set_Pwm()或Motor_Output()：将最终控制量转换为PWM并输出的函数。
4. 项目实战：从焊接调试到稳定运行
4.1 硬件组装与上电前检查
- 焊接：确保所有排针、电机线、电源线焊接牢固，无虚焊、短路。特别是MPU6050模块，引脚细密，焊接时注意不要连锡。
- 安装：将MPU6050模块水平安装在小车底盘的中心平面上，X轴指向小车前进方向。这是姿态解算的物理基础，装歪了角度基准就错了。
- 上电前检查：
- 万用表蜂鸣档检查电源与地是否短路。
- 检查电池极性是否正确。
- 用手轻轻拨动轮子，观察编码器信号线是否连接牢固。
4.2 软件调试分步走
- 基础外设测试：
- 串口：下载一个最简单的串口打印“Hello World”程序，确认下载器和串口通信正常。
- LED/按键：测试GPIO输出输入是否正常。
- 传感器测试：
- 编写代码读取MPU6050的ID（
0x68），确认I2C通信成功。 - 读取原始加速度和陀螺仪数据，通过串口打印，静止时观察加速度计Z轴是否约为
+1g或-1g（取决于安装方向），转动小车观察陀螺仪数据变化是否灵敏。
- 编写代码读取MPU6050的ID（
- 电机与编码器测试：
- 写一个固定占空比的PWM输出程序，测试左右电机是否能正反转。
- 开启定时器编码器模式，用手转动轮子，通过串口打印计数值，确认编码器工作正常且方向正确（正转递增，反转递减）。
- 闭环调试：
- 按照3.2.3节的步骤，先注释掉速度环和转向环，只调试直立环PD参数。
- 保护措施：调试时，用手扶住小车，或者将小车放在两个杯子中间，防止它突然暴走损坏设备或伤及自身。
- 利用串口绘图，边调边看。
4.3 稳定运行与功能扩展
当小车能稳定站立后，你可以尝试：
- 蓝牙遥控：通过HC-05/06模块，用手机APP或电脑发送指令，控制小车前进、后退、转向。
- 循迹/避障：增加红外对管或超声波模块，让小车实现自动循迹或避障功能。
- 上位机监控：利用Qt、Matlab或Python（如PyQt、Tkinter）编写一个简单的上位机，实时显示小车角度、速度、PWM等曲线，并支持参数在线调节。
- 优化控制算法：尝试更高级的算法，如串级PID、模糊PID，或者将卡尔曼滤波从姿态解算扩展到整个状态估计。
5. 常见问题与故障排查实录
即使有源码，调试过程也绝不会一帆风顺。下面是我和学生们常遇到的“坑”：
| 问题现象 | 可能原因 | 排查思路与解决方案 |
|---|---|---|
| 小车完全无反应，电机不转 | 1. 电源问题（电池没电、开关未开、电源线虚焊）。 2. 主控芯片未正常工作（晶振、复位电路、Boot引脚）。 3. 程序未成功下载或运行。 | 1. 用万用表测量各关键点电压（电池电压、5V/3.3V稳压输出、单片机VDD）。 2. 检查晶振是否起振（示波器看波形），Boot0/1引脚是否接地。 3. 下载一个最简单的LED闪烁程序，确认开发环境、下载器、芯片均正常。 |
| 电机抖动或只朝一个方向转 | 1. 电机驱动芯片（TB6612）输入逻辑错误。 2. PWM输出通道或极性配置错误。 3. 控制量计算错误，输出始终为正或负。 | 1. 检查AIN1/AIN2控制方向的GPIO电平是否正确。 2. 用示波器或逻辑分析仪检查PWM波形是否正常输出，占空比是否随控制量变化。 3. 在调试中打印最终的PWM控制值，看其是否在正负范围内正常变化。 |
| 小车立不住，往一个方向加速倒下 | 1.MPU6050安装方向错误或坐标系定义错误。 2. 直立环PID极性错误（正反馈）。 3. 角度零点（机械中值）未校准。 | 1.这是最高频的问题！确认小车前倾时，MPU6050测得的俯仰角是正还是负，与控制算法的期望是否匹配。最简单的方法：将计算出的角度通过串口打印，用手前倾/后倾小车，看角度值变化方向是否正确。 2. 检查直立环输出公式符号。小车前倾（角度为正），电机应该向后转（产生向前的力），使小车回正。如果反了，将Kp或整个输出取反。 3. 将小车放在一个你认为绝对水平的平面上，读取此时的俯仰角，将此值作为零点偏移量在程序中减去。 |
| 小车能站但剧烈抖动 | 1. 直立环Kp太大或Kd太小。 2. 控制周期不稳定（中断被干扰）。 3. 传感器数据噪声大（MPU6050未校准、电源不稳）。 | 1.降低Kp，增大Kd。这是最主要的调节手段。 2. 检查定时器中断优先级是否最高，中断服务函数是否执行时间过长。 3. 对MPU6050的原始数据进行简单的滑动平均滤波，或使用其内置的DLPF（数字低通滤波器）。确保其供电稳定（3.3V最好单独从LDO取电，而非电机驱动板上的3.3V）。 |
| 小车站住后缓慢漂移 | 1. 速度环未起作用或参数不当。 2. 机械结构不对称，重心偏移。 3. 电机或齿轮箱存在回差。 | 1. 检查速度环是否已启用，Ki_s是否过小或积分限幅是否太小。适当增大Ki_s。 2. 尝试微调小车重心（如移动电池位置）。 3. 这是硬件固有特性，可在软件中为两个电机设置微小的补偿值。 |
| 通过蓝牙遥控无反应 | 1. 蓝牙模块未正确配对或接线错误（TX/RX接反）。 2. 串口中断与定时器中断冲突。 3. 协议解析错误。 | 1. 先用串口助手测试蓝牙模块透传是否正常。 2. 避免在高速定时器中断中处理串口数据。应在主循环或低优先级串口中断中处理。 3. 打印接收到的原始数据，检查是否符合约定的协议格式（如 ‘f’前进，‘b’后退）。 |
最后一点个人体会：调平衡小车，耐心和观察力比盲目修改代码更重要。它是一个软硬件紧密结合的系统，任何一个环节的微小偏差都可能导致失败。充分利用好串口打印调试信息和绘图工具，让你的调试过程从“盲人摸象”变成“眼见为实”。当你第一次看到自己亲手组装、编程的小车颤颤巍巍又坚定地站立起来时，你会觉得之前所有的抓狂和熬夜都是值得的。这份从理论到实践，从问题到解决的全过程经验，才是这个“高分项目”带给你的最大财富。
本文还有配套的精品资源，点击获取
