STM32驱动VL53L1X激光测距：从I2C通信到稳定读数

简介一份基于STM32F103VET6微控制器与VL53L1X激光测距传感器的完整工程包面向需要实现非接触式距离测量的嵌入式开发者。主控芯片采用ARM Cortex-M3内核通过I2C总线与VL53L1X通信PA2/PA3分别配置为SDA/SCLPA4接XShut引脚控制传感器启停代码以轮询方式读取测距数据。VL53L1X为ToF飞行时间传感器支持单次、连续和区域测距模式可应用于室内导航、物体检测、自动对焦等实际场景。压缩包共417个文件约19.83MB其中C/H源文件包含完整驱动与例程hex/axf文件可直接烧录调试o/crf为编译中间件并附有硬件接线、I2C初始化、数据读取流程及错误处理等说明文档。目前已有2716人学习对理解STM32的I2C通信机制和VL53L1X驱动开发具有直接的参考价值。1. STM32 驱动 VL53L1X 激光测距从 I2C 通信到四米稳定读数做嵌入式这些年VL53L1X 是我用过的最省心的测距传感器之一也是翻车率最高的之一。省心在于它是 ST 官方的 FlightSense 方案TOF 原理不受目标颜色影响最远能测 4 米翻车在于它的驱动时序、寄存器配置、校准机制和普通的 I2C 传感器完全不一样——你拿 MPU6050 那套「写寄存器、读数据」的思路去调它大概率第一天就卡在初始化上。这份 STM32_VL53.zip 资源包解决的就是这个问题把 VL53L1X 从「上电就能读」到「在不同环境光、不同目标反射率下都能稳定出距离」的全套驱动逻辑理清楚适合正在做机器人避障、智能门锁、液位检测、接近感应的嵌入式开发者也适合第一次接触 TOF 传感器、被官方驱动代码吓退的新手。2. 先搞懂 VL53L1X 的工作原理TOF 测距为什么比红外三角法稳2.1 光子飞行时间测距的本质VL53L1X 和 VL53L0X 最大的区别在于测距架构。VL53L0X 是单点测距VL53L1X 不仅能测距还能输出 4x4 或 8x8 的低分辨率深度图。它内部集成了一颗 940nm 的 VCSEL 激光发射器和一颗 SPAD单光子雪崩二极管接收阵列。测距原理是发射器发出调制的红外光脉冲光打到目标反射回来被 SPAD 接收芯片内部通过测量发射和接收之间的时间差乘以光速除以 2得到往返距离。距离 (光速 × 飞行时间) / 2这里要注意VL53L1X 用的是间接飞行时间测量Indirect TOF不是直接计时。它发射的是经过调制的连续波通过测量发射信号和接收信号之间的相位差来反推飞行时间。这种方式的优势是对环境光的容忍度比直接计时更高而且能在较短的时间内完成多次测量取平均抗噪性能更好。从代码层面看你不需要关心底层的光学计算芯片内部已经把这些都做完了。你需要做的只是通过 I2C 接口告诉它「开始测距」然后等待数据准备好读取距离值。但问题出在「告诉它开始测距」这个动作上——它的初始化时序和状态机管理比普通传感器复杂得多。2.2 关键寄存器组与工作模式VL53L1X 的核心寄存器分布在 0x00-0xFF 地址空间其中几个关键的0x01SYSTEM_THRESH_HIGH高阈值0x02SYSTEM_THRESH_LOW低阈值0x0BSYSTEM__SEQUENCE_CONFIG测距序列配置0x0DSYSTEM_INTERMEASUREMENT_PERIOD两次测距之间的间隔0x1ESYSTEM__RANGE_CONFIG__TIMEOUT测距超时配置0x2DRESULT__RANGE_STATUS测距状态0x31RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0最终测距结果需要特别注意的是VL53L1X 有一套完整的测距序列Ranging Sequence包括 VCSEL 校准、SPAD 校准、相位检测、距离计算等多个阶段。每次测距前芯片会按序列逐个执行这些阶段。如果某个阶段超时或配置错误整个测距会失败状态寄存器会返回错误码。这就是为什么很多人第一次调这个传感器时读到的一直是 0xFFFF 或 0x00——不是传感器坏了而是测距序列里的某个阶段就没跑通。2.3 四种测距模式怎么选VL53L1X 支持四种预设的测距模式模式最大测距最小测距测距频率适用场景Short1.3m0mm最高 50Hz接近感应、防碰撞Medium3m0mm最高 30Hz机器人避障、液位检测Long4m0mm最高 15Hz远距离测量、安防监控Unknown由自定义参数决定由自定义参数决定由自定义参数决定需要特定测距窗口和时序模式选择直接影响测距时序预算Timing Budget。Short 模式下的时序预算短SPAD 接收窗口窄测量速度快但对反射率要求高Long 模式时序预算长SPAD 接收窗口宽能接收更弱的反射光但单次测距耗时也长。代码里设置模式的 API 在不同驱动库里写法不一样。有些库提供setDistanceMode(Short)这样的接口有些库要求你直接写寄存器。我的建议是能用库的预设接口就用库因为 VL53L1X 的模式切换不只是改一两个寄存器它涉及一组时序参数的联动手写容易漏。2.4 资源包里的驱动架构STM32_VL53.zip 里的驱动代码采用的是分层结构底层I2C 读写接口通过 HAL 库封装提供了VL53L1_WriteReg()和VL53L1_ReadReg()两个核心函数以及连续读写的VL53L1_WriteMulti()和VL53L1_ReadMulti()中间层VL53L1X 芯片控制封装了初始化、测距模式设置、单次/连续测距触发、状态查询等应用层测距结果解析把原始寄存器值转换成毫米距离并处理错误码这个分层方式比较直接。如果你用的是不带 HAL 的标准外设库只需要把底层 I2C 接口替换成你自己的实现上层代码可以复用。// 底层 I2C 读接口示例 uint8_t VL53L1_ReadReg(uint16_t addr) { uint8_t val 0; uint8_t buf[2]; buf[0] (addr 8) 0xFF; buf[1] addr 0xFF; // 发送寄存器地址然后读一个字节 HAL_I2C_Master_Transmit(hi2c1, 0x29 1, buf, 2, 100); HAL_I2C_Master_Receive(hi2c1, 0x29 1, val, 1, 100); return val; }这里有一个关键点VL53L1X 的寄存器是 16 位地址不是普通的 8 位地址。所以发送寄存器地址时要拆成高字节和低字节分别传输。这一点和 VL53L0X 一样也是和 BMP280、MPU6050 这类 8 位寄存器传感器的重要区别。如果你用 8 位地址的驱动模板去改读出来的数据永远是错的。3. STM32 端初始化和驱动代码从 I2C 探测到第一组距离数据3.1 I2C 硬件连接与地址确认VL53L1X 的 I2C 地址默认是 0x297 位地址模式下。与 STM32 连接时注意以下几点VCC 接 2.8V-3.3V不能接 5V否则会烧毁传感器XSHUT 引脚是复位引脚低电平有效。上电后必须拉高否则传感器处于复位状态GPIO1 是中断输出引脚可以接到 STM32 的外部中断引脚用于测距完成通知// 初始化 XSHUT 引脚和中断引脚 void VL53L1_InitGPIO(void) { GPIO_InitTypeDef GPIO_InitStruct {0}; // 使能 GPIO 时钟 __HAL_RCC_GPIOB_CLK_ENABLE(); // XSHUT 引脚配置推挽输出默认拉高 GPIO_InitStruct.Pin GPIO_PIN_0; GPIO_InitStruct.Mode GPIO_MODE_OUTPUT_PP; GPIO_InitStruct.Pull GPIO_NOPULL; GPIO_InitStruct.Speed GPIO_SPEED_FREQ_LOW; HAL_GPIO_Init(GPIOB, GPIO_InitStruct); HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_SET); // GPIO1 中断引脚配置上拉输入下降沿触发 GPIO_InitStruct.Pin GPIO_PIN_1; GPIO_InitStruct.Mode GPIO_MODE_IT_FALLING; GPIO_InitStruct.Pull GPIO_PULLUP; HAL_GPIO_Init(GPIOB, GPIO_InitStruct); HAL_NVIC_SetPriority(EXTI1_IRQn, 0, 0); HAL_NVIC_EnableIRQ(EXTI1_IRQn); }GPIO 配置里有个细节XSHUT 引脚在初始化完成后必须保持高电平而且是持续保持。有些开发者图省事把 XSHUT 直接接在 STM32 的某个空闲 GPIO 上初始化时拉高就完事。但如果程序运行中不小心把这个引脚拉低了一下传感器会立刻复位I2C 通信中断后面的测距全部失败。我习惯在系统进入低功耗模式前也保持 XSHUT 为高防止低功耗模式下引脚状态变化导致传感器异常。3.2 完整初始化时序VL53L1X 的初始化分为几个阶段上电等待、Boot 状态确认、传感器 ID 读取、数据配置、测距模式设置。资源包里的初始化函数大致流程如下uint8_t VL53L1_Init(void) { uint8_t id1, id2; uint16_t sensor_id; // 1. 等待传感器完成上电 boot HAL_Delay(10); // 上电后至少等待 1ms这里留出余量 // 2. 检查传感器 ID确认 I2C 通信正常 id1 VL53L1_ReadReg(0x010F); id2 VL53L1_ReadReg(0x0110); sensor_id (id1 8) | id2; if (sensor_id ! 0xEACC) { return 0xFF; // ID 读取失败传感器识别异常 } // 3. 读取传感器的静态校准数据从 NVM 中加载 VL53L1_LoadNVMCalData(); // 4. 设置 I2C 地址可选多传感器级联时需要 // VL53L1_SetI2CAddress(0x30); // 5. 设置测距模式为 Long Distance时序预算 100ms VL53L1_SetDistanceMode(LONG); VL53L1_SetTimingBudget(100); // 6. 设置测距间隔 200ms连续测距模式下生效 VL53L1_SetInterMeasurementPeriod(200); // 7. 开始测距 VL53L1_StartRanging(); return 0; }这段代码的每一个步骤都有讲究。第二步读取 ID 是排查 I2C 通信问题的关键诊断手段——如果读不到 0xEACC 这个 ID说明要么接线有问题要么传感器没退出复位态要么地址不对。我调试时第一步永远是读 ID不做任何配置先确认物理链路通。第三步加载 NVM 校准数据特别容易被忽略。VL53L1X 在出厂时会在内部的非易失性存储器里存一组校准参数包括 SPAD 校准、VCSEL 偏置、交叉串扰系数等。上电后这些数据不会自动加载到工作寄存器中必须由驱动代码主动读取并写入。如果跳过这一步传感器能测距但距离精度会有偏差尤其是在近距离100mm时误差可能达到几十毫米。3.3 单次测距与连续测距的代码差异单次测距模式下每次触发后等待 GPIO1 中断或轮询状态寄存器uint16_t VL53L1_GetDistanceSingle(void) { uint8_t status; // 触发一次测距 VL53L1X_WRITE_REG(0x00, 0x04); // 写 RANGE_START模式为单次 // 等待测距完成。轮询状态寄存器 0x02 的 bit 0 do { status VL53L1X_READ_REG(0x02); } while ((status 0x01) 0); // 读取距离值寄存器 0x31 和 0x3216 位小端 uint16_t distance VL53L1X_READ_REG(0x31) | (VL53L1X_READ_REG(0x32) 8); // 清除中断标志准备下一次测距 VL53L1X_WRITE_REG(0x0B, 0x01); // SYSTEM_INTERRUPT_CLEAR return distance; }轮询方式虽然简单但会占用 CPU。如果系统里还有其他任务要跑建议用 GPIO1 中断方式。GPIO1 引脚在测距完成时会拉低如果配置为下降沿触发在中断回调函数里读取数据。连续测距模式的差别在于启动后传感器会按照设定的间隔持续自动测距不需要每次手动触发。中断的产生频率由测距模式和时序预算决定。Short 模式 20ms 时序预算时中断频率最高可以到 50HzLong 模式 100ms 时序预算时中断频率就只有 10Hz。3.4 通信失败状态与 I2C 总线错误处理VL53L1X 在测距过程中偶尔会返回错误状态码。常见的是 0x01测量超时、0x04信号过低。遇到这种情况测距结果寄存器里的值可能是 0xFFFF 或一个明显异常的数值比如 10000mm。不加判断直接把结果拿去用会出大问题。正确的做法是每次读完距离先检查状态uint8_t range_status VL53L1X_READ_REG(0x2D); if (range_status ! 0x05 range_status ! 0x06) { // 0x05 表示有效数据0x06 表示低信号但仍可用 // 其他状态码都说明本次测距结果不可信 return INVALID_DISTANCE; // 让调用方决定如何处理 }我在项目里通常的做法是连续三次读到无效数据就报错单次无效数据则丢弃并触发一次重新测距。这样既能过滤掉偶发的环境光干扰导致的数据异常又不会因为一次失败就中断整个测距流程。4. 多传感器级联一台 STM32 驱动多路 VL53L1X 的地址切换方案4.1 为什么需要地址切换VL53L1X 的 I2C 地址固定是 0x29而且不像某些传感器支持通过引脚电平配置地址。如果一块板子上要接两个或更多的 VL53L1X又不能改地址I2C 总线上就会出现地址冲突。解决办法是利用 XSHUT 引脚。每个传感器的 XSHUT 单独接一个 STM32 的 GPIO操作时先只给要配置的传感器上电拉高 XSHUT其他传感器保持复位状态拉低 XSHUT然后通过 I2C 命令给这个传感器写入新的地址。这样就能把多个传感器配置成不同的地址之后就可以同时操作了。4.2 地址切换的完整代码void VL53L1X_SetMultiSensorAddress(uint8_t sensor_index, uint8_t new_addr) { // 1. 将所有传感器置于复位状态 for (int i 0; i SENSOR_COUNT; i) { HAL_GPIO_WritePin(XSHUT_PORT, XSHUT_PIN[i], GPIO_PIN_RESET); } HAL_Delay(1); // 2. 仅拉高当前要配置的传感器的 XSHUT HAL_GPIO_WritePin(XSHUT_PORT, XSHUT_PIN[sensor_index], GPIO_PIN_SET); HAL_Delay(10); // 等待传感器完成 boot // 3. 修改 I2C 地址。写入 0x0016 寄存器 uint8_t buf[3]; buf[0] (0x0016 8) 0xFF; buf[1] 0x0016 0xFF; buf[2] new_addr 1; // 注意寄存器里存的是 8 位地址左移一位的格式 HAL_I2C_Master_Transmit(hi2c1, 0x29 1, buf, 3, 100); // 4. 验证地址是否写成功。切换到新地址读 ID uint8_t id1 VL53L1X_ReadReg_WithAddr(new_addr, 0x010F); uint8_t id2 VL53L1X_ReadReg_WithAddr(new_addr, 0x0110); if ((id1 8 | id2) ! 0xEACC) { // 地址配置失败可能是 XSHUT 时序有问题 return ERROR; } // 5. 完成当前传感器配置后重复步骤 1-4 处理下一个传感器 }这个流程里最容易出问题的是步骤 3 的时序。写完地址寄存器后芯片内部需要一小段时间来完成地址切换生效。我第一次做这个的时候写完地址后立刻用新地址去读结果读不到——加了 50ms 延迟后就好了。注意我手上实际测过5ms 不够至少需要 20ms稳妥起见我加了 50ms。另外要注意一个细节I2C 地址写入到寄存器时要存的是 8 位地址格式左移一位后的值。比如你想让传感器用 0x30 这个 7 位地址写入寄存器的应该是 0x60。如果你直接写 0x30传感器实际工作在 0x18 地址上后面怎么读都读不到。4.3 多传感器级联时的时间同步多个传感器同时工作时如果我把它们全部配置成连续测距模式并且测距间隔相同它们的测距会互相干扰。原因在于 VL53L1X 的 VCSEL 发射光如果同时在 I2C 总线上通信会造成信号串扰。解决方式有几种。简单粗暴的是让每个传感器用不同的测距间隔错开时间。另一个更稳妥的方式是把所有传感器配置成单次测距模式由 STM32 轮流触发。比如有三个传感器就按 S1、S2、S3、S1、S2、S3 的顺序循环触发每次触发之间间隔 10ms。这样测距数据的时间戳错开避免了串扰。typedef struct { uint16_t distance; uint8_t status; } SensorData; SensorData multi_sensor_data[3]; void MultiSensor_TriggerRanging(void) { for (int i 0; i 3; i) { VL53L1X_StartSingleRanging(i); // 触发第 i 个传感器 HAL_Delay(10); // 等待测距完成注意这个延迟要大于单次测距的时序预算 multi_sensor_data[i].distance VL53L1X_GetDistanceSingle(i); multi_sensor_data[i].status VL53L1X_GetRangeStatus(i); } }这里的 10ms 延迟不是随意定的。Long 模式下时序预算最小是 20ms实际上传感器完成一次测距至少需要这个时间。如果你用的是 Short 模式测距时间短延迟可以缩短。但要注意XSHUT 拉高后的 boot 时间也需要算进去——我第一次做级联时就是因为没算 boot 时间第一个传感器配置好后第二个传感器还没 boot 完就写地址导致第二个传感器地址配置失败。5. 避坑指南VL53L1X 最常见的六类故障排查记录5.1 上电后读不到 I2C 设备地址现象用 I2C 扫描程序扫描总线0x29 地址不出现在设备列表里。读 ID 返回 0xFFFF。原因最常见的是 XSHUT 引脚没有被拉高。VL53L1X 上电后默认处于复位状态XSHUT 必须由外部拉高才能进入正常工作模式。第二个常见原因是 VCC 电压不对VL53L1X 最高只能承受 3.3V如果接到了 5V 电源芯片可能已经损坏。第三个可能性是 I2C 总线上拉电阻缺失导致通信不稳定。解决先量 XSHUT 引脚电压确认是高电平。然后用示波器或逻辑分析仪看 SCL/SDA 波形确认是否有时钟信号。最后检查电源电压和上拉电阻通常需要 4.7kΩ 到 10kΩ 的外部上拉VL53L1X 内部没有上拉电阻。我排查顺序是电源 → XSHUT → I2C 波形 → ID 寄存器。5.2 测距结果一直是 0xFFFF 或 0x00现象驱动代码正常运行GPIO1 中断也触发了但读取的距离值是 0xFFFF 或者 0x00。原因测距序列执行失败。可能是 VCSEL 校准数据没加载也可能是 SPAD 校准参数丢失导致接收信号异常。还有一个原因是目标物体太远或反射率太低返回信号强度不足。解决先读取状态寄存器 0x2D查看具体的错误码。0x01 是测距超时0x04 是信号过弱。如果是校准数据问题重新执行VL53L1_LoadNVMCalData()加载出厂校准数据。如果是信号弱改用 Long 距离模式增加时序预算到 100ms 甚至 200ms。在实测中我发现低反射率的黑色目标在 Short 模式下测距范围明显缩水同样的目标在 Long 模式下能测到更远。5.3 近距离测距误差大现象标称测距范围是 0-4m但实测在 100mm 以内的距离读数波动很大有时候偏差达到 50mm 以上。原因VL53L1X 的近距离盲区约为 0-10mm在 10-100mm 范围内串扰校正和 SPAD 偏置会引入非线性误差。尤其当目标表面是镜面或高反光材质时多重反射会导致测量值偏大。解决在应用层对近距离区域做分段校准。比如实测发现 50mm 处读数是 65mm就在代码里加一个偏差修正表uint16_t VL53L1X_ApplyDistanceCorrection(uint16_t raw_distance) { // 分段线性校准修正近距离非线性误差 if (raw_distance 50) return raw_distance; if (raw_distance 80) return raw_distance - 15; if (raw_distance 150) return raw_distance - 10; return raw_distance; }这个修正表不是通用的需要在你的具体目标材质上实测后调整。我在不同项目里用过不同的修正表——测木质表面、金属表面、纺织物表面的修正值都有差异。批量生产时如果控制不了目标材质建议把这个修正表做成可配置参数每台设备出厂时用标准目标标定一遍。5.4 连续测距模式下数据丢帧现象设定测距间隔为 50ms预期每秒 20 次测距。实测中断频率只有 15Hz 左右还有时断时续的现象。原因VL53L1X 的数据就绪中断需要在读数据后清除中断标志。如果中断标志没有被正确清除下一次测距完成后不会再次触发中断。解决每次读数据后必须写 SYSTEM_INTERRUPT_CLEAR 寄存器清除中断标志。另外测距间隔的设置要大于单次测距的时序预算否则传感器还在处理上一次测距新的测距已经开始处理不过来。我一般把测距间隔设置为时序预算的 2 倍以上。之前做过一次测试100ms 时序预算 50ms 间隔数据丢帧率超过 50%把间隔改成 200ms 后丢帧率降到 0。5.5 环境光强烈时测距失效现象在阳光下或强灯光下测距偶尔出现突跳值、零值或者状态寄存器返回信号过弱错误。原因940nm 波段的红外光会与环境光中的红外分量产生竞争。虽然 VL53L1X 的 SPAD 有滤光片但在强光下信噪比还是会被压下来。尤其是阳光直射时环境红外光强度是 VCSEL 反射信号的数倍导致接收阵列饱和。解决物理上在传感器视场角内加装遮光罩减少环境光的直射干扰。代码层面把测距模式切到 Long增加时序预算让芯片有更多的时间窗口来积累有效光子数。我实测过在室外阳光下Short 模式在 1m 以内还能正常工作超过 1.5m 基本不可靠切成 Long 模式 100ms 时序预算后3m 内都能保持稳定。5.6 多传感器级联时数据串扰现象多个传感器同时工作时某个传感器出现了和旁边传感器测距值相近的错误读数即使中间有遮挡也测出了距离。原因VCSEL 发射的红外光经过了被测物体的漫反射后进入了相邻传感器的接收视野被误判为目标回波。解决多传感器之间拉开物理距离至少保证视场角不重叠的区域。如果无法拉开距离调整传感器之间的测距相位是优先方案——不让它们同时测距。用单次测距模式轮询触发可以解决这个问题代价是测距频率降低。还有一种方式是给每个传感器加装独立的遮光管限制视场角。不过加的遮光管要避免在近距离内遮挡到发射和接收光路这样会影响近距离测距精度。6. 进阶技巧用开窗函数ROI做多区域测距和信号增强VL53L1X 支持配置测距区域的中心位置和大小也就是 ROIRegion of Interest。默认配置下SPAD 阵列全开视场角较大。你可以把测距窗口缩小到特定区域比如只看画面中央的一个小方块或者在 4x4 矩阵中选择其中 2x2 的区域。这个功能有两个实际用途一是避开视场角内的干扰物二是在目标较小的情况下提高信噪比。配置 ROI 的核心是写入 REGION_OF_INTEREST_CTRL 相关寄存器具体的做法是设置 ROI 的中心坐标和 ROI 的尺寸。中心坐标通过写0x00E9和0x00EA寄存器实现尺寸通过0x00F4和0x00F7控制void VL53L1X_SetROI(uint8_t center_x, uint8_t center_y, uint8_t width, uint8_t height) { // 设置 ROI 中心坐标。坐标范围 0-15对应 16x16 SPAD 阵列 VL53L1X_WriteReg(0x00E9, center_x); VL53L1X_WriteReg(0x00EA, center_y); // 设置 ROI 尺寸。width 和 height 范围 1-16 // 注意寄存器的编码格式高 4 位表示宽低 4 位表示高 VL53L1X_WriteReg(0x00F4, ((width - 1) 4) | (height - 1)); // 设置完成后需要重新初始化 SPAD VL53L1X_LoadNVMCalData(); }注意这里有个坑ROI 尺寸寄存器的编码不是直接写宽度和高度而是写「宽度值减 1」左移 4 位再加上「高度值减 1」。比如要配置一个 4x4 的 ROI写入的值是((4-1) 4) | (4-1) 0x33。如果直接写(4 4) | 4 0x44实际生效的 ROI 比配置值大一圈而且中心偏移。缩小 ROI 对测距能力的影响是双面的。正面效应是信噪比提升比如在 3m 的距离测一个 5cm 宽的小目标默认 ROI 下接收到的环境光背景噪声较多缩小 ROI 后目标反射信号占比更高测距稳定性有所提升。负面效应是当目标和 ROI 没有对准时有可能完全测不到目标——返回的是下一个强反射物比如背景墙体的距离。所以调整 ROI 后需要实测验证视场角是否还覆盖目标。我验证 ROI 配置对不对的方法很简单把传感器固定在一张白纸前 20cm 处左右平移一个黑色物体观察读数的跳变。如果读数在有物体遮挡和无物体遮挡之间平稳过渡说明 ROI 的位置和大小是合适的如果读数突然从 20cm 跳到 500cm说明 ROI 没有对准黑物体出了视场角。还有一个心得和滤波器相关。VL53L1X 的原始测量值有抖动短周期均值滤波是最常见的处理方式。但在做均值滤波时不要把窗口开太大——我用过 100ms 的滤波窗口优点是数据平滑缺点是运动的障碍物反映延迟明显。后来我改成了中值滤波 轻量级滑动平均的组合。中值滤波对单点突跳值的处理效果好滑动平均能进一步降噪。实际效果上50mm 处的读数抖动从 ±20mm 降到了 ±5mm 左右。#define FILTER_WINDOW 5 uint16_t VL53L1X_FilterDistance(uint16_t new_distance) { static uint16_t buffer[FILTER_WINDOW]; static uint8_t index 0; static uint8_t count 0; buffer[index] new_distance; index (index 1) % FILTER_WINDOW; if (count FILTER_WINDOW) count; // 冒泡排序取中值 uint16_t temp[FILTER_WINDOW]; for (int i 0; i count; i) temp[i] buffer[i]; for (int i 0; i count - 1; i) { for (int j 0; j count - i - 1; j) { if (temp[j] temp[j 1]) { uint16_t t temp[j]; temp[j] temp[j 1]; temp[j 1] t; } } } return temp[count / 2]; }从那以后我每做一个用到 VL53L1X 的项目都强制把「读状态寄存器 → 取数据 → 结果滤波 → 异常值丢弃」完整走一遍不在任何一步上偷懒。这个传感器本身不便宜调试时踩过的坑往往不是硬件坏而是软件时序没到位。希望帮到你。本文还有配套的精品资源点击获取