Separate I2C request code into header
Add I2CHandler to library