Increased I2C frequency to 400kHz

Decreases loop time from approx. 3.3 to 2.5 ms