企业官网建设流程全解析

简介：基于STM32的双轮平衡自动循迹小车项目，为嵌入式方向在校生、电子设计竞赛选手及STM32入门者提供了一套完整可运行的工程源码与文档。项目集成了姿态传感器数据融合、双电机差速控制、红外循迹检测等核心算法，代码结构清晰，注释明确，可直接在Keil中打开编译并烧录至硬件平台。压缩包内共278个文件，以C语言源代码、头文件、Keil工程文件为主，配合hex可执行文件、编译映射文件及备份配置，便于查看构建过程和实现细节，整体体积仅9.75MB，轻量易获取。目前已有264人学习下载。该工程经过功能验证，稳定可靠，既适合作为毕业设计、课程设计或竞赛初期立项的参照方案，也方便读者依据文档说明逐步调试硬件与算法，进而在源码基础上扩展蓝牙遥控、视觉巡线等更高阶功能。

1. 双轮平衡循迹小车：从立项到跑通，这是一条完整的STM32技术链路

一个两轮自平衡小车，本质上是“倒立摆”模型在嵌入式平台上的实时控制实现：系统必须在毫秒级周期内完成姿态解算、平衡控制和运动决策。当“平衡”与“循迹”叠加在同一辆车上时，真正的难点不是某个单一功能，而是中断优先级、控制周期、传感器带宽之间的协同调度。我会按工程落地的顺序——硬件选型、姿态解算、PID整定、循迹策略、代码组织——把这条链路讲清楚。适合准备做课程设计或毕业设计的在校生，也适合想快速搭建一个带源码参考的STM32项目的在职工程师。

2. 平衡控制的数学基础与硬件选型

2.1 倒立摆模型：为什么两轮车能立住

两轮平衡车在力学上等价于一个一阶倒立摆：重心位于轮轴上方，重力会使车体倾倒，而车轮加速度能产生抵消倾倒趋势的惯性力。控制目标是让车体倾角始终收敛在零度附近。

离散化后，常用状态变量为倾角 $\theta$ 和倾角角速度 $\dot{\theta}$，控制量为电机输出 PWM 占空比。工程上不直接求解状态空间方程，而是用两个级联的 PID 环来做近似控制，这也是目前绝大多数 STM32 平衡车项目的标准做法。外环是直立环，输入为目标倾角与实际倾角的偏差，输出为期望角速度；内环是速度环，输入为期望角速度与实际角速度的偏差，输出为电机 PWM。

2.2 STM32 型号选型与传感器搭配

主控我推荐用 STM32F103C8T6 或 STM32F405RGT6。F103 价格低、资料全，51 元的板子就能跑完整套逻辑；F405 主频高，适合后续加视觉循迹或者无线图传。两者的工程代码结构几乎一致，CubeMX 里切换芯片型号后重新生成初始化代码即可。

传感器选型在平衡车上决定了控制上限：

• 姿态传感器：MPU6050，带 DMP 输出四元数，省去自己写互补滤波的数学推导。注意读取频率要稳定在 1kHz 左右，I2C 时钟设为 400kHz，用硬件 I2C 而非软件模拟。
• 电机：带霍尔编码器的 N20 减速电机，减速比 1:30，编码器分辨率 11 线（配合 4 倍频后每圈 44 个脉冲）。直接用带 AB 相的编码器，便于测速和测方向。
• 驱动：TB6612FNG，比 L298N 轻，导通压降小，PWM 频率能推到 20kHz。

2.3 电源架构：一个容易被忽视的瓶颈

电机启动瞬间电流可达 1.5A，而 STM32 和 MPU6050 的工作电流加起来不到 100mA。如果共用一组电源，MPU6050 的 VCC 会被拉到低于 3.3V，姿态数据瞬间飘掉，车就会倒。

正确做法是：7.4V 锂电池直接进 TB6612 的 VM，再经 LM2596 降压到 5V 给 STM32 板载稳压器或直接给编码器供电，MPU6050 用 STM32 板上的 3.3V LDO。地线要单点接地，电机电源地和数字地在驱动板附近汇合，避免数字信号被电机换向噪声耦合。

