Implement AStar & Greedy agent with trivial heuristic