updated task manager to publish the first goal position received from base_selection