电赛H题车载平衡滚球系统：从零搭建与快速调试实战指南

最近在准备电赛的同学，是不是已经开始为H题“车载平衡滚球”头疼了？这个题目听起来就充满了机械、控制和算法的复合挑战。很多队伍拿到题目后，第一反应往往是先埋头画机械结构图，或者一头扎进复杂的PID调参里。但结果往往是，车架搭好了，代码也写了一堆，却发现球根本稳不住，或者小车一动球就飞了，调试陷入僵局。

这篇文章要解决的核心问题，正是这个“上车粗调试”的困境。我认为，在电赛这类时间紧迫的比赛中，“先跑通，再优化”的策略远比“一步到位追求完美”更有效。所谓的“粗调试”，其精髓不在于精度，而在于快速建立整个系统的闭环反馈意识，验证从传感器读取、到控制器决策、再到执行器动作的整个链路是否通畅。

如果你正卡在不知道如何让球动起来、让车动起来，或者两者一动就全乱套的阶段，那么这篇文章就是为你准备的。我们将抛开复杂的理论推导，聚焦于如何用最直接的方法，让滚球系统先“活”起来，为后续的精细优化打下坚实的基础。

1. 理解题目核心：我们到底在构建一个什么系统？

在动手之前，我们必须清晰地理解“车载平衡滚球”系统的本质。这不仅仅是“平衡车”和“平衡球”的简单叠加。

• 系统构成：它主要由三部分组成：

  1. 被控对象：平板上的滚球。我们需要控制它的位置（X, Y坐标）和速度。
  2. 执行机构：载着平板运动的小车（底盘）。通过控制两个电机的差速，驱动小车在平面（或坡道）上移动，从而带动平板产生倾斜，利用重力分力控制球体运动。
  3. 感知系统：用于检测小球位置的传感器（如摄像头、OpenMV、激光测距阵列等），以及用于检测车身姿态和速度的传感器（如陀螺仪/加速度计IMU、编码器）。

• 控制逻辑：这是一个典型的双闭环串级控制系统。

  • 内环（车身平衡环）：核心目标是保持车身自身稳定不倾倒。通过IMU获取车身俯仰/横滚角，使用PID控制器计算输出，控制电机转矩，让车身快速响应并维持平衡。这是基础，如果车身自己都站不稳，一切免谈。
  • 外环（滚球位置环）：核心目标是控制小球在平板上的位置。通过视觉等传感器获取小球坐标，与目标坐标比较，其输出结果（通常是平板需要倾斜的角度或小车的目标速度）作为内环的设定值。

简单来说，小车的运动是为了给球制造一个“可控的斜坡”。想让球往左走，就让平板左侧微微抬高（即小车整体向右微微加速移动）。整个系统的难点在于，两个环相互耦合，调试参数互相影响。

“粗调试”的目的，就是先分别验证这两个环能否独立工作，再尝试将它们弱耦合地联动起来。

2. 硬件平台选择与核心传感器

工欲善其事，必先利其器。在有限的时间和预算内，选择合适的核心部件至关重要。

2.1 主控与电机驱动

• 主控MCU：STM32系列（如F4或H7）是电赛的绝对主流，资源丰富，社区支持好。对于这个题目，需要足够的定时器（用于PWM输出和编码器输入）、足够的串口/SPI/I2C（连接多个传感器）和足够的计算能力（运行PID和控制逻辑）。粗调试阶段，确保你的工程模板（时钟、GPIO、定时器、中断）是稳定可用的。
• 电机与驱动：平衡需要快速响应，因此带编码器的直流减速电机（如MG513P30）配合直流电机驱动板（如TB6612、DRV8833、或大功率的BDLC）是常见选择。粗调试时，务必先单独测试每个电机：给定PWM值，电机是否正反转？编码器读数是否随转动变化？

2.2 姿态传感器 (IMU)

这是内环平衡的“眼睛”。MPU6050（六轴）或MPU9250（九轴）性价比最高。关键在于姿态解算。

• 粗调试策略：不要一开始就追求完美的四元数或卡尔曼滤波。可以先用atan2(accY, accZ)和atan2(-accX, accZ)来近似计算俯仰角(Pitch)和横滚角(Roll)。虽然动态时有误差，但足以验证车身是否能对倾斜做出反应。
• 接线与测试：确保I2C通信正常，能稳定读取原始加速度计和陀螺仪数据。将开发板平放、侧放，观察角度计算值是否大致符合预期。

