这次我们来看一个针对全国大学生电子设计竞赛电赛H题的解决方案——无视觉、无电机的平衡小球系统。这个方案的核心在于它绕开了传统方案中复杂的视觉识别和电机控制转而采用更简洁、更稳定的物理与电路设计直接“秒杀”了同届竞赛中的4、5、6题。对于正在备赛或对控制类题目感兴趣的同学来说这种思路的转变和实现细节比单纯堆砌代码和硬件更有价值。本文将详细拆解这套“无视觉无电机”方案的核心思想、硬件选型、电路设计、控制算法以及最终的调试验证过程。我们重点关注的是方案的可行性、实现的成本与门槛以及如何一步步复现并优化系统性能。无论你是想为下一届电赛做准备还是单纯想学习经典控制理论的实际应用这篇文章都能提供一条清晰的实践路径。1. 核心能力速览能力项说明目标赛题全国大学生电子设计竞赛电赛H题平衡小球系统核心创新摒弃摄像头视觉反馈和步进/舵机电机执行采用更直接的传感器与执行器主要传感器高精度角度传感器如MPU6050、位置检测传感器如激光测距/红外对管核心执行器电磁铁、音圈电机、线性伺服等可直接快速响应的器件控制核心STM32、ESP32等微控制器实现PID或更先进的控制算法系统特点响应快、结构简单、抗干扰能力强、成本相对可控适合场景电赛备赛、课程设计、控制算法学习、创新项目原型开发验证指标小球平衡稳定性、抗扰动能力、响应速度2. 方案思路与使用边界传统平衡小球题目主流思路是“摄像头捕捉小球位置 - 控制器计算 - 电机驱动平板调整角度”。这个链路长涉及图像处理、坐标变换、电机控制等多个环节任何一个环节的延迟或误差都会导致系统不稳定。本方案“无视觉无电机”的破局点在于无视觉不使用摄像头。小球在平板上的位置通过安装在平板边缘的红外对管阵列、激光测距模块或电阻触摸膜来直接检测。这避免了图像处理的巨大计算开销和延迟。无电机不使用传统的旋转电机来驱动平板。平板的角度调整通过电磁铁吸合/释放、音圈电机直推或线性伺服来实现。这些执行器可以直接产生直线运动或力矩响应速度极快控制模型更直接。适合谁用电赛参赛队员尤其是负责控制算法和硬件设计的同学。自动化、仪器仪表、机电相关专业的学生用于课程实践。对PID控制、实时系统、传感器融合感兴趣的硬件爱好者。能解决什么问题提供了一个避开复杂视觉和电机驱动直击控制问题核心的参考设计。降低了软件复杂度让开发者更专注于控制算法本身和硬件可靠性。方案具有高响应速度理论上能获得更好的动态性能。不适合什么场景需要极高定位精度如微米级的工业场景。本方案是教学竞赛级精度。对执行器推力或行程有超大要求的场景。电磁铁或音圈电机的推力/行程有限。完全不想动手焊接、调试硬件的纯软件学习者。安全与合规边界实验中涉及的电磁铁、激光模块等需注意用电安全避免短路。高速运动的小球和机构存在机械风险调试时需做好防护。本方案为学习研究目的若用于其他场合需考虑相应的安全认证。3. 硬件选型与电路设计一套稳定可靠的硬件是算法得以实现的基础。以下是核心部件的选型参考和电路设计要点。3.1 传感器选型与电路平板倾角检测MPU6050作用实时测量平板自身的俯仰角和横滚角。这是控制器的核心反馈之一。电路I2C通信。需连接MCU的I2C引脚注意上拉电阻通常4.7kΩ。VCC接3.3V。// 接线示例 (以STM32为例) // MPU6050 - STM32 // VCC - 3.3V // GND - GND // SCL - PB6 (I2C1_SCL) // SDA - PB7 (I2C1_SDA) // INT - 可选接中断引脚小球位置检测红外对管阵列作用在平板X轴和Y轴边缘布置多对红外发射与接收管通过检测哪一对被小球遮挡来判断小球坐标。电路发射管串联限流电阻如100Ω接MCU IO口输出模式。接收管光电三极管集电极接上拉电阻如10kΩ至3.3V发射极接地集电极输出接MCU的ADC引脚或数字IO口。优点成本低电路简单响应快。缺点精度取决于对管密度易受环境光干扰需加调制解调或物理遮光。小球位置检测备选TOF激光测距模块作用在平板四角向下安装测量到平板的距离通过算法反推小球位置当小球滚过时距离会发生变化。型号VL53L0X, VL53L1X。精度高抗干扰强。电路同样是I2C接口接线同MPU6050。3.2 执行器选型与驱动电路电磁铁方案原理平板一侧固定另一侧下方放置电磁铁。通过控制电磁铁的电流大小即磁力大小来吸合或释放平板从而改变其倾角。驱动电路必须使用H桥或MOSFET驱动电路因为需要快速通断和电流控制。不能直接用MCU的IO口驱动。// 驱动芯片示例DRV8833、TB6612、L298N // MCU通过PWM波控制驱动芯片的输入来调节电磁铁两端的电压/电流。关键参数电磁铁的吸力N、行程mm、额定电压/电流、响应时间。音圈电机方案原理直接产生直线力推动平板边缘。控制精度和响应速度极高是高性能选择。驱动需要专门的线性功率放大器或D类功放来驱动电路设计和成本更高。控制需要电流反馈环实现真正的力控。3.3 主控制器STM32F4系列如F407、F429或ESP32是主流选择。需要足够的定时器用于PWM生成、ADC用于红外接收信号采集、I2C接口以及足够的计算性能运行浮点PID运算。4. 系统建模与控制算法4.1 系统模型简化将系统简化为一个二维问题单轴控制。被控对象是平板控制输入是执行器施加的力或力矩u被控量是小球在平板上的位置x和平板的倾角θ。这是一个典型的倒立摆的变体但摆的“摆杆”变成了在斜面上滚动的小球。状态变量可以选取为[x, x_dot, θ, θ_dot]小球位置、小球速度、平板角度、平板角速度。4.2 控制算法串级PID这是最实用且有效的算法。采用内外双环结构外环位置环输入小球目标位置x_ref(通常为0即平板中心) 与小球实际位置x的误差e_x。输出平板的目标角度θ_ref。逻辑如果小球偏右就希望平板稍微向左倾斜让小球滚回来。所以θ_ref PID_x(e_x)。内环角度环输入外环输出的目标角度θ_ref与MPU6050测量的实际角度θ的误差e_θ。输出执行器的控制量u(如PWM占空比)。逻辑快速跟踪角度指令。u PID_θ(e_θ)。// 伪代码示例 float x_error target_position - current_ball_position; float angle_target pid_position.update(x_error); // 外环PID计算 float angle_error angle_target - mpu6050_angle; float pwm_output pid_angle.update(angle_error); // 内环PID计算 set_pwm_duty_cycle(pwm_output); // 输出到执行器驱动4.3 参数整定步骤先内后外首先将小球固定或拿掉只调试角度环。给定一个阶跃的角度指令调整PID_θ的Kp, Ki, Kd让平板能快速、无超调或微小超调地稳定在目标角度。再调外环加入小球调试位置环。此时PID_θ参数保持不变。调整PID_x的参数让小球能缓慢地回到中心点。PID_x的参数通常比PID_θ小很多尤其是Kp。微调与抗扰手动轻推小球观察系统能否迅速恢复平衡。可能需要微调Kd来抑制振荡或调整Ki来消除静差。5. 软件实现与调试流程5.1 开发环境搭建以STM32为例使用STM32CubeMX初始化代码配合Keil或STM32CubeIDE进行开发。初始化系统时钟、调试接口如SWD。配置I2C用于MPU6050和可能的激光测距。配置ADC用于读取红外接收管电压。配置定时器产生PWM波用于驱动执行器。配置一个高优先级定时器中断作为控制周期如1ms或2ms。5.2 核心代码模块// main.c 主循环示例 int main(void) { // 硬件初始化 HAL_Init(); SystemClock_Config(); MX_GPIO_Init(); MX_I2C1_Init(); MX_ADC1_Init(); MX_TIM1_PWM_Init(); // PWM定时器 MX_TIM2_Init(); // 控制周期定时器开启中断 // 传感器初始化 MPU6050_Init(); Infrared_Array_Init(); // PID控制器初始化 PID_Init(pid_position, 0.5, 0.01, 0.05); // 外环参数需调试 PID_Init(pid_angle, 3.0, 0.1, 0.2); // 内环参数需调试 // 开启控制周期定时器中断 HAL_TIM_Base_Start_IT(htim2); while (1) { // 主循环处理非实时任务如状态显示、参数接收串口 printf_Status_Info(); UART_Command_Parser(); // 控制算法在定时器中断中执行 } } // 定时器中断服务函数 (控制周期如1ms) void TIM2_IRQHandler(void) { if (__HAL_TIM_GET_FLAG(htim2, TIM_FLAG_UPDATE) ! RESET) { __HAL_TIM_CLEAR_FLAG(htim2, TIM_FLAG_UPDATE); // 1. 读取传感器数据 ball_position Read_Infrared_Position(); // 获取小球位置 mpu6050_angle Read_MPU6050_Angle(); // 获取平板角度 // 2. 执行串级PID控制 float pos_error 0 - ball_position; // 目标位置为0中心 float angle_target PID_Calculate(pid_position, pos_error); float angle_error angle_target - mpu6050_angle; float pwm_output PID_Calculate(pid_angle, angle_error); // 3. 输出限幅并驱动执行器 pwm_output LIMIT(pwm_output, -100.0, 100.0); // 限制在±100% Set_Actuator_PWM(pwm_output); } }5.3 调试与验证步骤单元测试单独测试MPU6050通过串口打印角度值晃动平板看数据是否正常变化。单独测试红外对管阵列用小球遮挡通过串口或LED观察哪个通道被触发。单独测试执行器驱动给固定的PWM观察平板是否按预期动作。开环测试不运行控制算法手动给一个小的固定PWM观察平板缓慢倾斜小球随之滚动。验证机械结构和传感器读数方向是否正确例如正PWM是否对应使小球向右滚动的倾斜方向。闭环调试无小球只运行角度环PID。通过串口发送目标角度指令观察平板能否快速稳定。用示波器或打印数据观察响应曲线整定PID_θ参数。闭环调试加入小球运行完整的串级PID。将小球放在平板上观察系统能否稳住。从非常小的PID_x参数开始逐步增加直到小球能在中心点附近稳定。性能测试稳态误差系统稳定后小球距离中心点的最大偏移量。抗扰动用小棍轻敲小球记录系统恢复到平衡的时间。动态跟踪缓慢移动目标位置观察小球能否跟随。6. 常见问题与排查方法问题现象可能原因排查方式解决方案系统上电后剧烈振荡甚至失控1. 传感器数据极性接反2. PID参数过大特别是Kp3. 执行器输出方向错误1. 检查MPU6050角度正方向与平板倾斜方向是否定义一致2. 先调角度环将Kp, Ki, Kd全部设为0然后非常缓慢地增加Kp3. 进行开环测试验证PWM正负与平板运动方向的关系1. 在代码中乘以-1校正传感器或执行器方向2. 遵循“先内后外参数从零微增”的原则3. 确保控制量与物理效应对应小球总是向一边跑无法停在中心1. 平板物理不水平零点漂移2. 红外对管检测中心点未校准3. PID中Ki过小或为0存在静差1. 系统上电静止时读取MPU6050角度将其作为零点偏移量减去2. 测量小球在中心时各红外对管的ADC值确定中心阈值3. 适当增加位置环的Ki1. 软件补偿零点漂移2. 校准传感器中心点3. 引入积分项消除静差响应迟钝小球滚动缓慢1. 控制周期太长2. PID的Kp值太小3. 执行器推力不足或响应慢1. 检查定时器中断周期是否设置正确建议1-5ms2. 在系统稳定的前提下逐步增大Kp3. 检查执行器驱动电压电流是否达标1. 缩短控制周期2. 增大比例增益3. 更换或加强执行器及驱动环境光干扰导致红外定位不准红外对管受日光灯、自然光影响在暗环境下测试或用手遮挡环境光测试1. 为红外对管增加物理遮光罩2. 改用调制解调电路发射管发射特定频率红外光接收管只解调该频率3. 换用激光测距方案电磁铁发热严重1. 驱动电路持续导通2. PWM频率过低1. 检查代码确保无输出时PWM占空比为02. 用示波器测量PWM波形1. 确保控制逻辑正确2. 提高PWM频率如20kHz以上避免低频导致电磁铁线圈电感续流发热7. 优化与进阶方向当基本功能实现后可以从以下方面进行优化以应对更高要求或提升性能传感器融合MPU6050的陀螺仪数据角速度和加速度计数据角度可以通过互补滤波或卡尔曼滤波进行融合得到更准确、延迟更低的倾角估计这对提高系统稳定性至关重要。先进控制算法在PID基础上可以尝试模糊PID、滑模控制或线性二次型调节器LQR。LQR需要系统的精确数学模型但一旦建立控制效果和鲁棒性往往优于PID。执行器线性化电磁铁的吸力与电流并非严格线性且存在剩磁。可以事先标定电流-力曲线在控制算法中进行查表补偿使控制更精确。状态观测器小球的速度x_dot不易直接测量。可以通过小球位置x和平板角度θ、角速度θ_dot利用观测器如龙伯格观测器来估计从而实现全状态反馈提升性能。抗积分饱和当误差持续较大时如小球被拿开积分项会累积到很大值导致系统恢复时超调严重。需在PID实现中加入抗积分饱和逻辑。8. 总结这套“无视觉无电机”的平衡小球方案其精髓在于化繁为简。它跳出了“摄像头电机”的思维定式用更直接的传感器和执行器构建了一条更短、更快的控制回路。对于电赛这类强调创新和实效的竞赛这种思路本身就是一个巨大的亮点。实现过程的关键在于硬件可靠性和参数调试耐心。从红外对管的遮光处理到电磁铁驱动电路的设计再到PID参数从零开始的摸索每一步都需要细致的验证。建议在开发时务必做好模块化测试确保每个子单元工作正常后再进行联调。最后这个项目不仅仅是为了解决一道赛题。它是对经典控制理论一次绝佳的实践涵盖了系统建模、传感器应用、执行器驱动、实时控制算法等多个核心知识点。成功实现它你对反馈控制的理解将会上升一个实实在在的台阶。建议收藏本文在动手实践中反复查阅。
