Modificeret algoritmen. Ændret klassenavn til BFS. metoden findPath i
denne klasse returnerer en liste af retninger.
Tilføjet testklasse, til en hurtig test.