1. 项目起源与整体方案设计1.1 2024电赛H题到底在考什么2024年电赛H题一出很多做控制方向的同学第一反应是松了口气——终于不是电源题或者射频题了。但真正上手搭车的时候才发现循迹小车这道题完全是“看着简单做起来全是细节”。H题的核心任务是设计一辆能够自主循迹、识别路况并完成指定动作的小车通常在特定颜色的引导线上行驶可能是直线、直角弯、S弯甚至十字路口部分年份还会有障碍物或停车的附加要求。说白了这就是一个典型的移动机器人运动控制问题核心链条是“感知—决策—执行”而把这三者串起来的关键就是PID。我这里用的主控是TI的MSPM0G3507。这颗芯片在2024年电赛里出镜率非常高原因很实在它是Arm Cortex-M0内核主频能到80MHz片上资源对做小车来说完全够用。我用它跑了一块8路灰度传感器阵列同时驱动两个编码器电机完成双闭环控制实测下来CPU占用率连一半都不到。相比STM32MSPM0系列的库函数风格更接近驱动层在竞赛里反而更容易把底层逻辑吃透。1.2 为什么选MSPM0G3507而不是STM32好几组同学一上来就问我直接用STM32F103C8T6不是更熟吗确实如果你寒假调过板子、手头有现成的工程模板直接切STM32没有任何问题。但如果你是从零开始MSPM0G3507其实是更稳的选择原因有三点。第一引脚和定时器资源够丰富。MSPM0G3507有多个TIMG定时器可以输出多路PWM不需要为了给左右电机分别配PWM而做引脚映射表翻半天。灰度传感器的ADC采集通道也够分配不会出现模拟口不够用的尴尬。第二Ti的SysConfig图形化配置工具对小白极其友好。管脚复用、外设初始化、中断优先级这些在图形界面里拉一拉就能生成省掉了STM32CubeMX熟悉过程关键是不会踩到坑。第三便宜。电赛买元器件是有预算约束的MSPM0G3507的LaunchPad开发板几十块钱一片烧了也不心疼对于需要反复折腾底层、做破坏性实验的备赛阶段来说这很重要。当然硬件选型只是第一步真正决定小车能不能跑好的是控制策略和代码质量。接下来我把完整思路拆开讲。2. 机械结构搭建与传感器布局2.1 车体平台的选型与改装我用的是常见的4轮小车底盘加两组TT电机前轮用万向轮辅助支撑。这个底盘在淘宝上几十块钱能买到优点是便宜、配件多、改装空间大缺点是塑料结构公差大直行时左右轮子虚位不一样。拼装的时候要重点检查两个驱动轮是否在同一轴线上轮子装好后用手拨一下看看是否能顺畅旋转、有无卡顿。底盘装好后要做的最重要改装是传感器支架。8路灰度传感器阵列最合理的安装位置是底盘正前方不管车头怎么摆动传感器阵列都能领先于前轮边缘“看”到引导线变化给控制系统留出反应时间。支架高度是一个容易被忽略的变量。灰度传感器是红外反射式原理发射管和接收管之间如果距离赛道表面太远反射光能量衰减很快雨天或者赛道反光时读数会乱跳太低的话遇到赛道接缝处又会刮到传感器。我这边反复试出来的经验值是离地1.2到1.8厘米这个高度范围内信号稳定且能容忍一定程度的赛道起伏。2.2 灰度传感器阵列的工作原理与电路设计灰度传感器阵列通常是一排红外对管每个通道独立输出一个模拟电压电压高低反映该通道下方是白底还是黑线。基本原理很简单白纸对红外光的反射率高接收管导通程度大输出电压高黑胶带吸收红外光反射率低输出电压低。但是直接读ADC原始值在比赛现场会出问题——环境光干扰和供电电压波动都会让绝对电压漂移。所以我用了动态阈值算法不是固定一个比较电压而是实时统计所有通道的最大值和最小值取中间作为当前帧的黑白判断阈值。这样即使光线变化导致整体电压抬升或下降判别结果依然稳定。电路设计上需要注意的是每个传感器的采样电阻阻值。阻值太大响应慢小车高速冲线时容易漏检阻值太小灵敏度高但容易受噪声干扰。我用的经验值是10千欧到20千欧配合软件里的均值滤波效果不错。从电路到代码的接线很简单8路传感器输出分别接MSPM0G3507的PA0到PA7这8个引脚配置成ADC输入模式每次采样循环读取一遍大约耗时不到1毫秒完全不会拖累主循环频率。2.3 电机驱动与编码器反馈接线电机驱动我用了TB6612FNG相比老的L298N它体积小、导通压降低、PWM频率可以跑得更高对电池电压的利用更充分。电机供电端直接接7.4V锂电池逻辑供电接开发板3.3V或者统一5V都行。TB6612和MSPM0G3507的接线没有特别复杂的地方AIN1、AIN2、BIN1、BIN2接GPIO控制转向PWMA、PWMB接两路PWM输出。唯一需要注意的是不要把逻辑电源和电机电源接反否则芯片会直接冒烟这个我赔过好几片。编码器电机需要注意接线极性。TT电机自带的霍尔编码器一般输出A、B两相信号接到了MSPM0的两个定时器捕获通道上用来做速度反馈。两相都接的好处是可以通过相位差判断正反转防止小车后天赋值时把方向搞反导致转角自锁。3. PID控制理论回顾与工程落地3.1 位置式PID和增量式PID怎么选很多教程把PID讲得玄之又玄但我一直觉得对于巡线这个场景不需要扯到高级控制理论。PID的本质就是根据误差的现在、过去和未来趋势综合计算出应该输出的修正量。位置式PID的输出公式是 u(k)Kpe(k)Kisum(e(n))Kd*(e(k)-e(k-1))输出量对应的是PWM的绝对占空比它依赖过去所有误差的累加需要另外设积分限幅不然积分饱和一旦触发小车停在原地也不会停下来。增量式PID只输出上一次控制量的增量公式是 dUKp*(e(k)-e(k-1))Kie(k)Kd(e(k)-2*e(k-1)e(k-2))实际PWM等于上次PWM加上dU。我在这道题里速度环用的是增量式PID转向环用的是位置式PID加限幅。为什么这样混搭速度环的负载变化比较大电池电压波动直接导致电机出力变化用增量式不容易累积积分饱和转向环的输出本质是左右轮转速差需要明确的物理范围位置式加输出限幅可以精确控制打角幅度。3.2 PID参数符号与单位的工程约定调PID第一件事是确认极性否则小车会往相反的方向越修越偏最后原地转圈。我定义误差error是“小车当前实际位置偏离赛道中心线的距离”用传感器归一化后的数值表示。比如8路传感器从左到右编号0到7理想状态下小车骑在黑线上读出的加权位置应该在3.5附近。实际读数是4.2说明车往右偏了误差为正。此时转向修正应该让小车往左打角也就是右边轮子的PWM要大于左边轮子的PWM。如果你的代码里转向输出正值是右转那就需要在代码里取负或者干脆反过来把误差定义为黑线偏离中心的值。为了不搞混我在工程里的习惯是所有传感器输出和误差、PID计算全部用浮点型只在最终输出PWM时强制转换成整数。虽然浮点运算在M0上稍微慢一点但80MHz主频的算术能力跑这点数据完全够用换来的是调试时直接通过串口打印小数波形不用反复折算定点数节省大量排查时间。3.3 适用于MSPM0G3507的PID核心源码直接上我在电赛时用的核心代码我把它做成了模块化接口方便在不同车况下复用。#include pid.h void PID_Init(PID_TypeDef *pid, float kp, float ki, float kd, float max_out, float max_integral) { pid-Kp kp; pid-Ki ki; pid-Kd kd; pid-MaxOut max_out; pid-MaxIntegral max_integral; pid-Integral 0.0f; pid-PrevError 0.0f; pid-PrevPrevError 0.0f; pid-Output 0.0f; } float PID_Incremental(PID_TypeDef *pid, float error) { float dU pid-Kp * (error - pid-PrevError) pid-Ki * error pid-Kd * (error - 2.0f * pid-PrevError pid-PrevPrevError); pid-Output dU; if (pid-Output pid-MaxOut) pid-Output pid-MaxOut; else if (pid-Output -pid-MaxOut) pid-Output -pid-MaxOut; pid-PrevPrevError pid-PrevError; pid-PrevError error; return pid-Output; }位置式PID的代码也不复杂关键是加了积分分离。在循迹场景里如果小车已经完全偏离赛道误差非常大此时还继续累加积分反而会让积分项饱和导致小车一旦回到赛道上时反应迟钝。所以我的写法是误差超过阈值时强制积分清零。float PID_Position(PID_TypeDef *pid, float error) { float Pout, Iout, Dout; if (fabsf(error) pid-IntegralHoldThreshold) { pid-Integral 0.0f; } else { pid-Integral error; if (pid-Integral pid-MaxIntegral) pid-Integral pid-MaxIntegral; else if (pid-Integral -pid-MaxIntegral) pid-Integral -pid-MaxIntegral; } Pout pid-Kp * error; Iout pid-Ki * pid-Integral; Dout pid-Kd * (error - pid-PrevError); pid-PrevError error; pid-Output Pout Iout Dout; if (pid-Output pid-MaxOut) pid-Output pid-MaxOut; else if (pid-Output -pid-MaxOut) pid-Output -pid-MaxOut; return pid-Output; }3.4 编码器测速代码与速度触发频次编码器测速的经典方法是M法即在一个固定时间窗口内统计脉冲数再乘以单位换算系数得到转速。我这里用定时器TIMG产生一个10毫秒的周期中断在中断里读取编码器计数值然后清零重新计数。void TIMG0_IRQHandler(void) { if (TIMG0-INT_ACK.MSK 1) { speed_left_raw TIMG1_CAPTURE_LEFT; // 读取脉冲数 speed_right_raw TIMG2_CAPTURE_RIGHT; TIMG1_CAPTURE_LEFT 0; TIMG2_CAPTURE_RIGHT 0; // 换算成cm/s并更新目标值 speed_left (float)speed_left_raw * 0.37f; speed_right (float)speed_right_raw * 0.37f; pid_error_speed_left target_speed - speed_left; pid_error_speed_right target_speed - speed_right; PID_Update_Speed(); PID_Update_Steering(); } }那个0.37的系数来自轮子周长除以编码器分辨率再除以时间窗口10毫秒。若你的轮子直径6.5厘米周长约20.42厘米编码器一轮输出13个脉冲TT电机常见是11或1310毫秒窗口内每个脉冲代表约1.57厘米每秒。所以系数应约为0.157而不是0.37。我这里的0.37只是示例真正用的时候一定要先做一次空转校准不要照抄。这一点我想强调一下很多同学拿别人的系数直接套用发现实际速度跟显示数值差很多然后怀疑是PID出了问题其实只是编码器换算没校准而已。4. 循迹算法与PID如何配合4.1 从误差到转向的完整计算链一辆循迹小车最核心的运算逻辑是从传感器读数到左右轮目标速度差的全链路。公式顺序一定要理清楚否则代码写起来东一块西一块出了问题都不知道在哪查。第一步读取8路传感器ADC值归一化成一个位置值position。我的做法是对每路传感器加权平均float GetTrackPosition(void) { uint8_t i; float numerator 0.0f; float denominator 0.0f; uint8_t weight[8] {0, 1, 2, 3, 4, 5, 6, 7}; for (i 0; i 8; i) { if (sensor_on_line[i]) { numerator weight[i]; denominator 1.0f; } } if (denominator 0.5f) { return -1.0f; // 全部离线返回特殊值 } return numerator / denominator; }这样处理的好处是哪怕多路传感器同时压线比如在十字路口最终位置值依然是一个处于0到7之间的连续浮点数核心差值计算逻辑不会被多线检测干扰。第二步计算误差。目标中心线是3.5误差error 3.5 - position。这样设计误差的符号方向我调试时使得误差为正意味着实际位置在中心线左侧应该让小车右转符合直觉也方便打印在串口助手里观察。第三步转向PID。把误差输入PID_Position函数得到一个转向修正量steer_cmd范围被我限制在[-1,1]之间表示“左右轮速度差与基础速度的比值”。第四步把基础速度和转向修正量合成为左右目标速度base_speed 50; // 单位cm/s left_speed_target base_speed - steer_cmd * 30; right_speed_target base_speed steer_cmd * 30;这里左右对称性取决于车头往哪边偏实际接线方向不同可能需要交换加减号调试时先用一个很低的base_speed跑观察方向是否正确错了就交换两个加减号不要靠猜。第五步把左右目标速度分别输入到两个速度环增量式PID中输出最终的PWM占空比。4.2 直道、直角弯、S弯、十字路口的判据切换纯PID加固定的速度输出遇到急弯时很容易因为速度过快导致传感器全部丢线。我的做法是增加一个简单的路况判别状态机。直道状态下位置值变化平缓维持高速运行。当检测到位置值快速向一边偏移并且误差绝对值连续3帧超过1.5时判定为进入弯道降低基础速度同时加大转向比例。当传感器读回0到7中至少连续3路都在线上并且位置值重新接近中心线时判定为恢复正常直道恢复高速。十字路口是所有循迹小车的老大难。因为8路传感器全部压线时加权位置值等于3.5看起来和正常直线一模一样如果没有额外判断小车会直行冲过去。我处理十字路口的策略是检测到8路全部有信号并且持续超过50毫秒时按照题目要求预先设定的动作直行、左转或右转锁定转向输出持续一段时间再释放。这个动作通过一个简单的状态机字段来表示而不是靠连续位置值判断因为位置值在十字路口时是“假中心”根本无法区分三个方向。S弯的处理不需要额外判据全靠PID的连续响应。但这时候Kd参数尤其重要微分项会让小车提前感受到误差变化趋势提前打方向避免到弯顶时才发现偏了。4.3 电机方向和PWM死区的处理很多新手调车时发现小车低速下抖得厉害高速又发飘其中一个重要原因是电机PWM在低占空比区域存在死区。TT电机是直流有刷电机PWM占空比太低时电压不足以克服电刷摩擦和转子惯性电机不转但一旦超过某个临界点转速又会突然跳到一个较高的值。这个非线性会直接导致PID在小误差工况下反复震荡因为输出50时不动输出70时又太快。解决办法有两层。第一层是在代码里加死区补偿检测到PID输出绝对值小于阈值时直接输出0大于阈值时把输出加上一个补偿常量让实际占空比跳跃过非线性区。第二层是尽量避开过低速运行区间基础速度不要低于30厘米每秒反正比赛规则里没有要求乌龟式蠕动。5. PID调参实战从震荡到稳定5.1 试凑法调参的完整流程PID调参方法很多但电赛现场最实用的一定是试凑法加波形观察。我调参前的准备工作是搭建一套可视化环境。MSPM0G3507通过串口以固定帧率输出三路数据——目标位置、当前位置、PID输出用Vofa JustFloat格式发出上位机实时绘制波形。这一步至关重要光是靠肉眼看车跑得稳不稳完全不够因为人的反应速度根本看不清20毫秒级的抖动但波形图会把每一个超调、每一次震荡都记录下来。调参顺序按照“先P、再I、最后D”的经典路线。第一步把Ki和Kd全部置0只保留Kp从一个很小的值开始慢慢加大。观察波形如果位置误差来回振荡并且幅值越来越大说明Kp太大如果误差收敛缓慢甚至一直有一个稳态残差说明Kp太小。调到小车能够大致稳定在中心线附近、有一点轻微晃动时记录当前Kp。第二步引入Ki消除稳态误差。我的经验是Ki从Kp的1/20开始试每次加一点点观察误差波形是否逐渐贴近零线。积分项加多了小车会过冲甚至甩尾原因是积分饱和把转向角憋到极限需要同时配合积分限幅调小。第三步加入Kd改善动态响应。Kd能让小车在误差开始变大之前就感觉到趋势从而提前修正特别适合S弯和直角弯。但Kd太大会让系统对噪声极其敏感传感器稍微抖一下微分项就像放炮一样猛打一下方向波形上表现为高频毛刺。5.2 串口波形怎么看波形判断其实是有一套相对通用的经验的我把我每次盯着Vofa界面时的心得写在这里。误差曲线如果呈现等幅振荡频率不高那八成是Kp过大或者Kd过小先降Kp再加Kd。如果误差曲线缓慢爬坡到某个值后长时间不回落说明积分作用不够或者输出限幅太小导致修正量不够。如果误差曲线在零点附近快速抖动频率很高那基本可以确定是微分项对噪声过度敏感调小Kd或者对传感器数据加滑动平均滤波。速度环的波形调试要单独看。速度环调好的标志是把目标速度从30阶跃到60时实际速度能在0.5秒左右跟上且无明显超调。如果超调量超过20%说明速度环Kp太大小车在急加速或急减速时会明显点头影响传感器稳定性进而造成转向环误判。5.3 分模块调试先速度环后转向环这里要特别强调一个顺序问题很多同学为了省时间直接整体联调结果速度也在晃、转向也在摆根本分不清是哪个环节出了问题。我的习惯是先把速度环调通。具体做法是把传感器输入固定通过串口下发指令设定不同目标速度观察编码器测速波形能否收敛到目标值。这一步要调好左右两个电机的对称性如果一侧速度环收敛明显慢于另一侧说明电机特性差异大需要分别微调PID参数甚至在代码层面对左右电机分开使用不同的Kp。速度环稳定后再接入传感器数据打开转向环。此时因为速度闭环已经把基础运动搞得比较线性转向环的算法可以专心处理位置误差调试效率高很多。5.4 参数整定结果参考我最终调试出的参数组合只提供一个范围参考因为车辆结构、传感器安装位置、胎压都会影响参数绝对值。你们照抄也许能跑但不一定是最优甚至连稳定都保证不了。需要自己按前面的方法重新试。参数转向环位置式PID速度环增量式PIDKp2.21.8Ki0.050.12Kd0.80.1积分限幅5.020.0输出限幅±1.0±306. 避坑指南电赛现场最折磨人的细节6.1 电源噪声导致传感器误判电赛场地通常用电紧张插线板接了一堆下载器和示波器电池输出本身也带纹波传感器供电如果和电机驱动共用同一路电源电机换向时产生的尖峰会直接耦合到传感器ADC电压上表现为小车明明走直线传感器却偶尔像被“吸”到黑线上一样跳变。我的解决方案是三级处理。第一传感器模块供电从开发板的LDO单独引出并在传感器电源引脚旁边并联100uF电解电容和0.1uF陶瓷电容做电源去耦。第二ADC在采样前做硬件平均把每路传感器的采样周期错开不集中在电机换向瞬间。第三软件上对传感器原始值做一次5点滑动平均滤除瞬时脉冲。三层叠加之后实测误判率降到很低。6.2 地线回路与共地问题很多同学在接线时只想着信号线怎么接忽略了地线。MSPM0G3507、TB6612、编码器、传感器模块如果各自为政地电位不统一就会出现极其诡异的“时好时坏”问题。解决起来其实很简单用一根较粗的导线把所有模块的地接到一起并且保证电池负极和开发板GND之间是直接的单一连接。需要注意的是不要形成地环路——即从电池负极分出两条路径最后又汇合到同一个地这样反而会给噪声制造环形天线。6.3 电机堵转与过热死机比赛过程中如果小车因为压到异物瞬间卡死电机堵转电流会飙升到正常工作电流的好几倍电池电压瞬间跌落单片机会因为欠压复位或者掉电重启。这是最崩溃的现场情况。我的经验是给电机驱动部分加一个独立的过流检测或者更简单粗暴一点在电池主回路串一个自恢复保险丝电流超过阈值自动断开几秒钟后自动恢复。另一个软件层面的预防措施是给PID输出加变化率限幅避免小车从静止突然猛加PWM导致瞬间大电流。6.4 代码层面中断优先级与共享资源MSPM0G3507的定时器中断用来做PID周期计算编码器捕获也依赖中断串口打印又频繁出入中断。如果中断优先级设置不当低优先级中断可能被高优先级中断长时间抢占导致PID控制周期抖动严重小车跑起来会间歇性抽风。我最终把PID任务放在最高优先级其次是编码器捕获串口发送优先级最低。并且用volatile修饰所有在中断和主循环之间共享的变量避免编译器优化出隐蔽的bug。6.5 现场光线的适应与断电重启电赛场地灯光以荧光灯为主这种灯光带有100Hz频闪灰度传感器如果不做处理图像会跟着灯光频率周期性波动。虽然我用了动态阈值但为了更稳还可以在采样时序上做同步把采样时刻固定在灯光周期的高亮度区间。这个操作可以利用MSPM0的定时器PWM输出触发ADC采样实现起来稍复杂但效果是真的稳。6.6 电池电压对PID的影响锂电池从满电4.2V到亏电3.7V电压变化超过12%。同样的PWM占空比下电机产生的力矩输出差很多速度环的目标速度即使是50cm/s实际跑起来也会偏慢。我在比赛时做了一版电池电压补偿用ADC实时采样电池分压后的电压电压低于某个阈值时整体放大PWM输出比例。不过更简单的方案是多备一块电池每轮上场前换满电电池省去软件补偿的复杂度和不确定性。7. 源码工程的整体结构与复用建议7.1 我的工程文件组织方式最后分享一下我的工程文件是怎么组织的方便你们参考和复用。Project/ ├── inc/ │ ├── pid.h │ ├── motor.h │ ├── sensor.h │ ├── encoder.h │ ├── control.h │ └── sys_config.h ├── src/ │ ├── pid.c │ ├── motor.c │ ├── sensor.c │ ├── encoder.c │ ├── control.c │ └── main.c每个模块的.c文件里只放本模块的函数实现头文件里导出对外接口。控制逻辑单独抽到control.c里这样以后换赛道、改传感器数量、换电机型号只需要改动底层驱动控制和PID层的内容基本不用动。比赛期间改代码的速度有时候比写代码的速度还要重要这种模块化设计能让你在最后一晚不至于崩溃。7.2 如何把代码迁移到下一年的赛题循迹小车做完以后这套代码框架其实可以迁移到很多移动机器人赛题上。如果你第二年遇到的是避障小车只需要在传感器层增加一个超声波或红外测距模块把距离信息转换成误差量输入到已有的转向PID中核心控制链几乎不用改。如果是麦克纳姆轮小车那就要把底盘模型从差速双轮模型升级成全向运动模型但底层PID的计算方式依然复用只是因为运动学解耦需要把转向修正量从左右轮的差速改写成四个轮的转速分量。我见过很多队伍每年都从零开始写代码这实在是不划算。工程上最好的状态是积累一个可靠的控制基座比赛时只需要写应用层的策略代码。8. 现场策略与赛后复盘8.1 比赛流程中的调试节奏把控电赛的时间节奏非常紧凑通常三天四夜很多人第一天就开始猛写代码然后第三天发现硬件还有问题最后一天熬夜改板子完全本末倒置。我的建议是第一天把机械结构装好、接线全部确认、用测试程序验证每个传感器和电机正常。第二天上午调速度环下午调转向环晚上联调。第三天白天跑赛道记录问题晚上针对性修复。最后一天上午留出完整时间做多轮全赛道测试累计跑够30次以上记录通过率。只有在高次数测试中稳定通过的小车才能在比赛现场比较放心。这里要特别提醒一点当天比赛场地和平时训练场地未必完全一致。彩排之前务必到比赛场地试跑几圈主要确认三件事第一是环境光对传感器阈值的影响程度第二是赛道橡胶表面的反射率是否和训练时一致第三是场地地面是否有坡度或者拼缝。有坡度的话PID参数要临时调特别是Ki和基础速度。8.2 常见失败模式与快速定位我把比赛中最常见的失败现象、可能原因和快速排查方法整理成了一张表完全是基于现场经验总结的。现象最可能原因快速排查方法启动后原地转圈电机接线反了或者左右映射反了交换一路PWM输出确认直道蛇形摆动Kp过大或Kd过小降低Kp并查看波形直角弯直接冲出赛道入弯速度过快或Kp太小降低基础速度增大转向输出限幅S弯尾部扫出赛道转向响应滞后增大Kd或增加预测前馈传感器全复位供电跌落或地线松动接示波器看供电波形突然间歇性乱转中断优先级冲突检查共享变量volatile声明过十字路口方向错状态机锁时的方向标志配置错误检查路况处理逻辑8.3 赛后复盘的价值比赛结束后我第一时间把代码、参数、波形截图、测试记录全部备份到一个文件夹里然后花了一个晚上复盘出这份文档。赛后复盘的习惯我保持了很多年每次比赛最大的收获不是奖状而是那套运行时表现稳定、逻辑清楚的代码框架以及一堆写满了失败原因和解决方法的笔记。这些经验在下一次遇到类似任务时能直接帮你节省至少三分之一的开发时间。这也是我写这篇博客的初衷之一如果你正在为某个比赛或者课程设计做循迹小车希望这篇文章能够帮你少踩一些我当年踩过的大坑。9. 几个压箱底的小技巧9.1 串口打印格式的坑使用Vofa JustFloat协议时数据帧格式必须是“float数据帧尾”帧尾通常是0x00 0x00 0x80 0x7F。很多同学上位机显示不出波形不是数据算错了而是帧尾没发对或者发送的频率不对。我的调试经验是保持100Hz发送频率也就是10毫秒一帧频率太低波形失真频率太高上位机处理不过来。9.2 调参时固定车速的小技巧如果调转向环时速度环的参数还没调好车速会忽快忽慢导致位置误差波形完全无法分析。我当时的做法是暂时把速度环的输出直接设成一个恒定PWM占空比让电机不受反馈控制地以固定油门跑这样转向环调出来的位移响应才真实可信。等转向环稳定了再恢复速度环这时底盘已经线性化整体调试难度大大降低。9.3 关于PID参数拷贝的忠告网上流传的很多PID参数模板其实是给特定车型调好的直接套用在你的车上基本不会一次通过。尤其是Ki和Kd这两个参数对机械特性极其敏感不同底盘、不同电机减速比、不同轮径参数差距可能达到5倍以上。我一直说抄代码可以但一定要抄懂它的计算流程和数据结构然后自己动手把参数跑出来。参数调优这件事没有任何捷径就是一遍一遍地观察、调整、记录积累足够多的训练波形手感自然就出来了。9.4 最后提醒比赛前夜必做检查比赛前一晚不要再去改任何控制参数了。把已经能稳定跑完赛道的程序固化下来只做这几件事检查所有接线是否松动、电池是否充满、传感器是否积灰、螺丝是否松动、轮子胎压是否正常。我见过太多队伍在比赛前夜改参数结果把原本稳定的车改废了然后第二天早上全场抓瞎。留着精力把状态机和参数微调的部分准备好到了现场根据赛道实际状况只改那几个明确需要调整的常量即可。