Play safe: use actual anglemod func to compute final yaw

anglemod_f and anglemod_c are convenient functions that simplify the
mathematics.  But the results they return might ever so slightly differ from
those returned by the actual anglemod.