Updated MPU-6050 DMP6 example to work with the teensy and without interrupts