Issues with a MPU6050 and Servo