Thank you for sharing this code!
Which pins from MPU6050 do you use on this project? Just SCL and SDA? Or do you use the INT pin as well? What is the easiest way to read the values you get from the MPU?
Somehow the code get stucked on the Setup_MPU6050(); routine,
Thank you