Add initial handling of mpu6050

Missing:
 - setup of interruption
 - communication with protocol
 - test