fixed a 2 pi wrap angle bug