Skip to content

Commit ec46cbd

Browse files
committed
Test CI - BUGFIX: Avoid processing fused clouds when empty
1 parent 24666fd commit ec46cbd

1 file changed

Lines changed: 7 additions & 0 deletions

File tree

easynav_sensors/src/easynav_sensors/SensorsNode.cpp

Lines changed: 7 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -285,6 +285,13 @@ SensorsNode::cycle([[maybe_unused]] std::shared_ptr<NavState> nav_state)
285285
" width=" << fused_points.width <<
286286
" height=" << fused_points.height << std::endl;
287287

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+
288295
std::cout << "[SENSORS_DEBUG] cycle(" << cycle_seq << ") toROSMsg begin" << std::endl;
289296
auto msg = points_to_rosmsg(fused_points);
290297
std::cout << "[SENSORS_DEBUG] cycle(" << cycle_seq << ") toROSMsg done"

0 commit comments

Comments
 (0)