4、IMU传感器原理与驱动：MPU6050/ICM20602加速度计与陀螺仪、I2C通信、原始数据读取与校准

IMU（惯性测量单元）是机器人感知自身运动状态的核心传感器，它通过加速度计和陀螺仪的协同工作，为姿态解算、运动控制和导航提供高频、低延迟的原始数据。在STM32机器人平台上，MPU6050和ICM20602是两款最常用的六轴IMU芯片。本章将深入剖析其内部工作原理、I2C通信时序、原始数据读取流程以及关键的校准方法，帮助开发者建立从寄存器操作到数据可信度的完整认知。

4.1 加速度计与陀螺仪的核心工作原理

MEMS（微机电系统）加速度计和陀螺仪是IMU的核心敏感元件。加速度计基于电容式检测原理：当芯片沿某一轴加速时，内部的微机械质量块因惯性发生位移，导致差分电容的极板间距改变，从而产生与加速度成正比的电容变化量。该变化量经片上电荷放大器和模数转换器（ADC）转换为16位数字信号。值得注意的是，加速度计测量的是"比力"（Specific Force），即物体受到的除重力以外的合力与质量的比值。因此，在静止状态下，加速度计读数的模长应等于重力加速度g（约9.8 m/s²），这一特性是后续零偏校准和姿态初始化的物理基础。

陀螺仪则基于科里奥利效应（Coriolis Effect）。MEMS陀螺仪内部有一个高速振动的质量块，当芯片绕敏感轴旋转时，质量块会受到科里奥利力作用，产生垂直于振动方向的位移。该位移同样通过电容检测转换为角速度信号。需要强调的是，陀螺仪输出的是角速度（°/s），而非角度。要获得角度，必须对时间进行积分，而积分过程会累积零偏漂移，这正是需要定期校准和融合加速度计数据的原因。

4.2 I2C通信协议与寄存器操作流程

I2C（Inter-Integrated Circuit）是一种两线制同步串行总线，由时钟线SCL和数据线SDA组成。在STM32与IMU的通信中，STM32作为主机（Master），IMU作为从机（Slave）。每个I2C设备都有唯一的7位地址，MPU6050和ICM20602的默认地址为0x68（AD0引脚接地）或0x69（AD0引脚接高电平）。通信时序遵循"起始条件（START）→ 发送从机地址+读写位 → 寄存器地址 → 数据 → 停止条件（STOP）"的格式。

读取IMU原始数据的标准流程如下：首先，通过I2C向电源管理寄存器（PWR_MGMT_1，地址0x6B）写入0x00，唤醒传感器并选择内部时钟源。其次，配置陀螺仪配置寄存器（GYRO_CONFIG，地址0x1B）和加速度计配置寄存器（ACCEL_CONFIG，地址0x1C），设置量程和数字低通滤波器（DLPF）带宽。然后，等待约50ms让传感器稳定。最后，连续读取加速度计和陀螺仪数据寄存器（从0x3B开始，共14个字节），每个轴的数据由高8位和低8位组成，需拼接为16位有符号整数。

// STM32 HAL库 I2C读取IMU原始数据示例
uint8_t buf[14];
int16_t accel_x, accel_y, accel_z;
int16_t gyro_x, gyro_y, gyro_z;

// 唤醒传感器
uint8_t pwr_cmd = 0x00;
HAL_I2C_Mem_Write(&hi2c1, 0x68 << 1, 0x6B, 1, &pwr_cmd, 1, 100);

// 配置量程：陀螺仪±2000°/s，加速度计±8g
uint8_t gyro_cfg = 0x18; // 0x18 = 2000°/s
uint8_t accel_cfg = 0x10; // 0x10 = ±8g
HAL_I2C_Mem_Write(&hi2c1, 0x68 << 1, 0x1B, 1, &gyro_cfg, 1, 100);
HAL_I2C_Mem_Write(&hi2c1, 0x68 << 1, 0x1C, 1, &accel_cfg, 1, 100);

// 读取14字节原始数据
HAL_I2C_Mem_Read(&hi2c1, 0x68 << 1, 0x3B, 1, buf, 14, 100);

// 拼接为有符号16位整数
accel_x = (int16_t)((buf[0] << 8) | buf[1]);
accel_y = (int16_t)((buf[2] << 8) | buf[3]);
accel_z = (int16_t)((buf[4] << 8) | buf[5]);
gyro_x  = (int16_t)((buf[8] << 8) | buf[9]);
gyro_y  = (int16_t)((buf[10] << 8) | buf[11]);
gyro_z  = (int16_t)((buf[12] << 8) | buf[13]);

4.3 原始数据读取与单位换算

从寄存器读出的16位原始值是无量纲的ADC计数，必须根据配置的量程换算为物理单位。换算公式为：物理值 = 原始值 × 灵敏度（LSB灵敏度）。灵敏度定义为量程除以ADC分辨率的一半。例如，当加速度计量程设为±8g时，灵敏度为 8g / 32768 ≈ 0.000244 g/LSB。陀螺仪量程设为±2000°/s时，灵敏度为 2000 / 32768 ≈ 0.061 °/s/LSB。

