Fixed slave address determination code
Added mode to cycle between slaves
Added simple test code to very the arduino's I2C pins are working