STM32与MPU6050实现低成本智能角度检测系统

1. 项目概述与核心功能解析

这个基于STM32的智能角度检测系统，是我在工业设备状态监测项目中实际应用过的一个成熟方案。整套硬件成本控制在50元以内，却能实现专业级的角度监测报警功能。核心部件STM32F103C8T6作为性价比之王，配合MPU6050这个六轴传感器（三轴加速度+三轴陀螺仪），构成了系统的"大脑"和"前庭系统"。

关键提示：MPU6050左侧的AD0引脚必须短接才能正常通信，这是新手最容易忽略的硬件细节

系统运行时，单片机通过I2C接口以400kHz的速率持续读取MPU6050的原始数据。这些16位的数字量需要经过一系列处理：

1. 原始数据校准（消除零偏）
2. 坐标系转换（传感器坐标系到世界坐标系）
3. 互补滤波算法融合加速度计和陀螺仪数据
4. 四元数解算得到欧拉角

最终得到的X/Y/Z三轴角度值，会同时显示在LCD1602液晶屏和手机蓝牙APP上。当任何一轴角度超过预设阈值时，蜂鸣器立即触发声光报警。所有阈值参数都存储在STM32的Flash存储器中，断电后也不会丢失。

2. 硬件设计关键细节

2.1 核心器件选型分析

STM32F103C8T6最小系统板：

• 选用理由：72MHz主频的Cortex-M3内核，内置64KB Flash和20KB RAM，完全满足数据处理需求
• 关键配置：启用内部8MHz RC振荡器，通过PLL倍频到72MHz工作频率
• 成本优势：相比Arduino方案，性能提升3倍而价格降低40%

MPU6050模块：

• 工作电压：3.3V（注意与STM32电平匹配）
• 通信接口：I2C标准模式（100kHz）或快速模式（400kHz）
• 量程配置：
  • 加速度计：±2g/±4g/±8g/±16g（建议选择±8g）
  • 陀螺仪：±250°/s至±2000°/s（建议选择±1000°/s）

LCD1602显示屏：

• 采用4位数据线接法（DB4-DB7）节省IO口
• 对比度调节：通过10KΩ电位器调整V0引脚电压
• 背光控制：串联100Ω限流电阻保护LED

2.2 电路设计注意事项

1. 电源设计：

   • 建议使用AMS1117-3.3稳压芯片
   • 每个IC的VCC引脚附近放置0.1μF去耦电容
   • 总电流需求：约150mA（含蓝牙模块峰值电流）

2. I2C总线布局：

   • SCL和SDA线需接4.7KΩ上拉电阻
   • 走线尽量短，避免与高频信号线平行
   • 建议使用双绞线降低干扰

3. 蜂鸣器驱动电路：

   • 有源蜂鸣器需配合NPN三极管驱动（如S8050）
   • 基极串联1KΩ电阻保护IO口
   • 反向并联1N4148二极管消除反电动势

3. 软件实现深度解析

3.1 MPU6050数据采集流程

c复制// 初始化I2C接口
void I2C_Init() {
    GPIO_InitTypeDef GPIO_InitStructure;
    I2C_InitTypeDef I2C_InitStructure;
    
    RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);
    RCC_APB1PeriphClockCmd(RCC_APB1Periph_I2C1, ENABLE);
    
    // PB6-SCL, PB7-SDA
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_OD;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_Init(GPIOB, &GPIO_InitStructure);
    
    I2C_InitStructure.I2C_Mode = I2C_Mode_I2C;
    I2C_InitStructure.I2C_DutyCycle = I2C_DutyCycle_2;
    I2C_InitStructure.I2C_OwnAddress1 = 0xA0;
    I2C_InitStructure.I2C_Ack = I2C_Ack_Enable;
    I2C_InitStructure.I2C_AcknowledgedAddress = I2C_AcknowledgedAddress_7bit;
    I2C_InitStructure.I2C_ClockSpeed = 400000;
    I2C_Init(I2C1, &I2C_InitStructure);
    
    I2C_Cmd(I2C1, ENABLE);
}

3.2 卡尔曼滤波算法实现

c复制typedef struct {
    float Q_angle; // 过程噪声协方差
    float Q_bias;  // 陀螺仪偏差噪声协方差
    float R_measure; // 测量噪声协方差
    
    float angle;  // 计算得到的最优角度
    float bias;   // 陀螺仪偏差
    float P[2][2]; // 误差协方差矩阵
} Kalman_t;

