AStar
AStar 80% implemented, it already finds the shortest path, however it doesn't save it, that shall be my next step