1. 项目概述与核心组件选型
两轮自平衡小车是嵌入式系统开发的经典练手项目,它完美融合了传感器数据采集、实时控制算法和嵌入式操作系统三大核心技术。我这次基于STM32F103C8T6最小系统板搭建的平衡小车,主要硬件包括:
- 控制核心:STM32F103C8T6(72MHz主频,20KB RAM)
- 姿态传感器:MPU6050(集成3轴加速度计+3轴陀螺仪)
- 电机驱动:TB6612FNG双路驱动芯片
- 执行机构:JGA25-370直流减速电机(12V/170RPM)
- 人机交互:0.96寸OLED屏+机械按键
选择STM32F1系列主要考虑其性价比和丰富的外设资源,特别是TIM定时器模块可以方便生成PWM波控制电机。FreeRTOS的引入解决了多任务调度问题——姿态解算、PID运算、电机控制等任务需要严格的时间序列控制。实测表明,在72MHz主频下,FreeRTOS的任务切换开销约5μs,完全满足实时性要求。
关键提示:MPU6050的安装位置必须与小车重心轴线严格对齐,哪怕1-2度的安装倾斜都会导致角度解算误差。建议先用3D打印件制作固定支架,再用水平仪校准。
需要模型API调用? 免费领10W Token,多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 传感器数据处理与姿态解算
2.1 MPU6050原始数据采集
通过I2C接口以100Hz频率读取MPU6050的原始数据(加速度计±4g量程,陀螺仪±500°/s量程)。原始数据需要经过以下处理:
c复制// 加速度计数据处理
float accel_x = (int16_t)(raw_data[0] << 8 | raw_data[1]) / 8192.0f;
float accel_z = (int16_t)(raw_data[4] << 8 | raw_data[5]) / 8192.0f;
// 陀螺仪数据处理
float gyro_y = (int16_t)(raw_data[2] << 8 | raw_data[3]) / 65.5f;
2.2 互补滤波算法实现
加速度计通过反正切计算瞬时角度:
c复制float acc_angle = atan2(accel_x, accel_z) * 180/PI;
但车辆运动时加速度计会产生动态误差。陀螺仪积分角度:
c复制gyro_angle += gyro_
