Sonar update frequency fix

We need to change i2c clock speed to 100kHz before sending commands to
sonar. Reading @ 400kHz is okay though.