Cons-n-Stuff/geki_pico
1
0
Fork 0
mirror of https://github.com/whowechina/geki_pico.git synced 2025-02-07 22:51:23 +01:00
Code Issues Actions Packages Projects Releases Wiki Activity

Fix ToF i2c write timing

Browse Source
This commit is contained in:
whowechina 2024-12-02 14:50:04 +08:00
parent 2326b411ec
commit a450d80ec5
2 changed files with 6 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

BIN
Production/Firmware/geki_pico.uf2
View File

Binary file not shown.

8
firmware/src/vl53l0x.c
View File

@ -188,8 +188,12 @@ static uint16_t read_reg16(uint8_t reg)
static void write_many(uint8_t reg, const uint8_t *src, uint8_t len) static void write_many(uint8_t reg, const uint8_t *src, uint8_t len)
{ {
i2c_write_blocking_until(I2C_PORT, I2C_ADDR, &reg, 1, true, time_us_64() + IO_TIMEOUT_US); uint8_t cache[32] = { reg, 0 };
i2c_write_blocking_until(I2C_PORT, I2C_ADDR, src, len, false, time_us_64() + IO_TIMEOUT_US); if (len > sizeof(cache) - 1) {
return;
}
memcpy(cache + 1, src, len);
i2c_write_blocking_until(I2C_PORT, I2C_ADDR, cache, len + 1, false, time_us_64() + IO_TIMEOUT_US * len);
} }
static void read_many(uint8_t reg, uint8_t *dst, uint8_t len) static void read_many(uint8_t reg, uint8_t *dst, uint8_t len)