Get average heading

[micycle]

If heading < 0, then heading = 2PI+heading ?

In a one-liner: heading = (heading+angle)%2PI;