Implemented A* and Manhattan heuristic.