MPU6050的DMP库移植到STM32CubeIDE全记录：从固件下载到LCD显示姿态角-深圳市維司達科技有限公司

MPU6050的DMP库移植到STM32CubeIDE全记录：从固件下载到LCD显示姿态角

在嵌入式开发领域，运动传感器数据处理一直是热门话题。MPU6050作为一款集成了三轴陀螺仪和三轴加速度计的6轴运动处理传感器，因其高性价比和丰富功能被广泛应用于无人机、平衡车、智能穿戴等设备中。而DMP（Digital Motion Processor）作为其内置的数字运动处理器，能够直接输出经过滤波和姿态解算的四元数数据，大大减轻了主控芯片的运算负担。

本文将详细介绍如何在STM32CubeIDE开发环境中，将MPU6050的DMP固件库移植到基于HAL库的STM32项目中，并最终实现姿态角数据的LCD显示。不同于传统的标准库移植方式，我们将充分利用CubeMX的图形化配置优势，构建一个现代化的开发流程。

1. 开发环境准备与工程创建

在开始移植前，我们需要准备完整的开发环境。STM32CubeIDE作为ST官方推出的集成开发环境，集成了CubeMX配置工具和Eclipse开发环境，大大简化了外设初始化和项目管理流程。

首先从ST官网下载并安装最新版的STM32CubeIDE。安装完成后，按照以下步骤创建新工程：

选择File > New > STM32 Project
在Target Selection界面输入您的STM32型号（如F103C8T6）
为工程命名（如MPU6050_DMP_Demo）
选择工程保存路径
点击Finish完成创建

工程创建完成后，CubeMX配置界面会自动打开。在这里我们需要配置两个关键外设：

I2C接口配置：

在Pinout & Configuration标签页左侧选择I2C
根据硬件连接选择I2C1或I2C2
配置合适的时钟速度（MPU6050支持最高400kHz）
确认SCL和SDA引脚分配正确

定时器配置（用于DMP的毫秒计数）：

选择TIMx（如TIM2）
配置为内部时钟源
设置预分频器和计数器周期，使定时器中断频率为1kHz
启用定时器中断

配置完成后，点击Project > Generate Code生成初始化代码。此时基本的工程框架已经建立，接下来我们需要获取DMP固件库。

2. DMP固件获取与工程导入

MPU6050的DMP固件库并非开源，需要从InvenSense官方获取。最新版本的固件通常包含在MPU6050的驱动库中，可以从以下途径获取：

访问InvenSense开发者网站（现属TDK集团）
下载MPU6050的MotionDriver软件包
解压后找到DMP相关的核心文件

DMP移植需要以下6个核心文件：

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

将这些文件复制到工程目录下的Driver/MPU6050文件夹中，然后在CubeIDE中添加这些文件到工程：

右键点击工程选择New > Folder
创建Driver/MPU6050目录
右键新目录选择Import > File System
选择刚才复制的6个文件导入

接下来需要在工程属性中添加头文件路径：

右键工程选择Properties
进入C/C++ Build > Settings
在Tool Settings > MCU GCC Compiler > Includes中添加Driver/MPU6050路径

3. HAL库与DMP接口适配

DMP固件库需要平台提供几个基础接口函数，包括I2C读写、延时和毫秒计数获取等。在标准库项目中，这些接口通常直接实现为底层驱动函数。但在HAL库环境下，我们需要进行适当适配。

首先在inv_mpu.c文件中进行必要的宏定义：

#define MPU6050 #define EMPL_TARGET_STM32 #define MPU_I2C_ADDRESS 0x68 // AD0引脚接地时为0x68，接VCC时为0x69

然后实现DMP所需的平台接口函数。在工程中新建一个mpu6050.c文件，添加以下内容：

#include "mpu6050.h" #include "i2c.h" #include "tim.h" uint32_t mpu_tick = 0; // I2C写函数 int i2c_write(uint8_t slave_addr, uint8_t reg_addr, uint8_t length, uint8_t const *data) { HAL_StatusTypeDef status; status = HAL_I2C_Mem_Write(&hi2c1, slave_addr<<1, reg_addr, I2C_MEMADD_SIZE_8BIT, (uint8_t*)data, length, 100); return (status == HAL_OK) ? 0 : -1; } // I2C读函数 int i2c_read(uint8_t slave_addr, uint8_t reg_addr, uint8_t length, uint8_t *data) { HAL_StatusTypeDef status; status = HAL_I2C_Mem_Read(&hi2c1, slave_addr<<1, reg_addr, I2C_MEMADD_SIZE_8BIT, data, length, 100); return (status == HAL_OK) ? 0 : -1; } // 毫秒延时函数 void delay_ms(unsigned long num_ms) { HAL_Delay(num_ms); } // 获取毫秒计数 int get_ms(unsigned long *count) { *count = mpu_tick; return 0; } // 定时器中断回调函数（在stm32f1xx_it.c中调用） void MPU_TIM_Update(void) { mpu_tick++; }

