电赛平衡车循迹一圈：从PID调参到圈数检测的工程实践

这类题目最值得先看的不是功能列表而是能不能在普通实验室条件下用常见的传感器和控制器把“循迹一圈”这个看似简单的任务稳定、准确地跑下来。它考验的不是单一模块的堆砌而是对传感器数据融合、控制算法调参、机械结构稳定性和任务逻辑完整性的综合理解。如果你正在准备电赛或者想深入理解如何让一个带滚球的平衡车平台沿着黑线走一圈那么这篇文章会拆解从任务理解到代码调试的全过程重点放在那些容易让小车跑偏、卡住或者计数不准的细节上。我建议先把目标拆清楚任务二的核心是“循迹一圈”这意味着小车不仅要能识别并跟随黑线还要能准确判断自己何时完成了一个完整的闭环并且在整个过程中车体承载滚球的平台需要保持平衡。很多队伍一开始会把精力全放在PID调参上但最后往往卡在“怎么算一圈”这个逻辑判断上。1. 先拆解任务到底要完成什么以及最容易在哪里翻车“车载平衡滚球运动控制系统”这个题目名字很长但核心对象就是一个两轮自平衡小车上面托着一个平板平板上有个滚球。任务二要求这个小车底盘沿着地面铺设的黑色轨迹线行驶一整圈。1.1 任务成功的四个关键判断点评判一个方案是否可行不能只看小车能动要看这四个点是否都能满足平衡维持在整个循迹过程中无论加速、减速、转弯车体两轮自平衡平台必须保持直立。这是所有动作的基础一旦失衡后续所有控制都无从谈起。轨迹跟踪小车必须能稳定地沿着黑线中心行驶不能大幅度蛇形摆动也不能跑出黑线。闭环检测必须有一个可靠的方法判断小车何时真正“跑完了一圈”。不能多跑也不能少跑。全程稳定从起点出发到一圈结束停车整个过程应连贯不应出现中途失控、卡死或需要人工干预的情况。很多队伍在实验室测试时前两点勉强能做到但一到正式演示因为光线变化、地面反光或者计数逻辑有漏洞导致无法准确判定一圈功亏一篑。1.2 传感器选型与布局为什么是“五路循迹”输入材料里提到了“五路循迹传感器的优点”这确实是当前最主流和稳妥的方案。它的核心优势不是精度最高而是在复杂光照和一定车速下提供了足够可靠的冗余判断。一路 vs 五路单路或双路传感器只能判断“是否压线”无法知道偏离的方向和程度。五路传感器中间一路左右各两路可以输出一个“偏差量”。例如中间传感器读到黑线偏差为0只有左边第一个读到说明轻微左偏只有左边第二个读到说明严重左偏。这为转向控制提供了比例P或比例微分PD的控制依据让转弯更平滑。安装高度与阈值传感器距离地面的高度直接影响反射回来的光强。高度一定要在调试前固定死然后通过程序读取每个传感器在纯白色和纯黑色区域下的AD值动态计算或固定设置一个阈值。不要凭感觉设一个固定数值不同场地、不同时间灯光下这个值会变。抗干扰处理这是最容易翻车的地方。除了设置阈值软件上一定要做软件滤波比如连续采样多次取平均或者采用“连续N次检测到黑线才认为有效”的判决机制防止因地面污点或瞬时反光导致的误触发。对于平衡控制核心传感器是陀螺仪和加速度计通常集成在一个IMU模块如MPU6050。循迹是“方向任务”平衡是“生存任务”后者优先级更高。在程序逻辑上平衡控制环的运算周期必须是最高的、不可被打断的。2. 系统框架搭建控制逻辑如何分层才不乱当平衡和循迹两个任务要同时进行时程序架构如果混乱调试起来会非常痛苦。一个清晰的分层框架能让你快速定位问题。2.1 硬件系统框图与供电“电赛电源模块”首先需要一个稳定的硬件基础。输入热词提到了“电赛电源模块”这确实是重点。整个系统通常包含主控MCU如STM32F4系列性能足够处理平衡PID和循迹PID。电机驱动模块如TB6612或DRV8833用于驱动两个直流减速电机。姿态传感器MPU6050提供角速度和角度。循迹传感器五路红外对管模块。电源模块这是关键电机启动瞬间电流很大会导致电压骤降可能引起MCU复位或传感器读数异常。必须将电机驱动电源与MCU、传感器电源隔离。常用方案是使用两节锂电池串联7.4V-8.4V一路通过大电流开关降压模块给电机驱动供电另一路通过低压差线性稳压器LDO或高效的DC-DC降压模块如LM2596产生稳定的5V或3.3V给控制电路。务必确保即使电机堵转控制电路的电压也纹波小、不掉电。[电源]锂电池 ├── [DC-DC降压] - 12V/5V - [电机驱动] - [电机] └── [LDO] - 3.3V - [MCU, 传感器]2.2 软件控制逻辑分层程序上建议采用“中断主循环”的方式将不同优先级的任务分开最高优先级定时中断任务读取MPU6050数据通过I2C或SPI进行姿态解算如互补滤波计算当前车体倾角与角速度。执行平衡PID控制器。根据目标角度通常为0度和当前角度计算出一个用于维持平衡的电机基础速度。这个中断周期要短且固定例如1ms或2ms。次高优先级定时中断或高速主循环任务读取五路循迹传感器的AD值或数字状态经过滤波后计算出轨迹偏差error。执行循迹PID控制器。根据偏差error计算出一个用于纠正方向的转向速度增量steer。合成与输出在同一处理单元中操作将平衡控制器输出的基础速度base_speed与循迹控制器输出的转向增量steer进行合成。通常left_motor_speed base_speed steerright_motor_speed base_speed - steer。执行将最终速度值通过PWM方式输出到电机驱动芯片。任务逻辑层主循环任务管理“循迹一圈”的整体流程。包括等待启动信号、开始循迹、检测一圈是否完成、到达终点后减速停车。执行这里运行速度可以慢一些主要负责状态机和圈数检测逻辑。这样分层后如果小车平衡不稳就重点查层1如果总是跑偏就重点查层2如果跑完了不停车就重点查层4。3. 核心算法调参平衡PID与循迹PID的配合PID调参是核心但顺序很重要。绝对不能同时调两个PID。3.1 第一步在静止状态下调好平衡PID断开循迹控制先让steer 0或者直接注释掉循迹部分的代码。用手扶住小车在平衡点附近轻轻放手观察小车反应。先调P比例增大P值小车的“回正”力度会变大。但P太大会在平衡点附近高频振荡。调到小车能快速回到平衡点但又有轻微抖动或缓慢摆动为止。再调D微分增大D值可以抑制P引起的振荡和摆动。D值相当于“阻尼”能让小车平稳地停在平衡点。D值太大反而会引入高频噪声可能让电机发出啸叫。最后考虑I积分平衡控制中I项用于消除静态误差比如平台始终微微倾斜。但I项容易积分饱和引起失控。对于新手可以暂时将I设为0仅用PD控制。如果发现小车有持续朝一个方向缓慢移动的趋势再尝试加入很小的I值。测试动态平衡用手轻轻推一下小车它应该能抵抗这个扰动并回到平衡而不是被推倒或者剧烈振荡。关键经验平衡PID的参数是整辆车的“生命线”一旦调好在后续循迹调试中尽量不要大动。后续的速度问题更多通过调整“循迹PID”和“速度合成策略”来解决。3.2 第二步在平衡基础上加入循迹PID恢复循迹控制将小车放在黑线起点确保五路传感器工作正常。先让车慢速直行可以暂时给一个很小的固定base_speed或者通过一个很小的角度偏移让车微微前倾来产生恒定的低速。目标是让车能平衡地、缓慢地向前移动。单独调循迹的P此时转向可能不灵敏或过度。调整循迹PID的P值让小车在遇到弯道时能平滑地跟随不冲出轨道。循迹的P值大小和车速强相关车速快P值要相应减小否则转弯会过冲。加入循迹的D如果小车在循迹时尤其是过弯后出现来回“画龙”的现象说明系统有滞后需要加入D项来预测趋势抑制超调。平衡与循迹的耦合调试这是难点。你会发现当小车转弯时由于两个轮子速度差车体姿态会受到影响可能诱发平衡振荡。此时需要微调平衡PID的D值或者适当降低循迹PID的输出幅度。核心原则是保证平衡优先。宁可转弯慢一点、平滑一点也不能让车摔倒。3.3 速度控制策略直接给一个固定的base_speed是最简单的但不够好。更好的方法是加入一个速度环设定一个目标速度。通过编码器测量电机实际转速。用一个单独的PID控制器根据速度偏差来调整base_speed。这样可以实现更稳定的匀速行驶对循迹也更友好。如果时间有限也可以采用更简单的“倾角前馈”让平衡的目标角度不是一个固定的0度而是一个根据循迹状态动态调整的微小角度。需要前进时目标角度设为0.5度前倾需要减速或停车时目标角度设为-0.5度后仰。通过调整这个“前馈角度”来控制车速。4. “一圈”的检测逻辑如何不靠运气准确判断终点这是决定任务成败的临门一脚。方法有很多但必须可靠。4.1 方案对比与选择方案实现方式优点缺点与风险计时法从起点开始计时估计跑完一圈的时间后停车。简单无需额外传感器。极度不稳定。电池电量、地面摩擦、每次运行的微小差异都会导致时间变化完全不可靠。强烈不推荐。路程法通过编码器测量车轮转动的总圈数或总脉冲数计算行驶距离。相对准确与速度无关。需要高精度编码器且车轮打滑会引入误差。弯道内外轮路程不同计算复杂。轨迹特征识别在赛道某处设置特殊标记如十字交叉、直角弯、短线。当传感器识别到该特殊图案时计为一圈。可靠性高是电赛常用方案。需要软件上能稳定识别该特征并防止在赛道其他类似地方误触发。绝对位置传感使用巡线传感器阵列更多路如8路、16路配合特殊起终点标签如RFID、磁标。非常精确、可靠。成本稍高需要额外的标签和传感器。对于“电赛H题”这类场景“轨迹特征识别”是最具实操性的方案。我们可以在起点/终点线处设计一个明显的、易于区分的特征。4.2 实现一个可靠的“起终点线”检测假设赛道是黑色电工胶带贴在白色KT板上。我们可以这样设计特征设计在起点处贴一个“工”字形的黑胶带。即一小段横线垂直于前进方向长度略大于小车宽度。检测逻辑正常循迹时只有中间的一两个传感器会持续检测到黑线轨迹线。当小车压过“工”字横线时五路传感器会同时或几乎同时检测到黑线因为横线覆盖了所有传感器的正下方区域。软件上设置一个状态标志。当检测到“所有传感器都为黑”的状态持续超过一个短时间例如50ms并且之前处于正常循迹状态则判定为“经过起终点线”。防误触措施状态机定义一个状态机例如SEARCHING寻找起点、RUNNING正常循迹、CROSSING正在通过特征线、FINISHED完成。延时确认检测到“全黑”后不立即判定而是进入CROSSING状态继续监测一小段时间。如果很快又恢复到正常循迹的“中间黑”模式则确认是一次有效的过线。计数逻辑从SEARCHING出发第一次进入CROSSING并确认后状态变为RUNNING并开始真正的循迹。当在RUNNING状态下再次检测到并确认CROSSING则判定一圈完成进入FINISHED状态执行停车程序。关键点一定要处理好从“全黑”特征线过渡回“中间黑”轨迹线的过程。此时循迹偏差error会剧烈变化转向控制可能会抽风。可以在CROSSING状态短暂冻结循迹PID的输出或者大幅度降低其权重让小车凭借惯性“冲过”特征线区域直到传感器重新稳定地检测到轨迹线。5. 调试流程与常见问题排查理论说完落地调试才是真正的战场。按这个顺序来能节省大量时间。5.1 分步调试清单硬件静态测试确保所有电源电压正确、稳定。手动移动小车用串口打印或屏幕显示确认MPU6050数据变化正常五路传感器在黑白区域读数差异明显。单独测试每个电机确认正反转PWM控制正确。平衡独立调试不装滚球不带循迹用手扶住小车观察角度反馈是否灵敏、正确。先调P让小车有回正趋势再调D抑制振荡。直到放手后能稳定站立数秒以上。此时若无法平衡排查MPU6050安装是否牢固、数据解算周期是否稳定、PID输出极性是否正确方向反了会加速倒下、电机接线是否对应。低速直行调试让小车在空地上缓慢直行例如给一个很小的固定速度或倾角前馈。观察是否能保持平衡前进和后退。此时若前行时摔倒排查平衡PID参数在动态下是否依然合适编码器反馈如果有是否正常机械重心是否合适。循迹静态调试小车断电放在黑线上手动移动观察五路传感器读数变化和计算出的error是否连续、合理。调整传感器安装高度和软件阈值。低速循迹调试在简单直道和弯道上以极低速度测试循迹。先调循迹P让小车能跟上弯道。此时若冲出轨道排查传感器error计算是否正确转向输出steer的极性是否正确左转应右轮快循迹P值是否太小或太大。速度与稳定性调试逐步提高目标速度微调平衡D和循迹P、D确保过弯平稳不振荡。测试急弯的通过性。圈数检测调试单独测试“工”字线检测逻辑。用手推着小车缓慢压过特征线观察状态机切换和传感器读数变化是否如预期。确认无误后进行低速完整一圈测试。全速完整测试与压力测试进行多次完整的一圈测试观察一致性。尝试在不同光照下测试开灯、关灯、自然光验证传感器阈值的鲁棒性。5.2 典型问题与解决思路问题小车平衡时剧烈抖动或发出啸叫。排查平衡D值过大引入了高频噪声。尝试降低D值。检查MPU6050数据是否受到电机或电源干扰做好电源滤波和信号隔离。问题循迹时小车在直道上“画龙”。排查循迹P值可能过大或D值不足。尝试减小P或增加D。也可能是传感器安装不水平导致读数有偏差。问题过弯时小车摔倒。排查转弯时速度差导致车身倾斜加剧平衡PID响应不过来。尝试降低转弯速度减小循迹PID输出限幅或者微调平衡PID的D值以增强抗扰动能力。问题无法检测到起终点线或误检测。排查检查“全黑”的判定阈值是否合理。可能是某个传感器损坏或阈值设置不当导致永远无法“全黑”。增加“延时确认”逻辑防止因地面污点导致误触发。问题检测到终点后停车不稳小车晃动或倒下。排查停车策略太粗暴。不要直接将速度设为0。应该进入停车状态后逐步减小目标速度至0同时平衡PID继续工作。或者让小车缓慢行驶超过终点线一小段距离后再执行柔和的停车程序。6. 进阶优化与备赛建议如果基础功能已经实现可以考虑以下优化点来提升性能和鲁棒性这在“电赛邀请赛”等竞争激烈的场合尤为重要。6.1 传感器融合与预测编码器融合除了红外循迹可以结合车轮编码器信息。在通过特征线全黑时编码器信息会短暂不可靠但进入正常轨迹后编码器可以提供更平滑的速度和位置估计与红外传感器的偏差信息进行互补滤波能让控制更顺滑。路径记忆与预测对于固定赛道可以尝试让小车第一次慢速学习一圈记录下关键位置如弯道入口的传感器特征或编码器计数。第二次运行时可以根据记忆提前进行转向调整实现更优的路径跟踪。6.2 控制算法优化参数自整定根据车速动态微调循迹PID的参数。高速时用一套参数低速时用另一套。模糊控制对于非线性严重的系统如急弯可以尝试简单的模糊控制规则例如“偏差大且偏差变化快则转向输出大”可能比固定参数的PID适应性更好。6.3 工程稳定性提升系统状态监控通过蓝牙或NRF模块将小车的姿态角、速度、传感器原始值、PID输出等关键数据实时发送到电脑上位机进行可视化。这是调试的“神器”。故障安全机制程序里加入软件看门狗。如果检测到长时间角度异常可能摔倒或电机堵转自动切断电机输出防止烧毁硬件。机械结构加固检查所有螺丝是否紧固传感器和IMU是否用海绵胶减震轮胎是否打滑电池是否固定牢靠。机械上的微小松动在高速运行时都会被放大。最后留几个我自己调试时会优先看的点第一电源一定要干净电机电源和控制电源分开第二平衡PID是根基必须先在空载、静态下调稳第三圈数检测逻辑一定要单独、反复测试并用串口打印状态变化来验证第四不要追求极限速度先追求稳定完成再逐步加速。这个任务真正的难点不在于让车跑起来而在于让车能稳定、可靠、自动地跑完一圈并停下任何一个环节的疏忽都可能导致演示失败。把每个模块的输入输出搞清楚用状态机的思维管理任务流程成功就是水到渠成的事。