I haven't looked into whether we handle wrapping around elsewhere when we apply the YawMax. I know that GCS doesn't put hard limits on YawMax (or RollMax or PitchMax for that matter), do you know if we handle it in the code?

Of course, the utility of yaw limiting in attitude mode on a non-holonomic vehicle is up for debate, but that's a different matter.