float Kalman_getAngle(Kalman_t *kalman, float newAngle, float newRate, float dt) {
    // 预测阶段
    kalman->angle += dt * (newRate - kalman->bias);
    kalman->P[0][0] += dt * (dt * kalman->P[1][1] - kalman->P[0][1] - kalman->P[1][0] + kalman->Q_angle);
    kalman->P[0][1] -= dt * kalman->P[1][1];
    kalman->P[1][0] -= dt * kalman->P[1][1];
    kalman->P[1][1] += kalman->Q_bias * dt;
    
    // 更新阶段
    float S = kalman->P[0][0] + kalman->R_measure;
    float K[2];
    K[0] = kalman->P[0][0] / S;
    K[1] = kalman->P[1][0] / S;
    
    float y = newAngle - kalman->angle;
    kalman->angle += K[0] * y;
    kalman->bias += K[1] * y;
    
    float P00_temp = kalman->P[0][0];
    float P01_temp = kalman->P[0][1];
    
    kalman->P[0][0] -= K[0] * P00_temp;
    kalman->P[0][1] -= K[0] * P01_temp;
    kalman->P[1][0] -= K[1] * P00_temp;
    kalman->P[1][1] -= K[1] * P01_temp;
    
    return kalman->angle;
}

3.3 蓝牙数据传输协议设计

采用自定义的轻量级协议框架：

典型数据包示例（角度数据）：

code复制AA 55 06 58 00 59 00 5A 00 3C

解析：

• X轴角度：0x0058 → 88°
• Y轴角度：0x0059 → 89°
• Z轴角度：0x005A → 90°
• 校验和：0x3C = ~(0xAA+0x55+0x06+0x58+0x00+0x59+0x00+0x5A+0x00)

4. 系统调试与性能优化

4.1 传感器校准实战

MPU6050必须进行以下校准步骤才能获得准确数据：

1. 静态校准（消除零偏）：

   • 将模块水平静止放置
   • 连续采样100次取平均值
   • 加速度计理想值：Z轴≈1g，X/Y轴≈0
   • 陀螺仪各轴理想值：≈0

2. 动态校准（比例系数校准）：

   c复制// 加速度计校准代码示例
   void accelCalibration() {
       int16_t accelSum[3] = {0};
       for(int i=0; i<100; i++) {
           MPU6050_ReadAccel(&ax, &ay, &az);
           accelSum[0] += ax;
           accelSum[1] += ay;
           accelSum[2] += az;
           delay(10);
       }
       accelOffset[0] = accelSum[0]/100;
       accelOffset[1] = accelSum[1]/100; 
       accelOffset[2] = accelSum[2]/100 - 16384; // 减去1g(16384 LSB/g)
   }
   

4.2 系统响应时间测试

通过逻辑分析仪实测各环节耗时：

实测整个处理周期约5.5ms，对应180Hz的更新率，完全满足大多数工业场景需求。

5. 典型问题排查指南

5.1 常见故障现象与解决方案

5.2 阈值设置功能的实现技巧

c复制// 在Flash的最后一页存储阈值参数
#define PARAM_ADDR 0x0801F800

void saveThresholds() {
    FLASH_Unlock();
    FLASH_ErasePage(PARAM_ADDR);
    
    uint16_t data[3] = {xThreshold, yThreshold, zThreshold};
    for(int i=0; i<3; i++) {
        FLASH_ProgramHalfWord(PARAM_ADDR + i*2, data[i]);
    }
    
    FLASH_Lock();
}

void loadThresholds() {
    xThreshold = *(__IO uint16_t*)(PARAM_ADDR);
    yThreshold = *(__IO uint16_t*)(PARAM_ADDR + 2);
    zThreshold = *(__IO uint16_t*)(PARAM_ADDR + 4);
    
    // 首次上电检测
    if(xThreshold == 0xFFFF) xThreshold = 30; // 默认值
    if(yThreshold == 0xFFFF) yThreshold = 30;
    if(zThreshold == 0xFFFF) zThreshold = 30;
}

重要提示：Flash写入前必须先擦除整个页（1KB），且每个地址最多只能写入10万次。频繁保存时应先判断数值是否变化。