2020电赛ProblemC爬坡小车源码解析：从驱动到调参实战

简介：这份2020年电赛ProblemC爬坡小车源码包，是一套基于MSP430F5529的完整嵌入式竞赛方案，面向电子、计算机、自动化等专业学生，适合正在备赛电赛或有嵌入式开发基础、希望研究小车爬坡与循迹算法的读者。压缩包共88个文件，大小仅320KB，其中包含main.c、pid.c、pwm.c、xunji.c等C源码与对应头文件，另有Makefile、CCS工程文件和launch调试配置，obj、out、map等编译链接产物也一并保留，目录结构清晰，便于阅读理解与二次开发。目前已有118人学习下载。通过这份源码可以快速掌握电赛ProblemC的整体框架，包括传感器循迹、PID调速、PWM驱动及OLED显示等关键模块的实现思路，所有代码均可直接编译使用，适合在官方MSP430F5529平台上运行调试。对于希望深入嵌入式竞赛项目的同学，这是一个很好的参考范例，可结合官方题目要求自行修改参数、优化算法，锻炼独立调试与排错能力。

1. 2020电赛ProblemC爬坡小车源码，解压之后先别急着烧录

2020年电赛的ProblemC坡道行驶小车，说白了就是让一辆电动车从平地出发、把速度提到够大，再沿一条引导线冲上坡道，最后在坡顶区域准确停下。题目的难点从来不在“跑得快”，而在“带着巡线误差上坡不倒退、停车位置不冲出”。2020电赛ProblemC爬坡小车源码.zip这类包里装的就是一套围绕这个目标组织的嵌入式工程：入口main、电机驱动、编码器测速、PID速度环、巡线算法、状态机。拿到它，真正值得做的事不是“烧录成功就算完”，而是先理清板级映射，再把速度环和巡线环拆开调，最后按自己的板子重做驱动层。这篇就按这个顺序讲，让你在最短时间内把别人的代码变成自己能改、能上赛场的代码。

2. 工程结构、引脚映射与编译前必须做的三处核对

拿到压缩包后的常见动作是用7-Zip或Windows自带解压工具先看内部结构。源码包能不能在你的板子上跑，关键不在IDE配置，而在“板级映射”对不对得上。这一步做扎实，后面改算法才有意义。

2.1 典型的裸机源码目录与文件职责

大部分电赛小车工程没有跑RTOS，是一个前后台结构，目录通常长这样：

Project/ ├─ README.txt # 接线说明、按键定义，最值得先读 ├─ Hardware/ │ ├─ motor.c # 电机PWM输出与方向IO │ ├─ encoder.c # 定时器编码器模式，读取轮速 │ ├─ line_sensor.c # 多路巡线传感器的采集与阈值化 │ ├─ mpu6050.c # 陀螺仪加速度计，用于坡道角度判断 │ └─ oled.c # 参数显示，调车时能看到内部状态 ├─ Control/ │ ├─ pid.c # 速度环/方向环共用的一组PID │ └─ strategy.c # 从发车到爬坡停车的状态机 └─ main.c # 主循环：定时调度+任务切换

README.txt里往往写着哪些跳线帽要短接、哪个按键负责发车。没有README时就看头文件里的宏定义，板级配置基本都以宏的形式集中放在一个bsp.h里，这是拿到源码后第一个要改的地方。源码包能不能在你的板子上跑，关键在“这个宏定义对应的引脚资源”和你的原理图是否一致。

2.2 引脚映射表：先确认时钟、PWM与编码器通道

拿到任一小车源码，第一步是在main.c或bsp.c里找板级资源配置。我一般会把它们抄成一张对照表，再对照自己的原理图逐项打勾：

其中最容易出问题的是引脚复用。源码里默认TIM1_CH1输出在PA8，如果你的板子把PWM接到了PB13，需要改的不只是一个宏，而是GPIO_InitStructure.GPIO_Pin和GPIO_PinAFConfig两个地方都要同步改。只看宏名字就以为配置完成，是移植电赛源码最常见的不靠谱习惯。