// 电源状态检测：ADC 采样电池电压，低于阈值时减小最大 PWM 限幅 #define BATTERY_LOW_THRESHOLD_MV 6800 uint16_t get_battery_mv(void) { ADC_HandleTypeDef hadc; // 假设使用 ADC1_IN0，参考电压 3.3V，分压比 1/3 HAL_ADC_Start(&hadc); HAL_ADC_PollForConversion(&hadc, 100); uint16_t raw = HAL_ADC_GetValue(&hadc); return (uint32_t)raw * 3300 * 3 / 4095; }

这段代码的作用是让控制线程能感知电源状态。电池电压下降时，电机能输出的最大驱动力也在下降，如果仍然输出同样大小的 PID 控制量，车会在低电量时震荡加剧。具体做法是将电压低于 6.8V 时的 PWM 限幅从 95% 降到 80%，保持系统稳态裕度。

3. 姿态解算与 PID 控制核心代码

3.1 MPU6050 数据读取与卡尔曼/互补滤波

MPU6050 输出的加速度计和陀螺仪数据单独都不能直接用：加速度计高频噪声大，陀螺仪存在温漂积分导致的角度漂移。需要把两者融合。开源社区最常见的融合方案是 Mahony 互补滤波，代码量小，在 F103 平台上只需约 300 个周期。

// Mahony 互补滤波核心，更新四元数 void mahony_update(float gx, float gy, float gz, float ax, float ay, float az, float halfT) { float norm; float vx, vy, vz; float ex, ey, ez; norm = sqrtf(ax*ax + ay*ay + az*az); ax /= norm; ay /= norm; az /= norm; // 从四元数计算重力方向估计 vx = 2.0f * (q1*q3 - q0*q2); vy = 2.0f * (q0*q1 + q2*q3); vz = q0*q0 - q1*q1 - q2*q2 + q3*q3; // 叉积误差 ex = ay * vz - az * vy; ey = az * vx - ax * vz; ez = ax * vy - ay * vx; // PI 补偿陀螺仪积分漂移 exInt += ex * Ki * halfT; eyInt += ey * Ki * halfT; ezInt += ez * Ki * halfT; gx += ex * Kp + exInt; gy += ey * Kp + eyInt; gz += ez * Kp + ezInt; // 一阶龙格库塔更新四元数 q0 += halfT * (-q1*gx - q2*gy - q3*gz); q1 += halfT * (q0*gx + q2*gz - q3*gy); q2 += halfT * (q0*gy - q1*gz + q3*gx); q3 += halfT * (q0*gz + q1*gy - q2*gx); // 归一化 norm = sqrtf(q0*q0 + q1*q1 + q2*q2 + q3*q3); q0 /= norm; q1 /= norm; q2 /= norm; q3 /= norm; // 转换成欧拉角：pitch 即为车体倾角 pitch = asinf(-2.0f * (q1*q3 - q0*q2)) * 57.29578f; }

参数halfT是采样周期的一半，由定时器中断周期决定，若控制频率为 1kHz，则halfT = 0.0005f。Kp和Ki分别取 0.5 和 0.05 作为初始值。注意Ki不能给得太大，否则陀螺仪零漂会被放大，导致实际静止时角度慢漂。每次上电后要让小车静置两秒完成陀螺仪零偏校准。

3.2 串级 PID：直立环与速度环的耦合

单环 PID 直接控制 PWM 会导致两个问题：车没有前进动力时会持续倾斜去够目标倾角；下坡时车会一直加速。标准解法是直立环外、速度环内，速度环输出作为直立环的目标值修正量，而不是直接叠加 PWM。

