Move A* search to new file and namespace