2.3 编译下载前必查的三处冲突

第一处是JTAG占用。很多板子的PB3、PB4、PA15默认被SWD/JTAG复用，如果源码把方向控制引脚或编码器引脚放在这些脚上，下载后引脚驱动无效，反复烧录还会偶发失败。处理方法是在GPIO_Init之前把SWJ配置成只保留SWD或全关闭。

第二处是定时器通道映射。编码器模式必须挂在具备输入捕获能力的引脚上，且A、B两相必须落在同一个定时器的两个通道。若你的原理图把编码器接到普通GPIO上，这不是代码问题，是接线错误，源码改不了。

第三处是时钟频率。源码默认HSE=8MHz、系统时钟72MHz时，你的板子若改用12MHz外部晶振，串口打印会乱码，PWM频率也全部偏移。排查方法很简单：先烧一个串口回环测试，确认打印周期对不对，再谈其它功能。

提示：编译之前先做“驱动层单测”。把main.c改成上电自检：左右电机各转0.5秒、OLED显示编码器增量、巡线传感器实时值，全部正确后再进入赛题逻辑。这个动作能直接省掉后续调试阶段一半的“程序到底跑没跑”的疑问。

3. 上坡不溜车：速度闭环与巡线转向的实现细节

这段源码是整个包的核心价值。爬坡小车的本质是双轮差速模型：速度环保证整体推进力，转向环负责沿着引导线修偏。理解顺序也是先速度、再转向、最后看怎么叠加。

3.1 编码器测速与10ms速度采样

不管是AB相正交编码器还是磁编码器，进入STM32的定时器编码器模式后，计数寄存器会自动增减。测速时只需要在固定时基中断里做“读增量、清零”两件事：

TIM_HandleTypeDef htim_enc_l; // 编码器定时器句柄，以左轮为例 // 10ms 定时器中断唤一次，测速周期固定 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim->Instance == TIM_BASE) { // 专门用另一个基本定时器做时基 int32_t delta_l = __HAL_TIM_GET_COUNTER(&htim_enc_l); // 取当前计数值 __HAL_TIM_SET_COUNTER(&htim_enc_l, 0); // 清计，准备下一段 int16_t speed_l = (int16_t)((delta_l * 100) / 10); // 换算单位速度 } }

这里的核心设计是“增量清零”而不是“直接读累计值”。如果把累计值当成速度用，低速时速度值长时间不变，高速时又来回跳动，因为每次读到的都是从启动到现在的总和。先把中断周期固定到10ms，读到的就是这一段的速度增量，之后的PID才有稳定输入。

参数说明：TIM_BASE是单独分配的基本定时器，负责产生10ms时基，不要和编码器定时器混用；括号里的100 / 10只是示意，实际要根据轮径和减速比换算成mm/s，换算系数建议写成宏，调车时只改一处。

3.2 带积分分离的速度PID实现

爬坡时负载突变，速度PID如果带普通积分项，很容易积分饱和：误差大时积分一路累加，等轮速追上来，输出还在高位，车就猛冲。更稳妥的方案是积分分离，误差过大时直接停用积分：

float err_sum = 0.0f; float err_last = 0.0f; #define KP_SPEED 12.0f #define KI_SPEED 0.4f #define KD_SPEED 0.05f float pid_speed_update(float target_speed, float current_speed, float dt) { float err = target_speed - current_speed; // 积分分离：误差过大时清积分，防止爬坡时饱和 if ((err > 8.0f) || (err < -8.0f)) { err_sum = 0.0f; } else { err_sum += err * dt; if (err_sum > 1000.0f) err_sum = 1000.0f; // 积分限幅 if (err_sum < -1000.0f) err_sum = -1000.0f; } float p_out = KP_SPEED * err; float i_out = KI_SPEED * err_sum; float d_out = KD_SPEED * (err - err_last) / dt; err_last = err; float pwm = p_out + i_out + d_out; // 输出限幅，给转向留出调节空间 if (pwm > 85.0f) pwm = 85.0f; if (pwm < -85.0f) pwm = -85.0f; return pwm; }

