Add MPU6050dmp example code