2.3 球位检测传感器

这是外环的“眼睛”。选择取决于赛题具体要求（精度、范围、成本）。

• 摄像头方案（如OpenMV、OV7725）：通用性强，可获取全局信息。粗调试时，先别急着写复杂的识别算法。目标是稳定地找到小球并输出其质心坐标。可以先用单色球、高对比度背景，使用find_blobs（OpenMV）或颜色阈值化（OpenCV）快速实现。
• 激光测距/模拟摄像头阵列：响应快，抗光干扰强。粗调试时，确保每个传感器能正确返回距离值，并建立距离值与球位置的映射关系。

粗调试核心：无论用哪种方案，请先在静态情况下（小车不动），用手移动小球，在串口助手上观察输出的坐标值是否连续、平滑、方向正确。这是所有后续控制的前提。

3. 软件框架搭建：模块化是高效调试的基石

在写第一行控制代码前，建立一个清晰的软件框架能事半功倍。建议按以下模块划分：

/Project ├── Core/ // 系统核心（时钟、延时、调试） ├── Drivers/ // 硬件驱动层 │ ├── motor.c/.h // 电机PWM与编码器 │ ├── imu.c/.h // IMU数据读取与简单解算 │ ├── vision.c/.h // 视觉传感器数据获取 │ └── ... ├── Algorithm/ // 控制算法层 │ ├── pid.c/.h // 通用PID控制器 │ ├── balance.c/.h // 车身平衡控制逻辑 │ ├── ball_ctrl.c/.h // 滚球位置控制逻辑 │ └── ... ├── Tasks/ // 任务层（基于RTOS或定时中断） │ ├── ctrl_task.c/.h // 核心控制任务（100Hz-500Hz） │ ├── sens_task.c/.h // 传感器数据采集任务 │ └── ... └── main.c

粗调试的关键：每个.c文件都应有对应的测试函数。例如，在motor.c中写一个Motor_Test()函数，循环让两个电机正反转；在imu.c中写一个IMU_Print_Data()函数，持续打印角度值。

4. 分步粗调试实战流程

现在进入最核心的实操环节。请严格按照以下顺序进行，每一步成功后再进入下一步。

4.1 第一步：电机与编码器基础测试

目标：确保动力系统受控且可观测。

1. 写一个简单程序，忽略所有传感器，直接给两个电机固定的PWM值（如30%占空比）。

   // 在main的while(1)中或测试函数中 Motor_Set_PWM(MOTOR_LEFT, 3000); // 假设PWM范围0-10000 Motor_Set_PWM(MOTOR_RIGHT, 3000); HAL_Delay(2000); Motor_Set_PWM(MOTOR_LEFT, -3000); Motor_Set_PWM(MOTOR_RIGHT, -3000); HAL_Delay(2000); Motor_Set_PWM(MOTOR_LEFT, 0); Motor_Set_PWM(MOTOR_RIGHT, 0);

2. 观察小车是否按预期前进、后退。注意安全，用手扶住或架起小车，防止跑飞。
3. 加入编码器读数打印。转动轮子，观察计数值是否增减，方向是否正确。

   int32_t enc_left, enc_right; enc_left = Encoder_Get_Count(ENCODER_LEFT); enc_right = Encoder_Get_Count(ENCODER_RIGHT); printf("L:%ld, R:%ld\r\n", enc_left, enc_right);

4.2 第二步：车身平衡环独立调试（内环）

目标：让小车自己能站稳。

1. 架起小车：用书本或支架把小车架空，让轮子悬空。这是最重要的安全措施！
2. 编写最简单的平衡PD控制器：

   // 在控制任务中（假设100Hz运行） float pitch = IMU_Get_Pitch(); // 获取当前俯仰角 float pitch_target = 0.0f; // 目标角度是0度（直立） float pitch_error = pitch_target - pitch; // 非常粗略的PD参数，仅用于启动调试 static float last_error = 0; float Kp = -10.0f; // 注意符号！需要根据你的电机方向调整 float Kd = -0.5f; float output = Kp * pitch_error + Kd * (pitch_error - last_error); last_error = pitch_error; // 输出限制 if(output > 8000) output = 8000; if(output < -8000) output = -8000; Motor_Set_PWM(MOTOR_LEFT, (int32_t)output); Motor_Set_PWM(MOTOR_RIGHT, (int32_t)output);

