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 ...
Modular Arduino two wheel balancing robot based on gimbal BLDC motors and SimpleFOClibrary. Balancing robots are always a bit tricky to design, in order to make the robot balance we need to design and ...