Sonar i2c

tested and works