From 425a78298da1987d82637061fd0aed8df724430f Mon Sep 17 00:00:00 2001
From: Mathieu Labbe <matlabbe@gmail.com>
Date: Mon, 29 Aug 2016 15:56:42 -0400
Subject: [PATCH] Fixed negative grids not overwritten

---
 src/MapsManager.cpp | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/src/MapsManager.cpp b/src/MapsManager.cpp
index 2dd0bbf5..d38333d5 100644
--- a/src/MapsManager.cpp
+++ b/src/MapsManager.cpp
@@ -470,8 +470,8 @@ std::map<int, rtabmap::Transform> MapsManager::updateMapCaches(
 							{
 								// normally data should be already uncompressed for negative ids
 								occupancyGrid_->createLocalMap(findIter->second, ground, obstacles, viewPoint);
-								gridMaps_.insert(std::make_pair(iter->first, std::make_pair(ground, obstacles)));
-								gridMapsViewpoints_.insert(std::make_pair(iter->first, viewPoint));
+								uInsert(gridMaps_, std::make_pair(iter->first, std::make_pair(ground, obstacles)));
+								uInsert(gridMapsViewpoints_, std::make_pair(iter->first, viewPoint));
 							}
 							else
 							{