STM32C5轮询读取LSM6DSOW陀螺仪数据：从寄存器到实测

拿到一块STM32C5开发板，我第一件事就打算让它驱动LSM6DSOW六轴惯性传感器。这个组合在可穿戴设备原型里很常见：C5负责算，LSM6DSOW负责采集陀螺仪和加速度计数据。本篇是系列第一篇，先把最基础的一件事做通——用轮询方式获取陀螺仪数据。适合正在从F1/F4平台迁移到C5、或者第一次在STM32上调试IMU的开发者。文章不会只贴代码，我会把寄存器为什么这么配、轮询到底在等什么、实测中会遇到哪些坑都说清楚。作为第一篇，我尽量保持最低依赖：CubeMX生成工程，底层只调HAL库的I2C函数，不引入任何第三方驱动。先跑通，再谈优化。

1. 先说说为什么这套组合值得从轮询开始

1.1 STM32C5这种新平台反而更适合练驱动

STM32C5是ST新推出的主流型MCU，内核换成了Arm Cortex-M33，主频可以跑到250MHz，带FPU和DSP指令集，功耗控制也比老的F系列强不少。它提供的I2C、SPI、USART这些基础外设数量充足，做传感器数据采集这类任务绰绰有余。

实际项目里，很多人拿到新平台的第一反应是去找现成的库，最好一行代码都不写就能把传感器数据读出来。但这次我建议反过来：越是新平台，越应该从寄存器级驱动开始写。原因很简单，C5在CubeMX里的支持已经成熟，但各种第三方驱动库针对STM32C5的适配参差不齐，很多还停留在“能用”而不是“可靠”的阶段。自己把传感器初始化、数据读取、换算这条路走一遍，后面不管移植什么库，出了问题都能快速定位。

1.2 LSM6DSOW的关键特性：不只是个陀螺仪

LSM6DSOW是ST推出的六轴惯性传感器，内部集成了三轴加速度计和三轴陀螺仪。它的W后缀代表低功耗版本，专门针对可穿戴设备优化过功耗，正常工作电流可以做到很低。传感器本身还带一些高级功能，比如FSM有限状态机和MLC机器学习核，可以在传感器内部完成动作识别、异常检测，把结果直接通过中断脚告诉MCU。这些高级功能听起来很酷，但前提是最基本的数据通路要先跑通——传感器有没有正常初始化、数据寄存器能不能读出来、读出来的值到底对不对。本篇的核心就是这个地基。

1.3 轮询为什么是第一篇的正确选择

读取IMU数据常见三种方案：轮询、中断、FIFO加DMA。轮询看起来最“笨”，但它的优势非常明显：

• 不依赖外部中断引脚，硬件连接简单
• 不需要理解FIFO水位、批处理、DMA传输这些进阶概念
• 代码执行路径完全可控，每一步在干什么一目了然
• 排查问题更直接，寄存器没配好、接线有问题，很快就能暴露

中断方式虽然省CPU，但需要把传感器中断引脚接到MCU的EXTI，还要处理中断回调里读数据的时序问题。FIFO方式效率高，但如果FIFO触发条件、水位阈值没搞明白，读出来一堆错位数据反而更头疼。我的建议是：第一版驱动一定用轮询跑通，把寄存器配置和输出数据格式摸清楚，再根据实际负载去升级机制。轮询模式对入门和理解底层是最友好的，这步走稳了，后面切中断或者FIFO都有底。

2. 硬件接线与CubeMX工程准备

2.1 I2C和SPI到底选哪个

LSM6DSOW支持I2C和SPI两种接口。同一个传感器，两种都支持，但硬件接法和驱动代码差别不小。我在第一版里选了I2C，理由见下面的对比。

如果只是为了把陀螺仪数据读出来，I2C的400kHz速率完全够用。传感器ODR即使开到833Hz，一次读6个字节加状态判断，占用总线的时间也很短。SPI的高速率优势在需要频繁读取大量数据时才明显，比如后面要启用FIFO并一次读出几十个样本。所以本篇用I2C，如果你手头模块是SPI版本，改起来也不复杂，核心寄存器配置是一致的。

2.2 接线和I2C地址的关键细节

LSM6DSOW的供电范围是1.71V到3.6V，用开发板上的3.3V供电即可。接线表如下：

