STM32 HAL库硬件I2C移植MPU6050 DMP 5.1.3版本实战与避坑指南

关注

原创最新推荐文章于 2026-04-15 21:31:13 发布 915 阅读 AI 写同款· GEO 优化 ›

STM32Cube HAL库——MPU6050 DMP姿态解算文章主要讲述了mpu6050的姿态获取原理，使用HAL库编程时Cube MX的配置和Cube IDE编程，DMP解算MPU6050姿态的过程，附带开源代码。阅读详情

1. 环境准备与硬件连接

在开始移植MPU6050 DMP库之前，我们需要先准备好开发环境和硬件连接。我使用的是STM32F103C8T6最小系统板，搭配MPU6050模块，通过硬件I2C进行通信。开发环境是STM32CubeIDE 1.9.0，DMP库版本是motion_driver 5.1.3。

硬件连接非常简单，MPU6050的SDA和SCL引脚分别连接到STM32的PB7和PB6（I2C1），VCC和GND接3.3V和地。这里要注意，MPU6050的AD0引脚如果接地，设备地址是0x68；如果接VCC，地址是0x69。我习惯接地，所以地址是0x68。

在CubeMX中配置I2C时，我建议将I2C速度设置为标准模式（100kHz），因为MPU6050的DMP库对时序要求比较严格，太快了容易出问题。另外，记得开启I2C的中断，虽然初期调试可以不用中断，但后续优化时会用到。

2. DMP库文件移植

DMP库的移植是整个过程中最核心的部分。首先需要从InvenSense官网下载motion_driver 5.1.3版本，然后从中提取必要的文件。我通常会把以下文件复制到我的工程中：

inv_mpu.c
inv_mpu.h
inv_mpu_dmp_motion_driver.c
inv_mpu_dmp_motion_driver.h
dmpKey.h
dmpmap.h

这些文件放在Drivers/MPU6050文件夹下，然后在CubeIDE中添加这些文件的路径。接下来就是修改这些文件，使其适配STM32的HAL库。

首先修改inv_mpu.h，注释掉原有的MSP430相关代码，添加STM32的宏定义：

#define STM32_MPU6050
#define MPU6050
#include "main.h"
extern I2C_HandleTypeDef hi2c1;

#define i2c_write(mpuaddr, regaddr, dsize, pdata) \
    HAL_I2C_Mem_Write(&hi2c1, mpuaddr << 1, regaddr, I2C_MEMADD_SIZE_8BIT, pdata, dsize, HAL_MAX_DELAY)

#define i2c_read(mpuaddr, regaddr, dsize, pdata) \
    HAL_I2C_Mem_Read(&hi2c1, mpuaddr << 1, regaddr, I2C_MEMADD_SIZE_8BIT, pdata, dsize, HAL_MAX_DELAY)

#define delay_ms(ms) HAL_Delay(ms)
#define get_ms(p) do { *p = HAL_GetTick(); } while(0)
#define log_i(...) do {} while (0)
#define log_e(...) do {} while (0)
#define fabs fabsf
#define min(a,b) ((a<b)?a:b)

这里特别注意mpuaddr << 1这个操作，因为HAL库的I2C函数要求7位地址左移1位。如果你的MPU6050地址是0x68，这里就是0xD0；如果是0x69，就是0xD2。

3. 关键代码修改与适配

移植过程中有几个关键点需要特别注意，这些都是我踩过坑的地方。首先是在inv_mpu.c中，需要移除所有MSP430相关的代码，包括头文件引用和函数定义。特别是reg_int_cb这个函数，要完全注释掉，因为STM32的中断处理方式不同。

另一个重点是自检函数的修改。在DMP 5.1.3版本中，自检函数的返回值判断需要特别注意。在inv_mpu.c的2747行左右，你会看到这样一段代码：

result |= 0x04;

