Add basic byte/word read and write functionality to i2c library
Implemented the functions to read sensor data from MotionSensor, untested
Added skeleton for testing MotionSensor