gazebosim#2724 Fix publication id handling

nlamprian · Aug 10, 2020 · cafa41d · cafa41d
1 parent 21db7f2
commit cafa41d
Showing 1 changed file with 7 additions and 4 deletions.
diff --git a/gazebo/transport/Publisher.cc b/gazebo/transport/Publisher.cc
@@ -259,10 +259,13 @@ void Publisher::SendMessage()
           pubDataPtr, std::placeholders::_1), *pubIter);
 
       std::lock_guard<std::mutex> lock2(pubDataPtr->mutex);
-      if (result > 0)
-        pubDataPtr->pubIds[*pubIter] = result;
-      else
-        pubDataPtr->pubIds.erase(*pubIter);
+      if (pubDataPtr->pubIds.find(*pubIter) != pubDataPtr->pubIds.end())
+      {
+        if (result > 0)
+          pubDataPtr->pubIds[*pubIter] = result;
+        else
+          pubDataPtr->pubIds.erase(*pubIter);
+      }
     }
 
     // Clear the local buffer.