mbedI2C related fixes