Trying a very simple smoothing filter on yaw.