3. 上电观察：用手轻轻推一下小车，它应该试图反抗，回到平衡位置。如果剧烈抖动或朝一个方向猛转，立即断电！
   • 猛转：说明Kp符号反了，或者电机接线极性反了。
   • 剧烈抖动：说明Kd太小（或为0）导致振荡，或者Kp太大。尝试减小Kp，增加Kd。
   • 反应迟钝，稳不住：说明Kp太小，或Kd太大（过度阻尼）。
4. 粗调参数：遵循“先P后D”的原则。慢慢增加Kp直到小车能较快响应推力但不振荡，然后加入Kd抑制振荡。此时不追求完美稳定，只要小车能有明显的“平衡意图”即可。

4.3 第三步：滚球位置环独立调试（外环）

目标：在平板静止（小车被固定住）时，能通过手动倾斜平板控制小球。

1. 固定小车：用夹具牢牢固定小车底盘，使其完全不能移动。
2. 获取球坐标：确保视觉/传感器能稳定输出小球坐标(ball_x, ball_y)。将平板中心设为坐标原点(0,0)。
3. 编写位置P控制器：

   float target_x = 0.0f; // 目标：让球停在中心 float target_y = 0.0f; float error_x = target_x - ball_x; float error_y = target_y - ball_y; float Kp_ball = 0.05f; // 很小的系数，因为输出是角度 float pitch_target_for_ball = Kp_ball * error_y; // Y误差控制俯仰（前后倾斜） float roll_target_for_ball = -Kp_ball * error_x; // X误差控制横滚（左右倾斜），注意符号

   pitch_target_for_ball和roll_target_for_ball就是我们认为为了把球拉回中心，平板需要倾斜的角度。
4. 手动模拟：此时，pitch_target_for_ball和roll_target_for_ball会随着球的位置变化。你可以不把它们接入真正的电机控制，而是通过串口打印出来。用手拨动小球，观察计算出的目标倾斜角方向是否正确（球在左边，目标角度是否指示平板应向右倾斜？）。

4.4 第四步：双环初步耦合与“上车”粗调

目标：让小车通过移动，来控制小球大致运动。 这是最挑战的一步，但粗调试不要求精确追踪，只要求“能动且可控”。

1. 修改内环设定值：将内环平衡控制的目标角度pitch_target和roll_target，从固定的0度，改为由外环计算出的pitch_target_for_ball和roll_target_for_ball。

   // 在控制任务中 // 外环计算 float pitch_target = pitch_target_for_ball; // 来自球位置控制 float roll_target = roll_target_for_ball; // 内环平衡控制（简化版，假设独立控制俯仰和横滚） float pitch_error = pitch_target - imu_pitch; float roll_error = roll_target - imu_roll; float output_pitch = Kp_p * pitch_error + Kd_p * (pitch_error - last_pitch_error); float output_roll = Kp_r * roll_error + Kd_r * (roll_error - last_roll_error); // 混合为左右轮输出 (差速模型) float output_left = output_pitch - output_roll; // 根据你的车体坐标系调整符号 float output_right = output_pitch + output_roll; Motor_Set_PWM(MOTOR_LEFT, (int32_t)output_left); Motor_Set_PWM(MOTOR_RIGHT, (int32_t)output_right);

2. 参数设置极保守：
   • 将外环的Kp_ball设得非常小（例如0.01甚至0.005）。
   • 内环的平衡PID参数使用第二步调试好的值。
   • 做好安全防护：用手扶住小车，或者在一个封闭的区域内进行。
3. 上电测试：
   • 将小球放在平板一侧。
   • 期望现象：小车应该非常缓慢地向相反方向移动一点点，试图将平板倾斜以拉回小球。球会开始滚动。
   • 如果小车纹丝不动：稍微增大Kp_ball。
   • 如果小车突然猛冲导致球飞出去：立即断电！说明Kp_ball太大，或者内外环参数匹配极差。大幅减小Kp_ball。
4. 实现最基础的“定点”：通过串口指令或按键，动态改变外环的target_x和target_y。观察小车是否能带动小球缓慢地向目标点移动。成功标准是：小球能大致被“吸”向目标位置，即使有超调和振荡也没关系。这证明整个控制链路是通的！

5. 核心代码片段与关键逻辑解析

这里提供一个高度简化的、用于理解双环耦合逻辑的代码框架。实际工程中需要考虑中断、滤波、任务调度等。

