用STM32和MPU6050做个简易姿态仪：从硬件I2C配置到OLED数据显示全流程

STM32与MPU6050实战：打造高精度姿态检测系统

1. 项目概述与硬件准备

姿态检测在现代嵌入式系统中扮演着重要角色，从无人机稳定控制到虚拟现实设备运动追踪都离不开这项基础技术。本项目将使用STM32微控制器搭配MPU6050六轴传感器构建一个完整的姿态检测系统，并通过OLED屏幕实时显示数据变化。

所需硬件清单：

• STM32F103C8T6最小系统板（蓝色药丸开发板）
• MPU6050六轴运动传感器模块（带DMP功能版本更佳）
• 0.96寸OLED显示屏（SSD1306驱动芯片）
• 杜邦线若干（建议使用不同颜色区分功能）
• USB转TTL串口模块（用于程序烧录）

硬件连接示意图如下：

注意：I2C总线需要上拉电阻，大多数模块板载了4.7kΩ上拉电阻。若使用裸MPU6050芯片，需自行添加外部上拉。

2. 开发环境搭建

2.1 工具链配置

推荐使用以下开发工具组合：

• IDE：Keil MDK-ARM（标准外设库版本）或STM32CubeIDE
• 调试器：ST-Link V2或J-Link
• 串口工具：Putty或Tera Term

对于习惯使用开源工具链的开发者，也可以选择：

# 安装ARM工具链（Linux/macOS） brew install arm-none-eabi-gcc # 或者 sudo apt-get install gcc-arm-none-eabi

2.2 工程创建步骤

1. 新建STM32工程，选择对应芯片型号（STM32F103C8）
2. 配置RCC时钟树，设置系统时钟为72MHz
3. 启用I2C1外设（用于MPU6050通信）
4. 配置I2C引脚为复用开漏输出模式
5. 添加必要的驱动文件：
   • stm32f10x_i2c.c
   • stm32f10x_gpio.c
   • stm32f10x_rcc.c

3. 硬件I2C驱动实现

3.1 I2C初始化配置

MPU6050默认I2C地址为0x68（7位地址），通信速率建议设置为400kHz（快速模式）。以下是标准初始化代码：

