PR #2946 from gwen2018: fix ros random crash with error hw monitor co…

…mmand for asic temperature failed
IntelRealSense · Dec 15, 2023 · 91c0f35 · 91c0f35
2 parents 4679aa4 + 573d6a7
commit 91c0f35
Showing 1 changed file with 11 additions and 3 deletions.
diff --git a/realsense2_camera/src/base_realsense_node.cpp b/realsense2_camera/src/base_realsense_node.cpp
@@ -1140,10 +1140,18 @@ void BaseRealSenseNode::startDiagnosticsUpdater()
             {
                 for (rs2_option option : _monitor_options)
                 {
-                    if (sensor->supports(option))
+                    try
                     {
-                        status.add(rs2_option_to_string(option), sensor->get_option(option));
-                        got_temperature = true;
+                        if (sensor->supports(option))
+                        {
+                            status.add(rs2_option_to_string(option), sensor->get_option(option));
+                            got_temperature = true;
+                        }
+                    }
+                    catch(const std::exception& ex)
+                    {
+                        got_temperature = false;
+                        ROS_WARN_STREAM("An error has occurred during monitoring: " << ex.what());
                     }
                 }
                 if (got_temperature) break;