// 控制周期 2ms 的定时器中断内 void balance_control_task(void) { // 速度环：目标速度为外部指令速度，实际速度为编码器测速 float speed_err = target_speed - current_speed; speed_i += speed_err * 0.02f; // 积分分离：速度误差大时清掉积分 if (fabsf(speed_err) > 100.0f) speed_i = 0.0f; speed_i = fmaxf(fminf(speed_i, 3000.0f), -3000.0f); float speed_out = speed_err * 1.2f + speed_i * 0.3f; // 直立环：目标倾角 = 0 + 速度环输出角度修正 float target_angle = 0.0f + speed_out * 0.002f; float angle_err = target_angle - pitch; float gyro_rate = get_gyro_y(); // 注意陀螺仪轴向与倾角方向一致 float balance_out = angle_err * 28.0f + gyro_rate * 0.5f; // 死区补偿：防止 PWM 小信号时电机不转 if (balance_out > 0) balance_out += 12.0f; if (balance_out < 0) balance_out -= 12.0f; // 限幅后输出至 TB6612 balance_out = fmaxf(fminf(balance_out, 7200.0f), -7200.0f); set_motor_pwm(balance_out); }

速度环积分项和时间步长的匹配是这里最容易出错的地方。控制周期是 2ms，speed_i += speed_err * 0.02f中的0.02f就是经过换算的K_i * dt。如果改了中断频率，这个系数必须同步改。死区补偿值 12 对应约 3% 的占空比，具体数值取决于电机的启动电流，需要通过实测调出，过大反而会在零位附近来回撞击。

3.3 PID 参数整定顺序与方法

参数整定顺序不能乱，否则车永远立不稳。第一步整直立环 P，D 给零，P 从小到大加，直到手扶车体时感受到明显抵抗，但还没开始高频抖动；第二步加 D，抑制回正时的超调，效果是倾斜后手能感觉到阻尼；第三步调速度环，先给 P，观察车是否朝一个方向缓慢漂移，再加 I 消除稳态误差。

整定过程强烈建议用蓝牙串口实时查看pitch和目标角度曲线。常见的现象是：P 过大时高频振荡，P 过小时车倾斜后无返回力矩；D 过大时手推车体感觉像在推弹簧，回正慢且有过冲。

4. 循迹算法与灰度传感器信号处理

4.1 传感器布局与采样策略

循迹传感器我用的是 4 路灰度模块（如 TCRT5000），左右各两路，间距根据赛道黑线宽度调整，常见黑线宽 2cm，传感器中心距 1.5cm 比较合适。4 路数字量的输出组合能覆盖“直线、左偏、右偏、左急弯、右急弯、脱线”六种状态。如果预算允许，8 路模拟输出可以提供更平滑的位置信息，但 4 路数字量配合位置权重偏差算法已经足够稳定。

// 4 路数字量灰度传感器映射为偏差值，0 表示对中 // 传感器从左到右顺序为 S1 S2 S3 S4 int8_t get_line_error(void) { uint8_t s1 = HAL_GPIO_ReadPin(S1_GPIO_Port, S1_Pin); uint8_t s2 = HAL_GPIO_ReadPin(S2_GPIO_Port, S2_Pin); uint8_t s3 = HAL_GPIO_ReadPin(S3_GPIO_Port, S3_Pin); uint8_t s4 = HAL_GPIO_ReadPin(S4_GPIO_Port, S4_Pin); // 整体偏右 -> 偏差为负，整体偏左 -> 偏差为正 if (s2 && s3) return 0; // 中间两路压线 if (s1 && s2) return 2; // 左偏，偏差中等 if (s3 && s4) return -2; // 右偏 if (s1) return 3; // 左急弯，偏差大 if (s4) return -3; // 右急弯 if (s1 && s4) return 0; // 脱线但两侧都有信号，保持当前方向 if (!(s1 || s2 || s3 || s4)) { // 全无信号，沿用上一周期偏差，防止脱线时突然转向 return last_error; } last_error = ...; // 更新为当前计算出的偏差 return ...; }

这里的关键是脱线处理：当没有传感器压到黑线时，直接返回零偏差会让车走直线，结果是车笔直冲出赛道。正确逻辑是在脱线时保持上一次的偏差方向，让车沿着最后已知的曲线方向继续转弯，直到重新捕获黑线。这个逻辑配合“全白且两侧都有信号”的场景，能覆盖绝大多数 90 度弯和 T 字路口。

4.2 循迹转向 PID 与速度耦合