void I2C_Config(void) { GPIO_InitTypeDef GPIO_InitStructure; I2C_InitTypeDef I2C_InitStructure; // 使能时钟 RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE); RCC_APB1PeriphClockCmd(RCC_APB1Periph_I2C1, ENABLE); // 配置GPIO 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参数配置 I2C_InitStructure.I2C_Mode = I2C_Mode_I2C; I2C_InitStructure.I2C_DutyCycle = I2C_DutyCycle_2; I2C_InitStructure.I2C_OwnAddress1 = 0x00; 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 MPU6050寄存器操作

MPU6050通过寄存器进行配置和数据读取，核心寄存器包括：

寄存器读写函数实现：

void MPU6050_Write_Reg(uint8_t reg, uint8_t data) { // 等待总线空闲 while(I2C_GetFlagStatus(I2C1, I2C_FLAG_BUSY)); // 发送起始条件 I2C_GenerateSTART(I2C1, ENABLE); while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_MODE_SELECT)); // 发送设备地址（写模式） I2C_Send7bitAddress(I2C1, MPU6050_ADDRESS, I2C_Direction_Transmitter); while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_TRANSMITTER_MODE_SELECTED)); // 发送寄存器地址 I2C_SendData(I2C1, reg); while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_BYTE_TRANSMITTING)); // 发送数据 I2C_SendData(I2C1, data); while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_BYTE_TRANSMITTED)); // 发送停止条件 I2C_GenerateSTOP(I2C1, ENABLE); }

4. 传感器数据采集与处理

4.1 MPU6050初始化流程

完整的传感器初始化应包括以下步骤：

1. 唤醒设备（写0到PWR_MGMT_1寄存器）
2. 配置陀螺仪量程（±250/500/1000/2000°/s）
3. 配置加速度计量程（±2/4/8/16g）
4. 设置采样率分频器
5. 配置数字低通滤波器

初始化代码示例：

void MPU6050_Init(void) { // 唤醒MPU6050 MPU6050_Write_Reg(0x6B, 0x00); // 配置加速度计 ±2g MPU6050_Write_Reg(0x1C, 0x00); // 配置陀螺仪 ±250°/s MPU6050_Write_Reg(0x1B, 0x00); // 设置采样率1kHz，DLPF带宽94Hz MPU6050_Write_Reg(0x19, 0x07); MPU6050_Write_Reg(0x1A, 0x02); }

4.2 六轴数据读取

MPU6050的传感器数据以16位有符号整数形式存储，连续读取14个字节可获得全部数据：

void MPU6050_Read_Data(int16_t *accel, int16_t *gyro) { uint8_t buf[14]; // 设置起始寄存器地址 MPU6050_Write_Reg(0x3B, 0x00); // 读取14字节数据 I2C_Read_MultiBytes(MPU6050_ADDRESS, 0x3B, buf, 14); // 解析加速度数据 accel[0] = (buf[0]<<8) | buf[1]; // X轴 accel[1] = (buf[2]<<8) | buf[3]; // Y轴 accel[2] = (buf[4]<<8) | buf[5]; // Z轴 // 解析陀螺仪数据 gyro[0] = (buf[8]<<8) | buf[9]; // X轴 gyro[1] = (buf[10]<<8) | buf[11]; // Y轴 gyro[2] = (buf[12]<<8) | buf[13]; // Z轴 }

4.3 数据转换与校准

原始数据需要转换为物理量：

• 加速度计：实际值(g) = 原始值 / 灵敏度
  • ±2g量程时灵敏度为16384 LSB/g
• 陀螺仪：角速度(°/s) = 原始值 / 灵敏度
  • ±250°/s量程时灵敏度为131 LSB/°/s

校准建议：

1. 将传感器水平静止放置，采集100组数据求平均值作为零偏
2. 通过旋转设备验证各轴方向是否正确
3. 对于高精度应用，可考虑温度补偿

5. OLED显示实现

5.1 SSD1306驱动移植

OLED显示通常使用I2C接口的SSD1306驱动芯片，与MPU6050共享I2C总线时需注意：

• 使用不同的I2C地址（通常0x3C或0x3D）
• 避免同时访问冲突
• 优化刷新速率以避免闪烁

显示初始化代码：

void OLED_Init(void) { // 初始化命令序列 const uint8_t init_cmds[] = { 0xAE, // 关闭显示 0xD5, 0x80, // 设置时钟分频 0xA8, 0x3F, // 设置复用率 0xD3, 0x00, // 设置显示偏移 0x40, // 设置起始行 0x8D, 0x14, // 电荷泵设置 0x20, 0x00, // 内存地址模式 0xA1, // 段重映射 0xC8, // 扫描方向 0xDA, 0x12, // COM引脚配置 0x81, 0xCF, // 对比度设置 0xD9, 0xF1, // 预充电周期 0xDB, 0x40, // VCOMH设置 0xA4, // 整体显示开启 0xA6, // 正常显示 0xAF // 开启显示 }; for(uint8_t i=0; i<sizeof(init_cmds); i++) { OLED_Write_Command(init_cmds[i]); } OLED_Clear(); }

5.2 数据可视化设计

有效的姿态数据显示应考虑：

1. 数值显示区域：清晰展示各轴当前值
2. 波形显示区域：绘制实时变化曲线
3. 姿态指示器：简易的3D立方体或平面指示器

数据显示优化技巧：

// 优化后的数据显示函数 void Show_Sensor_Data(int16_t accel[], int16_t gyro[]) { char buf[16]; // 加速度计数据显示 sprintf(buf, "AX:%6d", accel[0]); OLED_ShowString(0, 0, buf); sprintf(buf, "AY:%6d", accel[1]); OLED_ShowString(2, 0, buf); sprintf(buf, "AZ:%6d", accel[2]); OLED_ShowString(4, 0, buf); // 陀螺仪数据显示 sprintf(buf, "GX:%6d", gyro[0]); OLED_ShowString(0, 8, buf); sprintf(buf, "GY:%6d", gyro[1]); OLED_ShowString(2, 8, buf); sprintf(buf, "GZ:%6d", gyro[2]); OLED_ShowString(4, 8, buf); // 简易水平指示器 Draw_Level_Indicator(6, 0, accel[0], 10000); Draw_Level_Indicator(6, 8, accel[1], 10000); }

6. 系统优化与进阶应用

6.1 性能优化技巧

1. I2C通信优化：

   • 使用DMA传输减少CPU占用
   • 合理设置时钟延展
   • 批量读取数据减少通信次数

2. 数据处理优化：

   • 使用查表法替代浮点运算
   • 实现移动平均滤波
   • 采用定点数运算提高效率

3. 电源管理：

   • 合理配置MPU6050低功耗模式
   • 动态调整OLED刷新率
   • 使用STM32的睡眠模式

6.2 姿态解算基础

虽然原始传感器数据已能反映设备运动状态，但通过传感器融合可获得更精确的姿态信息：

1. 互补滤波：简单有效的算法，适合资源受限系统

   // 简易互补滤波实现 float angle = 0.98*(angle + gyro*dt) + 0.02*accel_angle;

2. 卡尔曼滤波：更精确但计算量较大

3. DMP使用：MPU6050内置数字运动处理器，可直接输出四元数

6.3 项目扩展方向

1. 无线传输：通过蓝牙或WiFi模块将数据发送到手机/PC
2. 数据记录：添加SD卡模块存储运动数据
3. 控制应用：作为平衡车或云台的控制输入
4. 人机交互：实现手势识别功能

7. 常见问题排查

I2C通信失败：

• 检查硬件连接是否正确
• 确认上拉电阻存在（通常4.7kΩ）
• 用逻辑分析仪抓取I2C波形
• 降低通信速率测试

数据异常：

• 确保传感器初始化正确
• 检查量程设置是否合适
• 进行传感器校准
• 排除电磁干扰

显示问题：

• 确认OLED驱动芯片型号
• 检查I2C地址是否正确
• 调整对比度设置
• 优化刷新时序

实际调试中发现，STM32硬件I2C有时会出现总线锁死的情况。解决方法是在I2C初始化前添加总线恢复程序，或者使用软件复位I2C外设。另一个常见问题是MPU6050数据跳动较大，这通常需要通过软件滤波和合理校准来解决。