Added Astar and Node classes
Merge commit '7274a6fd32ecf52bd3bd2a4e6269f153f25c4099'