Moved I2C stuff to its own class