Added mode for generating poses on costmaps