private double angle(State state1, State state2) {
		Point p1 = state1.getPoint();
		Point p2 = state2.getPoint();
		double x = (double) (p2.x - p1.x);
		double y = (double) (p2.y - p1.y);
		return Math.atan2(y, x);
	}