void i2c_scanner() {
uint8_t i;
for (i = 1; i < 128; i++) {
if (HAL_I2C_IsDeviceReady(&hi2c1, i << 1, 1, HAL_MAX_DELAY) == HAL_OK) {
printf("I2C Device found at address: 0x%02X\n", i);
}
}
printf("I2C Device found at address: 0x%02X\n", i);
}