STM32实战：MPU6050姿态数据采集与OLED显示

1. 从零搭建MPU6050姿态监测系统

第一次接触MPU6050传感器时，我完全被它小巧的体积和强大的功能震撼到了。这个只有指甲盖大小的芯片，居然能同时测量六个维度的运动数据。记得当时为了做一个自平衡小车，我花了整整三天时间才让传感器正确输出数据。现在回头看，其实只要掌握几个关键点，任何人都能在半小时内完成基础数据采集。

MPU6050的核心价值在于它集成了三轴加速度计和三轴陀螺仪。加速度计测量的是线性运动，比如手机突然下坠时的失重感；陀螺仪则感知旋转动作，就像我们转动方向盘时的角度变化。两者结合后，就能完整描述物体在三维空间中的运动状态。实际应用中，这种传感器常被用于无人机姿态控制、VR手柄动作追踪、甚至智能手机的屏幕旋转功能。

2. 硬件连接与电路设计

2.1 元器件选型要点

在开始焊接电路前，我们需要准备以下核心部件：

• STM32F103C8T6最小系统板（蓝色药丸板性价比最高）
• MPU6050模块（建议选择带电平转换的5V兼容版本）
• 0.96寸OLED显示屏（SSD1306驱动芯片的I2C接口款）
• 杜邦线若干（建议使用不同颜色区分功能）

特别提醒：市场上有些劣质MPU6050模块存在供电不稳的问题。我曾在某宝买到过一批传感器，工作时数据会随机跳变，后来发现是板载稳压芯片偷工减料。建议选择带有AMS1117稳压芯片的模块，虽然贵两三块钱，但稳定性绝对值得。

2.2 接线方案详解

具体接线时需要特别注意I2C总线的拓扑结构。以下是经过实测的稳定连接方案：

这里有个容易踩的坑：上拉电阻不能省略！我刚开始调试时发现通信时好时坏，后来用示波器查看波形，发现上升沿不够陡峭。加上4.7K上拉电阻后，信号质量立即改善。如果手头没有贴片电阻，也可以用开发板自带的排阻。

3. 软件I2C驱动实现

3.1 时序模拟关键技巧

硬件I2C虽然方便，但在某些STM32型号上存在兼容性问题。软件模拟I2C虽然速度稍慢，但胜在稳定可控。下面是我优化过的GPIO操作函数：

c复制void I2C_Delay(void) {
    for(uint8_t i=0; i<10; i++); // 约5us延时
}

void I2C_Start(void) {
    SDA_HIGH();
    SCL_HIGH();
    I2C_Delay();
    SDA_LOW();
    I2C_Delay();
    SCL_LOW();
}

这个延时方案经过实测，在72MHz主频下工作稳定。有个细节值得注意：在SCL高电平期间，SDA信号必须保持稳定。这就是为什么我们要先拉高SDA再操作SCL。如果顺序反了，某些敏感的从设备会误判为重复起始条件。

3.2 错误处理机制

完善的I2C驱动应该包含超时检测：

c复制uint8_t I2C_WaitAck(void) {
    uint16_t timeout = 1000;
    SDA_INPUT();
    SCL_HIGH();
    while(READ_SDA()) {
        if(--timeout == 0) {
            SCL_LOW();
            return 1; // 超时错误
        }
        Delay_us(1);
    }
    SCL_LOW();
    return 0; // 正常应答
}

这个机制帮我省去了很多调试时间。有次传感器接触不良，如果没有超时返回，整个程序就会卡死。建议在每次I2C操作后都检查返回值，这样出现问题能快速定位。

4. MPU6050寄存器配置

4.1 关键寄存器详解

传感器初始化时需要配置几个核心寄存器：

量程选择需要根据应用场景决定。做平衡车时我用±8g和±1000°/s，既能保证精度又不会轻易超量程。但如果是监测剧烈运动，就需要更大的量程范围。

4.2 数据读取优化

原始数据读取函数可以这样优化：

c复制void MPU6050_ReadBytes(uint8_t regAddr, uint8_t *data, uint8_t len) {
    I2C_Start();
    I2C_SendByte(MPU6050_ADDR_W);
    I2C_WaitAck();
    I2C_SendByte(regAddr);
    I2C_WaitAck();
    
    I2C_Start();
    I2C_SendByte(MPU6050_ADDR_R);
    I2C_WaitAck();
    
    while(len--) {
        *data++ = I2C_ReadByte();
        I2C_SendAck(len ? 0 : 1); // 最后一个字节发送NACK
    }
    I2C_Stop();
}

