28 std::vector<std::string> param_names;
31 NODELET_ERROR(
"NodeHandle::getParamNames() failed. Aborting.");
36 std::set<std::string> devices;
39 for (
const auto &
param : param_names)
41 if (
param.find(prefix) != 0)
continue;
43 std::string::size_type next_slash =
param.find(
"/", prefix.size() + 1);
44 if (next_slash == std::string::npos) next_slash =
param.size();
45 const std::string device =
param.substr(prefix.size() + 1, next_slash - prefix.size() - 1);
46 devices.insert(device);
50 for (
const auto &device : devices)
83 catch(
const std::exception &exception)
85 NODELET_FATAL_STREAM(
"Unknown exception occurred while updating device \"" << ros_device.getName() <<
"\". Aborting: " << exception.what());