Fix costmap 2D test failures (#3611)

* costmap test without action

* test2

* try just printing first thing

* Update test_costmap_2d_publisher.cpp

Author: SteveMacenski

nav2_costmap_2d/test/integration/test_costmap_2d_publisher.cpp

@@ -167,12 +167,14 @@ TEST_F(CostmapRosTestFixture, costmap_pub_test)
     EXPECT_EQ(costmap_raw->data[i], nav2_costmap_2d::FREE_SPACE);
   }
   for (; i < 10; ++i) {
-    EXPECT_EQ(costmap_raw->data[i++], nav2_costmap_2d::LETHAL_OBSTACLE);
+    EXPECT_EQ(costmap_raw->data[i], nav2_costmap_2d::LETHAL_OBSTACLE);
   }
   for (; i < 17; ++i) {
     EXPECT_EQ(costmap_raw->data[i], nav2_costmap_2d::FREE_SPACE);
   }
   for (; i < 20; ++i) {
-    EXPECT_EQ(costmap_raw->data[i++], nav2_costmap_2d::LETHAL_OBSTACLE);
+    EXPECT_EQ(costmap_raw->data[i], nav2_costmap_2d::LETHAL_OBSTACLE);
   }
+
+  SUCCEED();
 }