Code for the Arduino to test I2C with sonar system.