diff --git a/realsense2_camera/src/ros_sensor.cpp b/realsense2_camera/src/ros_sensor.cpp index 541b07bc04..d860a79dec 100644 --- a/realsense2_camera/src/ros_sensor.cpp +++ b/realsense2_camera/src/ros_sensor.cpp @@ -244,7 +244,7 @@ void RosSensor::stop() { if (get_active_streams().size() == 0) return; - ROS_INFO_STREAM("Stop Sensor: " << get_info(RS2_CAMERA_INFO_NAME)); + ROS_INFO_STREAM("Stop Sensor: " << rs2_to_ros(get_info(RS2_CAMERA_INFO_NAME))); _frequency_diagnostics.clear(); try @@ -337,13 +337,13 @@ bool RosSensor::getUpdatedProfiles(std::vector& wanted_profiles) profile_manager->addWantedProfiles(wanted_profiles); } - ROS_DEBUG_STREAM(get_info(RS2_CAMERA_INFO_NAME) << ":" << "active_profiles.size() = " << active_profiles.size()); + ROS_DEBUG_STREAM(rs2_to_ros(get_info(RS2_CAMERA_INFO_NAME)) << ":" << "active_profiles.size() = " << active_profiles.size()); for (auto& profile : active_profiles) { ROS_DEBUG_STREAM("Sensor profile: " << ProfilesManager::profile_string(profile)); } - ROS_DEBUG_STREAM(get_info(RS2_CAMERA_INFO_NAME) << ":" << "wanted_profiles"); + ROS_DEBUG_STREAM(rs2_to_ros(get_info(RS2_CAMERA_INFO_NAME)) << ":" << "wanted_profiles"); for (auto& profile : wanted_profiles) { ROS_DEBUG_STREAM("Sensor profile: " << ProfilesManager::profile_string(profile)); diff --git a/realsense2_camera/src/rs_node_setup.cpp b/realsense2_camera/src/rs_node_setup.cpp index 3648fc3c8a..b375a00de3 100755 --- a/realsense2_camera/src/rs_node_setup.cpp +++ b/realsense2_camera/src/rs_node_setup.cpp @@ -139,7 +139,7 @@ void BaseRealSenseNode::setAvailableSensors() for(auto&& sensor : _dev_sensors) { - const std::string module_name(sensor.get_info(RS2_CAMERA_INFO_NAME)); + const std::string module_name(rs2_to_ros(sensor.get_info(RS2_CAMERA_INFO_NAME))); std::unique_ptr rosSensor; if (sensor.is() || sensor.is() || @@ -304,7 +304,7 @@ void BaseRealSenseNode::updateSensors() try{ for(auto&& sensor : _available_ros_sensors) { - std::string module_name(sensor->get_info(RS2_CAMERA_INFO_NAME)); + std::string module_name(rs2_to_ros(sensor->get_info(RS2_CAMERA_INFO_NAME))); // if active_profiles != wanted_profiles: stop sensor. std::vector wanted_profiles; @@ -386,7 +386,7 @@ void BaseRealSenseNode::getDeviceInfo(const realsense2_camera_msgs::srv::DeviceI for(auto&& sensor : _available_ros_sensors) { - sensors_names << create_graph_resource_name(sensor->get_info(RS2_CAMERA_INFO_NAME)) << ","; + sensors_names << create_graph_resource_name(rs2_to_ros(sensor->get_info(RS2_CAMERA_INFO_NAME))) << ","; } res->sensors = sensors_names.str().substr(0, sensors_names.str().size()-1);