Implementerte A* algoritmen