STM32F103驱动LSM6DSL六轴传感器：I2C通信与数据融合实战

简介这是基于STM32F103CBT6主控的LSM6DSL运动传感器加速度计陀螺仪驱动源码包面向嵌入式运动传感与STM32外设编程学习者解决传感器数据采集与串口输出的快速验证问题。压缩包共144个文件、约4.53MB文件类型以34个.h头文件、33个.c源文件为主包含ST标准外设库、Keil工程文件、编译中间文件及清理脚本目录内还含有keilkilll.bat等辅助工具便于重新编译与工程维护。驱动同时提供IIC和SPI两种接口方式默认通过IIC读取LSM6DSL数据如需改用SPI只需修改初始化调用部分无需大面积改动适配性强程序将实时加速度和陀螺仪数据通过串口打印方便示波器或串口助手观察调试。目前已有3091人学习下载适合希望快速掌握传感器驱动编写、串口通信或STM32工程搭建的开发者参考。 前两天折腾了一个STM32F103 LSM6DSL的工程包看到压缩包名字的时候我就知道里面是什么一块芯片、一个六轴传感器加上一堆标准外设库代码。这类包网上很多但大多数解压后不是直接能跑而是要花不少时间在接线、初始化、寄存器配置这些细节上。这个组合其实很典型STM32F103 是入门首选 MCULSM6DSL 是 ST 出品的低功耗六轴惯性传感器加速度计加陀螺仪适合做姿态、计步、人机交互、跌倒检测这类应用。把这颗传感器调通并读出稳定数据中间确实有不少值得记录的细节我分几块讲清楚。H2 2. 解压之后先搞清这颗 LSM6DSL 到底能干什么H3 2.1 六轴数据是什么别把加速度和角速度搞混LSM6DSL 内部集成了三轴加速度计和三轴陀螺仪输出的是 6 路原始数据。加速度计测量的是物体受到的比力静止时垂直轴能读出 1g 的重力加速度所以它能给出“倾斜”信息陀螺仪测量的是绕三个轴的旋转角速度把它积分后能估算转过的角度但会随时间漂移。两者配合才能通过滤波得到稳定姿态角单靠任何一个都不行。我在调试时遇到过不少人只盯着加速度计看发现稍微一晃角度就乱跳其实是因为没有陀螺仪数据参与融合。这颗传感器支持 I2C 和 SPI 两种接口默认我一般用 I2C因为接线少只要 SCL、SDA 两根线。它支持 1.8V 到 3.3V 供电和 3.3V 的 STM32F103 正好匹配。需要注意的是STM32F103 的 GPIO 虽然标称可以容忍 5V但 LSM6DSL 可不是 5V 器件I2C 上拉电阻必须接到 3.3V千万不能顺手拉到 5V 上否则长时间运行容易把传感器烧掉。H3 2.2 为什么用 STM32F103 搭配 LSM6DSLSTM32F103 这款芯片主频 72MHz自带 I2C、SPI、USART、USB 等外设开发资料和固件库都非常成熟成本也低是目前学习 IMU 驱动最常用的 MCU 之一。搭配 LSM6DSL 的 I2C 接口一个工程下来能同时练习到外设初始化、寄存器读写、中断处理、低功耗设计这些嵌入式基本功。工程包里通常会有几个目录CORE 放启动文件HARDWARE 放外设驱动SYSTEM 放时钟和延时USER 放 main。我拿到这类包后的第一步不是看 main而是先找lsm6dsl.c和lsm6dsl.h确认驱动层接口有没有封装好再看主函数里怎么调用。这类参考工程普遍是基于标准外设库写的对于新人来说其实比 HAL 库更容易看清寄存器操作逻辑因为每一行都对应手册里的寄存器位。但说白了工程包的代码是别人的思路你要做的是把它消化成自己的理解每一步为什么这么写。H3 2.3 重要寄存器与 WHO_AM_I 校验开始写初始化之前一定要先学会读WHO_AM_I寄存器。LSM6DSL 的地址是 0x0F读出来的固定值应该是0x6A。这一步能验证三件事接线是否正确、I2C 地址是否选对、传感器是否处于正常的通信状态。我在移植时发现相当多问题出在这里有人读回来是0xFF那就是 SDA 上拉没接或者从机地址不对有人读回来是 0x00大概率是 SCL 被拉死或者芯片没供上电。只有确认 WHO_AM_I 正确再继续往下配寄存器才有意义。I2C 从机地址由 SA0 引脚的电平决定常见地址是 0x6A 或 0x6B。注意这个 0x6A 和 WHO_AM_I 的 0x6A 只是数值巧合不是一回事很多新手在这里绕晕。驱动代码里addr和who_am_i要分开看别混了。H2 3. 从零跑通 I2C 通信硬件接线与初始化顺序H3 3.1 接线图和我常用的引脚选择STM32F103 的硬件 I2C 控制器在业界口碑不太好很多人宁可花时间软件模拟也不愿意用硬件 I2C。我用过几次硬件 I2C 后最终还是把工程里的读取函数改成 GPIO 模拟 I2C原因后面详细说。这里先给一套我实测稳定的接线方案使用 PB6 作 SCLPB7 作 SDA两个引脚各接一个 4.7kΩ 上拉电阻到 3.3VLSM6DSL 的 VDD 接 3.3VGND 共地SA0 我默认接 GND这样 I2C 地址就是 0x6A。如果你把 SA0 接 VDD地址会变成 0x6B代码里别写死。如果只是验证通信不需要接 INT 引脚但如果要用中断唤醒就把 INT1 接到 STM32 的外部中断引脚比如 PA0。还有一个容易忽略的是 LSM6DSL 的VDD_IO引脚它决定 I2C 接口电平必须接 3.3V否则通信时序会异常。H3 3.2 初始化序列先复位、开 BDU再配量程和采样频率LSM6DSL 的初始化顺序很关键不建议直接跳过复位。我的推荐顺序是对CTRL3_C地址 0x12写入0x01触发软件复位然后等待 20ms。再次向CTRL3_C写入0x04把BDU位置 1。BDU 是“Block Data Update”它的作用是确保读取高字节和低字节时不会被新数据打断防止出现前一刻读高位、下一刻数据已经更新的半截数据。配置CTRL1_XL0x10设置加速度计量程和输出数据速率比如写入0x60表示 ±8g、1.66kHz。配置CTRL2_G0x11设置陀螺仪量程和数据速率比如写入0x58表示 ±1000dps、1.66kHz。配置CTRL6_C0x15等辅助寄存器默认也可以不写。读取STATUS_REG0x1E等待数据就绪位。很多人初始化不检查返回状态直接从输出寄存器读数据。我建议在每个寄存器写入后都跟着读一遍至少在关键寄存器上验证写成功不然后面出了问题很难定位是通信问题还是寄存器配置问题。H3 3.3 为什么我推荐软件 I2C 而不是硬件 I2CSTM32F103 的硬件 I2C 在引脚复用时配置麻烦一旦遇到总线错误I2C_SR1里的各种错误标志常常让新手手足无措。我实测在 400kHz 速率下硬件 I2C 偶尔会因为 interrupt 优先级问题出现 BUSY 标志清不掉的情况尤其在高负载时更明显。软件模拟 I2C 的做法是直接用 GPIO 翻转 SCL按数据手册时序拉高拉低 SDA虽然多占一点 CPU但对 LSM6DSL 这种数据量不大的传感器来说毫无压力。而且软件 I2C 的时钟频率更容易控制遇到长线路或上拉电阻偏大时把延时调大一点就能稳定通信。当然硬件 I2C 也不是不能用如果你后续要用 DMA 搬大量数据硬件 I2C 有优势。但从稳定性和快速出成果的角度我建议先把软件 I2C 跑通再去研究硬件 I2C 的进阶玩法。H2 4. 把原始值变成物理量量程换算与标定H3 4.1 原始数据的读取与灵敏度换算LSM6DSL 的每个输出通道是 16 位数据存在两个 8 位寄存器里比如加速度计 X 轴输出是OUTX_L_XL0x28和OUTX_H_XL0x29。读取时要先读低字节再读高字节合成int16_t注意不能定义为uint16_t因为带符号补码负的半轴数据需要符号扩展。合成后乘上当前量程的灵敏度才能得到物理单位。我常用的灵敏度表加速度计量程灵敏度 (mg/LSB)±2g0.061±4g0.122±8g0.244±16g0.488陀螺仪量程灵敏度 (mdps/LSB)±125 dps4.375±250 dps8.75±500 dps17.5±1000 dps35±2000 dps70比如加速度计配置成 ±8g读到的原始值是1234那么实际加速度约等于1234 * 0.244 mg/LSB再除以 1000 就是 g 值。陀螺仪同理读到的原始值转成float后乘以 mdps/LSB 再除以 1000就得到 dps。注意 LSM6DSL 手册里的灵敏度单位是mg/LSB和mdps/LSB换算时单位别抄错。H3 4.2 陀螺仪零偏静止时它不归零陀螺仪静止时理论上输出应该全 0但实际上每个轴都会有一个固定偏置这个偏置来自芯片内部结构不同批次芯片也不一样。解决方法是上电后先让设备静止放一会儿采集 100 次数据取平均作为该轴零偏。之后每次读取原始数据时先减掉零偏再乘以灵敏度。我在实测中发现温度变化会让零偏缓慢漂移所以如果产品工作温度范围大只做了常温零偏校准还是不够最好在设备启动时做一次短时静止校准或者在算法上增加零点漂移抑制。加速度计也可以做类似校准最简单的做法是水平静止采集 Z 轴读数如果不等于满量程对应的 1g就说明有偏移。但加速度计标定更完整的做法是采集六个姿态面的数据求出三个轴的偏移和比例系数这个工程包如果没有带标定程序建议自己补一个简易版否则姿态精度受影响。H3 4.3 数据就绪怎么判断LSM6DSL 的STATUS_REG0x1E每一位代表当前数据是否已更新。第 0 位XLDA表示加速度计新数据是否就绪第 1 位GDA表示陀螺仪新数据是否就绪。我见过不少代码不读状态寄存器直接一进来就读取当前寄存器值这样偶尔能行但一旦速度跟不上就会读到同一个数据两次或者读到半截更新数据。正确流程是先读STATUS_REG判断对应位是否为 1如果为 1继续读取 6 个寄存器的数据读完后再进入下一轮。这种轮询方式在单线程裸机代码里足够用也不会丢数据。H2 5. 数据搬运的工程实现状态机、FIFO 与低功耗H3 5.1 裸机轮询和状态机我推荐怎么选如果项目里只有这一个传感器main 里一个while循环轮询STATUS_REG就够了。但只要你后续加了按键、LED、串口打印循环里被其他操作占用的时间太长就容易把 IMU 数据覆盖。我后来一般会把传感器读取逻辑做成一个简单的状态机空闲、等待数据、读取数据、处理数据、发送数据。这样每个状态耗时短随时能进入更低功耗阶段。如果你想跑 RTOS这个状态机可以直接塞进一个线程里整个逻辑不会乱。H3 5.2 用 FIFO 批量读取减少 CPU 打扰LSM6DSL 内置 3KB 的 FIFO连续高频率采样时可以让传感器先把一批数据存进 FIFOMCU 每过一段时间批量读一次。这个机制在两种场景下特别有用一是 MCU 要睡眠省电可以用 FIFO 暂停在低功耗状态二是数据需要通过无线模块发送时攒一批再发比一包一包发更高效。配置 FIFO 时我建议先关注FIFO_CTRL3和FIFO_CTRL4的FTH阈值设置比如设置 FIFO 水位到 20 个样本时产生中断MCU 就会收到 INT 信号去读取。读取时要用FIFO_DATA_OUT_TAG寄存器按标签判断当前数据属于加速度计还是陀螺仪不是简单按顺序连续读六个寄存器就行。H3 5.3 低功耗场景停机模式与唤醒热搜词里多次出现“stm32f103 停机模式”这个和 IMU 项目关系很大。如果设备靠电池供电大部分时间静止就可以让 STM32F103 进入停机模式同时 LSM6DSL 只开加速度计低功耗模式检测到运动时通过中断引脚唤醒 MCU。配置要点有几个LSM6DSL 的CTRL3_C里IF_INC保持默认INT1_CTRL0x0D中把INT1_DRDY_XL或INT1_EMB_FUNC按需打开然后设置TAP_THS_X、WAKE_DUR等参数配置唤醒阈值。唤醒中断接到 MCU 的 PA0/WKUP 引脚MCU 进入PWR_STOP模式后外部中断能把内核唤醒。实际测量下来这个组合能大幅降低静态功耗比一直让 MCU 空转轮询要省几十倍电。H3 5.4 掉电保存标定数据用内部 FlashMCU 停机不会丢 RAM但完全掉电后采集到的陀螺仪零偏、加速度计偏移这些校准参数就没了。如果不想外挂 EEPROM可以把参数存到 STM32F103 内部 Flash 的最后几页。F103 的 Flash 容量几十 KB 到一百多 KB校准数据只占几十字节放在最后一页比较安全。注意写 Flash 前要先擦除整个扇区不能只改某几个字节擦写期间 CPU 会暂停。我把校准参数在上电后读出来发现异常就不使用改回默认值同时把“需要重新标定”标志记录在另一个变量里方便上位机提示用户。Flash 擦写次数有限正常设备不会频繁掉电所以不用担心寿命。H2 6. 调试 IMU 时的三个典型翻车现场H3 6.1 I2C 读到全0xFF或者状态卡死这个问题出现频率最高。先检查 SCL/SDA 上拉电阻很多最小系统板做 I2C 时已经带了上拉你不用再加但如果板子没有就一定要补。其次检查从机地址LSM6DSL 在 SA0 接 GND 时是 0x6A接 VDD 是 0x6B代码里的地址要跟硬件对上。如果这些都正常再用逻辑分析仪抓一下波形看看 SCL 是否输出稳定时钟SDA 有没有被拉死。我遇到过因为引脚复用配置错SCL 和 SDA 实际不在 PB6/PB7 上的情况这种问题靠肉眼很难看出来直接看波形最直接。H3 6.2 数据漂移、野值先查电源和接线加速度计和陀螺仪数据偶尔跳一下很多情况下不是代码问题而是电源纹波太大或者传感器部分接触不良。我用开发板供电时数据很干净换成劣质 USB 供电后 X 轴出现周期性尖峰后来在 VDD 和 GND 之间加了一个 0.1uF 和 10uF 电容尖峰消失了。传感器排线如果你用杜邦线连接长度不要超过 20cm线材晃动时也会带入噪声。软件上可以加一个简单的滑动平均但要注意滑动窗口过大会把真实运动信息抹平所以尽量先解决硬件噪声。H3 6.3 用内部晶振时I2C 时序如何调热搜词里有“让 STM32F103 工作在内部晶振模式下”。如果项目为了省成本不接外部晶振用 HSI 8MHz 作为系统时钟那硬件 I2C 的分频配置就需要重新算。F103 的 I2C 时钟源来自 APB1而 APB1 最高 36MHz如果用 HSI 倍频到 64MHz再配置好 APB1 分频I2C 速率才能正确。但我自己的经验是这种场景下直接改用软件 I2C 更省事——它就是 GPIO 翻转延时和系统时钟频率关系不大只要主循环频率够高就行。不过要注意一旦为了 USB 或更高精度应用内部晶振通常不够用LSM6DSL 这种靠 I2C 时序通信的传感器反而容易受影响。H2 7. 关于这个工程包最后补充三个可扩展方向H3 7.1 用 USB CDC 串口打印 IMU 数据调试F103 的 USB 外设可以配置为 CDC 虚拟串口把 IMU 的六轴数据直接传给上位机。这个方案比普通串口省一个 USB 转 TTL 模块还能同时保留另一个串口输出调试信息。需要留意的是USB 时钟必须以 48MHz 工作通常从外部 8MHz 晶振倍频得到如果你用内部晶振USB 枚举很可能失败。给有需要的朋友提个醒先确认板子有没有外部晶振再上 USB CDC否则还是老老实实用普通 UART 调试。H3 7.2 融合出姿态角F103 上没有 DMP 的替代方案很多人从 MPU6050 转过来习惯用芯片自带的 DMP 输出四元数但 LSM6DSL 没有 DMP需要自己做姿态融合。我推荐在 F103 上跑互补滤波它计算量小代码逻辑容易理解。陀螺仪积分提供短期角度变化加速度计姿态供长期修正两者按比例融合。如果想要更高精度可以用 Madgwick 或者 Mahony 算法但 F103 没有 FPU浮点运算量会偏大。建议把姿态解算频率控制在 100Hz 到 200Hz数据更新率没必要和传感器 1.6kHz 对齐否则 CPU 占用太高主循环会被拖垮。实际测试F103 在 72MHz 主频下跑一阶互补滤波解算 200Hz 的姿态角完全够用。H3 7.3 代码分层驱动层、中间层、应用层很多工程包把传感器驱动和业务逻辑揉在 main.c 里能跑但维护起来极其痛苦。我习惯把 I2C 底层接口单独放到i2c_driver.c把 LSM6DSL 的寄存器操作放到lsm6dsl.c然后再包一层imu_app.c处理数据处理和姿态解算。这样以后想换传感器只需要改驱动层上层不用动。同时也方便写测试用例。如果你准备在这个工程包的基础上做产品别嫌麻烦一定要先分层再写业务逻辑不然以后每次改上位机协议都可能把传感器驱动搞乱。个人实际体验是这类STM32F103 LSM6DSL资料包最核心的参考价值就是帮你在最短时间内绕过通信坑但它不能替代你读数据手册。把 WHO_AM_I 和 STATUS_REG 这两个寄存器吃透后面基本不会走太大弯路。如果你手头也有这个组合在调碰到某个具体问题可以按这个排查顺序走一遍大概率能省一个下午的时间。本文还有配套的精品资源点击获取