Callback update for I2C sensors now only called when input data is expected.
Updated header and I2C implementation of US sensor
Added header