public void testNormalize() throws Exception { assertEquals(Angle.normalize(0.0), 0.0, TOLERANCE); assertEquals(Angle.normalize(-0.5*Math.PI), -0.5*Math.PI, TOLERANCE); assertEquals(Angle.normalize(-Math.PI), Math.PI, TOLERANCE); assertEquals(Angle.normalize(-1.5*Math.PI), .5*Math.PI, TOLERANCE); assertEquals(Angle.normalize(-2*Math.PI), 0.0, TOLERANCE); assertEquals(Angle.normalize(-2.5*Math.PI), -0.5*Math.PI, TOLERANCE); assertEquals(Angle.normalize(-3*Math.PI), Math.PI, TOLERANCE); assertEquals(Angle.normalize(-4 * Math.PI), 0.0, TOLERANCE); assertEquals(Angle.normalize(0.5*Math.PI), 0.5*Math.PI, TOLERANCE); assertEquals(Angle.normalize(Math.PI), Math.PI, TOLERANCE); assertEquals(Angle.normalize(1.5*Math.PI), -0.5*Math.PI, TOLERANCE); assertEquals(Angle.normalize(2*Math.PI), 0.0, TOLERANCE); assertEquals(Angle.normalize(2.5*Math.PI), 0.5*Math.PI, TOLERANCE); assertEquals(Angle.normalize(3*Math.PI), Math.PI, TOLERANCE); assertEquals(Angle.normalize(4 * Math.PI), 0.0, TOLERANCE); }