Fix 180 flip after long period of us

The drift compensation and adjusted yaw values needed wrapping 360
degrees