fix(ndt_scan_matcher): skipping_publish_num does not switches error s…

…tate (#4853) fix skip_publishing_num status Co-authored-by: kminoda <[email protected]>
autowarefoundation · Sep 5, 2023 · 6806b13 · 6806b13
1 parent 30ec8f7
commit 6806b13
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/localization/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp b/localization/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp
@@ -270,7 +270,8 @@ void NDTScanMatcher::timer_diagnostic()
     }
     if (
       state_ptr_->count("skipping_publish_num") &&
-      std::stoi((*state_ptr_)["skipping_publish_num"]) > 1) {
+      std::stoi((*state_ptr_)["skipping_publish_num"]) > 1 &&
+      std::stoi((*state_ptr_)["skipping_publish_num"]) < 5) {
       diag_status_msg.level = diagnostic_msgs::msg::DiagnosticStatus::WARN;
       diag_status_msg.message += "skipping_publish_num > 1. ";
     }