简介面向嵌入式入门与进阶开发者一套基于STM32F103C8T6与MPU6050的Keil完整工程可直接编译下载使用。工程自带标准外设库源码与头文件并配套完整示例与说明文档覆盖I2C读取MPU6050原始数据、姿态解算、串口输出及定时器、ADC、USART等常用外设驱动适用于飞行器、机器人、智能穿戴及健康监测等姿态检测场景。资源共188个文件、约6.16MB以c与h源码、o与d及crf编译中间文件为主另含uvprojx工程配置、hex烧录文件与map映射表源码与工程结构齐全。项目内还保留批处理清理脚本便于一键整理临时编译产物与中间文件。已有2616人学习下载对初学者可参照例程快速上手对开发者则可在此基础上修改移植省去环境配置与底层调试时间直接聚焦应用层开发并结合文档快速理解姿态解算原理与代码逻辑。1. 一套源码先讲清楚一件事MPU6050解出来的姿态角到底怎么用反直觉的地方在于不少人以为 MPU6050 一上电就能直接读出角度实际它只给你三轴加速度和三轴角速度的原始寄存器值俯仰、横滚、偏航角全是靠后续的姿态解算算出来的。这份 STM32F103C8T6 MPU6050 源码工程把“原始数据 → 完整姿态角”的整条链路全部打通了拿到就能直接编译下载使用。适合正在做平衡小车、四轴飞控、云台稳像或者体感交互的开发者哪怕你第一次碰 I2C 和 DMP 固件也能顺着源码把每一步吃透不用再东拼西凑找例程。2. 工程结构拆解一个主循环串起的数据采集链路拿到压缩包先别急着点编译花十分钟把目录过一遍后面定位问题会快很多。这类工程通常按正点原子风格组织CORE 放启动文件和内核寄存器定义SYSTEM 放延时、串口、I2C 这类基础驱动HARDWARE 放具体外设驱动USER 放主函数和中断服务函数。你先在文件夹列表里找到这四块心里有数再往细节看。2.1 目录结构与模块划分我把典型目录结构拉出来看一下STM32F103C8T6_MPU6050/ ├── CORE/ │ ├── startup_stm32f10x_md.s │ └── core_cm3.c ├── SYSTEM/ │ ├── delay/ │ ├── sys/ │ └── usart/ ├── HARDWARE/ │ ├── i2c/ │ ├── mpu6050/ │ │ ├── mpu6050.c │ │ ├── mpu6050.h │ │ ├── inv_mpu.c │ │ └── inv_mpu_dmp_motion_driver.c │ └── oled/ ├── USER/ │ ├── main.c │ └── stm32f10x_it.c └── PROJECT.uvprojxCORE 里的启动文件和系统文件不需要动属于固定基础设施。SYSTEM 里的 delay 和 usart 是调试命脉串口打印全靠它俩。HARDWARE 里这块是重点mpu6050.c封装了寄存器读写和初始化inv_mpu.c是 InvenSense 官方的 MPU6050 底层驱动inv_mpu_dmp_motion_driver.c则是 DMP 固件加载和姿态数据读取的关键文件。OLED 不是必须的但它能让姿态角脱离电脑直接显示调试时非常直观。USER/main.c 是应用入口整个逻辑就一句话初始化硬件然后在 while(1) 里循环读姿态、刷新显示、串口上报。这种前后台架构在 F103 这种 M3 核上完全够用实时性取决于 DMP 更新频率和主循环耗时通常在 100Hz 上下。2.2 硬件接线I2C 总线上只有两个设备如果你用的是最小系统板加 MPU6050 模块接线表基本固定。这里以 STM32F103C8T6 的 I2C1 为例引脚功能接 MPU6050PB6I2C1_SCLSCLPB7I2C1_SDASDA3.3V电源VCCGND地GND一个很容易忽略的点F103 的 I2C1 是开漏输出MPU6050 模块板载的 I2C 上拉电阻如果焊的是 4.7k一般能正常工作如果是自己飞线搭的裸芯片电路SCL 和 SDA 必须各接一个 4.7k 上拉到 3.3V否则总线上连 ACK 都收不到。模块的 AD0 引脚通常悬空或接地对应 I2C 地址是 0x68如果你读到的设备地址是 0x69说明 AD0 被拉高了。这个地址在代码里有宏定义MPU6050_ADDR的值改一个字节就能切换。参考代码里 I2C 地址的写法#define MPU6050_ADDR 0x68 // AD0 0 #define MPU6050_SLAVE_WRITE (MPU6050_ADDR 1) // 0xD0 #define MPU6050_SLAVE_READ ((MPU6050_ADDR 1) | 1) // 0xD1为什么要左移一位因为 I2C 总线上的地址是 7 位而读写操作要的是 8 位字节最低位决定方向。这个细节经常有人搞混直接写 0xD0、0xD1 没问题但看代码时容易懵知道是左移来的就通了。2.3 主循环里的数据流传感器数据到应用层的路径main.c 里边的逻辑不复杂核心就三行代码MPU6050_Init()上电配置然后循环里dmp_read_fifo()拿四元数get_roll_pitch_yaw()转欧拉角最后决定是送 OLED 还是送串口。姿态解算的数据链路是这样的MPU6050 内部的 DMP 处理器直接读加速度计和陀螺仪原始数据在传感器内部完成四元数解算MCU 只需要通过 I2C 把结果取回来。这种方案的好处是 MCU 不参与矩阵运算F103 的 72MHz 主频跑起来毫无压力主循环里还能剩不少 CPU 时间做控制逻辑或通信协议。给中间变量加了注释的流程说明大致是while(1) { // 1. 从 DMP FIFO 取四元数成功才往下走 if (dmp_read_fifo(accel, gyro, quat, sensor_timestamp) 0) { // 2. 四元数转欧拉角单位是度 get_roll_pitch_yaw(pitch, roll, yaw, quat); // 3. 串口打包上行 / OLED 刷新 USART_Send_Data(pitch, roll, yaw); OLED_Show_Data(pitch, roll, yaw); } }这里读懂最关键的一点dmp_read_fifo返回 0 才说明 FIFO 里有新数据如果它持续返回非零值姿态角就不会更新问题大概率出在 DMP 没初始化成功或者 FIFO 溢出后面避坑章节会展开。3. 核心模块逐一放码I2C、DMP 与四元数转欧拉角这一章是整份源码最值得反复看的部分。我不会把整个文件贴出来而是按代码执行顺序把几个关键函数拆开你能照着画出一条完整调用链。先从最底层的 I2C 通信说起。3.1 I2C 驱动两个函数握住了整条总线MPU6050 的所有寄存器操作都是通过 I2C 完成的读和写各自封装一个函数就够了。写寄存器是这么实现的// 向 MPU6050 指定寄存器写入一个字节 // 成功返回 0NACK 返回 1 uint8_t MPU6050_Write_Byte(uint8_t reg, uint8_t data) { I2C_Start(); I2C_Send_Byte(MPU6050_SLAVE_WRITE); // 写地址 0xD0 if (I2C_Wait_Ack() ! 0) { I2C_Stop(); return 1; } I2C_Send_Byte(reg); // 寄存器地址 I2C_Wait_Ack(); I2C_Send_Byte(data); // 要写入的值 I2C_Wait_Ack(); I2C_Stop(); return 0; }这个函数的参数看着简单reg是寄存器地址data是配置值。但要注意每一步I2C_Wait_Ack()都在确认从设备在线如果返回非零多半是接线问题或上拉电阻缺失而不是代码逻辑问题。调试时建议在函数里加一个失败计数连续失败 10 次直接报警比主循环里死等要省心。读寄存器稍微复杂一点要先写寄存器地址再重新发起起始条件切换到读模式uint8_t MPU6050_Read_Byte(uint8_t reg) { uint8_t res 0; I2C_Start(); I2C_Send_Byte(MPU6050_SLAVE_WRITE); I2C_Wait_Ack(); I2C_Send_Byte(reg); I2C_Wait_Ack(); I2C_Start(); // 重启总线 I2C_Send_Byte(MPU6050_SLAVE_READ); // 读地址 0xD1 I2C_Wait_Ack(); res I2C_Receive_Byte(); // 读一个字节 I2C_Stop(); return res; }这里反复 Start 不是因为强迫症而是 I2C 协议的固定要求读操作必须先发送寄存器地址再在总线空闲后重新发起读事务。很多新人在这个地方翻车以为一个 Start 就能搞定结果读回来的永远是 0xFF。多字节读取比如一次拿六个轴的数据可以在这个函数基础上用连续读实现但 DMP 固件走的是官方i2c_read回调逻辑类似。3.2 初始化序列把传感器从睡梦中叫醒再设置量程MPU6050 上电默认是睡眠状态必须往电源管理寄存器写 0 才能唤醒。初始化函数的第一步就是这个然后配置采样率、量程和数字低通滤波。void MPU6050_Init(void) { MPU6050_Write_Byte(MPU6050_PWR_MGMT_1, 0x00); // 0x6B 唤醒并选择内部时钟 delay_ms(10); MPU6050_Write_Byte(MPU6050_SMPLRT_DIV, 0x07); // 0x19 采样率分频 MPU6050_Write_Byte(MPU6050_CONFIG, 0x06); // 0x1A 数字低通滤波 MPU6050_Write_Byte(MPU6050_GYRO_CONFIG, 0x18); // 0x1B 陀螺仪 ±2000dps MPU6050_Write_Byte(MPU6050_ACCEL_CONFIG, 0x00); // 0x1C 加速度计 ±2g delay_ms(50); }每个寄存器做的事不一样逐个说明一下。SMPLRT_DIV是采样率分频器内部陀螺仪输出频率默认 8kHz写 0x07 意味着 8kHz/(17)1kHz 采样率对姿态解算来说够用。CONFIG寄存器里的低通滤波配置是 0x06对应 1kHz 采样率下截止频率大约是 5Hz能滤掉不少高频噪声代价是响应变慢。GYRO_CONFIG写 0x18 是选择 ±2000°/s 量程ACCEL_CONFIG写 0x00 是 ±2g 量程如果做的是激烈运动的产品加速度计量程建议改成 ±8g对应寄存器值 0x10。初始化完成后建议读一次WHO_AM_I寄存器 0x75正常值是 0x68。这一句并不在初始化函数里强制做但我在调试时会加因为器件地址配置错了或者芯片是坏的这步立刻能暴露问题。3.3 DMP 固件让传感器自己算四元数DMPDigital Motion Processor是 MPU6050 内部的一颗可编程处理器官方把姿态解算固件通过 I2C 烧录进芯片的 RAM 里之后 MCU 就不用参与解算了。初始化 DMP 的入口是mpu_dmp_init内部做了三件事复位传感器、调用dmp_load_motion_driver_firmware()加载固件、使能六轴四元数输出。u8 mpu_dmp_init(void) { u8 ret 0; mpu_init(); // 复位并初始化传感器 ret dmp_load_motion_driver_firmware(); // 烧录固件到 MPU6050 RAM if (ret 0) { ret dmp_set_fifo_rate(100); // 设置 100Hz 输出 ret dmp_enable_feature(DMP_FEATURE_6X_LOW_QUAT); // 使能 6 轴四元数 ret dmp_set_interrupt_mode(DMP_INT_MODE_GESTURE); // 中断模式配置 ret mpu_set_dmp_state(1); // 启动 DMP } return ret; }注意看dmp_enable_feature(DMP_FEATURE_6X_LOW_QUAT)这个宏它决定 DMP 输出的是四元数还是欧拉角。官方驱动里还能使能DMP_FEATURE_TAP、DMP_FEATURE_ANDROID_ORIENT这类手势识别功能但一般用不到开了反而增加 FIFO 负担。DMP 固件的大小和 F103 的 Flash 容量要算一笔账inv_mpu_dmp_motion_driver.c里的固件数组有几十 KB加上库函数、协议栈和 OLED 驱动C8T6 的 64KB Flash 会非常紧张。完整工程里一般要在编译选项里开启-O2优化否则很容易出现 Flash 溢出的链接错误这个问题后面避坑章节会专门说。3.4 四元数转欧拉角最后一步的数学细节DMP 输出的四元数是 Q14 定点格式范围是 -1 到 1但不能直接当浮点用要除以 16384 转成归一化四元数再套三角函数公式// quat[0]~quat[3] 是 DMP 输出的四元数 u16 q[4]; float q0, q1, q2, q3; float pitch, roll, yaw; q0 q[0] / 16384.0f; q1 q[1] / 16384.0f; q2 q[2] / 16384.0f; q3 q[3] / 16384.0f; pitch asin(-2 * q1 * q3 2 * q0 * q2) * 57.3; roll atan2(2 * q2 * q3 2 * q0 * q1, -2 * q1 * q1 - 2 * q2 * q2 1) * 57.3; yaw atan2(2 * q1 * q2 2 * q0 * q3, -2 * q2 * q2 - 2 * q3 * q3 1) * 57.3;这段代码的三个角度都乘了 57.3这是弧度转角度因为asin和atan2返回的是弧度值。注意pitch的计算用了asin它的输入范围是 [-1,1]如果四元数没有归一化到位这里可能会出现NaN。用atan2计算yaw也是故意的它能处理四个象限比atan稳得多。转换结果里yaw有一个众所周知的短板当pitch接近 ±90° 时yaw会漂移甚至跳变。这不是代码写错了是欧拉角的万向锁问题。想要绕开它得把四元数直接传给上层控制算法。如果你做的是平衡车pitch和roll足够用如果做的是需要全姿态输出的设备建议保留四元数格式不要转欧拉角。4. 跑起工程的三件事编译配置、接线烧录、看串口数据源码在手怎么让它跑起来是下一个问题。这章按操作顺序来从打开工程到在屏幕上看到姿态角每一步卡住都有对应的检查方法。4.1 Keil 工程配置Flash 容量是第一个坎用 Keil 打开.uvprojx后先按 F7 编译一次如果看到FLASH: 64KB超出的报错说明工程默认的优化等级不够。进入Options for Target的 C/C 选项卡把 Optimization 调到-O2或-O3同时勾选One ELF Section per Function链接时会把没用的函数裁掉。这个工程用的是标准外设库需要在C/C选项卡的Define里确认STM32F10X_MD这个宏存在。它决定了器件是中等密度还是高密度直接影响启动文件和寄存器定义。如果宏不对最常见的问题是外设寄存器地址错乱表现为编译能过、运行就进 HardFault。Debug 选项卡要选ST-Link或J-Link取决于你手里的下载器然后在Flash Download里勾选Reset and Run烧录完自动复位运行省掉手动按复位键这一步。4.2 接线清单四根线加一个下载器烧录调试用 SWD 是最省引脚的方式一共四根线SWDIO、SWCLK、GND、3.3V。STM32F103C8T6 最小系统板的 SWDIO 是 PA13SWCLK 是 PA14一般板子都丝印标好了照着接就行。注意一点目标板如果由下载器供电3.3V 要接如果目标板已经接了 USB 线供电3.3V 可以不接但 GND 必须和下载器共地否则通信不稳定。我碰到过 SWD 能连上但下载一半报RDDI-DAP Error的情况十有八九是地线接触不良。上电之前先量一遍 VCC 和 GND 有没有短接MPU6050 模块接反一次就会烧传感器这是血泪经验。模块供电电压一定是 3.3V不要图省事接 5V虽然有些模块带了稳压芯片但裸片模块直接接 5V 立马冒烟。4.3 串口上位机看到姿态角的三步验证工程默认用串口 1 输出数据波特率一般在usart.c里定义常见是 115200 或 460800。连接方式很简单USB-TTL 模块的 TX 接 F103 的 PA10USART1_RXRX 接 PA9USART1_TX波特率选对然后打开串口助手。数据格式通常是-pitch,roll,yaw加换行或者打包成固定帧格式。如果你是第一次跑只需要做三个动作验证解算结果让模块水平静止pitch 和 roll 应该在 0° 附近 ±1° 抖动绕 Y 轴旋转 90°roll 显示 90° 或 -90°绕 X 轴旋转 90°pitch 显示对应的角度如果水平静止时 yaw 缓慢漂移这是陀螺仪零偏导致的正常现象DMP 已经通过自有算法抑制了一部分但长时间累积还是会有误差后面避坑章节讲怎么校准。如果绕轴旋转后角度回不到原来位置优先检查模块固定是否牢固手拿着晃会让加速度计的静态分量混进姿态解算。4.4 OLED 显示不依赖电脑的本地验证有 OLED 模块的话工程里已经带了 0.96 寸 SSD1306 驱动初始化后每 50ms 刷新一次三个角度。代码通常在 main 循环里调用OLED_ShowString显示角度的字符串。OLED 的 I2C 地址是 0x78写或 0x7A读具体看模块背面的电阻配置。工程默认用的是0x78如果你的模块显示不出来检查oled.c里的地址宏。OLED 和 MPU6050 共用同一路 I2C 总线没问题I2C 本身就是多设备总线只要地址不冲突就行。OLED 不亮的时候还有一种常见情况模块是 4 针 SPI 版本不是 I2C 版本。买之前看清楚型号SPI 版本的 SSD1306 例程使用的是不同的引脚接线硬接上去只会白屏。5. 常见问题与避坑五个让新手卡壳的现场这一章列五个我在调试中真实踩过或帮人排查过的典型问题。每一条都按“现象 → 原因 → 解决”的顺序写你可以当排查手册用。5.1 I2C 扫描不到 0x68上拉电阻和 AD0 在捣乱现象初始化函数卡在MPU6050_Init()里的I2C_Wait_Ack()寄存器写入一直返回 1或者写一个 I2C 扫描程序总线上什么都扫不到。原因有两种一个是 SCL/SDA 两根线缺少上拉电阻导致电平无法被拉高另一个是 MPU6050 的 AD0 引脚电平不明确地址从 0x68 变成了 0x69程序还在按 0x68 找设备自然找不着。解决用万用表量 SCL 和 SDA 的对地电压正常应该在 3.3V 附近如果接近 0V 就是漏接了上拉。然后检查 AD0 引脚悬空、接地是 0x68接 VCC 是 0x69。程序里如果不是用 7 位地址而是用 8 位地址扫描也要同步调整。经验做法初始化函数里加一个MPU6050_Read_Byte(MPU6050_WHO_AM_I)返回 0x68 才算通过放在 while 循环里阻塞等待不通过就串口打印错误码避免静默失败。5.2 DMP 初始化失败FIFO 溢出和中断配置混乱现象mpu_dmp_init()返回值是 4 或者别的非零值上位机收不到任何姿态数据。原因DMP 初始化失败通常不是固件问题而是 FIFO 溢出。如果在上电初始化之前有人往 FIFO 里写过数据或中断引脚 MPU6050_INT通常接 PA8没有正确配置为输入浮空DMP 输出的姿态数据无法及时取走FIFO 就满了。解决在初始化前先调mpu_reset_fifo()清空再按顺序执行mpu_init、dmp_load_motion_driver_firmware、dmp_enable_feature。另外检查EXTI初始化代码PA8作为外部中断输入要配置为上升沿触发并且在中断服务函数里调用dmp_read_fifo把数据取走。如果你不用中断也可以靠主循环轮询但轮询时速率必须跟得上 DMP 的 100Hz 输出。5.3 编译链接时报 Flash 超容量优化等级和裁剪函数现象L6238E: Execution region ... does not fit in ...提示 Flash 不够具体尺寸超出 64KB。原因DMP 固件数组本身就是几十 KB标准外设库默认加进工程的所有外设源文件也占空间Keil 在默认-O0等级下会生成大量调试信息Flash 很快就爆了。解决把优化等级设为-O2并勾选One ELF Section per Function。这两个设置能砍掉大部分未调用函数如果还是不够检查inv_mpu.c里不需要的功能把MPU6050_INCLUDE_DMP_MOTION_DRIVER相关的代码保留其余传感器代码可以精简。工程里如果同时勾选了 DSP 库或者调试信息打印先关掉再试。5.4 姿态数据跳变、偶然飙到几百加速度计量程和滤波背锅现象pitch 和 roll 在静止时偶尔会突然跳到 180°或者数值在高频抖动。原因DMP 解算用的是六轴融合带陀螺仪积分补偿加速度计量程不匹配会导致内部校准失效另外电源纹波过大或数字低通滤波配置太松高频振动混进加速度计解算结果自然不干净。解决把ACCEL_CONFIG从 ±2g 改到 ±8g寄存器值写 0x10然后重新初始化 DMP。电源方面看 MPU6050 模块的 VCC 引脚最好用 LDO 单独供电不要和舵机或电机驱动共用一个电源。还有一个小细节模块上的焊接点如果松了角度会随着线晃动改变检查排针或杜邦线有没有接触不良。排除法做一遍先把模块固定牢靠再看软件滤波。5.5 陀螺仪零漂导致 yaw 停不住初始化时做零偏校准现象模块水平放置时 pitch、roll 稳定但 yaw 以每秒几度的速度缓慢转圈或者停止旋转后 yaw 回不到原点。原因这是陀螺仪零偏导致的积分累积问题DMP 只能缓解一部分无法完全消除。环境温度、供电电压都会影响零偏一年前校准的数据现在不一定适用。解决在代码里加一个简单的零偏校准流程开机后让模块静止 2 秒采集加速度计和陀螺仪的初始偏移值然后在初始化 DMP 前调mpu_set_gyro_bias写进寄存器。更直接的方案是在产品逻辑里做动态校准比如无人机在地面检测到 2 秒以上的水平静止状态就自动重新校准零点。注意 yaw 本身没有绝对参考只用陀螺仪积分所以长时间运行必然漂移这是物理限制。如果应用场景对航向精度要求高得加磁力计做九轴融合这不是本工程的范围。6. 二次开发思路把姿态数据用进你自己的系统拿到这份源码不是终点真正的价值在于你知道怎么改它。这里给三条改造路径从容易到复杂方便你按产品需求切进去。第一条是把解算算法换掉。DMP 虽然方便但它在某些动态场景下反应偏慢如果做的是机械臂末端姿态反馈可以考虑改为互补滤波或卡尔曼滤波。互补滤波的核心思路是陀螺仪积分提供短期精度、加速度计提供长期无漂移参考代码量不大但一个关键参数要现场调加速度计信任权重调大了角度毛刺多调小了响应迟钝。从这份工程改起你只需要不动 I2C 读取逻辑把dmp_read_fifo换成自己读加速度和角速度原始值然后把互补滤波函数接进去就行。第二条是串口协议封装。现在工程输出的是逗号分隔的简单字符串如果接飞行控制板或者上位机做二次开发建议改成带帧头、帧尾和校验字节的协议。帧头用0xAA 0x55后跟数据长度和 CRC8上位机解析就稳定多了。协议定型之前先在纸上把字节序画清楚大小端不一致是嵌入式开发里最坑的玄学问题之一。第三条是接 PID 控制。平衡小车或云台的本质都是把姿态角当作反馈量误差送进 PID输出 PWM 控制电机。注意改造时要把更新频率从串口打印那种几十赫兹提到 200Hz 以上控制周期越短系统越稳。PID 三个参数可以从纯 P 开始一点一点加先能把车扶正再加微分抑制振荡最后加积分消除静态误差。早期我调 MPU6050 的时候总想着拿现成角度直接开局后来把 I2C 再读一遍才发现自己连量程都没配对。从那以后我每次换传感器模块都强制走一遍完整流程先看 WHO_AM_I再读原始轴数据验证方向最后才上姿态解算。这套工程跟这个习惯一样每一步都摆在那里跑通了就是你的基本功。希望帮到你。本文还有配套的精品资源点击获取