Testing program for MPU6050