@Test
public final void testFindElementInQueue() {

    assertEquals(PathUtils.findElementInQueue(pq, l1), elem1);
    assertEquals(PathUtils.findElementInQueue(pq, l4), elem4);
    assertEquals(PathUtils.findElementInQueue(new PriorityQueue<PQElem>(),
            l4), null);
}