Finished first draft of i2c.cpp and i2c.h - haven't tested yet