Fig. 5. Algorithm to obtain a headified body orientation from the measured body yaw. See the text for an explanation.