这里有个特别容易踩的坑：传感器的CS引脚如果拉低，芯片会进入SPI模式，I2C通信直接失效。所以用I2C时CS必须接到VDD，不是浮空，更不是接GND。另外SA0引脚的电平决定I2C设备地址：SA0接地时7位地址是0x6A，接高时是0x6B。我用的模块上，SA0默认有一根跳线或者电阻配置，第一次用最好查一下模块原理图，确认地址到底是哪个。地址搞错，后面所有I2C通信都会超时。

2.3 CubeMX配置步骤

STM32C5在CubeMX里需要较新的版本才支持，建议直接使用当前最新版。配置流程：

• 新建工程，选择具体型号的STM32C5芯片
• 将I2C1使能，选择I2C Fast Mode（400kHz），其他保持默认
• 使能一个USART用于串口打印，我习惯用USART2，参数设置为115200-8-N-1
• 时钟树保持默认即可，C5的时钟配置CubeMX会自动处理
• 工程名称自定义，工具链选择STM32CubeIDE，点击生成

生成之后别急着写代码，先检查三个地方。第一，I2C引脚是否已经分配了复用功能，CubeMX默认会给PB8/PB9这类引脚分配I2C功能。第二，GPIO初始化里是否配置了开漏输出加上拉电阻，I2C协议本身是开漏结构，需要上拉。有些模块板上自带上拉电阻，有些没有，如果SDA/SCL上没有上拉，通信会非常不稳定。第三，确认USART的GPIO配置正确，否则后面printf看不到输出。

2.4 printf重定向的小准备

串口打印需要用printf，在STM32CubeIDE里要做个简单的重定向。在main.c文件开头加上：

#include <stdio.h> int fputc(int ch, FILE *f) { HAL_UART_Transmit(&huart2, (uint8_t *)&ch, 1, 0xFFFF); return ch; }

这样printf就会输出到USART2。这里有个经验：如果你用的工具链是GCC，还需要在项目设置里把newlib的浮点支持打开，否则打印浮点数会失败。后面如果只想看原始整数，可以暂时不理会浮点问题。

3. 驱动初始化：软复位、WHO_AM_I和陀螺仪寄存器配置

3.1 先读WHO_AM_I，这是连接没连对的试金石

传感器驱动第一步不是配置，而是先验证I2C通信是否正常、芯片是否在工作。LSM6DSOW的WHO_AM_I寄存器地址是0x0F，正常情况下读回的固定值是0x6C。如果读不到0x6C，后面所有操作都没意义。

