util/set: Add a search_and_add function