Limit range to [-math.pi .. math.pi]

[pcholt]

I think this makes more sense, to limit the angles to a range between -math.pi and +math.pi? The old code kept adding and subtracting PI*2 all the time, it was confusing.