这个函数的输入是目标速度和实测速度，输出是百分比形式的PWM占空比。爬坡时最该关心的不是Kp，而是PWM上限85这个值：它限制速度环最多只能输出85%占空比，剩下15%的空间专门留给转向修正。如果发现爬坡中途速度环输出经常顶着上限，说明目标速度定太高了，或动力裕量不够，正确的做法是降目标速度，而不是把上限放开到100%。

3.3 巡线误差计算与差速转向

多路巡线传感器最常见的做法是“权重求和”。8路传感器按位置排开，左边权重为负、右边为正，压到黑线的传感器计入求和：

// 8路传感器，sensor[i]=1 表示压到黑线 int16_t line_error(uint8_t sensor[8]) { const int8_t weight[8] = {-7, -5, -3, -1, 1, 3, 5, 7}; int32_t weighted_sum = 0; int32_t sensor_sum = 0; for (int i = 0; i < 8; i++) { if (sensor[i]) { weighted_sum += weight[i]; sensor_sum += 1; } } if (sensor_sum == 0) return LINE_LOST; // 全部丢线，优先处理 // 加权和除以激活数，再用100/7归一化到 [-100, 100] return (int16_t)((weighted_sum * 100) / (sensor_sum * 7)); }

先除以激活传感器数量，再做归一化，最后误差尺度基本不随传感器安装宽度变化。误差为负表示引导线偏左，误差为正表示引导线偏右。把误差叠加到速度环输出上就成了转向策略：

int16_t base_pwm = (int16_t)pid_speed_update(...); // 前进基量 int16_t steer = (int16_t)(kp_line * err / 100); // 转向修正量，kp_line默认给40左右 set_left_pwm(base_pwm + steer); set_right_pwm(base_pwm - steer);

base_pwm保证车有底部推进力，steer在左右轮之间产生差速。需要注意的是基量不能太低，否则转弯时内侧轮接近停止甚至反转，整车会横着蹭，而不是顺着弧线走。

3.4 什么时候该给转向加PID

误差直接乘以比例系数，在高速时会抖动。我的经验是：赛道直道多、弯道半径大，直接用比例转向就够了；如果赛道是连续S形弯道，可以对误差再做一次PID，但此时转向Kp要缩到原来的1/4到1/5，并且积分必须限幅，否则过弯后的残余积分会让车在直道上反复横摆。

注意：速度环和转向环不要共用同一个PID实例。两个环的采样周期和输出范围都不同，掺在一起调参时参数互相污染，现场会浪费大量时间。

4. 爬坡调参顺序与现场排错，跑完一圈就能确认方向

直接上手改PID，参数范围拉太大容易跑飞。按顺序调，问题会按层次暴露出来。这一章的顺序是我在赛前调车时固定使用的。

4.1 先标定电机死区与最大PWM

每个电机的机械特性和驱动电路不同，存在一个“死区电压”：PWM占空比低于某个值，电机根本不转。直接测一下最快：

// 电机死区标定：从0%开始，每300ms加1% for (int duty = 0; duty <= 20; duty++) { set_left_pwm(duty); set_right_pwm(duty); delay_ms(300); }

观察OLED上的编码器计数，从0变成非0的那个duty值就是实测死区。代码里set_left_pwm若直接收百分比，死区值要作为偏置加到最终输出上。漏掉这一步，低速段的PWM输出全部落在死区之内，小车的起步会一顿一顿的，爬坡时尤其明显。

4.2 PID整定顺序：先速度环，再方向环，最后加停车

我的调参顺序永远是先速度环、后转向环。速度环的整定方法是：给定固定目标速度，让车在平台上直线跑，观察编码器反馈速度与目标值的偏差。先设Kp=10, Ki=0, Kd=0，逐步增大Kp直到响应快、停车后无明显振荡；再补一点Kd抑制过冲；最后加小量Ki消除稳态误差。

方向环在速度环稳定后再调。先设转向Kp=1，让车沿引导线走，稳步加到不抖为止。顺序反过来的后果很典型：方向环Kp偏大时，车在直道上一路蛇形，你分不清是转向太灵敏还是速度环没跟上。

