Fixat shortestPath till en bra algoritm. tagit bort onödiga kommentarer
och gammal kod. fler testfall, ytterligare kommentarer/JavaDoc kanske
behövs.