implement sorting by Fscore
add test for sorting Nodes by Fcost
wrap sorting in its own function
implement main Astar loop, working pathfinding