这行代码会导致自检返回值变成0x07，而不是老版本中的0x03。所以在新版本中，自检函数应该判断返回值是否为0x07，而不是0x03。

我建议直接从官方例程motion_driver_test.c中复制run_self_test函数，这个函数已经适配了新版本的自检逻辑。记得也要复制inv_row_2_scale和inv_orientation_matrix_to_scalar这两个辅助函数。

4. 初始化流程详解

MPU6050的初始化是整个流程中最容易出问题的环节。下面是我优化后的初始化函数：

int MPU6050_Init(void) {
    int result;
    struct int_param_s int_param;
    
    // 关键延时，必须添加！
    HAL_Delay(100);
    
    result = mpu_init(&int_param);
    if(result != 0) return -1;
    
    result = mpu_set_sensors(INV_XYZ_GYRO | INV_XYZ_ACCEL);
    if(result != 0) return -2;
    
    result = mpu_configure_fifo(INV_XYZ_GYRO | INV_XYZ_ACCEL);
    if(result != 0) return -3;
    
    result = mpu_set_sample_rate(DEFAULT_MPU_HZ);
    if(result != 0) return -4;
    
    result = dmp_load_motion_driver_firmware();
    if(result != 0) return -5;
    
    result = dmp_set_orientation(inv_orientation_matrix_to_scalar(gyro_orientation));
    if(result != 0) return -6;
    
    result = dmp_enable_feature(DMP_FEATURE_6X_LP_QUAT | DMP_FEATURE_SEND_RAW_ACCEL | 
                              DMP_FEATURE_SEND_CAL_GYRO | DMP_FEATURE_GYRO_CAL);
    if(result != 0) return -7;
    
    result = dmp_set_fifo_rate(DEFAULT_MPU_HZ);
    if(result != 0) return -8;
    
    result = run_self_test();
    if(result != 0) return -9;
    
    result = mpu_set_dmp_state(1);
    if(result != 0) return -10;
    
    return 0;
}

这个初始化函数有几个关键点：第一是必须在mpu_init前添加100ms延时，否则很容易初始化失败；第二是自检函数run_self_test要使用新版本的逻辑；第三是DMP功能配置要根据实际需求选择，我通常使用6轴四元数+校准数据输出。

5. 数据读取与处理

数据读取是最终的目的，这里我分享一个稳定的数据读取函数：

int MPU6050_ReadData(float *pitch, float *roll, float *yaw) {
    short gyro[3], accel[3];
    long quat[4];
    unsigned long timestamp;
    short sensors;
    unsigned char more;
    
    // 使用循环确保读取到有效数据
    while(dmp_read_fifo(gyro, accel, quat, &timestamp, &sensors, &more)) {
        // 可选：添加超时机制避免死循环
        if(HAL_GetTick() > timeout) return -1;
    }
    
    if(sensors & INV_WXYZ_QUAT) {
        // 将Q30格式的四元数转换为浮点数
        float q0 = quat[0] / 1073741824.0f;
        float q1 = quat[1] / 1073741824.0f;
        float q2 = quat[2] / 1073741824.0f;
        float q3 = quat[3] / 1073741824.0f;
        
        // 转换为欧拉角
        *pitch = asin(-2 * q1 * q3 + 2 * q0 * q2) * 57.2958f;
        *roll = atan2(2 * q2 * q3 + 2 * q0 * q1, -2 * q1 * q1 - 2 * q2 * q2 + 1) * 57.2958f;
        *yaw = atan2(2 * (q1 * q2 + q0 * q3), q0 * q0 + q1 * q1 - q2 * q2 - q3 * q3) * 57.2958f;
        
        return 0;
    }
    
    return -2;
}

这个函数有几个注意事项：第一是使用while循环确保读取到有效数据，避免因FIFO溢出导致的数据丢失；第二是四元数需要除以1073741824.0f（即2^30）转换为浮点数；第三是欧拉角转换公式中的57.2958是180/π，将弧度转换为角度。