Conceptual finished with A*

Finished with the function returnPath() that traces A* back