在实际工程中，建议将换算后的数据统一为国际单位制：加速度使用 m/s²（乘以9.8），角速度使用 rad/s（乘以π/180）。这有助于后续姿态解算时避免单位混乱。此外，需要注意数据符号：加速度计在芯片水平放置且Z轴朝上时，Z轴读数应为+1g（正方向）；陀螺仪正方向遵循右手定则。

4.4 校准方法：零偏、灵敏度与交叉轴

MEMS传感器出厂时虽经校准，但温度漂移、焊接应力和安装误差会导致实际参数偏离标称值。因此，上电后的现场校准是保证数据质量的关键步骤。校准主要包含三个层次：零偏校准（Bias）、灵敏度校准（Scale Factor）和交叉轴耦合校准（Cross-axis Coupling）。

零偏校准是最基础也是最重要的步骤。将机器人水平静止放置，采集N个样本（建议至少200个），分别计算加速度计和陀螺仪各轴的平均值。陀螺仪的零偏即为该平均值（理想应为0），加速度计的零偏则需减去重力分量。例如，若Z轴朝上，则加速度计Z轴零偏 = 平均读数 - 1g（或9.8 m/s²）。校准后，每次读取数据时减去零偏值。

灵敏度校准需要已知参考输入。对于加速度计，可利用重力作为标准：将芯片分别以+X、-X、+Y、-Y、+Z、-Z六个方向朝上放置，记录各轴读数，计算实际灵敏度与标称灵敏度的比值。对于陀螺仪，则需要转台提供已知角速度，这在机器人现场较难实现，通常依赖出厂标称值或使用IMU的DMP自校准功能。

4.5 实战案例：两轮平衡机器人的IMU校准与数据预处理

背景与约束：某两轮自平衡机器人项目，采用STM32F407主控，IMU选用MPU6050，安装在底盘中心。机器人要求能够在不同地面（瓷砖、地毯）上保持平衡，且允许用户推动后自动恢复。主要约束是：系统无外部转台，陀螺仪灵敏度无法现场标定；CPU还需同时处理电机控制，IMU数据读取和校准不能占用过多时间。

初始现象：在初步调试中，机器人静止时，通过串口打印的加速度计Z轴读数在9.5~10.2 m/s²之间波动，陀螺仪Z轴读数在-0.5~+0.8 °/s之间漂移。直接使用这些数据进行姿态解算，导致平衡控制震荡，甚至朝一个方向加速倒下。

分析判断：问题根源在于零偏未校准和加速度计读数波动。陀螺仪的零偏漂移在积分后会产生持续增长的角度误差；加速度计的波动则导致互补滤波中重力参考方向不准确。

操作步骤：

1. 编写校准程序：上电后等待2秒，然后以100Hz频率采集500个样本（5秒）。计算陀螺仪三轴平均值作为零偏，计算加速度计Z轴平均值与9.8的差值作为Z轴零偏。
2. 将零偏值存入STM32内部Flash，每次上电启动时加载。
3. 在数据读取函数中，对原始值减去零偏，再乘以灵敏度系数。
4. 对加速度计数据施加滑动平均滤波（窗口大小5），对陀螺仪数据施加低通滤波（截止频率50Hz），以抑制高频噪声。
5. 重新调试平衡控制器的PID参数，发现系统响应明显改善。

结果对比：校准后，静止时加速度计Z轴读数稳定在9.79~9.81 m/s²，陀螺仪Z轴零偏小于±0.1°/s。机器人能够平稳站立，在受到轻微推动后能在1秒内恢复平衡。进一步测试发现，连续运行30分钟后，陀螺仪零偏漂移约0.5°/s，但通过互补滤波中的加速度计修正，姿态角误差控制在±1°以内。

风险与代价：该校准方法假设IMU安装平面与机器人底盘平行，若存在安装倾角，需额外进行倾角补偿。此外，Flash写入次数有限，频繁校准会损耗Flash寿命，建议仅在首次上电或更换硬件时执行。

4.6 总结与工程复盘

IMU驱动开发的核心不在于"能读到数据"，而在于"读到的数据可信"。本章从MEMS工作原理出发，明确了加速度计和陀螺仪的本质差异；通过I2C时序和寄存器操作，实现了原始数据的稳定读取；通过单位换算和三级校准方法，将ADC计数转化为有物理意义的、低漂移的惯性数据。在工程实践中，建议遵循以下原则：先校准后使用、滤波与解算分离、定期验证零偏。对于MPU6050，可充分利用其内置DMP直接输出四元数，减少主控计算负担；对于ICM20602，则需自行实现姿态解算算法（如Mahony或Madgwick）。无论选择哪款芯片，扎实的校准功底都是机器人可靠运动控制的前提。