fix invalid memory access (#1969)

* fix invalid memory access

this fix was applied as part of the noetic release of costmap_2d

* uncrustify

nav2_costmap_2d/test/integration/inflation_tests.cpp

@@ -144,6 +144,12 @@ void TestNode::validatePointInflation(
           continue;
         }
 
+        if (dist == bin->first) {
+          // Adding to our current bin could cause a reallocation
+          // Which appears to cause the iterator to get messed up
+          dist += 0.001;
+        }
+
         if (cell.x_ > 0) {
           CellData data(costmap->getIndex(cell.x_ - 1, cell.y_),
             cell.x_ - 1, cell.y_, cell.src_x_, cell.src_y_);