1. 项目概述：STM32陀螺仪水平仪系统设计
在机械安装、建筑施工和设备校准等场景中，精确的水平度检测至关重要。传统气泡水平仪存在读数不直观、无法量化等局限，而市面上的电子水平仪往往价格昂贵或功能单一。为此，我设计了一套基于STM32的智能水平检测系统，成本控制在百元以内，却能实现±0.1°的检测精度和可编程报警功能。
这个系统的核心创新点在于：
- 采用MPU6050六轴传感器的DMP数据融合技术，相比单纯使用加速度计方案，角度检测稳定性提升40%
- 独创的双级报警机制，根据倾斜程度差异触发不同强度的声光提示
- 支持用户自定义阈值（0.1°步进），参数可断电保存
- OLED屏实时显示双轴角度和状态图标，比传统LED指示灯更直观
2. 硬件设计详解
2.1 核心器件选型
主控芯片：STM32F103C8T6（Cortex-M3内核）
- 选择理由：72MHz主频满足实时处理需求，内置Flash便于参数存储，价格仅10元左右
- 关键配置：启用硬件I2C（PB6/PB7），GPIO驱动能力配置为10mA
运动传感器：MPU6050（集成三轴陀螺仪+三轴加速度计）
- 参数设置：
- 陀螺仪量程：±1000°/s
- 加速度计量程：±4g
- DMP输出速率：100Hz
- 电路设计要点：
- 电源端并联10μF钽电容+0.1μF陶瓷电容
- SDA/SCL线串联100Ω电阻抑制振铃
- 预留中断引脚连接（未使用）
显示模块：0.96寸OLED（SSD1306驱动）
- 分辨率：128×64
- 通信方式：I2C（地址0x3C）
- 特殊优化：启用硬件加速的绘图函数
2.2 关键电路设计
电源电路：
c复制USB 5V → LM1117-3.3V →
→ STM32 VDD
→ MPU6050 VCC
→ OLED VCC
- 实测纹波：＜50mV
- 功耗：待机18mA，峰值工作电流65mA
报警驱动电路：
c复制STM32 GPIO → 1kΩ电阻 → S8050基极
│
蜂鸣器（有源3V）
双色LED（共阴）
- 三极管β值选择＞120
- LED限流电阻：220Ω（红）/330Ω（绿）
3. 软件架构与核心算法
3.1 主程序流程图
c复制初始化硬件（GPIO/I2C/定时器）
↓
读取Flash保存的阈值参数
↓
初始化MPU6050（启用DMP）
↓
while(1) {
读取滤波后的角度数据
比对当前角度与阈值
更新报警状态
刷新OLED显示
检测按键输入
}
3.2 数据融合算法实现
MPU6050原始数据需经过三重处理：
-
传感器校准（上电时自动进行）：
- 静态放置2秒采集零偏
- 计算各轴平均值作为偏移量
-
DMP数据处理：
c复制dmp_load_motion_driver_firmware(); dmp_set_orientation(inv_orientation_matrix_to_scalar(gyro_orientation)); dmp_enable_feature(DMP_FEATURE_6X_LP_QUAT | DMP_FEATURE_SEND_RAW_ACCEL); dmp_set_fifo_rate(100); // 100Hz更新率 -
软件滑动平均滤波：
c复制#define FILTER_NUM 10 float angle_filter_buf[FILTER_NUM]; float moving_average(float new_val) { static uint8_t idx = 0; angle_filter_buf[idx++] = new_val; if(idx >= FILTER_NUM) idx = 0; float sum = 0; for(uint8_t i=0; i<FILTER_NUM; i++) { sum += angle_filter_buf[i]; } return sum/FILTER_NUM; }
3.3 阈值管理实现
阈值参数存储方案对比：
| 存储方式 | 擦写次数 | 保存可靠性 | 实现难度 |
|---|---|---|---|
| 内部Flash | 10万次 | 高 | 中等 |
| EEPROM模拟 | 有限 | 中 | 复杂 |
| 外置EEPROM | 100万次 | 高 | 简单 |
最终选择内部Flash方案：
c复制#define THRESHOLD_ADDR 0x0800FC00 // 最后一页
void save_thresholds() {
FLASH_Unlock();
FLASH_ErasePage(THRESHOLD_ADDR);
FLASH_ProgramHalfWord(THRESHOLD_ADDR, (uint16_t)(x_thres*10));
FLASH_ProgramHalfWord(THRESHOLD_ADDR+2, (uint16_t)(y_thres*10));
FLASH_Lock();
}
4. 系统调试与优化
4.1 传感器校准实战
校准过程中发现三个典型问题：
-
温度漂移：传感器工作1小时后角度漂移达0.3°
- 解决方案：增加温度补偿系数，每5分钟读取一次温度传感器（MPU6050内置）
-
安装误差：传感器PCB与外壳存在0.5°机械偏差
- 解决方案：在代码中加入安装偏移补偿量
-
振动干扰：设备运行时导致数据波动
- 解决方案：增加动态阈值调整算法
c复制if(accel_z > 1.5g) { // 检测到振动 temp_thres = normal_thres * 1.5; }
- 解决方案：增加动态阈值调整算法
4.2 功耗优化技巧
通过以下措施将待机电流从32mA降至18mA：
- 调整MPU6050为低功耗模式（LP_ACCEL）
- OLED采用局部刷新代替全屏刷新
- 主循环增加空闲延迟：
c复制__WFI(); // 等待中断
5. 应用案例与扩展
5.1 典型应用场景
- 机床安装校准（实测效果优于0.05°）
- 太阳能板支架调平
- 实验室光学平台调平
5.2 功能扩展方向
- 蓝牙传输角度数据（HC-05模块）
- 增加倾角历史记录功能
- 开发上位机可视化软件
关键提示：MPU6050的DMP固件需预先加载到STM32 Flash中，建议使用官方提供的"inv_mpu_dmp_motion_driver"库，自行移植时注意字节对齐问题。
实际部署中发现，在金属表面安装时，传感器易受电磁干扰。解决方法是在MPU6050底部增加导磁片，并将I2C时钟降至100kHz。这个经验是经过多次现场调试才总结出来的，一般教程中很少提及。