// 文件：ctrl_task.c (假设在1kHz中断中运行) #include “pid.h” #include “motor.h” #include “imu.h” #include “vision.h” PID_HandleTypeDef pid_pitch， pid_roll; // 内环PID float ball_target_x， ball_target_y; // 球目标位置 float Kp_ball = 0.01f; // 外环P系数 void Control_Task_1kHz(void) { // 1. 读取传感器数据 float imu_pitch = IMU_Get_Pitch_Filtered(); // 使用滤波后的角度 float imu_roll = IMU_Get_Roll_Filtered(); float ball_x， ball_y; Vision_Get_Ball_Position(&ball_x， &ball_y); // 2. 外环计算：根据球位置误差，计算期望平板倾斜角度 float pitch_target = 0.0f; // 基础平衡目标 float roll_target = 0.0f; if (vision_data_valid) { // 视觉数据有效时才进行球控制 pitch_target += (ball_target_y - ball_y) * Kp_ball; roll_target -= (ball_target_x - ball_x) * Kp_ball; // 注意符号 } // 3. 内环计算：根据期望角度和实际角度，计算电机输出 float output_pitch = PID_Calculate(&pid_pitch， pitch_target， imu_pitch); float output_roll = PID_Calculate(&pid_roll， roll_target， imu_roll); // 4. 混合输出到左右轮（差速转向模型） // 假设：output_pitch为正时，车体前倾，电机应向前转以补偿。 // output_roll为正时，车体向右倾，左轮应更快/右轮应更慢以补偿。 int32_t pwm_left = (int32_t)(output_pitch - output_roll); int32_t pwm_right = (int32_t)(output_pitch + output_roll); // 5. 输出限幅与死区补偿 pwm_left = constrain(pwm_left， -MOTOR_PWM_MAX， MOTOR_PWM_MAX); pwm_right = constrain(pwm_right， -MOTOR_PWM_MAX， MOTOR_PWM_MAX); Motor_Set_PWM(MOTOR_LEFT， pwm_left); Motor_Set_PWM(MOTOR_RIGHT， pwm_right); }

关键逻辑解析：

• 外环输出是内环的输入：这是串级控制的核心。pitch_target和roll_target不再是常数0，而是由球位置误差动态调整的“平衡点”。小车为了在这个动态的平衡点上站稳，就必须移动，从而带动球。
• 符号至关重要：roll_target计算中的负号-=取决于你的坐标系定义。务必通过静态测试（用手推球看计算出的目标角度方向）来验证符号是否正确。
• 数据有效性判断：必须判断视觉数据是否有效，无效时外环应停止更新，仅保持车身平衡，防止因误识别导致小车失控。

6. 常见问题与快速排查清单

在粗调试阶段，你会遇到各种各样的问题。下表列出了典型现象及解决思路：

7. 粗调试后的优化方向与工程建议

一旦你的系统能完成“小球动，小车跟着动”的粗调目标，恭喜你，最艰难的一步已经跨过。接下来可以朝这些方向细化：

1. 内环精细化：

   • 引入更精确的姿态解算（如Mahony滤波、DMP）。
   • 调整PID为PI-D或串级PID，加入积分项(I)消除静差。
   • 加入转向控制，让小车不仅能前后左右倾斜，还能原地旋转。

2. 外环智能化：

   • 将外环的P控制升级为PD或PID控制，抑制小球振荡。
   • 加入速度环：控制小球的速度，而不仅仅是位置，使运动更平滑。
   • 实现轨迹规划：让小球按指定路径（如直线、圆形）运动。

3. 传感器融合与抗干扰：

   • 视觉数据加入卡尔曼滤波，预测小球位置，应对短暂遮挡。
   • 融合编码器信息进行车身位移估计，辅助定位。

4. 系统集成与鲁棒性：

   • 设计状态机：明确“初始化”、“平衡就绪”、“球控制”、“错误保护”等状态。
   • 加入安全保护：倾角过大、电机堵转、传感器失效时，自动切断电机输出。
   • 编写上位机调试工具：实时绘制小球轨迹、车身角度、电机输出等曲线，极大提升调试效率。

给备赛同学的最后建议：电赛是马拉松，不是百米冲刺。将大问题分解为“电机->平衡->视觉->耦合”这样的小问题，每解决一个，就离成功近一步。粗调试的意义在于打通任督二脉，建立信心。拿到基础分后，再有条不紊地冲击发挥部分。保留好每一次调试的参数和现象记录，这将是你们解决最终难题的最宝贵财富。