循迹转向环的输出是两轮速度差，叠加到平衡车的目标速度上。注意耦合关系：转向输出过大时，重心偏移会导致平衡环产生相反的纠正动作，车会有明显“甩头”现象。解决方式是将转向 PID 输出限幅在目标速度的 40% 以内，并且在直线段降低基础速度、弯道段通过偏差值动态降速。

// 循迹 PID 计算，输出左右轮速度差，单位 mm/s float track_pid(float error, float dt) { static float integral = 0.0f; float derivative = (error - last_error) / dt; // 积分分离：偏差大于 2.5 时停止积分，防止弯道积分饱和 if (fabsf(error) < 2.5f) { integral += error * dt; } else { integral = 0.0f; } integral = fmaxf(fminf(integral, 50.0f), -50.0f); float kp = 0.8f, ki = 0.05f, kd = 0.15f; return error * kp + integral * ki + derivative * kd; }

dt用循迹任务执行周期，建议与速度环一致或者更慢。Kp 初始值拿不准时，可以先让车走直线，人为用遥控器给出一个固定偏差，观察转向速度是否平滑。循迹 PID 的输出是速度差，最终左右轮目标速度分别为base_speed + speed_diff和base_speed - speed_diff，再分别送入速度环。

4.3 一个容易踩的坑：灰度阈值与环境光

TCRT5000 是反射式红外传感器，检测阈值受环境光和赛道颜色影响很大。不要用固定阈值硬比较，要在 main 函数启动时做一次自动校准：连续采样 50 次求平均，取白底平均值的 60% 作为阈值线。另外传感器距离地面的高度必须锁死在 5~10mm，误差超过 2mm 会让阈值失去意义。

// 动态阈值校准，上电时执行 uint16_t calibrate_threshold(ADC_HandleTypeDef *adc) { uint32_t sum = 0; for (int i = 0; i < 50; i++) { HAL_ADC_Start(adc); HAL_ADC_PollForConversion(adc, 10); sum += HAL_ADC_GetValue(adc); HAL_Delay(10); } uint16_t avg = sum / 50; // 返回白底阈值的 60% 作为区分黑白的阈值 return (uint16_t)(avg * 0.6f); }

用 ADC 采集模块的模拟输出而不是直接读数字引脚，是更稳的做法。因为模拟量能提供中间态信息，比如传感器压线一半时电压会处于中间值，软件可以从这里算出更精确的横向偏差。

5. STM32CubeMX 工程配置与代码架构组织

5.1 定时器与中断优先级分配

平衡控制对中断优先级的要求很严格。我这里给出一个经验上稳定的配置顺序（优先级数值越小越优先）：

平衡控制中断应设置为最高抢占优先级（数字最小），即使循迹或串口发生阻塞，也能保证车的直立不被打断。编码器中断频率如果与平衡控制频率相同，必须保证编码器先更新、平衡环后读取，否则读到的速度是上一时刻的旧值，会让速度环滞后一拍。

在 CubeMX 中，如果使用 F103 系列，注意它有 4 个定时器可用于编码器模式（TIM1/2/3/4，其中 TIM1 是高级定时器），配置时选择 Encoder Mode 后硬件会自动处理方向和计数。计数范围设为最大（0xFFFF），读取后自行转换为有符号数，避免溢出临界点无法判断方向的问题。

5.2 源码工程结构规划

一个具备可维护性的平衡车工程，不能把所有代码堆在 main.c 里。推荐按功能模块拆分为以下结构，这种组织方式也能让你的源代码文档显得更专业：

Car_Balance/ ├─ Core/ │ ├─ Inc/ (main.h, tim.h, adc.h) │ └─ Src/ (main.c, tim.c, adc.c) ├─ Drivers/ │ ├─ BSP/ (mpu6050.c/h, tb6612.c/h, encoder.c/h) │ ├─ Algorithm/ (mahony.c/h, pid.c/h, kalman.c/h) │ └─ Controller/ (balance.c/h, track.c/h) ├─ App/ │ ├─ task.c/h (任务调度) │ └─ debug.c/h (串口打印与参数在线修改) └─ Doc/ ├─ hardware_schematic.pdf └─ wiring_guide.md

