Modifications: publish only one msg for pickup, publish solution path after GreedySearch aswell