这种连续读取方式比单字节读取效率高得多。实测读取全部6轴数据只需0.3ms，而逐字节读取需要1.2ms。对于需要高频采样的应用，这个优化非常关键。

5. OLED动态显示实现

5.1 数据显示布局设计

在0.96寸OLED上合理布局6轴数据需要技巧。我的方案是：

• 第1行：显示设备ID和帧率
• 第2-4行：左侧显示加速度计XYZ，右侧显示陀螺仪XYZ
• 底部留空：后期可添加波形预览

具体实现时要注意数值对齐：

c复制void Show_SensorData(void) {
    OLED_ShowString(2,1,"A:");
    OLED_ShowSignedNum(2,3,accel[0],5);
    OLED_ShowString(2,9,"G:");
    OLED_ShowSignedNum(2,11,gyro[0],5);
    // 其他轴类似...
}

5.2 帧率优化技巧

默认的OLED刷新会有点闪烁，可以通过这些方法优化：

1. 使用局部刷新代替全屏刷新
2. 建立显示缓冲区，数据变化时才更新
3. 合理设置刷新间隔（20-30Hz足够）

这是我用的帧率控制代码：

c复制uint32_t last_refresh = 0;
void Refresh_OLED(void) {
    if(HAL_GetTick() - last_refresh > 50) { // 20Hz刷新
        OLED_Refresh();
        last_refresh = HAL_GetTick();
    }
}

6. 数据校准与滤波

6.1 自动零偏校准

传感器静止时的输出不一定是零，需要校准：

c复制void Calibrate_MPU6050(void) {
    int32_t acc_sum[3] = {0};
    int32_t gyro_sum[3] = {0};
    
    for(uint16_t i=0; i<1000; i++) {
        MPU6050_ReadRawData();
        for(uint8_t j=0; j<3; j++) {
            acc_sum[j] += accel[j];
            gyro_sum[j] += gyro[j];
        }
        Delay_ms(1);
    }
    
    for(uint8_t j=0; j<3; j++) {
        acc_offset[j] = acc_sum[j]/1000;
        gyro_offset[j] = gyro_sum[j]/1000;
    }
}

校准时要确保传感器保持水平静止。我通常把模块放在平整的桌面上，校准后再用双面胶固定。

6.2 软件滤波方案

原始数据会有高频噪声，简单的移动平均滤波就很有效：

c复制#define FILTER_SIZE 5
int16_t acc_filter[3][FILTER_SIZE];
uint8_t filter_index = 0;

void Filter_Data(void) {
    for(uint8_t i=0; i<3; i++) {
        acc_filter[i][filter_index] = accel[i];
        int32_t sum = 0;
        for(uint8_t j=0; j<FILTER_SIZE; j++) {
            sum += acc_filter[i][j];
        }
        accel[i] = sum / FILTER_SIZE;
    }
    filter_index = (filter_index + 1) % FILTER_SIZE;
}

对于要求更高的场景，可以尝试卡尔曼滤波。不过在实际项目中我发现，对于大多数应用，5点的移动平均加上适当的死区处理已经完全够用。

7. 进阶应用示例

7.1 简易姿态估计

通过加速度计可以估算倾角：

c复制void Calculate_Angle(void) {
    float roll = atan2(accel[1], accel[2]) * 180/PI;
    float pitch = atan2(-accel[0], sqrt(accel[1]*accel[1] + accel[2]*accel[2])) * 180/PI;
    
    OLED_ShowString(4,1,"Roll:");
    OLED_ShowNum(4,6,(int16_t)roll,3);
    OLED_ShowString(4,11,"Pitch:");
    OLED_ShowNum(4,17,(int16_t)pitch,3);
}

这个方法简单但存在动态误差。当物体运动时，加速度计测量的不只是重力分量，这时就需要结合陀螺仪数据进行互补滤波。

7.2 运动触发唤醒

利用加速度计实现低功耗唤醒：

c复制if(abs(accel[0])>1500 || abs(accel[1])>1500 || abs(accel[2])>1500) {
    // 触发唤醒事件
    LED_ON();
    Delay_ms(500);
    LED_OFF();
}

这个功能在可穿戴设备中很实用。我曾经用这个方案做过一个智能手环，静止时自动进入休眠，抬手亮屏时功耗只有正常工作时的1/10。