VX(Be): Fix the A* algorithm, add the unit tests that use the grid graph.