简介STM32F103C8T6与MPU6050六轴传感器联合开发是嵌入式入门的经典组合。这份资源围绕这一组合提供了一个基于HAL库的完整工程示例核心功能是通过I2C接口驱动MPU6050利用其内置DMP数字运动处理器完成姿态解算并将解算出的角度数据经UART1串口输出。对于正在学习STM32 HAL库、传感器驱动或串口通信的开发者这是一份可直接对照学习的工程模板。资源包内共94个文件压缩包约659KB。文件以C源文件与头文件为主涵盖HAL库底层驱动和应用层代码另包含IOC工程配置、MDK-ARM工程文件、启动文件及Hex固件便于直接打开工程或烧录验证。目前已有3003人学习下载。通过这份工程读者可以掌握I2C时序配置、DMP固件加载与寄存器设置、UART1中断收发等关键流程也能理解从传感器数据采集到串口输出的完整代码组织方式为无人机、机器人等姿态跟踪应用打下基础。1. 项目定位一颗MPU6050让IMU数据从寄存器到可用姿态角做平衡小车最头疼的不是电机PID而是倾角数据怎么读出来。某开发者第一次调MPU6050时对着数据手册翻了大半天最后发现HAL库的I2C接口和寄存器读写顺序全是坑——读出来的数据要么全是0要么角度跳得像心电图。这份STM32 HAL库MPU6050工程就是把这条链路完整打通CubeMX生成基础工程后用HAL_I2C_Mem_Read/Write封装MPU6050驱动读取原始加速度和角速度再通过互补滤波输出可用的Roll/Pitch角。适合正在做平衡小车、两轮自平衡、云台稳定器或手势识别的开发者也适合想把I2C和IMU驱动原理彻底搞明白、再移植其他传感器的入门玩家。2. 硬件接线与工程结构CubeMX初始化之外别忘了的细节2.1 引脚分配与I2C总线选型MPU6050的通信接口有I2C和SPI两种市面上绝大多数模块默认走I2C因为引脚少、接线简单四根线就能通VCC、GND、SCL、SDA。HAL库里I2C可选择I2C1或I2C2具体用哪一路取决于你的板子原理图。常见做法是在CubeMX里把SCL和SDA配到硬件I2C引脚上比如STM32F103C8T6的PB6/PB7对应I2C1PB10/PB11对应I2C2这样可以直接用HAL_I2C_Mem_Read这类硬件外设函数不用软件模拟I2C。但有一个很容易翻车的细节MPU6050模块的VCC供电电压。不少开发板模块是3.3V供电接到5V引脚上虽然芯片大概率不会立刻烧掉但I2C通信的电平逻辑会出问题——SDA和SCL的电平会被拉高到5V而MPU6050的I2C引脚标称耐压只有3.6V长时间运行会加速模块老化。我一般会先确认模块背面有没有稳压芯片有的话再接5V没有就老老实实接3.3V。接线时还需要注意SDA和SCL的上拉电阻。MPU6050模块设计得比较标准的板载已经带了4.7kΩ上拉电阻到VCC不需要额外再接。但如果你用的是最便宜的小模块或者自己画板子把MPU6050焊上去的就得在SDA和SCL上各接一个上拉电阻到VCC否则I2C总线会因为没有上拉而一直处于低电平通信直接失败。这个坑我当年排查了整整一个晚上最后用示波器看波形才发现SDA线根本没有高电平。接线确认无误后打开CubeMX选择对应的MCU型号在Pinout视图里找到I2C1或I2C2使能SCL和SDA引脚然后在Configuration面板里把I2C频率调到400kHz。MPU6050支持最大400kHz的I2C时钟但如果你用的是杜邦线连接而不是PCB走线建议先降到100kHz跑通再说——杜邦线的寄生电容在高频下会让波形变形导致数据偶发读错这种问题用逻辑分析仪都未必能一眼看出来。提示如果手头有逻辑分析仪在调试阶段把SCL和SDA的波形抓下来看比对着寄存器猜问题高效得多。400kHz模式下一个读操作会看到地址帧、寄存器地址帧、数据帧三段波形任何一段异常都能快速定位硬件还是驱动的问题。2.2 工程目录结构与关键文件整个工程解压后的目录结构大致是下面这个样子STM32HAL库MPU6050/ ├─ Core/ │ ├─ Inc/ │ │ ├─ main.h │ │ ├─ mpu6050.h │ │ └─ i2c.h │ └─ Src/ │ ├─ main.c │ ├─ mpu6050.c │ ├─ i2c.c │ └─ stm32f1xx_hal_msp.c ├─ Drivers/ │ ├─ CMSIS/ │ └─ STM32F1xx_HAL_Driver/ ├─ MDK-ARM/ │ ├─ project.uvprojx │ └─ startup_stm32f103xb.s └─ STM32HAL库MPU6050.ioc这里需要重点看两个文件mpu6050.c 和 mpu6050.h。mpu6050.c 里封装了所有的寄存器读写和数据处理函数是整个工程的核心main.c 里的 main 函数循环中调用这些函数把数据打印出来。Drivers 目录是CubeMX自动生成的HAL库代码正常情况下不需要改动。MDK-ARM 是Keil工程文件如果你用的是STM32CubeIDE直接用IDE打开.ioc文件重新生成代码就行。值得注意的是HAL库版本不同HAL_I2C_Mem_Read 函数的行为会有细微差别。早期版本在I2C从设备无应答时会立即返回超时错误而新版本增加了自动重试机制。如果你手里的工程是从老版本迁移过来的且发现I2C通信偶尔失败可以考虑直接升级HAL库版本或者自己加一个重试循环——在返回 HAL_ERROR 时重新调用一次读函数最多重试三次。2.3 CubeMX初始化配置要点CubeMX里除了基本的I2C配置还有两个地方容易忽略。第一是时钟树MPU6050的I2C时钟源来自APB1总线如果APB1的时钟频率配置不合理I2C的实际通信速率会和你预期的不一致。比如你想跑400kHz但APB1时钟是36MHz那么I2C分频系数要设置成36MHz/400kHz90这个值在CubeMX的I2C配置面板里会自动帮你算但前提是你得先把RCC时钟树配好让APB1跑在正确的频率上。第二是GPIO的开漏输出配置。I2C的SCL和SDA引脚必须配置为开漏输出Open-Drain这是I2C协议本身的要求——总线上的多个设备通过拉低电平来通信推挽输出会造成总线冲突。CubeMX的I2C配置会自动把引脚设置为开漏模式但如果你在代码里手动改了GPIO的初始化结构体把模式改成了推挽输出I2C通信就会出现随机失败的现象而且这种失败是间歇性的很难排查。我见过不少人在跑通I2C之后想调整引脚功能把配置覆盖了结果数据开始随机出错最后逐行对比才发现是GPIO模式被改了。/* I2C GPIO 初始化CubeMX 生成的代码一般长这样 */ void HAL_I2C_MspInit(I2C_HandleTypeDef *hi2c) { GPIO_InitTypeDef GPIO_InitStruct {0}; __HAL_RCC_GPIOB_CLK_ENABLE(); __HAL_RCC_I2C1_CLK_ENABLE(); /**I2C1 GPIO Configuration PB6 ------ I2C1_SCL PB7 ------ I2C1_SDA */ GPIO_InitStruct.Pin GPIO_PIN_6|GPIO_PIN_7; GPIO_InitStruct.Mode GPIO_MODE_AF_OD; /* 开漏复用模式不要改成推挽 */ GPIO_InitStruct.Speed GPIO_SPEED_FREQ_HIGH; HAL_GPIO_Init(GPIOB, GPIO_InitStruct); }这段配置里最关键的是GPIO_MODE_AF_OD即复用开漏模式。GPIO_SPEED_FREQ_HIGH设置成高速是因为400kHz的I2C时钟需要足够的边沿速率如果设置成低速波形上升沿会变缓通信距离稍远就可能出错。这里有个取舍问题高速模式会带来更大的EMI辐射如果是量产产品一般要加RC滤波或把I2C降速到100kHz换低速模式。还有一个小细节如果你换了板子比如从F103换到F407I2C引脚和时钟树都会变这时直接改CubeMX的芯片型号重新生成代码比手改HAL库要安全得多——HAL库在不同系列之间API基本一致但RCC时钟树和引脚复用表差异很大手改容易漏配置。3. 核心代码拆解从寄存器到实时姿态角的完整链路3.1 MPU6050寄存器映射先搞懂寄存器才能写驱动MPU6050的寄存器地址空间是从0x00到0x75其中和姿态读取最相关的寄存器整理成表来看寄存器地址名称作用0x6BPWR_MGMT_1电源管理bit6复位bit0睡眠控制0x19SMPLRT_DIV采样率分频寄存器0x1ACONFIG数字低通滤波器带宽配置0x1BGYRO_CONFIG陀螺仪量程与自检0x1CACCEL_CONFIG加速度计量程与自检0x3B~0x46DATA_REGS加速度、温度、陀螺仪数据0x75WHO_AM_I设备ID固定返回0x68这个表是写驱动时的地图。WHO_AM_I是检查I2C通信是否正常的第一个参考点——上电读它返回0x68就说明芯片活着且I2C通信没问题如果读出来是0xFF或者0x00大概率是接线或供电问题不用急着往下写初始化代码。/* 读取WHO_AM_I寄存器验证I2C通信 */ uint8_t mpu6050_get_id(void) { uint8_t id 0; HAL_StatusTypeDef ret HAL_I2C_Mem_Read(hi2c1, MPU6050_ADDR, 0x75, I2C_MEMADD_SIZE_8BIT, id, 1, 100); if (ret ! HAL_OK) { return 0; } return id; }这段代码里MPU6050_ADDR需要特别解释一下。MPU6050的7位从机地址是0x68AD0引脚接低电平或0x69AD0引脚接高电平但在HAL_I2C_Mem_Read中传入的是8位地址需要在7位地址左移一位加上读写位。HAL库内部会自动处理这个所以你在宏定义时直接写成0x68 1即0xD0。这个细节我第一次写时也漏掉了导致读出来的ID永远不对后来对比官方例程才发现是地址位没移位。I2C_MEMADD_SIZE_8BIT表示寄存器地址是8位MPU6050的寄存器地址确实都是8位的。100是超时时间单位毫秒调试阶段可以放大到200或500便于排查。如果读ID一直不对还有一种可能你用的是MPU6050模块但模块上已经把AD0引脚接到了高电平这时从机地址变成了0x69。遇到这种情况直接改宏定义就行不需要动硬件。3.2 初始化序列上电时序不是玄学MPU6050的初始化代码表面上看只是往几个寄存器写值但写的顺序其实有讲究。见过不少人写的驱动上来就配置量程然后就读数据结果读出来的数据在开机后前几十秒明显异常。原因是芯片刚上电时内部的传感器需要一段时间完成自校准大概几十毫秒。如果跳过这个等待直接配置寄存器部分寄存器可能写入失败或数据不稳定。/* MPU6050 初始化序列 */ uint8_t mpu6050_init(void) { uint8_t val 0; HAL_Delay(50); /* 上电后等待电源稳定 */ /* 唤醒芯片清零SLEEP位 */ val 0x00; if (HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, 0x6B, I2C_MEMADD_SIZE_8BIT, val, 1, 100) ! HAL_OK) { return 1; } /* 配置时钟源选择X轴陀螺仪作为内部时钟比内部RC振荡器更稳定 */ val 0x01; HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, 0x6B, I2C_MEMADD_SIZE_8BIT, val, 1, 100); /* 配置加速度计量程为±4g陀螺仪量程为±500°/s */ val 0x08; /* ACCEL_CONFIG: ±4g */ HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, 0x1C, I2C_MEMADD_SIZE_8BIT, val, 1, 100); val 0x08; /* GYRO_CONFIG: ±500°/s */ HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, 0x1B, I2C_MEMADD_SIZE_8BIT, val, 1, 100); /* 设置数字低通滤波器带宽为20Hz滤除传感器高频噪声 */ val 0x04; HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, 0x1A, I2C_MEMADD_SIZE_8BIT, val, 1, 100); /* 采样率分频内部采样率1kHz分频4得到250Hz采样率 */ val 0x03; HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, 0x19, I2C_MEMADD_SIZE_8BIT, val, 1, 100); HAL_Delay(100); /* 等待传感器稳定 */ return 0; }这里参数说明一下量程和分辨率的关系。MPU6050的加速度计是16位ADC量程为±2g时分辨率为16384 LSB/g量程为±4g时分辨率为8192 LSB/g量程为±8g时分辨率为4096 LSB/g。陀螺仪同理±250°/s量程时分辨率是131 LSB/(°/s)±500°/s量程时是65.5 LSB/(°/s)。选择量程要在测量范围和分辨率之间做权衡——平衡小车用±2g和±250°/s就够但如果你做云台需要应对快速转动就得用更大的量程代价是分辨率降低。DLPF寄存器0x1A的低3位控制滤波带宽0x04表示约20Hz的带宽。这个值对姿态解算的影响非常直接——带宽越低噪声越小但信号延迟越大。如果应用需要快速响应比如无人机飞控带宽可以设到42Hz或更高如果是静态倾斜测量20Hz就合适。但注意DLPF设置后陀螺仪的采样率会受影响实际采样率 内部采样率 / (1 SMPLRT_DIV)而内部采样率本身又和DLPF配置有关这块要对着数据手册的表格来不能凭感觉配。3.3 数据读取与姿态融合加速度计和陀螺仪怎么组合初始化完成后核心就是循环读取数据。关键函数是从0x3B开始的连续读把加速度计的6个字节和陀螺仪的6个字节一次性读出来。/* 一次性读取全部传感器原始数据 */ uint8_t mpu6050_read_raw(int16_t *accel_x, int16_t *accel_y, int16_t *accel_z, int16_t *gyro_x, int16_t *gyro_y, int16_t *gyro_z) { uint8_t buf[14]; if (HAL_I2C_Mem_Read(hi2c1, MPU6050_ADDR, 0x3B, I2C_MEMADD_SIZE_8BIT, buf, 14, 100) ! HAL_OK) { return 1; } *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]); return 0; }一次读14个字节比分别读两次要高效得多因为I2C传输有固定的起始条件、停止条件和地址帧开销合并读能把协议开销省掉一半。注意这里跳过了buf[6]和buf[7]因为0x39~0x3A是温度传感器寄存器不需要温度数据就不读。原始数据要换算成物理单位不能直接用。加速度换算要除以对应的LSB值以±4g量程为例accel_g raw / 8192.0f陀螺仪换算gyro_dps raw / 65.5f。这一步很多人会忘直接把原始值拿去做姿态解算结果角度算出来都是错的。拿到物理单位后姿态解算才是重点。这个工程用的是互补滤波思路是加速度计在静止时能准确测出重力方向但动态时噪声大陀螺仪积分能跟踪快速姿态变化但会有积分漂移。互补滤波把两者按权重融合公式是angle 0.98 * (angle gyro_dt) 0.02 * accel_angle。0.98和0.02这两个系数一个管陀螺仪一个管加速度计校正比例决定了系统是更信任短期积分还是长期绝对参考。/* 互补滤波姿态解算输入为换算后的物理单位 */ #define ALPHA 0.98f void complementary_filter(float *roll, float *pitch, float accel_roll, float accel_pitch, float gyro_roll_rate, float gyro_pitch_rate, float dt) { *roll ALPHA * (*roll gyro_roll_rate * dt) (1.0f - ALPHA) * accel_roll; *pitch ALPHA * (*pitch gyro_pitch_rate * dt) (1.0f - ALPHA) * accel_pitch; }这段代码的执行逻辑很直观角度 上一次角度 陀螺仪角速度 × 时间增量然后和加速度计解算出的角度取加权平均。ALPHA越大越信任陀螺仪积分姿态角更平滑但漂移明显ALPHA越小越信任加速度计响应快但噪声大。0.98这个值是平衡点前提是采样周期dt要稳定——dt如果忽大忽小积分结果就会不稳定。这也是为什么I2C读取不能放在主循环里随意延时的地方做最好用固定频率的定时器触发采样。4. 踩坑与排查从读数全零到角度漂移的四个实战问题这四个问题是从实际跑这个工程的过程中筛出来的覆盖了从硬件通信到软件滤波的各个环节。每一条都按现象、原因、解决三步来记录。4.1 读WHO_AM_I返回0xFF或0x00现象上电后调用mpu6050_get_id()返回值不是0x68。返回0xFF时I2C总线上没有设备应答返回0x00时SDA线一直被拉低。原因0xFF说明I2C总线上根本没有设备应答SDA线被外部拉高或设备未在总线上。0x00说明SDA线一直是低电平可能是模块没接电源也可能是上拉电阻缺失导致总线悬空后被拉低。解决先用万用表量VCC和GND确认模块供电正常。然后用示波器看SDA和SCL波形——发送地址帧时SDA是否出现脉冲串。如果SCL有时钟但SDA不变化说明模块没应答查地址对不对0x68还是0x69如果两个都没有波形查CubeMX引脚配置和GPIO模式是不是被改成了推挽。还有一个容易被忽略的点有些排针焊接质量差模块放一段时间后引脚虚焊把模块和板子之间的排针重新焊一遍往往就好了。4.2 HAL_I2C_Mem_Read返回HAL_BUSY现象代码执行到第一个I2C读操作时卡住或者返回HAL_BUSY而且后续所有读操作都会失败。原因HAL库的I2C是状态机驱动的如果上一次读取没正常结束比如中断模式被抢占状态机卡在BUSY状态后续所有请求都会直接返回HAL_BUSY不执行任何总线操作。很多人以为这是硬件问题其实多半是中断优先级配置不当——I2C中断和定时器中断发生竞争I2C的状态转换被延误。解决我一般会在I2C读失败后加一个__HAL_I2C_CLEAR_FLAG(hi2c1, I2C_FLAG_BUSY)把BUSY标志清掉。但这治标不治本要查为什么上次操作没结束。把I2C中断优先级调到比定时器高一级或者干脆用阻塞模式的I2CHAL_I2C_Mem_Read阻塞版内部有超时保护100ms超时后返回错误问题会缓解很多。另外检查是不是在中断回调里又调用了I2C读函数导致重入冲突。4.3 姿态角漂移静态放置时角度持续变大现象模块静止放在桌面Roll和Pitch角每分钟漂移0.5°以上时间越长越明显。原因陀螺仪零偏bias没有校准。每个MPU6050在出厂时零偏都不同而且会随温度变化。互补滤波里如果直接用原始陀螺仪数据参与积分零偏会被持续累积时间越长漂移越大。你可能会想不是有互补滤波里的加速度计校正项吗但0.98的权重决定了加速度计校正非常弱微小的零偏足以在长时间积分后产生明显漂移。解决上电后先让模块静止3~5秒在这段时间内对陀螺仪三个轴的读数取平均值作为零偏值保存之后每次读取都减去这个零偏再做积分。这个校准过程建议做成一个函数在产品启动流程中调用而不是在代码里写死零偏值因为温度变化后零偏会变写死等于没校准。4.4 数据跳变偶尔出现极端值现象打印的加速度数据大部分时间平稳但偶尔会出现一个明显离谱的值比如Z轴突然变成-16000。原因I2C读数据时没有对齐。如果主控在读6字节数据组的中间时刻恰好有新的采样数据写入寄存器MPU6050的寄存器写入不是原子的就会读到新采样和旧采样的拼接组合导致跳变。简而言之读取的6个字节来自两次不同的采样。解决加数据有效性校验读出来之后计算三个轴的合成向量模长如果和重力加速度g约16384 LSB偏差超过20%判定本次读取无效并丢弃。代码如下/* 数据校验合成向量模长应接近重力加速度 */ #define G_REF 8192.0f /* ±4g量程下的1g对应值 */ int is_valid_data(int16_t ax, int16_t ay, int16_t az) { float mag sqrtf((float)ax * ax (float)ay * ay (float)az * az); if (mag G_REF * 1.2f || mag G_REF * 0.8f) { return 0; /* 丢弃本次数据 */ } return 1; }这个校验对静态场景很有效但在剧烈运动场景下合成模长偏离g是正常的所以这个方法只适用于静止或慢速运动场景。如果你做的是高动态应用更好的方案是读STATUS寄存器中的数据就绪位等新数据完全写好后再读取但协议开销会大一些。5. 二次开发从原始数据到工程级姿态产品5.1 零偏校准流程封装把上电校准逻辑抽成一个独立函数这样每次上电都会自动校准代码只要在main函数初始化后调用一次即可不用每次改代码手动补偿。/* 陀螺仪零偏校准静止时采样100次取平均 */ void mpu6050_calibrate_gyro(float *bias_x, float *bias_y, float *bias_z) { int32_t sum_x 0, sum_y 0, sum_z 0; int16_t rx, ry, rz, gx, gy, gz; for (int i 0; i 100; i) { mpu6050_read_raw(rx, ry, rz, gx, gy, gz); sum_x gx; sum_y gy; sum_z gz; HAL_Delay(10); } *bias_x (float)sum_x / 100.0f / 65.5f; /* 除以100取平均再换算成°/s */ *bias_y (float)sum_y / 100.0f / 65.5f; *bias_z (float)sum_z / 100.0f / 65.5f; }这个函数的关键在于两点一是采样次数要够100次取平均能把随机噪声压到很小二是换算因子65.5必须和你初始化里配置的陀螺仪量程匹配如果改量程这里也要同步改。调用时要注意校准期间模块必须保持静止可以在产品提示里加一句请保持设备静止。5.2 数值计算的小技巧用atan2f代替asin加速度计解算Roll和Pitch角时有一个很多人会忽略的数值问题用asin计算Pitch角在接近90°时输入接近1函数导数趋于无穷微小噪声会被放大导致角度抖动剧烈。而atan2f是四象限反正切天然避开了这个问题。/* 加速度计解算角度输入为物理单位g */ accel_roll atan2f(accel_y, accel_z) * 57.29578f; accel_pitch atan2f(-accel_x, sqrtf(accel_y * accel_y accel_z * accel_z)) * 57.29578f;这里的57.29578f是180/π把弧度转成度。atan2f的第一个参数是Y轴分量第二个是X轴分量顺序不要搞反——很多人在这里把参数写反导致Roll和Pitch互换静态时看不出来一倾斜就露馅。5.3 调试习惯这套工程跑通之后我自己养成了一个固定流程先读WHO_AM_I确认通信再静止校准零偏再固定频率采样最后加数据模长校验。每一层都有对应的失败特征——通信问题看ID、漂移问题查零偏、跳变问题查校验这样出了问题能快速定位是哪一层的事而不是从头到尾把代码翻一遍。从那以后我每次做IMU相关项目都强制走一遍这套流程基本没有在一个问题上卡超过半小时。希望帮到你。获取这份STM32HAL库MPU6050工程源码后建议先用Keil或CubeIDE打开.ioc文件确认芯片型号和你手上的板子一致再按第2章的接线表连好硬件跑通第3章的例程最后再按第5章的方式改造成你自己的逻辑。相信这颗小芯片在你的板子上很快就能输出稳定的姿态角。本文还有配套的精品资源点击获取