Added A* utilities