MPU 6050 Breakout board [HELP]

I see, well it seems to be working out. I just have to let it for like 10 seconds and the values goes to the way they are supposed to be.

However, I tried to add this line (just for testing) but god damn it freaks out.
The value jumps up and down, and then getting stuck at last. From like 60 degrees to 30, then to 0 and so on.
Im using Jeffs sketch, just took the parts I was interrested in.
Any clue why this is happening? Is it cause its using interrupts?

 if(yaw > 1){
      YawServo.write(180);
      //delay(15);
    }
    else{
      YawServo.write(0);
      //delay(15);
    }

Could I use your sketch to convert the values into degrees?

Cheers