很多同学复刻电赛题目时最容易出现的情况是代码下载进去了传感器也读到了数据但小车就是不走直线要么原地画圈要么压着线冲出去。于是开始怀疑是不是单片机坏了是不是MPU6050坏了其实大概率是控制环没搭对。STM32F103C8T6 MPU6050 五路灰度传感器这套组合在2024年电赛H题相关作品里非常常见也是很多课程设计、毕设和入门竞赛项目的标配。但说句实在话传感器型号根本不重要灰度传感器负责“位置”MPU6050负责“角度”两者通过串级PID形成闭环这才是整套系统的技术核心。这篇文章不打算只贴一个现成工程让你抄而是把复刻这类题目时最容易被忽略的控制架构、代码组织、调参顺序和排查思路讲清楚。读完以后你应该能自己搭出一台能走直线、能过弯道、丢线还能救回来的小车。1. 这篇文章真正要解决的问题先聊三个典型痛点看看你有没有中招。第一个痛点是“代码能跑车不走直线”。从网上找到一份完整的工程烧录进去以后电机转了灰度传感器也有反应但小车左右扭来扭去像喝醉了一样。问题往往不在硬件而在PID参数完全没调过或者位置环和角度环的方向搞反了。第二个痛点是“传感器读数波动太大”。五路灰度传感器的模拟量输出不稳定同一块地板昨天阈值还能用今天阳光一变就失灵。很多人上来就调PID却不知道先把传感器阈值和滤波做好控制环输入本身就是噪声输出自然不可能稳定。第三个痛点是“不知道从哪里开始调参数”。位置环Kp是1还是100角度环的输出和PWM占空比怎么对应内环和外环应该先调谁这些问题在网上的开源工程里很难找到答案因为作者往往自己也没想清楚只是靠试。为什么选STM32F103C8T6因为它便宜、资料多、最小系统板几块钱就能买到而且完全能胜任这类控制任务。为什么题目里要同时用MPU6050和五路灰度传感器因为灰度传感器解决的是“小车相对于黑线偏了多少”的问题MPU6050解决的是“小车当前航向角速度和期望角速度差多少”的问题两个信息叠加在一起才能形成有效的闭环控制。这篇文章要给你的不是一份“抄完就跑”的源码而是一套可以复用的控制框架。它包括基础概念、硬件选型、引脚规划、代码实现、串级PID调试顺序、常见故障排查以及工程上值得坚持的细节。无论你是在准备电赛、做课程设计还是单纯想找一个小项目练手这套框架都能直接迁移。2. 基础概念与核心原理2.1 五路灰度传感器小车怎么判断“位置”灰度传感器本质上是红外反射式传感器模块上有一个红外发射管和一个接收管。发射管发出红外光照射到地面后反射回来接收管根据反射强度输出不同的信号。黑色线条吸光能力强反射弱白色或浅色地面反射强传感器输出就有明显差异。五路的意思就是从左到右排布了五个检测点常见的权重分布是通道表示含义位置权重S1最左边-2S2偏左-1S3正中间0S4偏右1S5最右边2这样设计的好处是可以通过加权平均计算出小车相对于黑线的横向偏差。举个例子如果只有中间的传感器检测到黑线那么偏差就是0说明小车居中了。如果偏右的传感器检测到黑线偏差变成正数系统就知道需要向右修正。至于输出形式灰度传感器模块通常有两种一种是数字输出模块上带有比较器直接输出高电平或低电平另一种是模拟输出输出电压随反射强度变化。复刻电赛题目时我更推荐用模拟量输出因为可以根据实际环境调节阈值灵活性高很多。STM32F103C8T6有多个ADC通道采集五路模拟信号完全够用。2.2 MPU6050小车怎么感知“姿态”MPU6050是一颗六轴惯性测量单元内部集成了三轴加速度计和三轴陀螺仪。加速度计可以测量物体在三个轴向上的加速度陀螺仪可以测量三个轴向上的角速度。在平衡小车、自平衡机器人这类项目里MPU6050被用来计算俯仰角从而判断车身是否倾斜。但在2024年这类循迹小车题目里MPU6050更常见的用法是获取Z轴角速度也就是车头转向的快慢或者通过积分得到航向角用来做角度环反馈。很多人以为拿到了MPU6050原始数据就可以直接当成角度用。实际上陀螺仪输出的是角速度必须积分才能得到角度。但单纯积分会引起漂移时间一长明明车头已经回正了积分结果却还偏着。所以通常需要姿态解算把加速度计数据和陀螺仪数据融合起来。常用的方法有Mahony互补滤波、Madgwick滤波工程量小效果好足够复刻电赛题目使用。2.3 角度环与位置环串级PID的分工这里先说结论位置环是外环角度环是内环。位置环的输出作为角度环的目标值角度环的输出直接去控制电机差速。用开车的例子类比。你开车时眼睛看着车道线判断车相对于车道中间偏了多少这是“位置环”。然后大脑根据这个偏差规划方向盘应该打多少手跟着执行这是“角度环”。如果眼睛只看前方三五米方向盘就会忽左忽右如果眼睛盯着近处车又会画龙。这个“看得远还是近”的感受在PID里就体现在位置环的P参数上。在内环角度环里反馈量来自MPU6050。可以是Z轴角速度也可以是积分后的航向角。如果只用灰度传感器的位置偏差直接做PID输出差速相当于省略了内环外环直接驱动执行器车会非常“神经质”一点偏差就猛打方向。串级PID的好处是内环先把姿态稳定住外环再去纠正位置整个系统不容易震荡。3. 硬件选型与环境准备3.1 器件清单器件说明STM32F103C8T6 最小系统板主控注意国内有大量兼容替代型号代码大体通用MPU6050 模块I2C接口3.3V供电五路灰度传感器模块建议选模拟量输出版本直流减速电机 电机驱动常见驱动有TB6612、DRV8833等电源模块动力电源和控制电源建议分开或者做好滤波OLED显示屏可选方便现场观察关键参数ST-Link / 串口模块烧录和调试STM32F103C8T6本身是48引脚芯片最小系统板上晶振、复位、Boot电路都已经做好直接通过排针引出GPIO。它内置64KB Flash、20KB RAM跑一个裸机的串级PID控制程序绰绰有余即使后面移植FreeRTOS也完全够用。3.2 引脚规划STM32F103C8T6虽然常用但引脚资源并不算丰富规划不好很容易冲突。这里给出一套比较保险的分配方案外设引脚说明MPU6050 SCLPB6I2C1时钟MPU6050 SDAPB7I2C1数据灰度传感器 S1-S5PA0-PA4ADC输入PWM 左电机PA8 / PA9用TIM1通道PWM 右电机PA10 / PA11同组或另一组定时器电机方向控制PB0-PB3普通GPIO输出串口调试PA9 / PA10 或单独引出注意和PWM冲突这里特别提醒STM32F103C8T6的PA9和PA10既是USART1的收发引脚也可以复用为TIM1的某个通道两者很容易冲突。如果你要用串口打印调试信息最好提前规划不要把PWM和串口挤在同一组引脚上。3.3 软件环境推荐使用STM32CubeMX生成初始化代码配合HAL库开发。HAL库代码可读性比标准库好适合从零搭建项目也方便后面移植到其他STM32型号。如果你习惯用标准库也可以本文的核心代码重点在控制逻辑并不依赖某一个库的特定API。编译工具推荐Keil MDK或者STM32CubeIDE烧录用ST-Link。先用一个最小工程点亮LED确认开发环境正常再开始接外设。4. 核心流程拆解4.1 创建工程与初始化外设用STM32CubeMX创建工程时需要开启的外设有RCC外部高速时钟HSESYSDebug串行线方便ST-Link调试I2C1连接MPU6050速率400KHz以下ADC1五通道采集灰度传感器TIM1或者TIM2/TIM3输出两路PWM控制左右电机USART1串口打印调试信息时钟配置方面让主频跑到72MHz即可。系统时钟配置错误会导致串口波特率不对、定时器频率意外偏差这也是“代码看起来没问题运行却不正常”的常见原因。4.2 MPU6050初始化与数据读取MPU6050的I2C地址通常是0x68如果AD0引脚接高电平则变成0x69。很多同学第一次调不通MPU6050就是地址搞错了。初始化MPU6050时最关键的一步是唤醒芯片。芯片上电后默认处于休眠状态需要往电源管理寄存器写入0x00来解除休眠。随后可以配置陀螺仪量程、加速度计量程、采样率分频等。读取数据时需要从加速度计数据寄存器起始地址一次性连续读取14个字节这14个字节依次是加速度计X/Y/Z各2字节、温度2字节、陀螺仪X/Y/Z各2字节。每个轴的数据是大端格式高字节在前。4.3 灰度传感器数据读取与偏差计算灰度传感器的数据读取要注意两点。第一ADC的值需要转换成0-1或者0-100的相对值方便统一阈值。第二环境光变化会影响绝对数值所以更推荐使用动态阈值。五路灰度传感器最常见的偏差计算方法对每一路做二值化判断是否检测到黑线。将检测到黑线的通道乘以对应权重。求和后除以检测到的通道数得到位置偏差。如果五个通道都没检测到黑线说明小车已经丢线此时需要进入丢线处理逻辑而不是继续用偏差计算。4.4 PID控制循环与电机输出整个控制循环可以总结为读取五路灰度传感器计算位置偏差。位置环PID根据偏差输出目标角速度。读取MPU6050的Z轴角速度作为当前角速度反馈。角度环PID根据“目标角速度”和“实际角速度”的误差输出电机差速。基础速度加上差速分别赋值给左右电机PWM。很多人只写了位置环也就是灰度偏差直接映射到差速这样当然也能跑但抗干扰能力差弯道一急就冲出去。加上角度环以后小车在当前姿态下会先修正转向速度位置环只在偏离赛道时发出指令整体表现会稳定很多。实际电赛题目如果包含坡道、侧倾等情况MPU6050还可以用来检测俯仰角辅助判断车身状态这属于题目功能的延伸但底层架构是一样的。5. 完整示例与代码实现这一部分给出核心代码框架。代码分三个文件MPU6050驱动、灰度传感器处理、PID控制与主循环。5.1 MPU6050驱动示例使用HAL库的I2C接口封装一个读取原始数据的函数。// 文件路径Src/mpu6050.c #include mpu6050.h #include i2c.h #define MPU6050_ADDR (0x68 1) // 8位I2C地址 #define MPU6050_PWR_MGMT_1 0x6B #define MPU6050_ACCEL_XOUT_H 0x3B #define MPU6050_GYRO_XOUT_H 0x43 void MPU6050_Init(void) { uint8_t tmp; // 解除休眠 tmp 0x00; HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, MPU6050_PWR_MGMT_1, I2C_MEMADD_SIZE_8BIT, tmp, 1, 100); // 陀螺仪量程 -2000dps加速度计量程 -2g tmp 0x03; // GYRO_CONFIG HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, 0x1B, I2C_MEMADD_SIZE_8BIT, tmp, 1, 100); tmp 0x00; // ACCEL_CONFIG HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, 0x1C, I2C_MEMADD_SIZE_8BIT, tmp, 1, 100); } void MPU6050_ReadRaw(int16_t *accel, int16_t *gyro) { uint8_t buf[14]; HAL_I2C_Mem_Read(hi2c1, MPU6050_ADDR, MPU6050_ACCEL_XOUT_H, I2C_MEMADD_SIZE_8BIT, buf, 14, 100); accel[0] (int16_t)((buf[0] 8) | buf[1]); accel[1] (int16_t)((buf[2] 8) | buf[3]); accel[2] (int16_t)((buf[4] 8) | buf[5]); gyro[0] (int16_t)((buf[8] 8) | buf[9]); gyro[1] (int16_t)((buf[10] 8) | buf[11]); gyro[2] (int16_t)((buf[12] 8) | buf[13]); }值得注意的细节是HAL库的HAL_I2C_Mem_Read和HAL_I2C_Mem_Write第一个地址参数需要的是8位地址所以7位地址0x68要左移一位变成0xD0。很多移植失败的原因就出在这里。5.2 灰度传感器偏差计算示例假设使用ADC1的通道0到通道4读取结果存放在数组adc_value[5]中。// 文件路径Src/grayscale.c #include grayscale.h #include adc.h #define GRAYSCALE_THRESHOLD 2000 // 需要根据实际环境调整 float Grayscale_GetPosition(uint32_t *adc_value) { float position 0.0f; int valid_count 0; int weights[5] {-2, -1, 0, 1, 2}; for (int i 0; i 5; i) { if (adc_value[i] GRAYSCALE_THRESHOLD) { // 检测到黑线反射量小 position weights[i]; valid_count; } } if (valid_count 0) { // 丢线状态返回一个特殊值由上层处理 return 100.0f; // 约定为丢线 } position / valid_count; return position; }这里的阈值逻辑要根据灰度传感器模块的输出极性来调整。有的模块检测到黑线时输出低电平、ADC值变小有的模块相反。建议先在串口上位机里打印五路ADC原始值观察颜色差异再确定阈值。5.3 串级PID控制核心实现先实现一个通用的PID结构体和更新函数然后在上层把位置环和角度环串联起来。// 文件路径Src/pid.c typedef struct { float kp; float ki; float kd; float integral; float prev_error; float integral_limit; float output_limit; } PID_t; void PID_Init(PID_t *pid, float kp, float ki, float kd, float integral_limit, float output_limit) { pid-kp kp; pid-ki ki; pid-kd kd; pid-integral 0.0f; pid-prev_error 0.0f; pid-integral_limit integral_limit; pid-output_limit output_limit; } float PID_Update(PID_t *pid, float target, float current, float dt) { float error target - current; float output; pid-integral error * dt; // 积分限幅 if (pid-integral pid-integral_limit) pid-integral pid-integral_limit; else if (pid-integral -pid-integral_limit) pid-integral -pid-integral_limit; float derivative (error - pid-prev_error) / dt; pid-prev_error error; output pid-kp * error pid-ki * pid-integral pid-kd * derivative; // 输出限幅 if (output pid-output_limit) output pid-output_limit; else if (output -pid-output_limit) output -pid-output_limit; return output; }主循环中位置环和角度环是这样衔接的// 文件路径Src/main.c 节选 #include pid.h #include mpu6050.h #include grayscale.h extern ADC_HandleTypeDef hadc1; extern TIM_HandleTypeDef htim1; PID_t position_pid; // 位置环灰度偏差 - 目标角速度 PID_t angle_pid; // 角度环角速度误差 - 差速PWM uint32_t adc_value[5] {0}; int16_t accel[3], gyro[3]; #define BASE_SPEED 500 // 基础PWM占空比0-999 #define ANGLE_RATE_SCALE 10.0f // 根据实际需求把位置偏差映射成角速度目标 void Control_Loop(float dt) { float position; float target_yaw_rate; float current_yaw_rate; float speed_diff; // 1. 读取五路灰度传感器并计算位置偏差 // 这里假设ADC已经由DMA或者轮询方式更新到adc_value数组 position Grayscale_GetPosition(adc_value); // 丢线处理 if (position 50.0f) { // 简单处理保持上一次的输出或者强制向一侧修正 target_yaw_rate 80.0f; } else { // 2. 位置环偏差 - 目标角速度 target_yaw_rate PID_Update(position_pid, 0.0f, position, dt); target_yaw_rate * ANGLE_RATE_SCALE; } // 3. 读取MPU6050的Z轴角速度 MPU6050_ReadRaw(accel, gyro); current_yaw_rate gyro[2] / 16.4f; // -2000dps量程下16.4 LSB/(deg/s) // 4. 角度环目标角速度 vs 当前角速度 speed_diff PID_Update(angle_pid, target_yaw_rate, current_yaw_rate, dt); // 5. 输出PWM差速 int left_pwm BASE_SPEED - (int)speed_diff; int right_pwm BASE_SPEED (int)speed_diff; // 限幅 if (left_pwm 0) left_pwm 0; if (left_pwm 999) left_pwm 999; if (right_pwm 0) right_pwm 0; if (right_pwm 999) right_pwm 999; __HAL_TIM_SET_COMPARE(htim1, TIM_CHANNEL_1, left_pwm); __HAL_TIM_SET_COMPARE(htim1, TIM_CHANNEL_2, right_pwm); }这段代码里MPU6050的陀螺仪量程配置为±2000dps所以原始值除以16.4才能得到实际的角速度单位deg/s。位置环的输出乘以ANGLE_RATE_SCALE目的是把位置环的无量纲输出映射到角速度目标值这个系数也是调试时需要重点调整的参数之一。6. 运行结果与效果验证代码写完以后不要急着把小车放到赛道上跑而是先做分步验证。第一步通过串口打印MPU6050的原始数据。用手轻轻转动小车观察Z轴角速度是否跟随转动方向变化。如果数据完全是乱的或者始终为0说明I2C通信或寄存器配置有问题。第二步通过串口打印五路灰度传感器的ADC值。用一张黑色电工胶带贴在浅色地面上依次把五个传感器对着黑线确认每一路的数值变化方向一致。如果某个通道数值反了后面计算出来的位置偏差就会正负颠倒小车会朝反方向打方向。第三步打印位置环输出的目标角速度和MPU6050测得的角度环反馈值。把小车放到线上给一个小初始偏差观察目标角速度和实际角速度是不是同方向。如果方向相反说明PID的极性搞反了这是画龙的最常见原因。调参时按照“先内环后外环先P后I后D”的顺序来把位置环的KP设为0只保留角度环。手动给一个固定目标角速度比如30deg/s调节角度环的KP让小车能够快速达到目标角速度且不振荡。再加入I项消除稳态误差D项抑制超调。角度环稳定后再逐渐增大位置环的KP。最后处理弯道和丢线场景。判断成功的标准小车在直道上基本不走S形遇到普通弯道不会冲出去即使有一瞬间全部传感器都丢线也能通过丢线策略救回来而不是直接原地停住。调PID最忌讳一次性把所有参数都装上去。正确的做法是每次只改一个参数并且记录下当前车身反应根据现象反推应该加大还是减小参数。7. 常见问题与排查思路问题现象可能原因排查方式解决方案MPU6050初始化失败I2C地址错误、接线错误、SCL/SDA缺少上拉电阻用I2C扫描程序确认设备地址确认AD0引脚电平检查上拉电阻降低I2C速率MPU6050数据跳变供电不稳定、数据线过长示波器或万用表检查3.3V电压加100nF去耦电容缩短杜邦线灰度传感器阈值经常失效环境光变化、模块供电波动串口打印ADC原始值观察波动范围改用动态阈值或归一化处理小车走S形曲线位置环KP过大、角度环KP过小逐项判断是外环震荡还是内环响应慢先增大角度环KP再减小位置环KP小车朝一个方向猛打灰度传感器方向极性接反、PID输出极性反了检查油门方向和偏差正负关系在代码中对偏差取反或交换电机方向电机不转或只有一边转PWM通道配置错误、方向引脚没初始化用固定占空比测试左右电机单独写测试函数排除控制环干扰一上电小车就冲出去积分项积累过快、PWM默认值异常初始化时将PWM输出置0增加积分限幅、输出限幅确认初始化顺序烧录后程序不运行Boot引脚状态错误、时钟配置错误检查BOOT0引脚和调试器连接BOOT0接地确认CubeMX时钟配置排查问题的总原则先硬件后软件先开环后闭环。硬件没测通就去调PID只会越调越乱。8. 最佳实践与工程建议8.1 代码分层把代码分成驱动层、算法层、应用层是让项目可持续维护的关键。MPU6050的寄存器读写属于驱动层PID计算属于算法层主循环里“传感器数据如何组合、PWM如何输出”属于应用层。这样分层以后即使换一个传感器型号也只需要替换驱动层不需要重写控制逻辑。8.2 数据可视化调PID时光靠肉眼看小车动作很难定位问题。推荐用串口配合上位机软件绘图把位置偏差、目标角速度、实际角速度三个量同时显示出来。不用买昂贵设备简单的串口调试助手配合文本波形显示工具就够用。如果不能绘图至少用OLED实时打印关键参数。8.3 电源设计直流电机启动瞬间电流很大如果和单片机共用一个电源很容易把MPU6050的供电拉低导致姿态数据跳变。常见的做法是电机和驱动单独用动力电源单片机和传感器单独用稳压电源或者至少在电源入口处加一个大容量的电解电容和若干100nF去耦电容。8.4 安全提醒调试电机和PWM输出时最好把小车架起来让轮子悬空避免意外飞车伤人。给电机供电前先确认控制板上的PWM默认占空比是0。如果从网上找来的工程上电后轮子直接转不要直接用手去抓先断开动力电源再检查代码。8.5 参数保存PID参数一旦调好可以用STM32的Flash或者外部EEPROM保存下来。电赛场地往往和平时测试环境不同如果参数不能现场修改到了赛场只能干着急。在代码里预留一个串口指令去修改并保存PID参数会省去很多麻烦。9. 总结与后续学习方向复刻电赛题目本质上不是为了把某一道题做出来而是通过完整的软硬件闭环理解传感器、执行器和控制算法之间的协作方式。STM32F103C8T6 MPU6050 五路灰度传感器这套组合刚好覆盖了采集、解算、控制、输出这条完整链路非常适合用来打基础。如果你还想继续深入可以从这几个方向入手给电机加编码器形成真正的电机速度闭环把速度环、角度环、位置环三层串联起来。把裸机主循环改造成FreeRTOS多任务让传感器采集、姿态解算、控制输出分别跑在不同的任务里。在MPU6050的姿态解算上引入更高级的滤波算法研究不同算法的计算量和稳定性差异。关注MCU的国产替代型号STM32F103C8T6有很多兼容芯片代码可以大体复用但外设寄存器细节需要核对这是一个实战中很实用的迁移能力。这套代码和控制思路建议先收藏备用。等你真正开始调PID的时候会发现在赛道上跑直线这件事比想象中更有挑战性也更有意思。有问题欢迎在评论区交流带上你的波形图或者串口日志来讨论会更容易定位到问题所在。