Fix I2C code to work when multiple addresses are sending I2C responses. Update tests to work in a more accurate world