If FIFO keeps resetting try configuring the MPU6050_DMP_FIFO_RATE_DIVISOR in Gyro.cpp. To stop I2C library from hanging, patch Wire lib with contents from i2c_patch ...