STM32C5这颗料拿到手之后我本来想先跑个点灯但点灯实在没意思。手里正好躺着一颗LSM6DSOW干脆直接跳进正题——用官方HAL库通过状态轮询的方式把陀螺仪数据读出来顺便把这颗传感器从寄存器到换算公式完整走一遍。这篇教程是系列第一篇不讲那些花里胡哨的DMP、中断、FIFO就把最朴素的“上电、配置、读数据”讲透。如果你正在用STM32C5系列做运动检测、姿态解算、防抖云台或者跌倒检测这类项目想快速验证传感器有没有工作这篇内容就是给你准备的。哪怕你之前从没碰过LSM6DSOW只要会一点HAL库基础跟着流程走也能调通。文章里我会把寄存器地址、配置思路、代码实现、数据换算原理全部拆开讲最后再把我实际调试中踩过的坑和排查方法整理成清单方便你直接抄作业。1. 项目概述与硬件分析1.1 LSM6DSOW是什么为什么选它LSM6DSOW是ST推出的一款六轴惯性传感器内部集成了三轴陀螺仪和三轴加速度计。后缀里的W代表的是新封装和功耗优化版本寄存器映射和LSM6DSO基本一致所以老的LSM6DSO代码稍微改改地址就能用。这颗芯片支持I2C和SPI两种通信方式陀螺仪的满量程可以从±125 dps一直选到±2000 dps精度和量程可以按场景灵活配置。我选它做教程主角原因很简单这颗料在无人机、智能穿戴、工业状态监测里非常常见而且它的数据手册写得相对清楚寄存器不多特别适合用来学习IMU的基础操作。陀螺仪输出的角速度数据本身不会直接告诉你“现在朝哪个方向”但它能告诉你在某个轴上转得有多快这是姿态解算、零偏校准、运动检测的地基。1.2 为什么拿STM32C5来跑这颗传感器STM32C5是ST新一代高性价比MCUCortex-M33内核主频拉到250MHz级别片上资源比同价位的G系列丰富不少像FDCAN、以太网这类外设都开始下放。拿它来读一个IMU确实是大材小用但反过来说C5的I2C外设、中断控制器和低功耗模式都比较完善做传感器读取这种入门级任务有一个好处——整个通信链路非常简单方便我们聚焦在传感器本身的寄存器操作上。另外STM32C5的生态已经完整了CubeMX里直接选型号就能生成HAL工程不需要像早期芯片那样手动移植库。对于刚上手C5系列的开发者来说用一颗I2C传感器练手既能熟悉CubeMX的配置流程又能摸清HAL库I2C读写接口的套路后续再做复杂项目心里就有底了。1.3 轮询方式的优势与取舍可能有人会问既然LSM6DSOW支持数据就绪中断引脚为什么不一开始就用中断去读反而要用轮询这是我故意安排的。轮询方式的核心逻辑很简单主循环里不断查看传感器的状态寄存器或者直接读取数据寄存器只要数据准备好就取走。这么做的好处是代码路径非常直白不设计EXTI中断映射也不涉及中断优先级和回调函数出问题时排查范围很小。对于第一次接触这颗传感器的朋友来说中断方式一旦失灵你根本分不清是传感器初始化失败还是中断配置漏了一步。轮询的代价也很明显你需要定期“打扰”传感器CPU没法在等待期间去睡大觉实时性也取决于主循环的调度周期。但对大多数采样率不高、逻辑不复杂的场景比如开机自检、数据采集验证、姿态解算原型开发轮询完全够用甚至更省心。等我们把数据链路跑通后续再升级到FIFO加中断也不迟。2. 通信接口与寄存器基础2.1 选I2C还是SPILSM6DSOW的I2C接口最高可以跑到400kHz Fast ModeSPI则可以跑得更快。对陀螺仪数据来说I2C完全够用而且只需要四根线VDD、GND、SCL、SDA省引脚、好接线随便找两根杜邦线就能连上。SPI速度高但要多一根CS片选线更适合高ODR、大量读取FIFO的场景。这里我采用I2C做演示一方面接线更简单另一方面HAL库里HAL_I2C_Mem_Read和HAL_I2C_Mem_Write这两个接口读寄存器非常顺手代码可读性高。你如果后面想切SPI寄存器流程完全一样只需要把底层读写函数换掉。2.2 I2C从机地址与硬件连接LSM6DSOW的I2C从机地址由SA0引脚的电平决定。SA0接地时7位地址是0x6ASA0接高电平是0x6B。我用的是0x6A。这里有个新手容易踩的坑HAL库里的设备地址参数需要左移一位保留最低位作为读写位所以实际传给HAL_I2C_Mem_Read的地址是(0x6A 1)也就是0xD4。如果你直接填0x6AI2C通信大概率会超时失败。接线方面SCL和SDA需要接上拉电阻到VDD一般开发板上已经预留外接模块通常也自带上拉。如果你是自己搭的电路记得加4.7kΩ上拉不然I2C时序会奇奇怪怪偶尔能通信偶尔超时这种隐蔽问题排查起来非常头疼。2.3 关键寄存器一览先把本教程需要用到的寄存器列出来不用每个都背但要能看懂寄存器地址作用WHO_AM_I0x0F芯片IDLSM6DSOW固定返回0x6CCTRL1_XL0x10加速度计配置输出速率、量程、滤波CTRL2_G0x11陀螺仪配置输出速率、量程、滤波CTRL3_C0x12主控制寄存器软复位、接口使能、地址自动递增等STATUS_REG0x1E状态寄存器bit1是陀螺仪数据就绪标志OUTX_L_G0x22陀螺仪X轴数据低字节OUTX_H_G0x23陀螺仪X轴数据高字节OUTY_L_G0x24陀螺仪Y轴数据低字节OUTY_H_G0x25陀螺仪Y轴数据高字节OUTZ_L_G0x26陀螺仪Z轴数据低字节OUTZ_H_G0x27陀螺仪Z轴数据高字节这里我们重点操作CTRL2_G和STATUS_REG。CTRL2_G的bit7到bit4决定输出数据速率bit3到bit2决定满量程范围bit1是额外的小量程使能。比如把ODR设为104Hz、满量程设为±250 dps只要向CTRL2_G写入0x40就够了。满量程越小灵敏度越高单位LSB对应的角速度越小满量程越大能测量的大角速度越多但同样一个原始值对应物理量也越大。WHY要在这里特别强调数据格式输出寄存器是16位有符号整数采用小端存储低字节在前高字节在后。读取的时候需要先读低字节再把两个字节拼成一个int16_t。如果顺序搞反得到的角速度符号会是乱的而且数值完全不对。3. 初始化流程与CubeMX配置3.1 CubeMX工程基本配置打开STM32CubeMX先在MCU选择器里找到STM32C5系列的具体型号。这里以带I2C1和USART1的C5型号为例。芯片选好之后做四件事SYS里把Debug设为Serial Wire避免SWD口被占掉导致后续没法下载程序Connectivity里使能I2C1I2C Speed Mode设为Fast Mode400kHzUSART1使能成异步模式波特率115200用于打印数据时钟树先按默认的内部时钟跑后面如果发现I2C时序不对再核对外设时钟。C5的HAL库生成逻辑和F系列基本一致Project Manager里面选好工具链代码生成器勾选“仅复制必要库文件”生成的工程会比较干净。有一点要提醒不同CubeMX版本对C5的I2C初始化结构体成员可能有差异生成代码后打开i2c.c看一眼hi2c1.Init.ClockSpeed是否被正确赋值为400000确认无误再继续。3.2 软复位与WHO_AM_I校验传感器上电后不要立刻操作寄存器先延时几十毫秒等内部上电时序稳定。然后第一步做WHO_AM_I校验读0x0F寄存器正常应该返回0x6C。这一步务必做它能在第一时间暴露接线问题、地址问题和芯片供电问题免得后续配置出错了到处瞎猜。校验通过后做一次软复位向CTRL3_C0x12写入0x01置位SW_RESET位然后等待一段时间让传感器内部完成复位。软复位后所有寄存器恢复默认值。实际调试中我发现软复位之后立即去写配置有过偶尔失败的情况稳妥做法是复位后加一个10到50毫秒延时再继续后面的寄存器配置否则第一次上电可能捕获到芯片还在复位中的状态。3.3 陀螺仪寄存器配置复位完成之后只配置陀螺仪部分配置CTRL2_G。我选择ODR104Hz、FS±250 dps所以向0x11写入0x40。为什么是这个值ODR位的104Hz对应二进制0100放到bit7到bit4就成了0x40FS±250 dps对应bit3到bit2为00。这样组合出来正好是0x40。如果你项目里需要更高采样率比如跑姿态解算常用208Hz或416Hz把ODR位改成0101或0110就行对应到0x11就是0x50和0x60。量程方面±250 dps灵敏度最高适合低速运动云台、机器人关节这类需要测大角速度的场景再往上调量程。这里先记住结论满量程决定灵敏度灵敏度决定了LSB到角速度的换算系数稍后数据转换部分会用到。加速度计本教程暂时不用不需要配置CTRL1_XL读到的加速度计默认输出是关闭的。但如果你之后要一起读六轴数据记得给CTRL1_XL也设置ODR和量程。4. 轮询读取的代码实现4.1 初始化函数的实现初始化函数整体长这样我用HAL库的I2C接口操作配合延时保证时序稳定#define LSM6DSOW_ADDR (0x6A 1) uint8_t LSM6DSOW_Init(void) { uint8_t val 0; // 读取WHO_AM_I确认通信正常 if (HAL_I2C_Mem_Read(hi2c1, LSM6DSOW_ADDR, 0x0F, 1, val, 1, 100) ! HAL_OK) return 1; if (val ! 0x6C) return 2; // 软复位 val 0x01; HAL_I2C_Mem_Write(hi2c1, LSM6DSOW_ADDR, 0x12, 1, val, 1, 100); HAL_Delay(50); // 配置陀螺仪ODR104HzFS±250dps val 0x40; HAL_I2C_Mem_Write(hi2c1, LSM6DSOW_ADDR, 0x11, 1, val, 1, 100); return 0; }注意HAL_I2C_Mem_Read最后一个参数是超时时间单位毫秒。如果总线有问题或者地址不对这个函数会一直阻塞到超时从现象上看就是程序卡死在那里。排查时可以先加大超时时间看现象但最终还是要靠逻辑分析仪或者示波器看I2C波形。4.2 主循环里轮询读取陀螺仪数据数据读取函数做了两件事先查STATUS_REG的bit1GDA位是否为1确认陀螺仪有新数据再一次性读6个字节拼出X、Y、Z三个轴的原始值。uint8_t LSM6DSOW_ReadGyro(int16_t *gx, int16_t *gy, int16_t *gz) { uint8_t status 0; uint8_t buf[6] {0}; if (HAL_I2C_Mem_Read(hi2c1, LSM6DSOW_ADDR, 0x1E, 1, status, 1, 100) ! HAL_OK) return 1; if ((status 0x02) 0) return 2; // 数据未就绪稍后重试 if (HAL_I2C_Mem_Read(hi2c1, LSM6DSOW_ADDR, 0x22, 1, buf, 6, 100) ! HAL_OK) return 1; *gx (int16_t)(buf[1] 8 | buf[0]); *gy (int16_t)(buf[3] 8 | buf[2]); *gz (int16_t)(buf[5] 8 | buf[4]); return 0; }这里有个细节我用了寄存器地址自动递增功能。默认情况下从0x22开始连续读取6个字节传感器会自动把地址指到0x23、0x24……直到0x27不用分三次读。前提是CTRL3_C里的IF_INC位保持默认的1这个在软复位之后的默认状态就是使能的所以不需要写。如果你不想检查GDA位直接连续读六个字节也能读到数据因为寄存器里总有上一次的采样值。但检查GDA位的好处是能保证每次读到的都是最新完整的一组数据不会出现上半帧是上次的、下半帧是这次的情况。4.3 数据转换与单位换算原始值是LSB要转成工程上的角速度值必须乘灵敏度系数。CTRL2_G的满量程选±250 dps时灵敏度是8.75 mdps/LSB也就是每个LSB代表0.00875度/秒。所以换算代码非常简单float gx_dps (float)gx * 0.00875f; float gy_dps (float)gy * 0.00875f; float gz_dps (float)gz * 0.00875f;不同满量程下灵敏度系数我整理成了表格方便你切换量程时对照满量程灵敏度 (mdps/LSB)换算系数 (dps/LSB)±125 dps4.3750.004375±250 dps8.750.00875±500 dps17.500.0175±1000 dps350.035±2000 dps700.07主循环里我每隔10毫秒读一次能跟104Hz的ODR基本匹配上int16_t gx 0, gy 0, gz 0; while (1) { if (LSM6DSOW_ReadGyro(gx, gy, gz) 0) { printf(GX:%.3f GY:%.3f GZ:%.3f\r\n, (float)gx * 0.00875f, (float)gy * 0.00875f, (float)gz * 0.00875f); } HAL_Delay(10); }如果你把ODR改成208Hz等于0x50主循环HAL_Delay也可以缩短到5毫秒打印频率拉高。如果只是想确认数据动没动延时20毫秒也无所谓传感器内部不会因为你不及时读而丢数据数据寄存器里始终保留最近一次采样下次读还是能拿到最新的。5. 实测数据与常见问题排查5.1 静态和动态实测结果怎么看代码烧进去以后串口工具打开115200应该能看见一行行GX:0.002 GY:-0.031 GZ:0.011这样的输出。手表静止放在桌面上时三个轴的角速度应该在0附近小幅跳动波动范围一般不超过±1 dps这是因为传感器本身有零偏和噪声。这时候你用手拿起板子快速绕Z轴转90度串口里GZ的值应该瞬间跳到一个较大数值甚至几百dps转完停下又回到0附近。X、Y轴的数据也会跟着姿态变化有响应。只要看到这个现象恭喜你整个数据链已经通了从I2C通信到寄存器配置到数据换算全部正确。有一点要提前打预防针静态时陀螺仪数值不是绝对0这是正常现象。直接拿这个带零偏的数据去做积分算角度几秒钟就会飘出误差后续必须做零偏校准。5.2 零偏校准思路零偏校准的原理很简单传感器静止时理论上角速度应该是0但实际输出有一个固定的偏置。把这个偏置测出来然后每次读数减掉它即可。我常做的做法是上电延时完成后连续采集100次陀螺仪数据求平均得到offset_x、offset_y、offset_zfloat offset_x 0, offset_y 0, offset_z 0; int16_t gx, gy, gz; for (int i 0; i 100; i) { if (LSM6DSOW_ReadGyro(gx, gy, gz) 0) { offset_x (float)gx * 0.00875f; offset_y (float)gy * 0.00875f; offset_z (float)gz * 0.00875f; } HAL_Delay(10); } offset_x / 100; offset_y / 100; offset_z / 100;之后输出数据前统一减去这个偏置。注意每次上电都重新校准一次因为零偏受温度影响放一晚上再开机可能就不一样了。5.3 常见问题排查表调I2C传感器最烦的就是读数不对或者压根不通。我把实际项目中遇到过的典型问题整理成表格按排查优先级排序现象可能原因排查方法WHO_AM_I读不到I2C超时接线错误或I2C地址不对先确认SDA、SCL没接反SA0接地时地址是0x6A 1WHO_AM_I返回0xFFSDA上拉缺失或供电异常测量VDD电压检查I2C上拉电阻WHO_AM_I返回0x6C但配置后读数全为0软复位后立即写寄存器失败软复位后加50ms延时再写配置读数始终不变传感器没退出复位或配置没写入读回CTRL2_G寄存器确认是否为0x40数值有但符号反了字节序拼反确认读取时低字节在前高字节在后数值偶尔跳变很大电源纹波或I2C时序余量不足尝试降低I2C速率到100kHz加滤波电容还有一个经验之谈如果你用杜邦线飞线连接模块线太长或者接触不良会出现“时好时坏”的现象表现为有时候能读到数据有时候卡死。这通常是接触电阻导致I2C信号畸变把杜邦线换短一点或者直接焊上去问题会暴露得更明显。5.4 用逻辑分析仪验证时序如果代码层面都改遍了还是有问题别硬猜直接上逻辑分析仪。把SCL和SDA两路信号夹出来抓包能清晰看到I2C启动条件、设备地址、寄存器地址和返回的数据。重点看两处一是地址字节最后一位读操作应该是1写操作应该是0二是传感器是否在第9个时钟周期回了ACK。如果设备没有ACK说明地址不对或者设备没醒过来。我之前遇到过一次诡异情况设备偶尔能读偶尔不能读逻辑分析仪抓出来发现是SCL线电容太大上升沿太缓导致从机识别不到时钟。把I2C速率从400kHz降到100kHz就稳定了。这种问题如果没仪器纯靠猜能折腾一整天。轮询读取陀螺仪虽然是最基础的用法但它是后续所有复杂功能的地基。我实际跑下来最大的感受是LSM6DSOW的寄存器操作并不复杂真正决定项目进度的是对I2C时序稳定性和数据格式细节的把控。如果一开始就用中断加FIFO底层出了岔子很难定位从轮询一点点跑通反而能帮你把每个环节都吃透。接下来这个系列我打算继续写LSM6DSOW的进阶用法至少包括加速度计读取、六轴数据融合、陀螺仪零偏校准实战以及FIFO批量读取配合STM32C5的低功耗采集。如果你在这个轮询版本上遇到了文章里没覆盖到的问题我建议先读一遍数据手册里CTRL2_G和STATUS_REG的寄存器描述再结合第5节的排查表格逐项验证百分之八十的问题都能自己定位。
STM32C5驱动LSM6DSOW陀螺仪：HAL库I2C轮询读取与数据换算
STM32C5这颗料拿到手之后我本来想先跑个点灯但点灯实在没意思。手里正好躺着一颗LSM6DSOW干脆直接跳进正题——用官方HAL库通过状态轮询的方式把陀螺仪数据读出来顺便把这颗传感器从寄存器到换算公式完整走一遍。这篇教程是系列第一篇不讲那些花里胡哨的DMP、中断、FIFO就把最朴素的“上电、配置、读数据”讲透。如果你正在用STM32C5系列做运动检测、姿态解算、防抖云台或者跌倒检测这类项目想快速验证传感器有没有工作这篇内容就是给你准备的。哪怕你之前从没碰过LSM6DSOW只要会一点HAL库基础跟着流程走也能调通。文章里我会把寄存器地址、配置思路、代码实现、数据换算原理全部拆开讲最后再把我实际调试中踩过的坑和排查方法整理成清单方便你直接抄作业。1. 项目概述与硬件分析1.1 LSM6DSOW是什么为什么选它LSM6DSOW是ST推出的一款六轴惯性传感器内部集成了三轴陀螺仪和三轴加速度计。后缀里的W代表的是新封装和功耗优化版本寄存器映射和LSM6DSO基本一致所以老的LSM6DSO代码稍微改改地址就能用。这颗芯片支持I2C和SPI两种通信方式陀螺仪的满量程可以从±125 dps一直选到±2000 dps精度和量程可以按场景灵活配置。我选它做教程主角原因很简单这颗料在无人机、智能穿戴、工业状态监测里非常常见而且它的数据手册写得相对清楚寄存器不多特别适合用来学习IMU的基础操作。陀螺仪输出的角速度数据本身不会直接告诉你“现在朝哪个方向”但它能告诉你在某个轴上转得有多快这是姿态解算、零偏校准、运动检测的地基。1.2 为什么拿STM32C5来跑这颗传感器STM32C5是ST新一代高性价比MCUCortex-M33内核主频拉到250MHz级别片上资源比同价位的G系列丰富不少像FDCAN、以太网这类外设都开始下放。拿它来读一个IMU确实是大材小用但反过来说C5的I2C外设、中断控制器和低功耗模式都比较完善做传感器读取这种入门级任务有一个好处——整个通信链路非常简单方便我们聚焦在传感器本身的寄存器操作上。另外STM32C5的生态已经完整了CubeMX里直接选型号就能生成HAL工程不需要像早期芯片那样手动移植库。对于刚上手C5系列的开发者来说用一颗I2C传感器练手既能熟悉CubeMX的配置流程又能摸清HAL库I2C读写接口的套路后续再做复杂项目心里就有底了。1.3 轮询方式的优势与取舍可能有人会问既然LSM6DSOW支持数据就绪中断引脚为什么不一开始就用中断去读反而要用轮询这是我故意安排的。轮询方式的核心逻辑很简单主循环里不断查看传感器的状态寄存器或者直接读取数据寄存器只要数据准备好就取走。这么做的好处是代码路径非常直白不设计EXTI中断映射也不涉及中断优先级和回调函数出问题时排查范围很小。对于第一次接触这颗传感器的朋友来说中断方式一旦失灵你根本分不清是传感器初始化失败还是中断配置漏了一步。轮询的代价也很明显你需要定期“打扰”传感器CPU没法在等待期间去睡大觉实时性也取决于主循环的调度周期。但对大多数采样率不高、逻辑不复杂的场景比如开机自检、数据采集验证、姿态解算原型开发轮询完全够用甚至更省心。等我们把数据链路跑通后续再升级到FIFO加中断也不迟。2. 通信接口与寄存器基础2.1 选I2C还是SPILSM6DSOW的I2C接口最高可以跑到400kHz Fast ModeSPI则可以跑得更快。对陀螺仪数据来说I2C完全够用而且只需要四根线VDD、GND、SCL、SDA省引脚、好接线随便找两根杜邦线就能连上。SPI速度高但要多一根CS片选线更适合高ODR、大量读取FIFO的场景。这里我采用I2C做演示一方面接线更简单另一方面HAL库里HAL_I2C_Mem_Read和HAL_I2C_Mem_Write这两个接口读寄存器非常顺手代码可读性高。你如果后面想切SPI寄存器流程完全一样只需要把底层读写函数换掉。2.2 I2C从机地址与硬件连接LSM6DSOW的I2C从机地址由SA0引脚的电平决定。SA0接地时7位地址是0x6ASA0接高电平是0x6B。我用的是0x6A。这里有个新手容易踩的坑HAL库里的设备地址参数需要左移一位保留最低位作为读写位所以实际传给HAL_I2C_Mem_Read的地址是(0x6A 1)也就是0xD4。如果你直接填0x6AI2C通信大概率会超时失败。接线方面SCL和SDA需要接上拉电阻到VDD一般开发板上已经预留外接模块通常也自带上拉。如果你是自己搭的电路记得加4.7kΩ上拉不然I2C时序会奇奇怪怪偶尔能通信偶尔超时这种隐蔽问题排查起来非常头疼。2.3 关键寄存器一览先把本教程需要用到的寄存器列出来不用每个都背但要能看懂寄存器地址作用WHO_AM_I0x0F芯片IDLSM6DSOW固定返回0x6CCTRL1_XL0x10加速度计配置输出速率、量程、滤波CTRL2_G0x11陀螺仪配置输出速率、量程、滤波CTRL3_C0x12主控制寄存器软复位、接口使能、地址自动递增等STATUS_REG0x1E状态寄存器bit1是陀螺仪数据就绪标志OUTX_L_G0x22陀螺仪X轴数据低字节OUTX_H_G0x23陀螺仪X轴数据高字节OUTY_L_G0x24陀螺仪Y轴数据低字节OUTY_H_G0x25陀螺仪Y轴数据高字节OUTZ_L_G0x26陀螺仪Z轴数据低字节OUTZ_H_G0x27陀螺仪Z轴数据高字节这里我们重点操作CTRL2_G和STATUS_REG。CTRL2_G的bit7到bit4决定输出数据速率bit3到bit2决定满量程范围bit1是额外的小量程使能。比如把ODR设为104Hz、满量程设为±250 dps只要向CTRL2_G写入0x40就够了。满量程越小灵敏度越高单位LSB对应的角速度越小满量程越大能测量的大角速度越多但同样一个原始值对应物理量也越大。WHY要在这里特别强调数据格式输出寄存器是16位有符号整数采用小端存储低字节在前高字节在后。读取的时候需要先读低字节再把两个字节拼成一个int16_t。如果顺序搞反得到的角速度符号会是乱的而且数值完全不对。3. 初始化流程与CubeMX配置3.1 CubeMX工程基本配置打开STM32CubeMX先在MCU选择器里找到STM32C5系列的具体型号。这里以带I2C1和USART1的C5型号为例。芯片选好之后做四件事SYS里把Debug设为Serial Wire避免SWD口被占掉导致后续没法下载程序Connectivity里使能I2C1I2C Speed Mode设为Fast Mode400kHzUSART1使能成异步模式波特率115200用于打印数据时钟树先按默认的内部时钟跑后面如果发现I2C时序不对再核对外设时钟。C5的HAL库生成逻辑和F系列基本一致Project Manager里面选好工具链代码生成器勾选“仅复制必要库文件”生成的工程会比较干净。有一点要提醒不同CubeMX版本对C5的I2C初始化结构体成员可能有差异生成代码后打开i2c.c看一眼hi2c1.Init.ClockSpeed是否被正确赋值为400000确认无误再继续。3.2 软复位与WHO_AM_I校验传感器上电后不要立刻操作寄存器先延时几十毫秒等内部上电时序稳定。然后第一步做WHO_AM_I校验读0x0F寄存器正常应该返回0x6C。这一步务必做它能在第一时间暴露接线问题、地址问题和芯片供电问题免得后续配置出错了到处瞎猜。校验通过后做一次软复位向CTRL3_C0x12写入0x01置位SW_RESET位然后等待一段时间让传感器内部完成复位。软复位后所有寄存器恢复默认值。实际调试中我发现软复位之后立即去写配置有过偶尔失败的情况稳妥做法是复位后加一个10到50毫秒延时再继续后面的寄存器配置否则第一次上电可能捕获到芯片还在复位中的状态。3.3 陀螺仪寄存器配置复位完成之后只配置陀螺仪部分配置CTRL2_G。我选择ODR104Hz、FS±250 dps所以向0x11写入0x40。为什么是这个值ODR位的104Hz对应二进制0100放到bit7到bit4就成了0x40FS±250 dps对应bit3到bit2为00。这样组合出来正好是0x40。如果你项目里需要更高采样率比如跑姿态解算常用208Hz或416Hz把ODR位改成0101或0110就行对应到0x11就是0x50和0x60。量程方面±250 dps灵敏度最高适合低速运动云台、机器人关节这类需要测大角速度的场景再往上调量程。这里先记住结论满量程决定灵敏度灵敏度决定了LSB到角速度的换算系数稍后数据转换部分会用到。加速度计本教程暂时不用不需要配置CTRL1_XL读到的加速度计默认输出是关闭的。但如果你之后要一起读六轴数据记得给CTRL1_XL也设置ODR和量程。4. 轮询读取的代码实现4.1 初始化函数的实现初始化函数整体长这样我用HAL库的I2C接口操作配合延时保证时序稳定#define LSM6DSOW_ADDR (0x6A 1) uint8_t LSM6DSOW_Init(void) { uint8_t val 0; // 读取WHO_AM_I确认通信正常 if (HAL_I2C_Mem_Read(hi2c1, LSM6DSOW_ADDR, 0x0F, 1, val, 1, 100) ! HAL_OK) return 1; if (val ! 0x6C) return 2; // 软复位 val 0x01; HAL_I2C_Mem_Write(hi2c1, LSM6DSOW_ADDR, 0x12, 1, val, 1, 100); HAL_Delay(50); // 配置陀螺仪ODR104HzFS±250dps val 0x40; HAL_I2C_Mem_Write(hi2c1, LSM6DSOW_ADDR, 0x11, 1, val, 1, 100); return 0; }注意HAL_I2C_Mem_Read最后一个参数是超时时间单位毫秒。如果总线有问题或者地址不对这个函数会一直阻塞到超时从现象上看就是程序卡死在那里。排查时可以先加大超时时间看现象但最终还是要靠逻辑分析仪或者示波器看I2C波形。4.2 主循环里轮询读取陀螺仪数据数据读取函数做了两件事先查STATUS_REG的bit1GDA位是否为1确认陀螺仪有新数据再一次性读6个字节拼出X、Y、Z三个轴的原始值。uint8_t LSM6DSOW_ReadGyro(int16_t *gx, int16_t *gy, int16_t *gz) { uint8_t status 0; uint8_t buf[6] {0}; if (HAL_I2C_Mem_Read(hi2c1, LSM6DSOW_ADDR, 0x1E, 1, status, 1, 100) ! HAL_OK) return 1; if ((status 0x02) 0) return 2; // 数据未就绪稍后重试 if (HAL_I2C_Mem_Read(hi2c1, LSM6DSOW_ADDR, 0x22, 1, buf, 6, 100) ! HAL_OK) return 1; *gx (int16_t)(buf[1] 8 | buf[0]); *gy (int16_t)(buf[3] 8 | buf[2]); *gz (int16_t)(buf[5] 8 | buf[4]); return 0; }这里有个细节我用了寄存器地址自动递增功能。默认情况下从0x22开始连续读取6个字节传感器会自动把地址指到0x23、0x24……直到0x27不用分三次读。前提是CTRL3_C里的IF_INC位保持默认的1这个在软复位之后的默认状态就是使能的所以不需要写。如果你不想检查GDA位直接连续读六个字节也能读到数据因为寄存器里总有上一次的采样值。但检查GDA位的好处是能保证每次读到的都是最新完整的一组数据不会出现上半帧是上次的、下半帧是这次的情况。4.3 数据转换与单位换算原始值是LSB要转成工程上的角速度值必须乘灵敏度系数。CTRL2_G的满量程选±250 dps时灵敏度是8.75 mdps/LSB也就是每个LSB代表0.00875度/秒。所以换算代码非常简单float gx_dps (float)gx * 0.00875f; float gy_dps (float)gy * 0.00875f; float gz_dps (float)gz * 0.00875f;不同满量程下灵敏度系数我整理成了表格方便你切换量程时对照满量程灵敏度 (mdps/LSB)换算系数 (dps/LSB)±125 dps4.3750.004375±250 dps8.750.00875±500 dps17.500.0175±1000 dps350.035±2000 dps700.07主循环里我每隔10毫秒读一次能跟104Hz的ODR基本匹配上int16_t gx 0, gy 0, gz 0; while (1) { if (LSM6DSOW_ReadGyro(gx, gy, gz) 0) { printf(GX:%.3f GY:%.3f GZ:%.3f\r\n, (float)gx * 0.00875f, (float)gy * 0.00875f, (float)gz * 0.00875f); } HAL_Delay(10); }如果你把ODR改成208Hz等于0x50主循环HAL_Delay也可以缩短到5毫秒打印频率拉高。如果只是想确认数据动没动延时20毫秒也无所谓传感器内部不会因为你不及时读而丢数据数据寄存器里始终保留最近一次采样下次读还是能拿到最新的。5. 实测数据与常见问题排查5.1 静态和动态实测结果怎么看代码烧进去以后串口工具打开115200应该能看见一行行GX:0.002 GY:-0.031 GZ:0.011这样的输出。手表静止放在桌面上时三个轴的角速度应该在0附近小幅跳动波动范围一般不超过±1 dps这是因为传感器本身有零偏和噪声。这时候你用手拿起板子快速绕Z轴转90度串口里GZ的值应该瞬间跳到一个较大数值甚至几百dps转完停下又回到0附近。X、Y轴的数据也会跟着姿态变化有响应。只要看到这个现象恭喜你整个数据链已经通了从I2C通信到寄存器配置到数据换算全部正确。有一点要提前打预防针静态时陀螺仪数值不是绝对0这是正常现象。直接拿这个带零偏的数据去做积分算角度几秒钟就会飘出误差后续必须做零偏校准。5.2 零偏校准思路零偏校准的原理很简单传感器静止时理论上角速度应该是0但实际输出有一个固定的偏置。把这个偏置测出来然后每次读数减掉它即可。我常做的做法是上电延时完成后连续采集100次陀螺仪数据求平均得到offset_x、offset_y、offset_zfloat offset_x 0, offset_y 0, offset_z 0; int16_t gx, gy, gz; for (int i 0; i 100; i) { if (LSM6DSOW_ReadGyro(gx, gy, gz) 0) { offset_x (float)gx * 0.00875f; offset_y (float)gy * 0.00875f; offset_z (float)gz * 0.00875f; } HAL_Delay(10); } offset_x / 100; offset_y / 100; offset_z / 100;之后输出数据前统一减去这个偏置。注意每次上电都重新校准一次因为零偏受温度影响放一晚上再开机可能就不一样了。5.3 常见问题排查表调I2C传感器最烦的就是读数不对或者压根不通。我把实际项目中遇到过的典型问题整理成表格按排查优先级排序现象可能原因排查方法WHO_AM_I读不到I2C超时接线错误或I2C地址不对先确认SDA、SCL没接反SA0接地时地址是0x6A 1WHO_AM_I返回0xFFSDA上拉缺失或供电异常测量VDD电压检查I2C上拉电阻WHO_AM_I返回0x6C但配置后读数全为0软复位后立即写寄存器失败软复位后加50ms延时再写配置读数始终不变传感器没退出复位或配置没写入读回CTRL2_G寄存器确认是否为0x40数值有但符号反了字节序拼反确认读取时低字节在前高字节在后数值偶尔跳变很大电源纹波或I2C时序余量不足尝试降低I2C速率到100kHz加滤波电容还有一个经验之谈如果你用杜邦线飞线连接模块线太长或者接触不良会出现“时好时坏”的现象表现为有时候能读到数据有时候卡死。这通常是接触电阻导致I2C信号畸变把杜邦线换短一点或者直接焊上去问题会暴露得更明显。5.4 用逻辑分析仪验证时序如果代码层面都改遍了还是有问题别硬猜直接上逻辑分析仪。把SCL和SDA两路信号夹出来抓包能清晰看到I2C启动条件、设备地址、寄存器地址和返回的数据。重点看两处一是地址字节最后一位读操作应该是1写操作应该是0二是传感器是否在第9个时钟周期回了ACK。如果设备没有ACK说明地址不对或者设备没醒过来。我之前遇到过一次诡异情况设备偶尔能读偶尔不能读逻辑分析仪抓出来发现是SCL线电容太大上升沿太缓导致从机识别不到时钟。把I2C速率从400kHz降到100kHz就稳定了。这种问题如果没仪器纯靠猜能折腾一整天。轮询读取陀螺仪虽然是最基础的用法但它是后续所有复杂功能的地基。我实际跑下来最大的感受是LSM6DSOW的寄存器操作并不复杂真正决定项目进度的是对I2C时序稳定性和数据格式细节的把控。如果一开始就用中断加FIFO底层出了岔子很难定位从轮询一点点跑通反而能帮你把每个环节都吃透。接下来这个系列我打算继续写LSM6DSOW的进阶用法至少包括加速度计读取、六轴数据融合、陀螺仪零偏校准实战以及FIFO批量读取配合STM32C5的低功耗采集。如果你在这个轮询版本上遇到了文章里没覆盖到的问题我建议先读一遍数据手册里CTRL2_G和STATUS_REG的寄存器描述再结合第5节的排查表格逐项验证百分之八十的问题都能自己定位。
