Initial work on I2C and proximity sensor