在stm32f1xx_it.c文件中找到定时器中断处理函数，添加mpu_tick计数：

void TIM2_IRQHandler(void) { HAL_TIM_IRQHandler(&htim2); MPU_TIM_Update(); // 添加这一行 }

4. DMP初始化与数据读取

完成接口适配后，我们可以开始DMP的初始化流程。在mpu6050.c中继续添加以下函数：

// DMP初始化函数 uint8_t MPU_DMP_Init(void) { uint8_t res = 0; // 1. 初始化MPU6050 res = mpu_init(); if(res != 0) return 1; // 2. 设置传感器 res = mpu_set_sensors(INV_XYZ_GYRO | INV_XYZ_ACCEL); if(res != 0) return 2; // 3. 配置FIFO res = mpu_configure_fifo(INV_XYZ_GYRO | INV_XYZ_ACCEL); if(res != 0) return 3; // 4. 设置采样率 res = mpu_set_sample_rate(DEFAULT_MPU_HZ); if(res != 0) return 4; // 5. 加载DMP固件 res = dmp_load_motion_driver_firmware(); if(res != 0) return 5; // 6. 设置陀螺仪方向 uint8_t gyro_orientation[9] = {0, 1, 0, -1, 0, 0, 0, 0, 1}; res = dmp_set_orientation(inv_orientation_matrix_to_scalar(gyro_orientation)); if(res != 0) return 6; // 7. 启用DMP功能 res = dmp_enable_feature(DMP_FEATURE_6X_LP_QUAT | DMP_FEATURE_SEND_RAW_ACCEL | DMP_FEATURE_SEND_CAL_GYRO | DMP_FEATURE_GYRO_CAL); if(res != 0) return 7; // 8. 设置DMP输出速率 res = dmp_set_fifo_rate(DEFAULT_MPU_HZ); if(res != 0) return 8; // 9. 自检 res = run_self_test(); if(res != 0) return 9; // 10. 启用DMP res = mpu_set_dmp_state(1); if(res != 0) return 10; return 0; } // 获取DMP处理后的姿态角 uint8_t MPU_DMP_Get_Data(float *pitch, float *roll, float *yaw) { float q0 = 1.0f, q1 = 0.0f, q2 = 0.0f, q3 = 0.0f; unsigned long sensor_timestamp; short gyro[3], accel[3], sensors; unsigned char more; long quat[4]; if(dmp_read_fifo(gyro, accel, quat, &sensor_timestamp, &sensors, &more)) return 1; if(sensors & INV_WXYZ_QUAT) { q0 = quat[0] / q30; // q30格式转换为浮点数 q1 = quat[1] / q30; q2 = quat[2] / q30; q3 = quat[3] / q30; // 计算得到俯仰角/横滚角/航向角 *pitch = asin(-2 * q1 * q3 + 2 * q0 * q2) * 57.3f; // pitch *roll = atan2(2 * q2 * q3 + 2 * q0 * q1, -2 * q1 * q1 - 2 * q2 * q2 + 1) * 57.3f; // roll *yaw = atan2(2*(q1*q2 + q0*q3), q0*q0+q1*q1-q2*q2-q3*q3) * 57.3f; // yaw } else { return 2; } return 0; }

5. LCD显示实现与系统集成

最后一步是将解算出的姿态角数据显示在LCD上。这里以常见的0.96寸OLED（SSD1306驱动）为例，介绍如何通过I2C接口显示数据。

首先确保已经配置好OLED的I2C接口（可以与MPU6050共用），然后添加OLED驱动文件到工程中。在main.c中添加以下代码：

#include "mpu6050.h" #include "ssd1306.h" float pitch, roll, yaw; char disp_buf[20]; int main(void) { HAL_Init(); SystemClock_Config(); MX_GPIO_Init(); MX_I2C1_Init(); MX_TIM2_Init(); // 初始化OLED SSD1306_Init(); SSD1306_Clear(); SSD1306_GotoXY(0,0); SSD1306_Puts("MPU6050 DMP Demo", &Font_7x10, 1); SSD1306_UpdateScreen(); // 初始化MPU6050 DMP if(MPU_DMP_Init() != 0) { SSD1306_GotoXY(0,2); SSD1306_Puts("MPU6050 Init Fail!", &Font_7x10, 1); SSD1306_UpdateScreen(); while(1); } SSD1306_GotoXY(0,2); SSD1306_Puts("MPU6050 Init OK!", &Font_7x10, 1); SSD1306_UpdateScreen(); HAL_Delay(1000); // 启动定时器 HAL_TIM_Base_Start_IT(&htim2); while (1) { if(MPU_DMP_Get_Data(&pitch, &roll, &yaw) == 0) { // 显示俯仰角 sprintf(disp_buf, "Pitch:%.1f", pitch); SSD1306_GotoXY(0,3); SSD1306_Puts(disp_buf, &Font_7x10, 1); // 显示横滚角 sprintf(disp_buf, "Roll:%.1f", roll); SSD1306_GotoXY(0,4); SSD1306_Puts(disp_buf, &Font_7x10, 1); // 显示航向角 sprintf(disp_buf, "Yaw:%.1f", yaw); SSD1306_GotoXY(0,5); SSD1306_Puts(disp_buf, &Font_7x10, 1); SSD1306_UpdateScreen(); } HAL_Delay(50); } }

6. 调试技巧与常见问题解决

在实际移植过程中，可能会遇到各种问题。以下是几个常见问题及其解决方案：

问题1：DMP初始化失败

检查I2C通信是否正常，可以使用逻辑分析仪观察SCL/SDA信号
确认MPU6050的供电电压稳定（3.3V）
检查AD0引脚电平是否正确，确保I2C地址匹配

问题2：姿态角数据不稳定

确保MPU6050固定牢固，避免振动干扰
尝试降低DMP输出速率（如从100Hz降到50Hz）
检查电源是否干净，必要时增加滤波电容

问题3：LCD显示异常

确认OLED的I2C地址是否正确（通常为0x78或0x7A）
检查I2C总线是否冲突，MPU6050和OLED不能同时使用同一总线
确保I2C上拉电阻正确（通常4.7kΩ）

提示：在调试过程中，可以先用HAL库的I2C扫描函数确认设备地址是否正确：
void I2C_Scan(void) { uint8_t i, ret; for(i=1; i<128; i++) { ret = HAL_I2C_IsDeviceReady(&hi2c1, i<<1, 2, 2); if(ret == HAL_OK) { printf("Found device at 0x%02X\n", i); } } }

7. 性能优化与扩展应用

完成基本功能后，可以考虑对系统进行优化和扩展：

1. 数据滤波处理虽然DMP已经进行了传感器数据融合，但有时还需要额外的滤波：

// 简易滑动平均滤波 #define FILTER_NUM 5 float filter_buf[FILTER_NUM] = {0}; uint8_t filter_idx = 0; float filter_update(float new_val) { filter_buf[filter_idx] = new_val; filter_idx = (filter_idx + 1) % FILTER_NUM; float sum = 0; for(uint8_t i=0; i<FILTER_NUM; i++) { sum += filter_buf[i]; } return sum / FILTER_NUM; }

2. 数据记录与分析可以通过串口将数据发送到上位机进行分析：

printf("Pitch:%.2f,Roll:%.2f,Yaw:%.2f\n", pitch, roll, yaw);

3. 姿态控制应用结合PID算法实现简单的姿态控制：

// 简易PID结构体 typedef struct { float Kp, Ki, Kd; float error, last_error, integral; } PID_TypeDef; // PID计算函数 float PID_Calculate(PID_TypeDef *pid, float setpoint, float input) { pid->error = setpoint - input; pid->integral += pid->error; float derivative = pid->error - pid->last_error; pid->last_error = pid->error; return pid->Kp * pid->error + pid->Ki * pid->integral + pid->Kd * derivative; }

移植MPU6050的DMP库到STM32CubeIDE环境，最关键的步骤是正确实现平台接口函数，确保I2C通信稳定可靠。在实际项目中，根据具体应用场景调整DMP参数和数据处理算法，可以获得更好的性能表现。