Switch to I2C1 for IMU