做姿态检测项目，我在选型阶段试过几颗常见的IMU，最后定了LSM6D3TR-C这颗6轴传感器。手头刚好在用STM32C5系列做主控，就直接在这个平台上把传感器驱动从零写了一遍。第一篇先从最基础的轮询方式说起：怎么初始化寄存器、怎么通过状态位判断数据就绪、怎么把原始值合并成有意义的角速度，以及实测中会遇到的零漂和滤波问题。这篇文章适合刚接触IMU、想用STM32快速跑通陀螺仪数据采集的开发者，看完可以直接照抄代码，也能理解每步操作背后的原因。
1. 为什么用LSM6D3TR-C搭配STM32C5：选型背后的几个考量
1.1 LSM6D3TR-C能覆盖哪些应用场景
LSM6D3TR-C是ST推出的6轴惯性测量单元，把3轴加速度计和3轴陀螺仪封装在一颗芯片里。相比老一代方案，这类器件在功耗、噪声和内置功能上提升明显。陀螺仪部分支持从±125dps到±2000dps的量程选择，加速度计支持±2g到±16g，ODR最高能跑到6.66kHz，覆盖穿戴设备、游戏手柄、机器人姿态估计、云台稳定这些常见场景都没问题。
这颗芯片还带了智能FIFO、计步器、倾斜检测这类嵌入式功能，后续想扩展不用换硬件。另外ST的传感器在车规和工业级市场铺得很开，长期供货和文档成熟度都相对让人放心。对于做产品原型验证来说，选一颗生态完善、资料齐全的器件能省掉很多折腾时间。
1.2 STM32C5平台对传感器开发有哪些便利
STM32C5系列属于ST主推的C系列产品线，内核是Cortex-M33，带FPU，主频相比同价位产品有优势。用它驱动LSM6D3TR-C，最大的便利在于整个开发流程和主流的STM32F/G系列几乎没有区别，ST的CubeMX和HAL库对这套外设的支持很成熟。
C系列在低功耗和成本控制上做了不少优化，但I2C、SPI、DMA这些外设的用法和既有生态完全一致。也就是说，网上大量基于STM32的传感器驱动代码，稍微改一下引脚配置和时钟树就能移植过来。这对快速上手特别友好，也是我选这个组合做开发的原因之一，芯片本身有亮点，外设开发又不绕弯子。
1.3 第一篇文章为什么要选"轮询"这个切入点
轮询可能是所有数据读取方式里最"笨"的一种，但我强烈建议新手从轮询开始。原因很简单：它能让你把传感器的寄存器模型、状态位语义、数据组合方式彻底看清楚。跑通了轮询，后续换中断、上FIFO、加DMA，都是在同一个基础上做优化，逻辑不会乱。
很多人一上来就追求FIFO加DMA的低CPU占用方案，结果寄存器配置错一半，数据都读不回来，排查起来非常痛苦。我的习惯是先把最简单的方式跑通，用串口把原始值打出来确认通信链路没问题，再逐步增加复杂度。这篇文章的代码量不大，但每一步都有明确目的。
2. 硬件连接与工程搭建里最容易忽视的几个点
2.1 引脚分配与I2C设备地址确认
LSM6D3TR-C支持I2C和SPI两种接口，通过CS引脚的电平选择：CS接高电平走I2C，CS拉低走SPI。新手最容易在这里翻车，传感器模块焊好之后怎么通信都不对，结果发现CS引脚悬空或者被外部电路拉低，接口模式根本没选对。
I2C模式下的设备地址由SDO/SA0引脚决定，接高电平时7位地址是0x6B，接低电平时是0x6A。我的模块上SDO默认接地，所以地址是0x6A。这里有一个非常关键的细节：STM32的HAL库在调用HAL_I2C_Mem_Read时，设备地址参数需要传入8位格式，也就是要把7位地址左移一位。0x6A左移一位变成0xD4，很多人直接填0x6A，通信必然失败。
下面是我用的接线表，供参考：
| 传感器引脚 | 连接目标 | 说明 |
|---|---|---|
| VCC | 3.3V | 注意不要接5V |
| GND | GND | 共地 |
| SCL | PB8 | I2C1时钟 |
| SDA | PB9 | I2C1数据 |
| CS | 3.3V | 拉高选择I2C模式 |
| SDO/SA0 | GND | 拉低，地址0x6A |
| INT1 | 暂不接 | 后续中断方式会用到 |
2.2 CubeMX里的配置步骤与时钟树注意点
打开STM32CubeMX，选择对应的C5型号，配置好系统时钟之后，只需要开启I2C1外设即可。I2C速度建议选400kHz快速模式，LSM6D3TR-C支持这个速率。C系列和F系列一样，I2C外设没有额外的特殊配置项，生成代码之后基础工程就能直接用。
有一点要留意：如果开发板的外部晶振没焊接，时钟树里要选择内部时钟源，否则系统时钟配置不对，I2C时序也会跟着乱。我之前在一块板子上折腾了很久，最后发现是时钟树里选了外部晶振但板子上没有这颗晶振，I2C速率完全不对，通信时好时坏。
2.3 硬件层面的常见坑：上拉电阻与去耦电容
STM32的I2C引脚本身有内部上拉，但内部上拉的阻值偏大，在400kHz速率下波形质量可能不好。独立传感器模块如果板子上已经做了4.7kΩ上拉，那就直接用；如果传感器是散件飞线连接，建议自己补两颗4.7kΩ上拉电阻到3.3V，否则总线上升沿太缓，通信不稳定。
另外VCC引脚旁边最好放一颗100nF去耦电容，尽量靠近芯片。IMU这类器件对电源纹波比较敏感，供电不干净会让陀螺仪输出噪声明显增大。飞线调试时，杜邦线越长越容易引入干扰，实测下来20cm以上的连线就会让数据抖动明显变大，能用短线的场合尽量用短线。
3. 寄存器初始化顺序：为什么先软复位再配置量程
3.1 WHO_AM_I：先确认通信链路再谈其他
初始化代码的第一步永远是读WHO_AM_I寄存器，这个习惯能帮你省下无数排查时间。WHO_AM_I的寄存器地址是0x0F，读出来是一个固定值，用来标识芯片型号。如果读到的值和数据手册不一致，说明I2C通信链路有问题，或者设备地址填错了。这时候不需要接着往下配置，先把通信搞定再说。
不同批次或不同型号的传感器这个值可能不一样，我习惯在代码里用宏定义，然后第一次跑的时候把读到的值和手册对比，确认无误之后再继续。只要这一步过了，后面的寄存器操作基本就是水到渠成的事。
#define LSM6D3TR_C_WHO_AM_I 0x0F uint8_t who_am_i = 0; lsm6d3_read_reg(LSM6D3TR_C_WHO_AM_I, &who_am_i, 1); printf("WHO_AM_I = 0x%02X\r\n", who_am_i);3.2 软复位：把芯片恢复到已知状态
上电之后建议先做一次软件复位。LSM6D3TR-C的CTRL3_C寄存器里有一位SW_RESET（bit0），写1触发复位。复位完成之后这位会自动清零。为什么要软复位？因为前一次调试可能让芯片停留在奇怪的配置状态，不复位直接配寄存器，可能会遇到写入不生效或者行为不符合预期的情况。软复位相当于把芯片恢复到出厂状态，确保后面每一步配置都是从干净的状态开始。
写软复位之后最好延时几十毫秒再继续配置。我实测下来延时50ms比较稳妥，时间太短复位动作可能还没完成，紧接着写寄存器会失败。这里不能用HAL_Delay那种阻塞延时也行，但后续如果上RTOS，建议改用系统延时函数。
3.3 BDU位：低字节和高字节要来自同一次采样
CTRL3_C里另一位非常关键——BDU（Block Data Update，bit6）。这个位是很多人会漏掉的细节。陀螺仪输出寄存器由两个8位寄存器组成高字节和低字节，如果A/D转换发生在你读取寄存器的过程中，可能发生低字节是上一次采样、高字节已经是下一次采样的错位情况，导致合并出来的16位数据完全错误。
BDU位为1时，输出寄存器在读取过程中被"锁住"，直到读完整组高字节和低字节才允许新的数据写入。这个机制和拍照时的防抖是一个道理，保证两个字节来自同一个采样时刻。我用生活化的类比来解释：就好比你从自动售货机里取饮料，如果机器在你取的过程中补货，你可能拿到一瓶半旧的半新饮料，BDU就是保证你拿到的一定是同一批货。开启方式很简单，在CTRL3_C里把BDU位置1即可。
3.4 量程与ODR配置：CTRL1_XL和CTRL2_G的语义
配置陀螺仪时用CTRL2_G寄存器，ODR和量程都在这个寄存器里。我通常把ODR设为104Hz，量程根据场景选择。这里有个关键概念要理解：量程和灵敏度是反比关系。量程越大，单位LSB代表的角速度就越大，分辨率越低。
| 陀螺仪量程 | 灵敏度 |
|---|---|
| ±125 dps | 4.375 mdps/LSB |
| ±250 dps | 8.75 mdps/LSB |
| ±500 dps | 17.50 mdps/LSB |
| ±1000 dps | 35 mdps/LSB |
| ±2000 dps | 70 mdps/LSB |
灵敏度表示1个LSB对应的角速度。如果选±2000dps量程，原始值跳1格代表角速度变化了70mdps；如果选±125dps量程，同样跳1格只代表4.375mdps的变化。做姿态解算或者需要细腻角速度变化的场景，能用低量程尽量用低量程，分辨率更高。但低量程的满量程范围小，如果你高速旋转传感器导致超出量程，数据会饱和，这时候又必须提高量程。这个取舍要根据实际应用场景来定。
加速度计的配置在CTRL1_XL，同理选择ODR和量程。我在示例里配成104Hz、±4g，如果只是测试陀螺仪，加速度计的量程选择其实不影响读取。
// CTRL3_C: 使能BDU，开启寄存器地址自增(IF_INC) // 0x44 = 0b0100 0100，bit6=1 (BDU) uint8_t ctrl3_c = 0x44; lsm6d3_write_reg(LSM6D3TR_C_CTRL3_C, &ctrl3_c, 1); // CTRL1_XL: ODR=104Hz, FS=±4g // 0x48 = 0b0100 1000，bit4-7=0100(104Hz), bit2-3=10(±4g) uint8_t ctrl1_xl = 0x48; lsm6d3_write_reg(LSM6D3TR_C_CTRL1_XL, &ctrl1_xl, 1); // CTRL2_G: ODR=104Hz, FS=±2000dps // 0x4C = 0b0100 1100，bit4-7=0100(104Hz), bit2-3=11(±2000dps) uint8_t ctrl2_g = 0x4C; lsm6d3_write_reg(LSM6D3TR_C_CTRL2_G, &ctrl2_g, 1);4. 轮询读取的完整代码：状态位、寄存器组合与主循环
4.1 状态寄存器判断：GDA位什么时候才算数
LSM6D3TR-C的陀螺仪数据输出寄存器地址从OUTX_L_G开始，地址是0x22到0x27，依次是X、Y、Z轴的低字节和高字节。但在读数据之前，要先判断数据是否真的更新了。状态寄存器STATUS_REG（0x1E）里有对应的数据可用位，陀螺仪数据可用标记通常会标为GDA或者TDA。当这一位为1时，表示新的陀螺仪采样数据已经写入输出寄存器，这时候去读才是有意义的数据。
轮询的核心逻辑就是不断去读STATUS_REG，等到GDA位置1，立刻读取6个字节的陀螺仪数据。然后继续循环等待下一次数据就绪。这个过程非常直观，数据就绪标志就像厨房里出餐的铃，铃响了才去端菜，而不是守在厨房门口一次一次问好了没。
有一点要注意：STATUS_REG是一个只读寄存器，读取动作本身不会清掉标志位。GDA位会在新数据写入时自动更新，不需要软件干预。
4.2 六字节读取与int16_t合并的正确姿势
读取陀螺仪数据时，我建议一次性读取6个字节，从OUTX_L_G开始连续读。前提是之前提到的IF_INC位（地址自增使能）是打开的，否则每读一个字节地址不会自动加1，读回来的数据全错。
合并原始值时，两个8位寄存器要组合成16位有符号数。低字节是数据的最低位，高字节是最高位，合并公式是(int16_t)((high << 8) | low)。这里必须强转成int16_t，否则高字节的符号位不会被正确扩展。陀螺仪输出是有符号数，静止时零附近的数据可能是正也可能是负，如果忘记符号扩展，静止时读数可能是一个很大的正数，完全不可用。
#define LSM6D3TR_C_STATUS_REG 0x1E #define LSM6D3TR_C_OUTX_L_G 0x22 uint8_t lsm6d3_read_gyro_raw(int16_t *gx, int16_t *gy, int16_t *gz) { uint8_t status = 0; lsm6d3_read_reg(LSM6D3TR_C_STATUS_REG, &status, 1); // 检查陀螺仪数据可用位（GDA） if ((status & 0x02) == 0) { return 0; // 数据未就绪 } uint8_t buf[6]; lsm6d3_read_reg(LSM6D3TR_C_OUTX_L_G, buf, 6); *gx = (int16_t)((uint16_t)(buf[1] << 8) | buf[0]); *gy = (int16_t)((uint16_t)(buf[3] << 8) | buf[2]); *gz = (int16_t)((uint16_t)(buf[5] << 8) | buf[4]); return 1; }4.3 主循环：串口打印与可视化前的数据处理
主循环的逻辑很直接：死循环里调用读取函数，如果数据就绪就通过串口打印。我用的是printf重定向到UART，方便在串口助手里看数据。换算成角速度值的公式是dps = 原始值 × 灵敏度，以±2000dps量程为例，灵敏度是70mdps/LSB，所以要除以1000转成dps。
int16_t gx_raw, gy_raw, gz_raw; float gx_dps, gy_dps, gz_dps; while (1) { if (lsm6d3_read_gyro_raw(&gx_raw, &gy_raw, &gz_raw)) { // 量程±2000dps，灵敏度70mdps/LSB gx_dps = (float)gx_raw * 70.0f / 1000.0f; gy_dps = (float)gy_raw * 70.0f / 1000.0f; gz_dps = (float)gz_raw * 70.0f / 1000.0f; printf("gx=%.2f gy=%.2f gz=%.2f\r\n", gx_dps, gy_dps, gz_dps); } }主循环里还可以加上每秒钟统计一次读取次数，用来验证实际的采样率是否接近配置的104Hz。如果次数明显偏少，说明循环里其他操作耗时太长，或者I2C通信有问题。我调试时喜欢在统计里确认采样率，这样能直观反映配置是否生效。
4.4 数值验证：静止时该看到什么
传感器静止放在桌面上时，X、Y、Z三个轴的陀螺仪输出都应该接近0dps。但"接近0"不等于稳定在0，实际会看到几十mdps的波动，对应原始值也就几个LSB。这个现象是正常的，因为MEMS陀螺仪本身存在噪声和零漂。
我第一次跑通代码时，Z轴读到+2.3dps左右的恒定偏置，当时以为配置有误。排查了很久，最后才发现是传感器模块放得不够平，或者模块本身在焊接时存在微小应力。后来换了一块水平放置的模块，偏置就小了很多。陀螺仪有一个特性：静止时的零偏（Zero-rate Offset）是客观存在的，需要靠软件校准来消除，而不是靠修改寄存器配置就能完全解决。这一点第5部分会详细说。
5. 上电实测后的数据观察与处理
5.1 打印原始值的现象：噪声、跳变与量程判断
我习惯在调试阶段把原始int16_t值也一起打印出来，而不是只看换算后的dps值。原始值能帮助你判断数据质量。以±2000dps量程为例，原始值一个LSB对应70mdps，如果你看到静止时X轴原始值在正负4之间跳动，说明波动不超过±280mdps，这个噪声水平对于该量程来说属于正常。
如果原始值频繁出现极端值，比如接近32767或-32768，大概率是操作上有问题，要么是量程设置和实际不匹配，要么是寄存器读取错位，把不同轴的数据组合到了一起。出现这种情况时，我建议从WHO_AM_I开始重新检查，而不是急着调软件滤波。
5.2 零漂问题：怎么用简单办法校准
陀螺仪的零漂是所有新手都会遇到的问题。传感器静止时，理论上角速度是0，但实际输出总有一个固定的偏置，这就是零偏。温度变化、供电电压、焊接应力都会影响这个偏置的大小。更麻烦的是，零偏还会随时间和温度缓慢变化，这不是一个固定的常数。
最基础的校准方法是在传感器真正静止时采集一段数据，取平均值作为偏移量，然后在运行时把这个偏移量减掉。我写了一个简单的校准函数：
int32_t gyro_offset[3] = {0, 0, 0}; void lsm6d3_gyro_calibrate(uint8_t samples) { int64_t sum[3] = {0, 0, 0}; int16_t gx, gy, gz; for (uint8_t i = 0; i < samples; i++) { if (lsm6d3_read_gyro_raw(&gx, &gy, &gz)) { sum[0] += gx; sum[1] += gy; sum[2] += gz; HAL_Delay(2); } } gyro_offset[0] = (int32_t)(sum[0] / samples); gyro_offset[1] = (int32_t)(sum[1] / samples); gyro_offset[2] = (int32_t)(sum[2] / samples); }校准之后，运行时每个轴的原始值先减去偏移量，再换算成角速度。我实测过一组数据：校准前Z轴静止时读出来+2.3dps左右，校准后基本能稳定在±0.1dps以内。这个精度在大多数姿态解算场景下已经够用了。
5.3 数据平滑的简单办法：滑动平均够不够用
陀螺仪原始数据里有高频噪声，直接拿去做积分或者姿态解算，结果会抖动得厉害。最简单的处理办法是滑动平均滤波。以ODR 104Hz为例，做8个点的滑动平均，输出等效30Hz左右的有效带宽，噪声能明显降下来，同时还能保留人体运动的主要频段。
滑动平均的实现很简单，不需要引入复杂算法。用一个环形缓冲区存最近N次采样，每次计算平均值即可。缺点是有不可避免的延迟，N越大延迟越大。如果项目对实时性要求高，可以考虑低通滤波或互补滤波，但对第一篇入门来说，滑动平均已经能直观感受到效果。
#define FILTER_N 8 float filter_buf[FILTER_N]; uint8_t filter_idx = 0; float gyro_filtered(float new_value) { float sum = 0; filter_buf[filter_idx] = new_value; filter_idx = (filter_idx + 1) % FILTER_N; for (uint8_t i = 0; i < FILTER_N; i++) { sum += filter_buf[i]; } return sum / FILTER_N; }6. 轮询方式的边界与后续演进
6.1 轮询的根本问题：CPU占用与数据延迟
轮询方式最大的问题在于CPU被"绑死"在读取循环里。以104Hz的ODR为例，CPU大约每10ms要检查一次状态寄存器，这个频率下影响还不明显。但如果ODR跑到1kHz以上，主循环几乎每毫秒就要醒来处理数据，其他任务就没法干了。
另外轮询的实时性是"尽力而为"的，数据就绪到程序真正去读取之间，延迟不稳定。如果主循环里恰好有其他耗时操作，比如串口打印大量数据或者处理显示刷新，就可能漏读数据。传感器内部寄存器不会为你保留所有历史数据，漏了一次采样就丢了这帧数据。对于姿态解算这种需要连续输入的应用来说，漏帧会造成角度积分误差。
6.2 中断方式的扩展思路：从"轮询"到"事件驱动"
中断方式是轮询的自然升级。把传感器的INT1引脚接到STM32的GPIO上，配置成上升沿或高电平触发，传感器每次数据就绪就会拉高INT1引脚，MCU通过外部中断响应，在中断服务函数里读取数据。这样CPU在数据未就绪时可以安心做其他事情，不用一直盯着状态寄存器。
从轮询切换到中断，代码改动量其实不大。初始化里需要配置传感器的中断路由寄存器，把数据就绪信号输出到INT1引脚，然后在STM32的GPIO中断回调里调用读取函数。唯一的注意点是中断服务函数尽量短，不要在中断里做大量运算或者长时间阻塞，建议只做数据读取，把后续处理放到主循环里完成。
6.3 FIFO与DMA：高采样率下的最终方案
如果采样率要求高，单靠中断频繁唤醒CPU也不是最优解。LSM6D3TR-C内部有FIFO，可以按设定的节奏自动存储采样数据，MCU不用每次采样都来处理，等FIFO积攒一批数据后一次性读取。配合DMA，读取过程甚至不需要CPU干预，只需在传输完成中断里处理数据即可。
这也是我计划在系列后续文章里展开的内容。对当前这篇来说，先用轮询把寄存器读写、数据合并、零漂校准这些基本功打牢，后面上FIFO和DMA时会顺畅很多。我做项目的一个经验是：跳步学习往往会让人卡在奇怪的Bug上，而扎实过一遍基础知识，后面每一步都会很顺。
另外说一个实操中的技巧，调试传感器时串口打印别太频繁。104Hz的ODR，如果每次打印都走阻塞式UART，串口可能来不及发送，主循环被拖慢，反而影响数据读取节奏。调试阶段可以把打印频率降到10Hz左右，或者使用DMA方式发送串口数据，让主循环保持稳定运行。
