Added readI2C and writeI2C to quadcopter.cpp and quadcopter.h
Also updated the Working_TWI_Compass example to set the mode regsiter and added comments