简介面向STM32F030平台的博世BMI160自写驱动代码通过I2C总线实现三轴陀螺仪的基础数据交互适用于嵌入式开发者学习传感器驱动编写或快速搭建原型。压缩包共3个文件、仅6KB包含BMI160.c源文件以及BMI160.h、BMI160_prm.h两个头文件分别对应通信实现、寄存器定义和参数配置结构精简便于逐行研读。目前已有1887人学习下载是微型驱动资源中较受关注的参考模板。代码覆盖初始化、寄存器读写与数据读取等核心环节但作者注明功能并不完整I2C外设初始化及中断、低功耗等高级特性需要使用者自行补充。借助BMI160_prm.h中的灵敏度与滤波参数可在此基础上进一步实现数据融合或姿态解算从而深入理解传感器底层工作原理和STM32外设驱动开发方法。1. 从一块零度以下的 IMU 开始为什么我扔掉手头的惯性测量模块从头写一份 BMI160 驱动之前做某个姿态采集项目手头的六轴模块换成了博世 BMI160。第一反应是打开现成库看两眼、调个接口就完事结果发现事情没这么简单现成驱动对量程、滤波、数据更新率的封装太多里面怎么拼字节、怎么对齐 FIFO、怎么处理工厂校准参数全是黑匣子出了问题根本没法定位。折腾两天后决定只留芯片手册自己把寄存器配置层、原始数据读取层、校准补偿层完整写一遍。这篇笔记就是把这份自写驱动拆开讲透功能上覆盖了 BMI160 的加速度计和陀螺仪全部量程档位、数字滤波设置、FIFO 读取和软件校准适合两类人——一类是要把 BMI160 跑起来做姿态解算的嵌入式开发者另一类是跟我一样看现成源码总觉得不踏实的二次开发型选手。这份资源不是入门 demo而是一套能直接平移到其他博世 IMU 型号的驱动骨架读完你能照着自己写、自己改、自己查错。2. 驱动架构拆解从寄存器映射到应用层接口的完整链路2.1 为什么 BMI160 值得自己写驱动而不是直接抄现成库博世 BMI160 是一颗六轴惯性传感器内部同时集成了三轴加速度计和三轴陀螺仪采用 16 位数字输出接口支持 I2C 和 SPI。它的寄存器设计在所有博世 IMU 里属于比较规整的一类每个功能模块的配置寄存器集中在固定地址段数据输出寄存器从0x0A到0x1F连续排布读一次突发传输就能拿到全部六轴原始值。这种规整性对驱动开发极其友好但前提是你真的去读芯片手册里的寄存器说明而不是依赖封装好的现成 SDK。我的驱动设计分三层最底层是寄存器和通信抽象中间层是初始化配置和数据读取最上层是对外提供的应用接口。这样分层的好处是上层跑姿态解算的人完全不用关心底层是 I2C 还是 SPI、量程是 2g 还是 16g只需要拿到已经换算成物理单位的加速度和角速度。项目中很多二次开发的需求都集中在中间层——比如换量程、改滤波、切换工作模式——这一层不做好上层做得再花哨也白搭。2.2 目录结构与文件职责整个驱动源文件不多但每份文件的职责都很清晰bmi160_driver/ ├── bmi160_reg.h // 寄存器地址映射全部用宏定义 ├── bmi160_core.c // 核心逻辑初始化、寄存器读写、数据拼接 ├── bmi160_core.h // 对外 API 声明和数据结构定义 ├── bmi160_i2c.c // I2C 通信抽象层 ├── bmi160_i2c.h // I2C 接口回调注册 ├── bmi160_cal.c // 软件校准零偏标定和温漂补偿 ├── bmi160_fifo.c // FIFO 突发读取和解析 └── example_mcu.c // 一个裸机 MCU 上的调用示例bmi160_reg.h是整个驱动的基石里面把用到的寄存器全列成了宏。bmi160_core.c是核心包含了初始化和数据读取的所有逻辑。bmi160_i2c.c做的是通信解耦不直接调用硬件 I2C 外设而是预留回调函数指针由使用者把它接到自己平台的 I2C 驱动上。bmi160_cal.c处理的是校准逻辑下面第 4 章会单独分析。bmi160_fifo.c专门负责 FIFO 模式下的批量读取适合需要低功耗连续采样的场景。2.3 通信抽象设计注册回调而不是硬编码硬件接口BMI160 的驱动移植性最难的部分就是通信层。不同 MCU 的 I2C 外设接口差异很大所以我在这份驱动里没有直接和具体平台绑定而是采用回调注册的方式来解耦。通信抽象层只定义了一个结构体里面放了两个函数指针typedef struct { uint8_t i2c_addr; // I2C 从机地址BMI160 默认为 0x68 int32_t (*read_reg)(uint8_t reg, uint8_t *buf, uint16_t len); int32_t (*write_reg)(uint8_t reg, const uint8_t *buf, uint16_t len); } bmi160_io_t;调用方只需要在初始化驱动前把自己平台的读写函数填进这个结构体。比如某 MCU 的硬件 I2C 函数是HAL_I2C_Mem_Read就包一层把reg映射成内存地址len映射成读取长度再放回bmi160_io_t里。这样驱动核心逻辑里所有对通信的调用都走io-read_reg(...)和io-write_reg(...)不关心底下接的是哪颗 MCU。这种设计最直接的好处是调试的时候可以在这里做手脚。我以前踩过一个坑怀疑数据跳变是通信干扰导致的就把read_reg换成软件模拟 I2C 的版本对比波形后确认确实是硬件 I2C 的时钟线受干扰。没有这层抽象的话这种排查几乎要重写整个驱动。3. 初始化与配置核心代码量程、滤波和数据更新率的设置逻辑3.1 上电后第一步软复位和校验芯片 IDBMI160 上电后先要确认通信是否正常最直接的办法就是读芯片的 ID 寄存器0x00。这个值固定是0xD1读到这个值说明 I2C/SPI 链路通畅器件没被焊坏、没被拉低地址线导致访问错设备。#define BMI160_REG_CHIP_ID 0x00 #define BMI160_CHIP_ID_VALUE 0xD1 #define BMI160_REG_CMD 0x7E #define BMI160_CMD_SOFTRESET 0xB6 int bmi160_init(bmi160_dev_t *dev) { uint8_t id 0; int32_t ret dev-io.read_reg(BMI160_REG_CHIP_ID, id, 1); if (ret ! 0 || id ! BMI160_CHIP_ID_VALUE) { return BMI160_ERR_COMM; // 错误码也按层定义通信错误、参数错误、校准未完成 } // 软复位让器件回到默认寄存器状态避免残留配置影响后续初始化 uint8_t cmd BMI160_CMD_SOFTRESET; dev-io.write_reg(BMI160_REG_CMD, cmd, 1); dev-delay_ms(10); // 软复位后需要等待至少 10ms 让内部状态机恢复 return bmi160_configure(dev); }软复位这步是血泪经验换来的。第一次写完初始化代码后没有先软复位直接往下配置寄存器结果量程和滤波器设置有时生效有时不生效后来用逻辑分析仪抓 I2C 波形才发现器件上电后如果没有复位指令内部的非易失设置会残留上一次的下电状态。加了软复位并延时 10ms 之后配置行为完全稳定了。注意——写0xB6到命令寄存器会导致 BMI160 内部重新加载校准参数所以在复位之后再配置量程和滤波是正确顺序。3.2 加速度计和陀螺仪的量程、带宽配置BMI160 的加速计量程有四种±2g、±4g、±8g、±16g陀螺仪量程有五种±125、±250、±500、±1000、±2000 dps。配置量程不是只改一个寄存器位需要同时考虑数据更新率和数字滤波的配置因为这三者耦合在一起共同决定了输出数据的带宽特性。#define BMI160_REG_ACC_CONF 0x41 #define BMI160_REG_ACC_RANGE 0x41 #define BMI160_REG_GYR_CONF 0x42 #define BMI160_REG_GYR_RANGE 0x43 // 取加速度计配置寄存器时注意0x41 同时包含 acc_range 和 acc_bw 两个字段 // [7:4] acc_bw数字滤波带宽 // [3:0] acc_odr数据更新率 static int bmi160_set_acc_range(bmi160_dev_t *dev, uint8_t range) { uint8_t reg 0; dev-io.read_reg(BMI160_REG_ACC_RANGE, reg, 1); reg 0x0F; // 保留低 4 位acc_odr reg | (range 4) 0xF0; // 把量程写入高 4 位 return dev-io.write_reg(BMI160_REG_ACC_RANGE, reg, 1); } static int bmi160_set_acc_odr_bw(bmi160_dev_t *dev, uint8_t odr, uint8_t bw) { uint8_t reg 0; dev-io.read_reg(BMI160_REG_ACC_CONF, reg, 1); reg 0xF0; // 保留高 4 位acc_range reg | (bw 4) 0xF0; // 注意 bw 和 range 在同一个字节的高半部分 reg | odr 0x0F; return dev-io.write_reg(BMI160_REG_ACC_CONF, reg, 1); }这里有一个 ARM Cortex-M 开发中容易犯的错误BMI160_REG_ACC_CONF和BMI160_REG_ACC_RANGE是同一个物理地址0x41高 4 位是量程低 4 位是数据更新率。你不能分两次分别写高低位因为第二次写会覆盖第一次写的结果。正确做法是先读回当前值只修改目标字段再整体写回。整个 BMI160 的寄存器配置里有好几处这样的复用地址设计写配置前一定要先查手册里的寄存器布局表格确认字段位宽和字节偏移否则极易走进寄存器写进去了但实际不生效的死胡同。3.3 各量程下的分辨率换算和预期噪声水平量程设置完成后从数据寄存器读到的原始值是 16 位有符号整数需要换算成物理单位。换算公式不复杂物理值 原始值 ÷ 32768 × 量程。原因在于 BMI160 内部 ADC 的输出就是按量程基准归一化的——±2g 量程下32768对应2g±16g 量程下32768对应16g。但不同量程下的实际分辨率和噪声表现差别很大这里把参数整理成了一张配置速查表方便二次开发时按场景选择。量程分辨率典型噪声(加速度)适用场景±2g0.061 mg/LSB低倾斜检测、静态姿态、低振动设备±4g0.122 mg/LSB中手持式设备、包含人体运动±8g0.244 mg/LSB中高运动检测、包含冲击过程±16g0.488 mg/LSB高跌落检测、剧烈运动捕捉陀螺仪同理±250 dps 下32768对应250分辨率约0.0076 dps/LSB±2000 dps 下分辨率约0.061 dps/LSB。数据类型方面16 位原始值直接用int16_t存储换算成物理值时建议用浮点但如果目标 MCU 没有 FPU可以退化为定点数表示保留 3 位小数再输出。4. 数据读取与姿态解算从原始寄存器值到可用的姿态四元数4.1 突发读取六轴数据一次 I2C 读全部BMI160 的加速度和陀螺仪数据输出寄存器是连续排布的从0x0A开始加速度 X 轴高字节到陀螺仪 Z 轴低字节一共 12 个字节。驱动里一次突发传输读完这 12 个字节然后在本地解析能大幅降低 I2C 访问次数减少数据不同步的风险。#define BMI160_REG_ACC_X_LSB 0x0A #define BMI160_DATA_LEN 12 typedef struct { int16_t acc_x; int16_t acc_y; int16_t acc_z; int16_t gyr_x; int16_t gyr_y; int16_t gyr_z; } bmi160_raw_data_t; int bmi160_read_raw(bmi160_dev_t *dev, bmi160_raw_data_t *raw) { uint8_t buf[BMI160_DATA_LEN] {0}; int32_t ret dev-io.read_reg(BMI160_REG_ACC_X_LSB, buf, BMI160_DATA_LEN); if (ret ! 0) return ret; // BMI160 输出小端序低字节在前高字节在后 // 拼接时用带符号扩展的写法避免类型转换问题 raw-acc_x (int16_t)((uint16_t)buf[1] 8 | buf[0]); raw-acc_y (int16_t)((uint16_t)buf[3] 8 | buf[2]); raw-acc_z (int16_t)((uint16_t)buf[5] 8 | buf[4]); raw-gyr_x (int16_t)((uint16_t)buf[7] 8 | buf[6]); raw-gyr_y (int16_t)((uint16_t)buf[9] 8 | buf[8]); raw-gyr_z (int16_t)((uint16_t)buf[11] 8 | buf[10]); return BMI160_OK; }为什么拼接的时候要先把两个字节拼成uint16_t再强转成int16_t因为如果直接(int16_t)(buf[1] 8 | buf[0])表达式里的buf[1]会先被提升为int如果高字节的最高位是 1左移后的值在int里是正数直接转int16_t的行为由编译器实现定义不同编译器下结果可能不同。先拼成uint16_t再转一次所有平台行为一致。读取频率怎么定BMI160 的数据更新率ODR决定了数据寄存器刷新的频率例如配置成100Hz时每10ms数据刷新一次。读得太快会读到上一次的数据没更新完读得太慢会错过中间的数据点。所以驱动里在主循环里做判断记录上一次读取的时刻和1000/ODR比较间隔足够再触发新读取。裸机环境下用SysTick计时RTOS 环境下直接vTaskDelayUntil这两种做法在示例工程里都写了。4.2 数据单位换算和传感器坐标系对齐原始值必须换算成物理单位否则姿态解算的结果完全没法用。换算不是简单的除法而是要根据量程做对应系数调整typedef struct { float acc_x; // 单位 g float acc_y; float acc_z; float gyr_x; // 单位 dps float gyr_y; float gyr_z; } bmi160_data_t; void bmi160_raw_to_phy(bmi160_dev_t *dev, const bmi160_raw_data_t *raw, bmi160_data_t *phy) { float acc_scale dev-acc_range / 32768.0f; float gyr_scale dev-gyr_range / 32768.0f; phy-acc_x (float)raw-acc_x * acc_scale; phy-acc_y (float)raw-acc_y * acc_scale; phy-acc_z (float)raw-acc_z * acc_scale; phy-gyr_x (float)raw-gyr_x * gyr_scale; phy-gyr_y (float)raw-gyr_y * gyr_scale; phy-gyr_z (float)raw-gyr_z * gyr_scale; }坐标系的坑必须说明。BMI160 的芯片坐标系默认是X 轴指向芯片右侧、Y 轴指向芯片上方、Z 轴垂直于芯片平面向上右手系。但实际安装到板卡上时几乎不可能不旋转所以驱动里预留了坐标映射接口通过一个 3×3 的旋转矩阵把传感器坐标系转回板卡的机械坐标系。大多数现成库都不做这一步导致用户把模块转个方向装姿态角就全部乱掉。自写驱动的好处就是能在这个环节加入自己的轴映射配置适配非标准安装位。4.3 软件零偏校准静态采集 200 组数据取均值BMI160 出厂之前做过工厂校准加速度计和陀螺仪的零偏通常已经调整过但焊接应力、温度漂移、安装倾斜都会让零偏重新变大。尤其陀螺仪的零偏静态下输出不为零积分几分钟就能偏出几十度。我在这份驱动里实现了软件零偏校准核心逻辑是让设备静止放置采集一组数据后求平均。#define CALIB_SAMPLES 200 #define CALIB_WAIT_MS 10 int bmi160_calibrate_gyro_zero(bmi160_dev_t *dev, bmi160_data_t *gyro_bias) { float sum_x 0, sum_y 0, sum_z 0; bmi160_raw_data_t raw; bmi160_data_t phy; // 校准前先丢弃前 20 个数据点刚上电的数据通常包含内部状态机启动的瞬态 for (int i 0; i 20; i) { bmi160_read_raw(dev, raw); dev-delay_ms(5); } for (int i 0; i CALIB_SAMPLES; i) { bmi160_read_raw(dev, raw); bmi160_raw_to_phy(dev, raw, phy); sum_x phy.gyr_x; sum_y phy.gyr_y; sum_z phy.gyr_z; dev-delay_ms(CALIB_WAIT_MS); } gyro_bias-gyr_x sum_x / CALIB_SAMPLES; gyro_bias-gyr_y sum_y / CALIB_SAMPLES; gyro_bias-gyr_z sum_z / CALIB_SAMPLES; return BMI160_OK; }为什么取 200 组样本BMI160 自带数字滤波后每 10ms 采一组的噪声已经比较小但单次采样里仍包含高频随机分量。采集 200 组取平均均值误差能压低到噪声标准差的 1/14 左右对于常规姿态解算精度足够了。如果想更高精度可以把样本量提到 500 组但要注意校准时间变长设备必须全程静止否则均值里混入运动分量校准结果直接翻车。校准结果存哪里驱动里提供了两个选择一是只保存在 RAM适用于单次上电后校准、掉电后重新校准的场景二是把偏置写进 MCU 的 Flash 或 EEPROM下次上电直接加载。写 Flash 时要注意擦写寿命不能在每次上电都自动写我一般在生产测试流程里单独执行一次校准并存储运行阶段只读加载。4.4 六轴融合Mahony 姿态解算补上陀螺仪积分漂移校准之后的陀螺仪零偏已经不大但依然有积分漂移长时间运行姿态角会缓慢爬升。加速度计没有积分漂移但动态环境下噪声太大直接用作角度也不可靠。两者融合是标准解法这份驱动里带的是 Mahony 互补滤波算法计算量小、参数容易收敛很适合无 FPU 的 MCU。void mahony_update(bmi160_data_t *imu, float dt, float *q, float *bias) { float ax imu-acc_x, ay imu-acc_y, az imu-acc_z; float gx imu-gyr_x, gy imu-gyr_y, gz imu-gyr_z; // 归一化加速度计向量 float norm sqrtf(ax*ax ay*ay az*az); if (norm 1e-6f) return; ax / norm; ay / norm; az / norm; // 用四元数算出重力向量在机体坐标系下的估计值 float vx 2.0f * (q[1]*q[3] - q[0]*q[2]); float vy 2.0f * (q[0]*q[1] q[2]*q[3]); float vz q[0]*q[0] - q[1]*q[1] - q[2]*q[2] q[3]*q[3]; // 向量叉积作为修正误差 float ex ay*vz - az*vy; float ey az*vx - ax*vz; float ez ax*vy - ay*vx; // 比例-积分修正 gx 2.0f * Kp * ex 2.0f * Ki * ex * dt; gy 2.0f * Kp * ey 2.0f * Ki * ey * dt; gz 2.0f * Kp * ez 2.0f * Ki * ez * dt; // 四元数微分方程更新 q[0] 0.5f * dt * (-q[1]*gx - q[2]*gy - q[3]*gz); q[1] 0.5f * dt * ( q[0]*gx q[2]*gz - q[3]*gy); q[2] 0.5f * dt * ( q[0]*gy - q[1]*gz q[3]*gx); q[3] 0.5f * dt * ( q[0]*gz q[1]*gy - q[2]*gx); // 归一化四元数 norm sqrtf(q[0]*q[0] q[1]*q[1] q[2]*q[2] q[3]*q[3]); q[0] / norm; q[1] / norm; q[2] / norm; q[3] / norm; }Kp和Ki是互补滤波器的两个关键参数。Kp越大对加速度计修正的信任越强动态响应快但噪声更容易串进来Ki的作用是消除长期漂移但太大会让姿态角跟着加速度计动态误差走。我常用的先调法是Kp1.0f、Ki0.05f做慢速运动采集后看静止时的姿态角稳定性和动态时的跟随延迟如果静止时角度还在漂加Ki如果动态时角度抖动厉害减Kp。这个地方没有银弹只能一组一组试记录姿态角曲线对比。我调了差不多一个下午才收敛到满意的效果。5. 避坑与常见问题排查从设备探测失败到数据跳变的定位过程5.1 芯片探测失败读不到正确的 Chip ID整个过程最让人抓狂的问题就是bmi160_init()返回通信错误。排查这个问题的套路其实有固定路径先量 VDD 电压、确认 I2C 上拉电阻焊接、再用示波器抓 SCL/SDA 波形看器件有没有 ACK最后才是怀疑芯片本身烧了。实际发生最多的是 I2C 地址不对——BMI160 的 SDO 引脚拉高时地址是0x69拉低时是0x68很多板子出厂时默认下拉但驱动里写死0x68遇到 SDO 被拉高的板子直接挂掉。解决办法很简单初始化前先枚举两个地址都试一遍读到0xD1的地址就是当前器件地址。这是驱动里值得加上的一步能省掉大量排查时间。另一个容易忽视的点是 I2C 通信速率。BMI160 的 I2C 最大速率是 400kHz高速模式 3.4MHz但很多 MCU 默认配置主频走到 1MHz 甚至更高。如果外部上拉电阻阻值偏大时钟线上升沿太慢数据位就会出错、表现为偶发性读值错误。遇到这类问题先把 I2C 频率降到 100kHz能稳定通过再逐步提频。5.2 数据寄存器读出全零或全 0xFF通信层和上电时序的陷阱有段时间我的代码能通过 ID 校验但六轴数据读回来全是0x0000配置量程也没反应。逻辑分析仪抓波形后发现读写命令正常但器件响应内容全是零。最后定位到是上电时序的问题BMI160 的 VDD 和 VDDIO 必须按手册要求的上电顺序来VDDIO 先上、VDD 后上如果顺序反了或者间隔不够器件内部的状态机进入异常模式寄存器能读但数据通路没有正常启动。解决方法是在bmi160_init()开头加一个40ms的上电稳定延时再执行软复位问题消失。还有一种极端情况是读回来全0xFF这通常是 I2C 总线上根本没有器件响应排查方向回到检验地址和电路连接。5.3 加速度计数据在静止时依然跳变滤波配置踩坑静止放置的板子加速度 Z 轴读数理论上是1.0g但实际上总有噪声。我一开始以为是传感器本身噪声太大后来看了手册才明白BMI160 的数字滤波默认关闭或处于宽带宽模式配合 1600Hz 的高输出率噪声会完整保留下来。解决方法是把加速度计的 ODR 降到 100Hz 并配置对应的滤波带宽例如bw 0x08对应普通滤波模式设置后静止噪声从±0.05g降到±0.01g。注意 ODR 和带宽是有对应表的不能任意组合比如 ODR 100Hz 时必须选带宽10Hz~100Hz区间内的配置否则滤波效果和预期不同。这个配置项最容易变成玄学问题寄存器写进去了但波形没变多半是字段位宽填错了比如把带宽写到了acc_range的高 4 位覆盖了量程配置。5.4 陀螺仪静止时输出不为零零偏校准和温度漂移的坑刚上电时陀螺仪零偏可能比预热后高出不少这在惯性传感器领域很常见。第一次校准时没有丢弃开头的数据点直接把上电瞬态的采样也做了平均导致偏置偏大。这个问题的解决方法是像前文代码里那样校准时先等器件状态稳定、主动丢弃前 20 个点再正式采集。但零偏会随温度漂移同一个偏置在 25℃ 和 60℃ 下差别明显精度要求高的场景需要做温补。我的驱动里留了一个温漂补偿结构体存放温度系数和参考温度运行时根据当前温度对偏置做线性修正。这个功能只有在对精度有苛刻要求的项目里才会用到大多数场景存一个静态偏置就够了。6. 二次开发实战从这份驱动出发扩展自己的 IMU 应用6.1 移植到新平台的第一步替换通信回调而不是改核心逻辑如果你拿到这份驱动要平移到自己的板卡上我的建议是不要动bmi160_core.c里的任何一个逻辑只去实现bmi160_io_t里的读写函数。以某 MCU 的硬件 I2C 为例包一层接口即可完成对接static int32_t mcu_i2c_read_reg(uint8_t reg, uint8_t *buf, uint16_t len) { return mcu_i2c_mem_read(MCU_I2C_BUS, 0x68, reg, I2C_MEMADD_SIZE_8BIT, buf, len, 100); } static int32_t mcu_i2c_write_reg(uint8_t reg, const uint8_t *buf, uint16_t len) { return mcu_i2c_mem_write(MCU_I2C_BUS, 0x68, reg, I2C_MEMADD_SIZE_8BIT, (uint8_t *)buf, len, 100); } const bmi160_io_t bmi160_io { .i2c_addr 0x68, .read_reg mcu_i2c_read_reg, .write_reg mcu_i2c_write_reg };接下来只需要把bmi160_io传入bmi160_init()核心驱动的初始化、数据读取、校准流程全部照常工作。验证移植是否成功的方法是透传打印——先打印芯片 ID再打印一段静止状态下的六轴原始值和物理值确认静止时 Z 轴加速度接近1.0g且水平放置时 X、Y 轴接近0。这比直接跳到姿态解算靠谱得多能一次性验证通信、配置、数据拼接三条链路是否同时正确。6.2 扩展一个低功耗 FIFO 读取模式减少主控唤醒次数原始驱动里数据读取是轮询式的主控每 10ms 被唤醒一次读数据。这在电池供电的项目里完全不可接受所以我在二次开发时加了一个 FIFO 模式BMI160 内部有 1024 字节的 FIFO可以缓存多组数据主控睡够一整段时间后一次性读回全部缓存。FIFO 的水位中断可以配置成当缓存数据到达设定阈值时触发一次中断唤醒主控主控短时间内连续读回数据后再次入睡。#define BMI160_REG_FIFO_CONFIG 0x46 #define BMI160_REG_FIFO_CONFIG_1 0x47 #define BMI160_REG_INT_ENABLE_1 0x50 int bmi160_fifo_enable(bmi160_dev_t *dev, uint8_t fifo_watermark) { uint8_t cfg 0x40; // fifo 存储加速度和陀螺仪数据 dev-io.write_reg(BMI160_REG_FIFO_CONFIG, cfg, 1); cfg fifo_watermark; // 水位线为 4 组数据12 字节×448 字节以上 dev-io.write_reg(BMI160_REG_FIFO_CONFIG_1, cfg, 1); cfg 0x02; // 使能 fifo 水位中断 dev-io.write_reg(BMI160_REG_INT_ENABLE_1, cfg, 1); return BMI160_OK; }这个模式的坑在于 FIFO 头的解析——BMI160 的数据帧头要从 FIFO 的第一个字节判断是否带传感器 ID处理不好会出现数据串位导致六轴数据对不上。我第一次实现后验证时发现读出的加速度和陀螺仪数据错位最后对照手册才发现 FIFO 帧头有两种格式需要通过配置寄存器选择是否包含传感器 ID。默认启用后每帧多出 1 个字节解析时要把这个字节跳过才能对齐 12 字节的数据块。6.3 验证驱动正确性的三个关键实验每次改完驱动我会固定做三个验证实验。第一个实验是量程切换验证把量程配成±2g竖直抬高板子让 Z 轴朝天读到的物理值应该接近1.0g再切换到±16g重复一次如果两次读数的物理值一致说明量程配置和换算系数都正确。第二个实验是陀螺仪积分验证静止时采集一分钟数据并做积分角度漂移应该非常缓慢快速翻转 90 度后停止姿态输出应该稳定在新的角度而不是继续爬升这个实验验证的是零偏校准和 Mahony 滤波是否配合到位。第三个实验是计时稳定性验证把主循环用固定节拍跑 10 分钟检查每两次数据读取的时间间隔是否一致。I2C 读取偶尔会被中断优先级更高的代码打断导致采样间隔抖动时间长了姿态解算会累积误差——这个验证能暴露出中断优先级配置是否合理。这三个实验都通过驱动才算真正落地。后续做新项目时我给自己立了一个规矩每拿到一颗不熟悉的传感器就按这份驱动的结构重建一套——reg.h做宏映射、core.c做初始化和读取、cal.c做校准、fifo.c做批量模式。刚开始觉得很慢但后来发现一旦某个平台的链路打通后续所有传感器驱动移植都在复用同一套骨架调试时间直线下降。希望你也能从这份 BMI160 驱动里拿到有用的东西。本文还有配套的精品资源点击获取