最近在评估STM32C5这颗新系列MCU，正好手头有一颗LSM6D3TR-C六轴传感器，我就用最基础的轮询方式把陀螺仪数据先跑通了。这篇是系列的第一篇，核心目标很明确：上电之后，能稳定地从LSM6D3TR-C里读到陀螺仪的角速度原始值，并且换算成有意义的dps（度/秒）。
这个系列适合两类人看：一是刚接触ST传感器、对I2C/SPI寄存器配置还不太熟的开发者，二是想快速评估STM32C5这颗料、看看它配合外部传感器好不好用的工程师。内容我会尽量讲透，从硬件接线、CubeMX配置、寄存器初始化，到轮询读取和数据换算，每一步都给出我实测可用的方案。把这一篇啃下来，后续再往中断、FIFO、姿态解算方向走，就会顺很多。
1. 写代码前先想清楚：为什么用轮询，为什么选这套组合
1.1 STM32C5在传感器类项目里的定位
STM32C5是意法半导体新推的主流系列，用的是Cortex-M33内核，主频在250MHz这一档，比老一代F系列的性价比和功耗表现都要好。M33内核带TrustZone和DSP指令，做传感器数据预处理、跑简单的滤波算法很合适，不会像入门级M0那样算力紧张。
对我这种经常做IoT传感器节点的人来说，STM32C5有一个很实际的优点：外设配置灵活，低功耗模式丰富，I2C、SPI、UART这些常规接口都有，而且CubeMX支持得很完整，生成代码后基本不用手动改底层。这颗料配合LSM6D3TR-C这类低功耗MEMS传感器，做电池供电的穿戴设备或工业状态监测节点，是很合理的组合。
1.2 LSM6D3TR-C到底是个什么传感器
LSM6D3TR-C是意法半导体LSM6DS系列里的一个型号，内部集成三轴加速度计和三轴陀螺仪，也就是常说的六轴IMU。接口支持I2C和SPI，3V3供电，封装很小，非常适合嵌入式板卡。
陀螺仪部分支持±125、±250、±500、±1000、±2000 dps几个满量程档位，输出速率可以从12.5Hz一路调到6.66kHz。加速度计部分支持±2到±16g，输出速率范围同样很宽。这些参数放在同类产品里属于主流配置，关键是ST的手册写得比较详细，寄存器规划也规整，适合做入门学习。
这部分要提醒一点：这颗料在不少资料里会写成LSM6DS3TR-C，D系列后缀不同，寄存器地址、WHO_AM_I值可能有细微差别。实际用的时候，一定以你拿到的那颗物料丝印和最新数据手册为准，不要照抄网上老代码不管版本。
1.3 轮询、中断、DMA，第一版为什么先选轮询
传感器数据从外设进MCU，通常有三种方式：轮询、中断、DMA。
轮询的逻辑最简单：主循环一遍一遍去查状态寄存器，看有没有新数据，有就取走。这种方式代码直观、调试方便，缺点也很明显，会占用CPU。中断方式适合低功耗场景，数据就绪时硬件引脚拉一下，CPU被唤醒后才去读，平时可以睡大觉。DMA则适合高数据率、需要把传感器数据持续搬运到内存的场景，CPU基本不参与拷贝过程。
我坚持第一版用轮询，原因很直接：先把通信链路和寄存器配置验证通，再谈优化。很多朋友一上来就上DMA+FIFO，结果I2C地址都没写对，排查起来痛苦得很。轮询是最低成本的验证手段，它能确认传感器有没有正常出数、量程和速率配置是否符合预期，这些基础打牢了，后面换中断或DMA就是改个触发方式的事。
如果你做过工控可能更有感觉，三菱、西门子PLC做Modbus采集时也是轮询思路，一个站一个站问，只不过问的是寄存器，这里问的是传感器状态位。轮询不是low，它是一种简单可靠的数据获取方式，适合很多实时性要求不高的场景。
2. 硬件接线与工程准备
2.1 最小系统接线清单
我这次用的是I2C接口，接线非常简单。LSM6D3TR-C总共需要接4到5根线：VDD接3V3，GND接地，SCL和SDA分别接到MCU的I2C引脚，另外SA0引脚决定了I2C从机地址，我直接接GND，这样7位地址固定为0x6A。
注意：如果你的板子上没有把SCL、SDA的上拉电阻引出来，建议在总线上各加一个4.7kΩ的上拉电阻到3V3。STM32C5的I2C引脚内部虽然有弱上拉，但外部上拉能显著提高通信稳定性，尤其是线缆稍微长一点的时候。
我手上的评估板把I2C1引到了PB8（SCL）和PB9（SDA），你用的板子引脚可能不同，以CubeMX分配为准。另外我同时把UART1接了出来，用来把读取结果打印到串口助手上，方便观察数据。
接线汇总：
| 信号 | LSM6D3TR-C | STM32C5 |
|---|---|---|
| 供电 | VDD | 3V3 |
| 地 | GND | GND |
| I2C时钟 | SCL | PB8（I2C1_SCL） |
| I2C数据 | SDA | PB9（I2C1_SDA） |
| 从机地址选择 | SA0 | GND |
| 调试串口 | - | UART1_TX/RX |
2.2 CubeMX里的关键配置
工程我用STM32CubeMX生成，选好STM32C5型号后，只需要配三个外设：I2C1、UART1、一个LED引脚做状态指示。
I2C1我配成快速模式，速率400kHz，这是LSM6D3TR-C支持的常规速率。如果只是低速读几个字节，100kHz标准模式也能跑，但既然传感器支持，直接上400kHz能留出余量。UART1配成115200-8-N-1，用于打印陀螺仪原始值和换算后的dps。
时钟树保持默认就行，STM32C5的I2C时钟源CubeMX会自动处理好。我建议开启I2C的中断或事件中断吗？第一版轮询不需要，关掉反而清爽。
生成代码后，记得在main.c里加一个printf重定向，把fputc映射到UART，这样就能直接在串口助手看数据。HAL库工程默认不带这个，需要自己补几行代码。如果你不想改，也可以直接调用HAL_UART_Transmit发字符串，就是写起来啰嗦一点。
2.3 I2C读写驱动封装
LSM6D3TR-C的寄存器操作模式很简单：读操作是发送设备地址加寄存器地址，然后连续读N个字节；写操作是发送设备地址加寄存器地址，再发送要写入的值。因为传感器开启了地址自增（后面会说到），读多个连续寄存器时能一次读完，效率很高。
这里我写两个很薄的基础函数，一个读一个写，整个工程都用它们：
#define LSM6D3TR_C_ADDR_7BIT 0x6A #define LSM6D3TR_C_ADDR (LSM6D3TR_C_ADDR_7BIT << 1) uint8_t LSM6D3TR_C_ReadReg(uint8_t reg, uint8_t *buf, uint16_t len) { return HAL_I2C_Mem_Read(&hi2c1, LSM6D3TR_C_ADDR, reg, I2C_MEMADD_SIZE_8BIT, buf, len, 100); } uint8_t LSM6D3TR_C_WriteReg(uint8_t reg, uint8_t value) { return HAL_I2C_Mem_Write(&hi2c1, LSM6D3TR_C_ADDR, reg, I2C_MEMADD_SIZE_8BIT, &value, 1, 100); }提示：
HAL_I2C_Mem_Read的地址参数是8位地址，所以要把7位地址左移一位。这一点很容易漏，很多人I2C通信不通就是在这里踩了坑。
封装完之后，后续无论是读WHO_AM_I还是读陀螺仪数据，都只需要一行调用。
3. 传感器初始化流程与寄存器配置
3.1 上电复位与WHO_AM_I校验
LSM6D3TR-C上电后推荐先做一次软件复位，确保内部状态干净。复位寄存器是CTRL3_C，地址0x12，把bit0写1即可触发软复位。复位完成后该位会自动清零，所以可以轮询等待复位完成。
复位之后第一件事是读WHO_AM_I寄存器，地址0x0F，固定返回值0x69。这个校验看起来简单，但非常重要。它能一次性确认三件事：I2C地址对不对、接线通没通、芯片是不是LSM6D3系列。
uint8_t who_am_i = 0; LSM6D3TR_C_WriteReg(0x12, 0x01); // SW_RESET HAL_Delay(50); LSM6D3TR_C_ReadReg(0x0F, &who_am_i, 1); if (who_am_i != 0x69) { printf("WHO_AM_I error: 0x%02X\r\n", who_am_i); while (1); } else { printf("WHO_AM_I OK: 0x69\r\n"); }如果卡在WHO_AM_I error，先别急着改代码，用万用表量一下传感器供电，再确认SA0高低电平，然后用示波器或逻辑分析仪看I2C总线上有没有ACK。绝大多数问题出在硬件层面，软件反而没那么多坑。
3.2 陀螺仪量程与输出速率配置
LSM6D3TR-C的陀螺仪配置寄存器是CTRL2_G，地址0x11。高四位ODR_G决定输出速率，bit3和bit2组成FS_G决定满量程。我把陀螺仪设为208Hz输出速率，量程±250dps，写入值0x50。
选择208Hz是因为，这个速率做姿态解算、振动测量都够用，数据量又不至于大到轮询响应不过来。±250dps在大多数手持设备场景下够用，而且这个量程下敏感度最高，单位LSB代表的角速度最小，原始数据分辨率最好。
常用陀螺仪配置值可以直接查下表：
| ODR_G | 输出速率 | FS_G | 满量程 | CTRL2_G值 |
|---|---|---|---|---|
| 0100 | 104Hz | 00 | ±250dps | 0x40 |
| 0101 | 208Hz | 00 | ±250dps | 0x50 |
| 0101 | 208Hz | 01 | ±500dps | 0x51 |
| 0101 | 208Hz | 10 | ±1000dps | 0x52 |
| 0110 | 416Hz | 00 | ±250dps | 0x60 |
| 0111 | 833Hz | 11 | ±2000dps | 0x73 |
注意：ODR和FS是两个独立维度，别以为满量程设大一点敏感度更好。恰恰相反，量程大了以后每个LSB代表的角速度更大，小角度变化的分辨率反而会下降。能用±250dps的地方就不要轻易上±2000dps。
初始化代码：
LSM6D3TR_C_WriteReg(0x11, 0x50); // CTRL2_G: ODR=208Hz, FS=±250dps3.3 BDU与地址自增，这两个位一定记得开
CTRL3_C寄存器里有两个位对读取稳定性影响极大，一个是BDU（Block Data Update），另一个是IF_INC（Register Address Increment）。
BDU在bit6，置1后，传感器在输出寄存器高低字节没被读完之前，不会更新数据。如果不开启，读高字节和低字节的间隙里数据一旦刷新，就会出现高字节是新数据、低字节是旧数据，拼出来的值完全错误。开启BDU是数据稳定性的关键。
IF_INC在bit2，置1后，I2C连续读寄存器时地址自动递增。不开这个，读6字节陀螺仪数据就得发6次读命令，每次还要带上寄存器地址，效率低代码也丑。开启后一次读6字节即可。
CTRL3_C写入0x44，正好同时打开这两个位：
LSM6D3TR_C_WriteReg(0x12, 0x44); // CTRL3_C: BDU=1, IF_INC=1我每次初始化传感器都习惯把这一步写在配置之后、正式读取之前，顺序上没什么约束，但放到一起读代码时逻辑更清楚。
4. 轮询读取陀螺仪数据与换算
4.1 状态寄存器怎么判断数据就绪
LSM6D3TR-C的STATUS_REG寄存器地址是0x1E，bit1是GDA位，对应陀螺仪新数据可用标志。当GDA为1时，说明陀螺仪输出寄存器已经更新过一组新数据，可以安全读取。读完后该位会自动清零，不需要软件干预。
有些朋友图省事，不查状态位直接读数据。这在慢速读取时可能偶尔能蒙对，但稍微一忙就容易读到重复数据或者新旧拼接数据。轮询的意义就在于用软件手段保证每次拿到的都是完整且最新的一组数据。
4.2 主循环轮询代码实现
主循环的逻辑，说白了就是三步：查状态、读六字节、拼数据。先查GDA，没就绪就继续等；就绪了就一次读0x22到0x27这六个寄存器，分别对应X、Y、Z轴的低字节和高字节。
uint8_t status = 0; uint8_t data[6] = {0}; int16_t gx_raw, gy_raw, gz_raw; while (1) { LSM6D3TR_C_ReadReg(0x1E, &status, 1); if (status & 0x02) // GDA = 1 { LSM6D3TR_C_ReadReg(0x22, data, 6); gx_raw = (int16_t)((data[1] << 8) | data[0]); gy_raw = (int16_t)((data[3] << 8) | data[2]); gz_raw = (int16_t)((data[5] << 8) | data[4]); printf("GX:%6d GY:%6d GZ:%6d\r\n", gx_raw, gy_raw, gz_raw); } }提示：
data[1] << 8一定要转成int16_t再拼。如果直接在uint8_t上移位，会先提升成int，符号扩展的逻辑容易出错，导致负数显示成很大的正数。
这段代码实测200Hz左右输出速率下，CPU占用非常低，轮询完全能兜住。
4.3 原始值怎么换算成角速度
LSM6D3TR-C陀螺仪输出是16位有符号数，范围从-32768到32767。把这组原始数变成物理量，需要乘以敏感度系数。敏感度取决于满量程档位，满量程越大，每个LSB代表的角速度越大。
各量程下的敏感度系数：
| 满量程 | 敏感度 | 说明 |
|---|---|---|
| ±250 dps | 8.75 mdps/LSB | 分辨率最高 |
| ±500 dps | 17.50 mdps/LSB | 常规档位 |
| ±1000 dps | 35.00 mdps/LSB | 高速旋转场景 |
| ±2000 dps | 70.00 mdps/LSB | 适合动作剧烈场景 |
以我配置的±250dps档位为例，敏感度8.75mdps/LSB，也就是说，原始值每增加1，实际角速度增加0.00875dps。换算公式如下：
float gx_dps = (float)gx_raw * 0.00875f; float gy_dps = (float)gy_raw * 0.00875f; float gz_dps = (float)gz_raw * 0.00875f;为什么不是直接除以一个整数？因为敏感度是小数，用乘法更直观，也不会因为整数除法丢精度。0.00875就是8.75除以1000，和除以114.285是等价的，但乘法写起来更清楚。
打印验证时一步到位：
printf("GX:%.2f dps GY:%.2f dps GZ:%.2f dps\r\n", gx_dps, gy_dps, gz_dps);把传感器平放在桌面上，理论上Z轴输出应该接近0dps，X/Y轴也接近0dps。当然MEMS陀螺仪都有零偏，静止时有个±1到±3dps的波动是正常的，不必纠结。
5. 常见问题与调试实录
5.1 典型故障速查表
这一节是我整理的真实排障经验，按出现概率排序：
| 现象 | 可能原因 | 排查方法 |
|---|---|---|
| WHO_AM_I读不到或不匹配 | 接线错、地址错、供电异常 | 确认SA0电平，核对7位地址，量VDD |
| WHO_AM_I能读到，陀螺仪数据全0 | CTRL2_G没有配置ODR，芯片处于掉电模式 | 写0x11为0x50，再读回验证 |
| 数据跳动特别大 | BDU未开启，高低字节拼接错位 | CTRL3_C写0x44 |
| 数据一直不变 | 没查状态位，一直在读旧数据 | 确认STATUS_REG轮询逻辑 |
| 负数显示成65535这种大数 | 高低字节拼接没做符号扩展 | 拼完强制转int16_t |
| 偶发通信失败 | 上拉电阻缺失、I2C速率过高 | 加4.7kΩ上拉，速率降到100kHz试 |
5.2 几个值得记住的实操教训
第一个教训是电源纹波。MEMS传感器的模拟部分对电源质量比较敏感，我第一次搭测试板时用了比较长的杜邦线从开发板取3V3，结果陀螺仪数据在静止时有明显的周期性波动。后来在传感器VDD引脚旁边就近加了0.1μF陶瓷电容，纹波问题基本消失。测试传感器时，电源走线尽量短，去耦电容尽量靠近芯片。
第二个教训是I2C波形一定要实际看一眼。很多通信问题看起来像代码逻辑问题，实际上总线时序压根不对。我的排查习惯是：先读WHO_AM_I，看ACK波形，再往下走。逻辑分析仪在这种调试里价值很大，二三十块钱的就能看I2C解码，比盲猜代码高效太多。
第三个教训是寄存器配置后要读回验证。写完CTRL2_G后，把寄存器读出来打印，确认写入值是0x50而不是被其他代码覆盖。STM32C5的HAL库里，有些外设初始化代码会操作保留寄存器，虽然不常用，但养成读回验证的习惯总是好的。
第四个教训关于轮询频率。虽然STM32C5跑250MHz，但I2C通信速率只有400kHz，读取6字节加寄存器地址大概需要几十微秒。如果主循环里还有其他耗时操作，比如打印大量日志、跑浮点运算，轮询频率可能跟不上传感器输出速率，这时GDA位会一直保持1，读到的数据间隔不均。第一版调试时，printf格式化大量数据会让轮询周期波动，建议正式测试时把打印频率降下来，比如每50ms打一次，或者只打印关键数据。
5.3 下一步往哪走
轮询跑通之后，我个人建议的进阶路径有两条。一条是把读取方式换成中断，让INT1引脚在数据就绪时触发MCU中断，主循环可以去做别的事，适合低功耗场景。另一条是开启传感器内部的FIFO，让传感器先暂存一批数据，MCU闲了再一次性读出来，能显著降低I2C通信频率，适合高数据率场景。
我自己在这套电路上的下一个目标是加一个简单的零偏校准流程：静止采样几百组数据求平均，把零偏值存下来，之后每次读数都先减掉零偏，这样静态精度能改善不少。这套校准代码跑通之后，再考虑把加速度计数据一起读出来，做简化版的姿态角计算。
