这类竞赛题目最值得先看的不是功能列表而是能不能在普通实验室环境下用常见的开发板和传感器把核心的控制逻辑跑通。H题《车载平衡滚球运动控制系统》听起来复杂但核心就是两件事一是让一个“小车”平台保持自身平衡二是让平台上的小球能按指令运动。它考察的是对PID控制、传感器融合、运动学和动力学建模的综合应用能力。很多人一看到“平衡”和“滚球”就想到复杂的算法和昂贵的硬件其实不然。我更建议把第一次实现拆成三步先让小车平台自己能站稳自平衡再让小球在静止的平台上动起来平面控制最后把两者结合起来动态平台上的球体控制。下面按实际落地顺序结合常见的STM32、OpenMV、MPU6050、舵机、直流电机这些器材拆解一遍从零到一的实现路径。1. 先拆解题目到底要做一个什么样的系统拿到题目不要急着画电路图或写代码。先明确系统的输入、输出和核心任务。1.1 系统构成与核心任务题目要求设计一个“车载”系统这意味着整个平衡平台是能够移动的。平台上有一个凹面或平面带围栏小球在里面。系统需要完成两类任务平台自平衡无论平台如何移动或受到扰动它都能像平衡车一样通过轮子或类似执行机构的快速反应保持平台本身的水平或倾斜角度稳定。这是所有功能的基础。小球轨迹控制在平台保持平衡或进行特定倾斜的前提下通过改变平台的倾斜角度利用重力分量来驱动小球使其能够按照指令要求运动。指令可能包括将小球移动到指定坐标点、沿指定轨迹如直线、圆形运动、或者完成避障等。所以这本质上是一个两级控制系统底层是平台平衡环快速响应上层是小球位置/轨迹环相对慢速。上层环的输出期望的平台倾斜角度作为底层环的输入。1.2 硬件选型与分工建议对于大学生竞赛硬件在可靠性和易用性间取得平衡是关键。主控芯片STM32F4系列如F407、F429是主流选择。计算能力足够运行多路PID和简单滤波算法外设丰富。可以考虑使用两块一块专用于高速的平台平衡控制另一块用于小球视觉识别、轨迹规划和上层指令生成两者通过串口或CAN通信。姿态传感器MPU6050六轴或MPU9250九轴是必选项用于测量平台的俯仰角和滚转角。必须做好传感器数据的滤波如互补滤波、卡尔曼滤波来获得稳定的角度和角速度。小球检测传感器方案一推荐OpenMV或树莓派摄像头。通过图像处理识别小球中心的像素坐标再通过校准转换为平台坐标系下的物理坐标单位毫米。这是最直观、信息量最大的方式。方案二激光测距/红外阵列。在平台边缘布置多个测距传感器通过三角测量定位小球。成本高安装复杂但不受光照影响。执行机构平台平衡驱动通常使用直流减速电机编码器构成双轮自平衡小车底盘。编码器用于测量轮子转速结合姿态传感器实现平衡。平台倾斜驱动如果平台与底盘非刚性连接可能需要额外的舵机或直线电机来改变平台相对于底盘的倾角。如果平台就是底盘本身那么直接通过控制两个轮子的差速就能实现倾斜。电源大容量锂电池组如3S锂电并搭配多个稳压模块如12V转5V 5V转3.3V确保电机突发启动时控制电路电压稳定。注意第一次搭建建议先实现“平台平衡”和“小球视觉识别”这两个独立功能验证通过后再进行联调。不要试图一次性把所有硬件连起来。2. 核心一让车载平台先站起来自平衡控制这是整个系统稳定运行的前提。如果平台自己都晃来晃去小球控制无从谈起。2.1 控制模型建立可以将平台简化为一个倒立摆模型。控制输入是电机转矩输出是平台倾角。核心状态量是倾角θ和角速度θ_dot。通过MPU6050可以测量这两个量角速度需积分或滤波得到角度。2.2 PID控制器设计与调试这是实现平衡的核心算法。通常需要两个PID环角度环外环输入是期望角度通常为0度即水平与当前角度滤波值的偏差输出是期望的角速度。// 伪代码示例 float desired_angle 0.0; // 期望平衡角度 float current_angle get_filtered_angle(); // 从MPU6050滤波后得到 float angle_error desired_angle - current_angle; float desired_angular_velocity pid_angle.update(angle_error);角速度环内环输入是期望角速度与当前角速度直接从MPU6050陀螺仪读取的偏差输出是最终的电机PWM控制量。float current_gyro_y get_gyro_y(); // 读取Y轴陀螺仪数据俯仰角速度 float velocity_error desired_angular_velocity - current_gyro_y; float motor_pwm_output pid_velocity.update(velocity_error); // 将 motor_pwm_output 分别施加到左右电机考虑转向调试顺序至关重要先调内环角速度环用手轻轻转动平台电机应该产生一个反向力试图“抵抗”你的转动。调整Kp使响应迅速但不过冲。Ki和Kd初期可以设为0。再调外环角度环将平台扶正后松开它应该能自己保持直立。角度环的Kp决定了平衡的“刚度”太大会高频振荡太小则回正无力。同样先调Kp。联调与抗扰轻轻推搡平台它应该能在晃动几次后恢复平衡。此时可以微调Kd来抑制振荡或引入Ki消除静态误差注意积分饱和问题。实测经验PID参数没有“通用最优值”。与你的电机性能、电池电压、车身重量和重心高度强相关。调试时一定要把平台用绳子吊起来或放在安全网中防止飞出去损坏。2.3 关键实现细节传感器滤波MPU6050的原始数据噪声很大。互补滤波是入门首选计算量小效果足够。进阶可以用卡尔曼滤波状态估计更优但参数难调。// 简易互补滤波伪代码 float dt 0.005; // 采样周期如5ms float angle 0.0; float a 0.98; // 互补滤波系数可调 void update_angle(float accel_angle, float gyro_rate) { // accel_angle: 由加速度计计算出的角度低频可靠高频噪声大 // gyro_rate: 陀螺仪角速度高频精确但存在漂移 angle a * (angle gyro_rate * dt) (1 - a) * accel_angle; }死区与输出限幅当角度误差很小时应设置死区防止电机高频微振。PID输出必须进行限幅防止超出电机和驱动板的承受范围。编码器反馈虽然平衡主要靠姿态传感器但轮子编码器可以用于速度闭环防止平台“跑飞”实现定点平衡。3. 核心二让小球在平台上听指挥视觉与轨迹控制当平台能稳定平衡后就可以考虑控制小球了。前提是你知道小球在哪里定位以及你想让它去哪规划。3.1 基于视觉的小球定位使用OpenMV等摄像头模块步骤清晰摄像头固定与标定将摄像头固定在平台上方正中央镜头朝下。拍摄一张标定图例如画有已知间距网格的纸建立像素坐标 (u, v)到平台物理坐标 (x, y)的映射关系。这通常是一个透视变换或简单的线性缩放如果摄像头正对且平台平面与像平面平行。图像处理流程镜头校正消除广角镜头的畸变让直线看起来是直的。颜色阈值分割小球的颜色比如橙色与平台背景比如黑色或白色反差要大。在OpenMV IDE中使用阈值编辑器找出小球颜色的LAB或RGB阈值范围。# OpenMV 示例代码片段 import sensor, image, time sensor.reset() sensor.set_pixformat(sensor.RGB565) sensor.set_framesize(sensor.QVGA) sensor.skip_frames(time 2000) # 定义橙色小球的颜色阈值 orange_threshold (30, 60, 10, 50, 10, 40) # (L_min, L_max, A_min, A_max, B_min, B_max) while(True): img sensor.snapshot() # 寻找色块 blobs img.find_blobs([orange_threshold], pixels_threshold100, area_threshold100) if blobs: largest_blob max(blobs, keylambda b: b.pixels()) # 绘制中心点 img.draw_cross(largest_blob.cx(), largest_blob.cy()) # 将像素中心(cx, cy)通过标定矩阵转换为物理坐标(x_mm, y_mm) # x_mm, y_mm transform(largest_blob.cx(), largest_blob.cy()) # 通过串口发送(x_mm, y_mm)给主控寻找色块与中心计算find_blobs函数可以找到连通域选择面积最大的那个作为小球并获取其外接矩形或中心坐标。坐标变换与输出将小球中心像素坐标通过标定得到的变换矩阵换算为以平台中心为原点的物理坐标单位毫米通过串口实时发送给STM32主控。3.2 小球运动控制策略主控STM32收到小球当前位置(x, y)后如何控制它到达目标点(x_target, y_target)生成平台期望倾角最简单的方法是比例控制平台在X方向的倾角θx_desired与小球在X方向的误差(x_target - x)成正比Y方向同理。倾角方向应使得重力分量能驱动小球向目标点运动。float kp_ball 0.01; // 比例系数需要实验调整 float desired_platform_angle_x kp_ball * (target_y - ball_y); // 注意平台X轴倾斜影响小球Y轴运动 float desired_platform_angle_y kp_ball * (target_x - ball_x); // 平台Y轴倾斜影响小球X轴运动更优的方法是引入小球的速度反馈构成PD控制使小球运动更平滑减少在目标点附近的振荡。平衡控制器的设定点切换此时平台自平衡PID的期望角度不再固定为0。而是将上面计算出的desired_platform_angle_x/y作为新的设定点输入给平衡控制器。平衡控制器会迅速驱动平台倾斜到这个角度从而带动小球运动。轨迹跟踪对于圆形等轨迹可以将其离散化为一系列连续的目标点让小球依次追踪。关键在于目标点切换的频率和小球当前速度的匹配避免急停急启。3.3 防掉落与边界处理平台有物理边界。当小球靠近边缘时控制策略必须优先防止其掉落。设置安全区域在平台物理边界内定义一个更小的矩形安全区。势场法在控制算法中为边界添加一个“排斥力”。当小球靠近边界时这个排斥力会叠加在指向目标点的“吸引力”上使小球自动远离边界。状态机系统可以有不同的状态如“正常追踪”、“接近边界减速”、“边界紧急回中”等。4. 系统集成、调试与竞赛准备要点将平衡平台和小球控制两个子系统整合并稳定运行是最后也是最考验人的一步。4.1 软硬件联调步骤独立验证确保平台能长时间5分钟稳定自平衡确保视觉模块能稳定、低延迟100ms地输出小球坐标。通信测试用串口调试助手确认视觉模块发送给主控的数据格式正确、频率稳定如50Hz。主控端要做好数据接收的解析和校验如校验和。开环测试固定平台或用手持让小球控制环单独工作。通过串口发送模拟的目标点观察计算出的平台期望倾角是否合理例如目标点在右边平台应向左倾。闭环静态测试让平台在平衡状态下给定一个固定目标点。观察小球是否能运动到目标点附近并保持。此时重点调试小球控制环的PID参数。闭环动态测试让目标点移动实现轨迹跟踪。从慢速开始逐步提高速度。抗扰测试轻轻触碰小球或平台观察系统能否恢复稳定。4.2 常见问题与排查清单遇到问题按这个顺序查现象可能原因排查方向平台根本站不起来直接倒下1. 电机输出方向反了。2. PID极性错误正反馈。3. 传感器安装方向不对。4. 电机功率不足或电池没电。1. 交换电机线。2. 将角度误差或角速度误差取反。3. 检查MPU6050坐标系与平台坐标系是否一致。4. 测试电机空载转速测量电池电压。平台高频剧烈振荡1. 角度环或角速度环的Kp太大。2. 传感器数据噪声大未滤波。3. 控制周期不稳定或太慢。1. 大幅减小Kp特别是角度环。2. 添加或加强滤波互补滤波。3. 确保中断定时器准确控制周期在5-10ms。平台缓慢漂移或倾斜1. 重心不在轮轴正上方。2. 传感器存在零漂特别是陀螺仪。3. 需要角度环加入较小的Ki。1. 调整电池等重物位置。2. 上电静止一段时间计算陀螺仪零偏并软件扣除。3. 谨慎加入Ki并设积分限幅。小球定位不准、跳动1. 光照变化导致颜色阈值失效。2. 镜头畸变未校正。3. 标定不准。4. 小球滚动导致图像模糊。1. 使用更稳定的颜色空间如LAB或增加补光灯。2. 进行镜头标定应用校正矩阵。3. 重新标定使用更密集的网格点。4. 提高快门速度或使用曝光控制。小球控制响应迟钝或过冲1. 小球位置控制环Kp太小/太大。2. 视觉数据延迟太大。3. 平台响应速度跟不上。1. 重新调试小球环PID。2. 降低图像分辨率优化算法提高发送频率。3. 检查平台平衡环的响应速度可能需提高其控制频率。小球接近边缘时系统失控1. 边界处理算法未生效。2. 平台倾角饱和达到机械极限。1. 调试边界“排斥力”参数。2. 在软件中对平台最大指令倾角进行限幅。4.3 竞赛方案优化建议满足基本功能后这些优化点能让你脱颖而出控制算法升级模糊PID适应不同小球速度、平台状态下的参数自适应。LQR线性二次型调节器比PID更优的状态反馈控制器需要精确的数学模型。模型预测控制MPC更高级能处理约束如平台倾角限制但计算量大。轨迹规划优化不仅让小球走到目标点还要规划时间最优或能量最优的平滑路径。人机交互增加蓝牙或Wi-Fi用手机APP或电脑上位机设置目标点、轨迹、参数并实时显示小球位置、平台姿态等数据。鲁棒性设计掉球检测与恢复如果小球意外掉落系统能检测到并回到安全状态平台回平。参数掉电保存将调试好的PID参数保存在STM32的Flash中。看门狗防止程序跑飞。最后也是最实际的建议硬件平台尽早搭好留出充足的调试时间。算法仿真如MATLAB/Simulink有帮助但最终都要在实物上验证。队内分工要明确一人负责底层平衡控制与硬件一人负责视觉识别与上层算法一人负责系统集成、调试与文档。从平衡平台做起一步一个脚印这个复杂的题目完全可以被拆解并攻克。