Test code for the Arduino, to test I2C with sonar system.