add test check timeout

gazebosim · Dec 15, 2020 · c9e2141 · c9e2141
1 parent 6ead525
commit c9e2141
Showing 1 changed file with 16 additions and 0 deletions.
diff --git a/test/integration/diff_drive_system.cc b/test/integration/diff_drive_system.cc
@@ -356,6 +356,14 @@ TEST_P(DiffDriveTest, OdomFrameId)
 
   server.Run(true, 100, false);
 
+  int sleep = 0;
+  int maxSleep = 30;
+  for (; odomPosesCount < 5 && sleep < maxSleep; ++sleep)
+  {
+    std::this_thread::sleep_for(std::chrono::milliseconds(100));
+  }
+  ASSERT_NE(maxSleep, sleep);
+
   EXPECT_EQ(5u, odomPosesCount);
 }
 
@@ -398,6 +406,14 @@ TEST_P(DiffDriveTest, OdomCustomFrameId)
 
   server.Run(true, 100, false);
 
+  int sleep = 0;
+  int maxSleep = 30;
+  for (; odomPosesCount < 5 && sleep < maxSleep; ++sleep)
+  {
+    std::this_thread::sleep_for(std::chrono::milliseconds(100));
+  }
+  ASSERT_NE(maxSleep, sleep);
+
   EXPECT_EQ(5u, odomPosesCount);
 }