uint8_t who_am_i = 0; HAL_I2C_Mem_Read(&hi2c1, LSM6DSOW_ADDR, 0x0F, I2C_MEMADD_SIZE_8BIT, &who_am_i, 1, 100); if (who_am_i != 0x6C) { // 通信异常，检查接线、地址、供电 }

这三个字节的判断能帮你排除一半以上的低级问题。地址不对读不到数据，接线错误读不到数据，模块没焊好还是读不到数据。把WHO_AM_I当作硬件验证关卡，通关后再继续。

3.2 软复位为什么放在配置前面

LSM6DSOW上电后，内部寄存器状态不确定，直接配置大概率会出问题。正确做法是先软复位，把芯片恢复到默认状态。软复位寄存器是CTRL3_C（地址0x12），将bit0写成1，芯片就会复位，复位完成后该位自动清零。

还有个容易出错的地方：CTRL3_C的bit2是IF_INC，也就是I2C/SPI寄存器地址自动增量使能。如果不开这个位，连续读多个数据寄存器时，I2C每读一个字节都要重新指定寄存器地址，效率很低。正确的流程是：

1. 写CTRL3_C为0x01，触发软复位
2. 等待SW_RESET位自动清零
3. 再写CTRL3_C为0x04，使能IF_INC

如果顺序反了，先开IF_INC再复位，复位会把IF_INC清掉，等于白设置。这个细节在很多教程里不会提，但实际调试中经常遇到。

3.3 CTRL1_XL先把加速度计关掉

CTRL1_XL寄存器（地址0x10）控制加速度计的ODR和量程。本篇只需要陀螺仪数据，加速度计可以保持关闭状态，既能省电，也避免内部数据通路相互干扰。把CTRL1_XL写成0x00，加速度计就处于关闭模式。这里多说一句，LSM6DSOW支持同时读取加速度计和陀螺仪，但分开初始化、分开验证更容易排查问题。先把陀螺仪数据读通，再回头配置加速度计，成功率会高很多。

3.4 陀螺仪配置值怎么选

陀螺仪配置寄存器是CTRL2_G（地址0x11），其中bit7到bit4是输出数据速率ODR，bit3到bit2是量程FS，bit1保留，bit0是+/-125dps扩展量程位。

我选择的配置值是0x64，对应ODR为416Hz，量程为正负500dps。选择416Hz是平衡考量：对于手动转动板子验证数据，这个速率能真实反映运动变化，又不会因为数据太快导致串口刷屏；选择正负500dps量程，是因为日常手动转动的角速度通常在几十到几百dps之间，500dps比较合适。如果量程选250dps，稍快一点的转动就会超出量程导致数据裁切，看起来像数值突然跳变。

对应量程的灵敏度如下：

3.5 初始化函数完整代码

把前面的流程串起来，初始化函数如下：

#define LSM6DSOW_ADDR (0x6A << 1) // 注意：HAL库需要左移1位 #define LSM6DSOW_WHO_AM_I 0x0F #define LSM6DSOW_CTRL1_XL 0x10 #define LSM6DSOW_CTRL2_G 0x11 #define LSM6DSOW_CTRL3_C 0x12 uint8_t lsm6dsow_init(void) { uint8_t tmp = 0; // 1. 软复位 tmp = 0x01; if (HAL_I2C_Mem_Write(&hi2c1, LSM6DSOW_ADDR, LSM6DSOW_CTRL3_C, I2C_MEMADD_SIZE_8BIT, &tmp, 1, 100) != HAL_OK) return 1; // 2. 等待软复位完成 do { HAL_I2C_Mem_Read(&hi2c1, LSM6DSOW_ADDR, LSM6DSOW_CTRL3_C, I2C_MEMADD_SIZE_8BIT, &tmp, 1, 100); } while (tmp & 0x01); // 3. 使能寄存器地址自动增量 tmp = 0x04; HAL_I2C_Mem_Write(&hi2c1, LSM6DSOW_ADDR, LSM6DSOW_CTRL3_C, I2C_MEMADD_SIZE_8BIT, &tmp, 1, 100); // 4. 关闭加速度计 tmp = 0x00; HAL_I2C_Mem_Write(&hi2c1, LSM6DSOW_ADDR, LSM6DSOW_CTRL1_XL, I2C_MEMADD_SIZE_8BIT, &tmp, 1, 100); // 5. 配置陀螺仪：416Hz，+/-500dps，0x64 tmp = 0x64; HAL_I2C_Mem_Write(&hi2c1, LSM6DSOW_ADDR, LSM6DSOW_CTRL2_G, I2C_MEMADD_SIZE_8BIT, &tmp, 1, 100); return 0; }

这里有个要注意的地方：HAL库的I2C设备地址参数需要传入的是8位地址，也就是7位地址左移一位。我在宏定义里写的LSM6DSOW_ADDR是0x6A左移一位，如果你直接写0x6A，通信会失败。有些老的例程直接写0xD4这类8位地址，本质是一样的，但要跟HAL库的API风格保持一致。

4. 轮询读取的完整代码：从STATUS到拼接换算

4.1 STATUS_REG里藏着“什么时候可以读”

轮询的核心是判断传感器数据什么时候更新完毕。LSM6DSOW每次按ODR速率刷新输出寄存器，刷新完成后会在STATUS_REG寄存器（地址0x1E）里置一个标志位。STATUS_REG的bit1是GDA，也就是陀螺仪数据就绪位；bit0是XLDA，加速度计数据就绪位。

读取流程是：读STATUS_REG，检查GDA是否等于1，等于1说明当前输出寄存器里的陀螺仪数据是新的，可以读取；读完数据寄存器之后，GDA会自动清零，然后传感器继续准备下一批数据。这个机制保证我们读到的不会是一个尚未更新完的旧值。

如果跳过状态判断，用固定延时去读，可能会读到同一份数据两次，也可能在数据更新到一半的时候去读，导致高低字节不是同一时刻的值，组合出来的原始数据就是错的。这也是轮询方案里最容易出错的地方。

4.2 连续读六个字节需要IF_INC配合

陀螺仪数据由三个轴组成，每个轴的数据是16位，分低字节和高字节。六个寄存器地址如下：

由于前面初始化时开启了IF_INC，我们只需要指定起始地址0x22，然后一次读取6个字节，硬件会自动把地址递增到0x23、0x24……直到0x27。如果没有开IF_INC，读出来的六个字节会全部是OUTX_L_G的内容，数据完全错乱。

4.3 数据拼接和量程换算

传感器输出的是二进制补码形式的16位有符号数，低字节在前（小端序）。拼接时要小心符号位：先把两个字节组成uint16_t，再强转成int16_t，这样负数值才能正确处理。

int16_t gx = (int16_t)((uint16_t)buf[0] | ((uint16_t)buf[1] << 8)); int16_t gy = (int16_t)((uint16_t)buf[2] | ((uint16_t)buf[3] << 8)); int16_t gz = (int16_t)((uint16_t)buf[4] | ((uint16_t)buf[5] << 8));

原始值本身是有意义的，但在调试时最好换算成实际角速度dps（度每秒）。根据前面提到的灵敏度表，正负500dps量程下，每个LSB代表17.50 mdps，也就是0.0175度每秒。用浮点乘法转换：

float gx_dps = gx * 0.0175f; float gy_dps = gy * 0.0175f; float gz_dps = gz * 0.0175f;

如果你的开发环境不想用浮点库，可以直接打印原始值，调试效果一样。传感器静止时原始值应该接近0，翻转板子时对应轴的数值会明显变大，这些表现用原始值完全能判断。

4.4 主循环里的轮询实现

主循环代码结构如下：

while (1) { uint8_t status = 0; uint8_t data[6] = {0}; int16_t gx, gy, gz; // 轮询等待陀螺仪数据就绪 do { HAL_I2C_Mem_Read(&hi2c1, LSM6DSOW_ADDR, 0x1E, I2C_MEMADD_SIZE_8BIT, &status, 1, 100); } while (!(status & 0x02)); // 读取六字节陀螺仪数据 HAL_I2C_Mem_Read(&hi2c1, LSM6DSOW_ADDR, 0x22, I2C_MEMADD_SIZE_8BIT, data, 6, 100); // 拼接为有符号16位数 gx = (int16_t)((uint16_t)data[0] | ((uint16_t)data[1] << 8)); gy = (int16_t)((uint16_t)data[2] | ((uint16_t)data[3] << 8)); gz = (int16_t)((uint16_t)data[4] | ((uint16_t)data[5] << 8)); // 打印原始值或换算值 printf("gx=%d gy=%d gz=%d\r\n", gx, gy, gz); HAL_Delay(5); }

do-while循环会一直等待GDA置位，然后立刻读取数据。这里加了一个HAL_Delay(5)，是为了控制打印频率，否则416Hz的数据速率会让串口输出非常密集，看着眼花。打印的时候注意，数据方向和传感器标注的轴向有关，转动板子时哪个轴数值变化大，就说明你转的是哪个轴。

5. 实测现象、数据验证与轮询频率边界

5.1 静止时应该看到什么

代码烧进去之后，串口首先快速刷出一行行的gx、gy、gz。把板子平放在桌面上静止，正常的现象是三个轴的数值都接近0。由于传感器存在零漂，不可能完全等于0，会有几个dps的偏差，这属于正常范围。

如果读到的数值一直是一个非常大的固定值，比如几万原始值不变，大概率是拼接出错或者量程系数用错了。常见错误是传感器配置成正负250dps量程，却用500dps的灵敏度去换算，导致读数偏大一倍。检查这类问题的方法很简单：读取CTRL2_G寄存器，确认实际配置值，再对照灵敏度表。

静止时数据跳动幅度也能反映问题。如果某一轴数值在几十dps甚至上百dps之间剧烈跳动，可能不是传感器问题，而是传感器模块靠近了电机或者电源干扰源。LSM6DSOW对电源纹波比较敏感，供电不稳会导致读数异常。

5.2 转动板子时如何验证

把板子拿起来绕Z轴转动，观察gz值，它会在正负之间摆动，转动越快数值越大。同时gx和gy会有少量变化，这是手转动时无法完美保持其他轴不动的正常情况。绕X轴转动同理，gx变化最明显。

我做了一个简单的验证表：

如果转动X轴时Z轴反而变化最大，说明传感器安装方向和板子标称方向不一致，或者你的坐标轴定义不同。这不会影响数据正确性，但后续做姿态解算时需要理清轴向关系。

5.3 ODR和轮询频率的边界思考

LSM6DSOW的ODR配置为416Hz，意味着传感器每秒钟刷新416次数据。但MCU通过I2C轮询读取的速度可能跟不上这个频率。每一次读取操作本身需要时间，再加上printf打印，实际循环周期可能远大于2.4毫秒。

如果轮询时间短于数据刷新周期，你会看到GDA大多数时间是0，read函数处于等待状态；如果轮询时间长于数据刷新周期，GDA会一直保持1，因为传感器更新了新数据，但你没来得及读取，最极端的情况是中间数据直接被覆盖，读到的永远是最新的一个样本。这意味着会丢样本，但并不会导致数据错位——丢样本在陀螺仪调试阶段可以接受，如果做姿态融合，丢样本会影响精度，那就该考虑提高读取效率或者用FIFO了。

实测下来，在416Hz的ODR下用I2C轮询加串口打印，即使打印频率限制在几十赫兹，CPU占用依然很低。对于原型验证来说，轮询完全够用。

5.4 验证实际轮询频率的小技巧

想知道自己的主循环实际读取频率是多少，可以加一个计数器统计每秒循环次数。在循环里对变量累加，用定时器或者简单HAL_GetTick判断一秒间隔，打印累加值。我第一次跑的时候实际读取频率只有40Hz左右，瓶颈主要在printf串口输出上，因为115200波特率打印一行三个整数加换行至少要零点几毫秒。提高波特率到921600之后，读取频率明显上升。

如果对读取频率有要求，建议把打印放在低频任务里，数据读取放在高频循环里。这个结构调整对后续做姿态融合尤其重要。

6. 轮询方案常见坑位与后续换中断/FIFO的判断

6.1 我实际踩过的几个坑

轮询方案还有一个隐形坑：HAL_I2C_Mem_Read在通信异常时默认超时时间如果设太短，比如设成10毫秒，连续几次异常之后I2C总线可能锁死。我在调试初期遇到过I2C总线锁死的情况，表现为程序卡死在HAL_I2C_Mem_Read里。原因是SDA被模块拉低后总线无法释放，需要给MCU重新上电或者把I2C引脚手动拉高才能恢复。这种情况多发生在硬件接触不良的时候，排查时优先检查杜邦线是否松动。

6.2 什么时候该放弃轮询

轮询不是万能的。当出现下面这些需求时，应该考虑升级方案：

• ODR超过1kHz，轮询循环频繁被读取操作打断，MCU无法兼顾其他任务
• 姿态解算要求必须拿到每一个样本，不能丢数据
• 低功耗场景，MCU大部分时间要进入睡眠，等传感器中断唤醒

中断方式的思路是：传感器每准备好一批数据，会通过INT引脚产生一个脉冲，MCU进入中断回调函数，在回调里读取数据。这样MCU不用反复查询状态寄存器，省下的时间可以做其他事情。FIFO方式则是传感器先把数据缓存在内部FIFO里，攒够一定数量后一次性读出来，适合高ODR、低功耗的场景。

6.3 我的调试习惯

无论以后要不要上FIFO，第一版驱动我几乎都会先用轮询跑通。一个WHO_AM_I、一个STATUS、六个数据寄存器，这几行代码比任何现成驱动库都能更快帮你确认硬件电路没问题。尤其是新平台配上新传感器，两个都是第一次接触的时候，轮询这种低复杂度方案能把变量控制在最小范围。等看到稳定的陀螺仪数据在串口里刷起来，再去研究中断、FIFO、甚至传感器内部MLC，心态会完全不一样。

另外一个建议：给传感器驱动单独建一套文件，不要把所有代码堆在main.c里。lsm6dsow.c放初始化函数和读取函数，main.c只放业务逻辑，后面换平台、换接口时你会感谢自己当初这个决定。