MPU6050 dmp code merge