Correct Yaw and Pitch