STM32F103C8T6 MPU6050 TB6612从零构建两轮平衡小车的工程实践平衡小车一直是嵌入式开发者入门的经典项目它不仅融合了传感器技术、控制算法和机电一体化设计还能让你在实践中深入理解PID控制等核心概念。今天我们就来拆解一个基于STM32F103C8T6的两轮平衡小车完整实现方案从硬件选型到软件调参手把手带你完成这个有趣的项目。1. 硬件架构设计与选型指南1.1 核心控制器STM32F103C8T6最小系统这款被称为蓝色药丸的开发板是平衡小车的理想选择。72MHz主频的Cortex-M3内核足以处理实时控制任务64KB的Flash和20KB的SRAM也足够存放我们的控制程序。实际使用中需要注意几个关键点时钟配置建议使用外部8MHz晶振通过PLL倍频到72MHzGPIO分配提前规划好各外设的引脚分配避免冲突调试接口务必保留SWD接口方便在线调试// 典型的时钟配置代码使用HAL库 void SystemClock_Config(void) { RCC_OscInitTypeDef RCC_OscInitStruct {0}; RCC_ClkInitTypeDef RCC_ClkInitStruct {0}; // 配置HSE振荡器 RCC_OscInitStruct.OscillatorType RCC_OSCILLATORTYPE_HSE; RCC_OscInitStruct.HSEState RCC_HSE_ON; RCC_OscInitStruct.PLL.PLLState RCC_PLL_ON; RCC_OscInitStruct.PLL.PLLSource RCC_PLLSOURCE_HSE; RCC_OscInitStruct.PLL.PLLMUL RCC_PLL_MUL9; HAL_RCC_OscConfig(RCC_OscInitStruct); // 配置时钟树 RCC_ClkInitStruct.ClockType RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2; RCC_ClkInitStruct.SYSCLKSource RCC_SYSCLKSOURCE_PLLCLK; RCC_ClkInitStruct.AHBCLKDivider RCC_SYSCLK_DIV1; RCC_ClkInitStruct.APB1CLKDivider RCC_HCLK_DIV2; RCC_ClkInitStruct.APB2CLKDivider RCC_HCLK_DIV1; HAL_RCC_ClockConfig(RCC_ClkInitStruct, FLASH_LATENCY_2); }1.2 姿态传感器MPU6050的实战应用MPU6050集成了3轴加速度计和3轴陀螺仪是获取小车姿态的核心传感器。实际使用中常见以下问题问题现象可能原因解决方案数据跳动大电源噪声增加0.1μF去耦电容I2C通信失败上拉电阻不足SCL/SDA加4.7k上拉角度漂移未校准执行传感器校准程序提示MPU6050的INT引脚可以配置为数据就绪中断避免轮询方式带来的延迟。1.3 电机驱动TB6612FNG的合理使用相比传统的L298NTB6612FNG具有更高的效率和更小的体积。关键参数配置PWM频率建议8-10kHz人耳听不到死区时间2-3μs防止上下桥臂直通电流限制通过硬件设计限制最大电流// 电机PWM初始化示例 void Motor_PWM_Init(TIM_HandleTypeDef *htim, uint32_t Channel) { TIM_OC_InitTypeDef sConfigOC {0}; htim-Instance-ARR 999; // 10kHz PWM 72MHz sConfigOC.OCMode TIM_OCMODE_PWM1; sConfigOC.Pulse 0; // 初始占空比0 sConfigOC.OCPolarity TIM_OCPOLARITY_HIGH; sConfigOC.OCFastMode TIM_OCFAST_DISABLE; HAL_TIM_PWM_ConfigChannel(htim, sConfigOC, Channel); HAL_TIM_PWM_Start(htim, Channel); }2. 机械结构设计与装配要点2.1 底盘设计与重心计算平衡小车的机械结构直接影响到控制效果。我们选用12cm直径的亚克力板作为底盘两个N20电机对称安装轴距10cm。重心位置的计算至关重要重心高度h (电机质量×电机高度 电池质量×电池高度) / 总质量理想情况下重心应该略高于轮轴约1-2cm这样既有足够的恢复力矩又不会导致系统过于敏感。2.2 电机选型与传动方案N20减速电机参数对比型号电压空载转速减速比扭矩适用性6V6V10000rpm1:1000.3kg·cm适合轻载12V12V15000rpm1:1500.5kg·cm平衡性佳实际装配时要注意使用联轴器确保电机与轮轴同心轮胎选择65mm直径的橡胶轮增加摩擦力电机固定要牢固避免振动3. 软件架构与核心算法实现3.1 姿态解算从原始数据到可靠角度MPU6050输出的原始数据需要经过处理才能得到可用的姿态信息。我们采用卡尔曼滤波融合加速度计和陀螺仪数据加速度计提供长期稳定的角度参考陀螺仪提供短期精确的角度变化卡尔曼滤波动态调整两者的权重// 简化的卡尔曼滤波实现 typedef struct { float Q_angle; // 过程噪声协方差 float Q_gyro; // 陀螺仪噪声协方差 float R_angle; // 测量噪声协方差 float angle; // 最优估计角度 float bias; // 陀螺仪零偏 float P[2][2]; // 误差协方差矩阵 } KalmanFilter; float Kalman_Update(KalmanFilter *kf, float newAngle, float newRate, float dt) { // 预测步骤 kf-angle dt * (newRate - kf-bias); kf-P[0][0] dt * (dt*kf-P[1][1] - kf-P[0][1] - kf-P[1][0] kf-Q_angle); kf-P[0][1] - dt * kf-P[1][1]; kf-P[1][0] - dt * kf-P[1][1]; kf-P[1][1] kf-Q_gyro * dt; // 更新步骤 float S kf-P[0][0] kf-R_angle; float K[2]; K[0] kf-P[0][0] / S; K[1] kf-P[1][0] / S; float y newAngle - kf-angle; kf-angle K[0] * y; kf-bias K[1] * y; float P00_temp kf-P[0][0]; float P01_temp kf-P[0][1]; kf-P[0][0] - K[0] * P00_temp; kf-P[0][1] - K[0] * P01_temp; kf-P[1][0] - K[1] * P00_temp; kf-P[1][1] - K[1] * P01_temp; return kf-angle; }3.2 三环PID控制器的实现平衡小车采用三环PID控制架构直立环最内环响应最快保持车身直立速度环中间环调节小车移动速度转向环最外环控制转向动作// PID控制器结构体 typedef struct { float Kp, Ki, Kd; float integral; float prev_error; float output; float max_output; } PIDController; float PID_Update(PIDController *pid, float setpoint, float input, float dt) { float error setpoint - input; pid-integral error * dt; // 积分限幅防止windup if(pid-integral pid-max_output) pid-integral pid-max_output; else if(pid-integral -pid-max_output) pid-integral -pid-max_output; float derivative (error - pid-prev_error) / dt; pid-output pid-Kp * error pid-Ki * pid-integral pid-Kd * derivative; pid-prev_error error; // 输出限幅 if(pid-output pid-max_output) pid-output pid-max_output; else if(pid-output -pid-max_output) pid-output -pid-max_output; return pid-output; }4. 系统调试与性能优化4.1 PID参数整定的实用技巧调参是平衡小车项目中最具挑战性的环节。建议按照以下顺序进行直立环先调Kp从0开始增加直到小车能短暂直立再调Kd抑制振荡使小车稳定最后加少量Ki消除静态偏差速度环Kp从0.1开始确保加减速平稳Ki要非常小0.001级别转向环Kp略大于速度环Kd用于抑制转向过冲注意每次只调整一个参数记录下效果后再尝试下一个参数。4.2 常见问题排查指南调试过程中常见问题及解决方案小车剧烈振荡可能原因Kp过大或Kd过小解决方案降低Kp或增加Kd小车缓慢倒下可能原因Kp不足或重心过低解决方案增加Kp或调整重心电机发热严重可能原因PWM频率过低或死区时间不足解决方案提高PWM频率至10kHz增加死区时间4.3 电源管理与低功耗优化平衡小车的电源系统需要特别注意电源分层电机驱动使用电池直接供电控制电路通过稳压芯片供电去耦电容布置每个芯片的电源引脚附近放置0.1μF陶瓷电容电源入口放置100μF电解电容低功耗模式空闲时STM32进入睡眠模式降低MPU6050的采样率// 进入低功耗模式示例 void Enter_LowPower_Mode(void) { // 配置唤醒源如外部中断 HAL_PWR_EnableWakeUpPin(PWR_WAKEUP_PIN1); // 进入停止模式 HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI); // 唤醒后重新配置时钟 SystemClock_Config(); }5. 项目扩展与进阶方向完成基础版本后可以考虑以下扩展功能无线遥控通过蓝牙或2.4G模块实现手机控制添加速度设置和模式切换功能环境感知增加超声波模块实现避障添加红外传感器实现循迹数据可视化通过串口发送数据到上位机使用Python matplotlib实时显示姿态曲线# 简单的上位机数据显示示例 import matplotlib.pyplot as plt import serial ser serial.Serial(COM3, 115200) plt.ion() fig, ax plt.subplots() x, y [], [] line, ax.plot(x, y) while True: data ser.readline().decode().strip() if data: angle float(data) x.append(len(x)) y.append(angle) line.set_data(x, y) ax.relim() ax.autoscale_view() plt.pause(0.01)实际项目中我发现最影响稳定性的因素是机械结构的刚性。使用3D打印件固定电机时如果结构不够坚固微小的变形都会导致控制效果大幅下降。经过几次迭代后改用CNC加工的铝制支架稳定性明显提升。