all algo seems to work. A* is still wrong
Fix A*
fix corners problem heuristic
implement findpathtoclosestdot
Finished hw1