From fdb7fddf6134117a45d1190f5440f6030d28a3da Mon Sep 17 00:00:00 2001 From: YunHorn Technology Date: Tue, 31 Oct 2023 21:09:42 +0800 Subject: [PATCH] 1. re-detect sensor position for every ranging no matter power on-off 2. set i2c speed to standard mode 100k instead of fast mode 400k for longer cable support --- Core/Src/i2c.c | 2 +- STM32CubeIDE/STS_RR_R125.launch | 4 ++-- TOF/App/app_tof_vl53l0x_range.c | 4 ++++ 3 files changed, 7 insertions(+), 3 deletions(-) diff --git a/Core/Src/i2c.c b/Core/Src/i2c.c index b8de436..89074ee 100644 --- a/Core/Src/i2c.c +++ b/Core/Src/i2c.c @@ -44,7 +44,7 @@ void MX_I2C2_Init(void) /* USER CODE END I2C2_Init 1 */ hi2c2.Instance = I2C2; - hi2c2.Init.Timing = 0x2010091A; //0x2010091A = 400K Fast Mode, 0x20303E5D, 100K Standard mode, 0x20000209 Fast Mode Plus, 1Mbps + hi2c2.Init.Timing = 0x20303E5D; //0x2010091A = 400K Fast Mode, 0x20303E5D, 100K Standard mode, 0x20000209 Fast Mode Plus, 1Mbps hi2c2.Init.OwnAddress1 = 0; hi2c2.Init.AddressingMode = I2C_ADDRESSINGMODE_7BIT; hi2c2.Init.DualAddressMode = I2C_DUALADDRESS_DISABLE; diff --git a/STM32CubeIDE/STS_RR_R125.launch b/STM32CubeIDE/STS_RR_R125.launch index c60eadc..7058cf6 100644 --- a/STM32CubeIDE/STS_RR_R125.launch +++ b/STM32CubeIDE/STS_RR_R125.launch @@ -12,7 +12,7 @@ - + @@ -67,7 +67,7 @@ - + diff --git a/TOF/App/app_tof_vl53l0x_range.c b/TOF/App/app_tof_vl53l0x_range.c index fdc9731..fe1ee66 100644 --- a/TOF/App/app_tof_vl53l0x_range.c +++ b/TOF/App/app_tof_vl53l0x_range.c @@ -411,6 +411,10 @@ void STS_TOF_VL53L0X_Range_Process(void) } } // nSensorPresent >0 + + // reset for next ranging + nDevMask = 0; + nSensorPresent = 0; }