CartesianGeometricUtilities { public static double restrictRadians(double rads) { while (rads >= 2 * Math.PI) { rads -= 2 * Math.PI; } while (rads < 0) { rads += 2 * Math.PI; } return rads; }  static Tuple2D centerAndScale(Tuple2D toScale, int width, int height); static Vertex centerAndScale(Vertex toScale, int width, int height, int depth); static double centerAndScale(double toScale, int maxDimension); static Tuple2D Bottom1DCenterAndScale(Tuple2D toScale, int width, int height); static Tuple2D bottomCenterAndScale(Tuple2D toScale, int width, int height); static double bottomScale(double toScale, int maxDimension); static double shortestDistanceToLineSegment(ILocated2D p1, ILocated2D l1, ILocated2D l2); static double shortestDistanceToLineSegment(double x, double y, double x1, double x2, double y1, double y2); static double euclideanDistance(ArrayList<Double> x1, ArrayList<Double> x2); static double[] polarToCartesian(double r, double theta); static double signedAngleFromSourceHeadingToTarget(ILocated2D source, ILocated2D target, double sourceRads); static double signedAngleDifference(ILocated2D v1, ILocated2D v2); static double signedAngleDifference(double rad1, double rad2); static boolean sourceHeadingTowardsTarget(double sourceRadians, ILocated2D source, ILocated2D target,
			double allowance); static boolean onSideOf(ILocated2D source, double sourceRadians, ILocated2D other, boolean right); static double restrictRadians(double rads);  }
@Test public void testRestrictRadians() { double rads1 = 4 * Math.PI; double rads2 = 4 * Math.PI - .1; assertEquals(CartesianGeometricUtilities.restrictRadians(rads1), 0.0, DOUBLE_THRESHOLD); assertEquals(CartesianGeometricUtilities.restrictRadians(rads2), 2 * Math.PI - .1, DOUBLE_THRESHOLD); }