We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent 24666fd commit ec46cbdCopy full SHA for ec46cbd
1 file changed
easynav_sensors/src/easynav_sensors/SensorsNode.cpp
@@ -285,6 +285,13 @@ SensorsNode::cycle([[maybe_unused]] std::shared_ptr<NavState> nav_state)
285
" width=" << fused_points.width <<
286
" height=" << fused_points.height << std::endl;
287
288
+ if (fused_points.empty()) {
289
+ std::cout << "[SENSORS_DEBUG] cycle(" << cycle_seq <<
290
+ ") skip publish: fused cloud is empty" << std::endl;
291
+ std::cout << "[SENSORS_DEBUG] cycle(" << cycle_seq << ") exit" << std::endl;
292
+ return;
293
+ }
294
+
295
std::cout << "[SENSORS_DEBUG] cycle(" << cycle_seq << ") toROSMsg begin" << std::endl;
296
auto msg = points_to_rosmsg(fused_points);
297
std::cout << "[SENSORS_DEBUG] cycle(" << cycle_seq << ") toROSMsg done"
0 commit comments