catch runtime_error if the message from laser is malformed (#2511)

* catch runtime_error if the message from laser is malformed * fix styling Co-authored-by: Kai-Tao Xie <kaitaoxie@qq.com>
ros-navigation · Sep 14, 2021 · 8316fa2 · 8316fa2
1 parent e326d3f
commit 8316fa2
Showing 1 changed file with 14 additions and 0 deletions.
diff --git a/nav2_costmap_2d/plugins/obstacle_layer.cpp b/nav2_costmap_2d/plugins/obstacle_layer.cpp
@@ -291,6 +291,13 @@ ObstacleLayer::laserScanCallback(
       global_frame_.c_str(),
       ex.what());
     projector_.projectLaser(*message, cloud);
+  } catch (std::runtime_error & ex) {
+    RCLCPP_WARN(
+      logger_,
+      "transformLaserScanToPointCloud error, it seems the message from laser is malformed."
+      " Ignore this message. what(): %s",
+      ex.what());
+    return;
   }
 
   // buffer the point cloud
@@ -327,6 +334,13 @@ ObstacleLayer::laserScanValidInfCallback(
       "High fidelity enabled, but TF returned a transform exception to frame %s: %s",
       global_frame_.c_str(), ex.what());
     projector_.projectLaser(message, cloud);
+  } catch (std::runtime_error & ex) {
+    RCLCPP_WARN(
+      logger_,
+      "transformLaserScanToPointCloud error, it seems the message from laser is malformed."
+      " Ignore this message. what(): %s",
+      ex.what());
+    return;
   }
 
   // buffer the point cloud