停车逻辑放在最后调。常见错误是用固定延时判断“到了没”，这在电池电压变化后完全不成立；可靠做法是用编码器累计距离，设一个目标距离值，到点就切换状态机。

4.3 爬坡启动的斜坡策略

很多源码包在发车瞬间直接给目标速度。若坡道起始就在起步点附近，扭矩不够会打滑。更稳的做法是把目标速度做成斜坡，每10ms抬一小格：

static int32_t target_speed_ramp(int32_t final_speed) { static int32_t cur_target = 0; int32_t step = final_speed / 50; // 50步爬到目标速度 if (cur_target < final_speed) { cur_target += step; if (cur_target > final_speed) cur_target = final_speed; } return cur_target; }

每10ms调用一次，约0.5秒到达全速。同时把加速度计的三轴倾角解算结果作为坡道判据：检测到俯仰角从0变为非零时，说明车头已接触坡道，此时把目标速度切到爬坡速度，避免在坡底犹豫减速。

4.4 现场故障快速诊断表

调试时遇到的绝大部分问题都能归到下面几类，按顺序查，比盲目改参数有效得多。

调车时建议在车上留一个无线串口或OLED日志口，周期性打印当前目标速度、实测速度、巡线误差。没有这些内部数据，光看车跑，遇到问题永远只能靠猜。

5. 把2020电赛ProblemC源码包移植到新板子的快捷路径

如果赛题编号换到别的年份，任务里仍带“引导线+定点停车”这些元素，这个源码包能不能复用？能，但必须先把代码按层切开。

5.1 代码中间层的划分方法

原则是把源码分成三层：驱动层只与芯片和板子有关，控制层与车模有关但与题目相对独立，任务逻辑层与题目相关。PID速度环、巡线误差算法属于控制层，是最值得原样保留的代码；电机、编码器、I2C驱动属于驱动层，换板子就重写驱动；状态机和停车判据属于任务逻辑层，换题就改这一层。

新板子的验证顺序应该按层来：先烧一个“驱动层自检”程序，确认电机、编码器、巡线传感器都能正确读写；再单独验证控制层；最后才跑完整赛题逻辑。每层独立验证，出问题能立刻定位到楼层。

5.2 移植和验证的检查清单

验证驱动改动时要一项一项来，别一次换掉所有东西。下面这个自检函数能同时暴露接线方向、编码器极性和传感器状态的问题：

void driver_selftest(void) { // 左右轮反向转动，验证电机方向和编码器符号 for (int i = 0; i < 2; i++) { set_left_pwm(20); set_right_pwm(-20); delay_ms(500); set_left_pwm(-20); set_right_pwm(20); delay_ms(500); } // 打印编码器增量，确认方向一致 for (int i = 0; i < 10; i++) { oled_printf("enc_l=%d enc_r=%d\r\n", read_encoder(MOTOR_L), read_encoder(MOTOR_R)); delay_ms(100); } }

如果左右轮反向转动时，编码器读数一边正一边负，说明A/B相接反了，先把接线修正再进控制层。这个函数只验证驱动层，不涉及任何PID参数，跑不过就修硬件，不要绕过它。

5.3 遇到zip解压失败时的安全处理

现场流传的源码包偶尔会出现“error read zip archive”或解压到一半报错。别急着去找zip密码破解工具，先确认下载完整性：比对文件大小、用7-Zip的测试功能检查压缩包，还不行就找发件人要原始压缩包。很多解压失败只是压缩软件版本过旧，升级到新版7-Zip就能解决。源码包真有缺文件的情况，对照硬件自己补驱动层反而更快，不值得在损坏的压缩包上反复耗时间。

移植完成后，最后一步是回到底层参数：重新核对引导线宽度、坡道角度、停止线位置与源码中参数值的对应关系。每个参数都以现场实测为准，源码里的默认值只负责让车先动起来。把这一条写进调试记录，连续跑五次的停车误差落在同一个区间内，再谈下一步优化。

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