assertEquals(3, n2.getDistanceTo(wp3),1e-4);
assertEquals(Double.MAX_VALUE, n2.getDistanceTo(wp1),1);
assertEquals(1 , n1.compareTo(n2));
assertEquals(-1, n1.compareTo(n3));
assertEquals(0, n1.compareTo(n1));
n4 = new PriorityNode(5, wp1);
assertTrue(n1.equals(n4));
assertFalse(n1.equals(n2));