Feature/mpu 6050

This should cover most to the stuff for #17 
Still need to look at Pedometer functions and low power wake up modes