Code runs, need to test A* correctness