关键原则是：硬件驱动层（BSP）只做寄存器读写，不包含控制逻辑；算法层保持纯函数输入输出，方便在 PC 端用 Python 复现验证；控制器层调用算法层，处理中断上下文中的时间戳和临界区保护。Doc目录里放一个接线表，标注每根信号线对应的 STM32 引脚，这比在代码里写注释更直观。

5.3 参数在线调试：不用改代码就能调 PID

每次调参都重新编译烧录，三轮下来就烦了。常见做法是用串口作为参数通道，在中断中解析收到的指令帧。协议简单定义为$CMD,VALUE\r\n，例如$P,28.5\r\n表示将直立环 Kp 改为 28.5。

// 串口命令解析，需在接收中断或 DMA 空闲中断中调用 void debug_parse_command(char *buf) { if (buf[0] != '$') return; float val = atof(buf + 2); switch (buf[1]) { case 'P': balance_kp = val; break; case 'D': balance_kd = val; break; case 'I': speed_ki = val; break; case 'V': target_speed = (int16_t)val; break; default: break; } }

配合 PC 端的串口助手，可以做到车在运行中直接调整参数，观察车体响应。注意修改参数时要加滤波或斜坡，防止参数跳变让车瞬间失控，例如new_kp = 0.2 * target_kp + 0.8 * old_kp做一个一阶低通。

6. 代码阅读指南与三个容易忽视的细节

6.1 源码阅读顺序：从 main 到中断，三层链路

拿到别人的平衡车源代码，不要从 main 第一行往后读。正确的阅读顺序是：

1. 先看中断向量表或定时器回调函数，确认控制周期和控制链路入口；
2. 再找传感器数据读取函数，确认数据类型和数据更新频率；
3. 最后回到 main 中的外设初始化顺序，确认传感器上电时序和 GPIO 复用配置。

具体到你的工程，第一行应该读tim.c里的HAL_TIM_PeriodElapsedCallback，找到balance_control_task的调用位置。这个函数每 2ms 执行一次，内部流程是“读陀螺仪 -> Mahony 更新 -> 速度环 -> 直立环 -> PWM 输出”。理解了这条链，整体代码就已经在你的脑内跑起来了。

6.2 编码器方向与电机极性的匹配关系

编码器方向反了的典型症状是车一上电就全速往一个方向冲。这是因为速度环反馈为正反馈，理论上增益大于 1 就会发散。排查方法是：手动转动左轮前进方向，串口打印编码器计数值，确认是增加；再给电机一个正向 PWM，确认轮子是向前转。

如果方向相反，优先在encoder.c的读取函数里交换 AB 相的符号，而不是改电机接线。因为 TB6612 输出端接电机，交换任意两条线也可以反转极性，但更容易造成逻辑混乱，在代码中统一处理更清晰。

6.3 串口打印性能开销：printf 重定向必须用 DMA

默认的printf通过fputc轮询发送，在 115200 波特率下一个字符需要约 87us，打印 20 个字符就是 1.7ms，正好吃掉一个控制周期。如果把printf放进控制循环里，车立刻开始抖动。

解决方案是重定向到 DMA 发送或使用ITM调试端口。最简单的做法是在main.c中实现HAL_UART_Transmit_DMA的格式化版本：

// 使用 vsnprintf + DMA 的轻量日志，不阻塞控制中断 void debug_log(const char *fmt, ...) { static char buf[128]; va_list args; va_start(args, fmt); int len = vsnprintf(buf, sizeof(buf), fmt, args); va_end(args); // 非阻塞发送，如果上次发送未完成则丢弃本次日志 if (huart2.gState == HAL_UART_STATE_READY) { HAL_UART_Transmit_DMA(&huart2, (uint8_t *)buf, len); } }

这里的“丢弃日志”是刻意的。控制周期内日志不能阻塞，丢了这帧下帧还能补上，比让控制中断等待更重要。如果串口 DMA 不可用，另一个方案是用ITM_SendChar通过 SWO 引脚输出到调试器，完全零开销，但需要配合 ARM 调试器使用。

本文还有配套的精品资源，点击获取