From 8a786d3c507e7de3ba80a3b74060e816863c3efc Mon Sep 17 00:00:00 2001
From: matlabbe <matlabbe@f169173b-cf89-36c8-b27e-44dbe73f0c83>
Date: Wed, 9 Jul 2014 17:28:57 +0000
Subject: [PATCH] set azimut3 launch RehearsedNodesKept=false Showing a
 QMessageBox in Rviz plugin when downloading the map

git-svn-id: http://rtabmap.googlecode.com/svn/trunk/ros-pkg@1484 f169173b-cf89-36c8-b27e-44dbe73f0c83
---
 launch/azimut3/az3_mapping_robot.launch |  4 +-
 src/rviz/MapCloudDisplay.cpp            | 66 +++++++++++++++++++------
 2 files changed, 54 insertions(+), 16 deletions(-)

diff --git a/launch/azimut3/az3_mapping_robot.launch b/launch/azimut3/az3_mapping_robot.launch
index d4b50fc9..22c0056c 100644
--- a/launch/azimut3/az3_mapping_robot.launch
+++ b/launch/azimut3/az3_mapping_robot.launch
@@ -66,9 +66,9 @@
 	  <param name="RGBD/AngularUpdate" type="string" value="0.01"/>             <!-- Update map only if the robot is moving -->
 	  <param name="RGBD/LinearUpdate" type="string" value="0.01"/>              <!-- Update map only if the robot is moving -->
 	  <param name="Rtabmap/TimeThr" type="string" value="700"/>
-	  <param name="Mem/RehearsalSimilarity" type="string" value="0.45"/>   
+	  <param name="Mem/RehearsalSimilarity" type="string" value="0.45"/>
+	  <param name="Mem/RehearsedNodesKept" type="string" value="false"/>   
    	  <param name="RGBD/OptimizeFromGraphEnd" type="string" value="false"/>    <!-- Optimize graph from initial node so /map -> /odom transform will be generated -->
-
     </node>
   </group>
 </launch>
diff --git a/src/rviz/MapCloudDisplay.cpp b/src/rviz/MapCloudDisplay.cpp
index 9577e2c7..3dd0d16b 100644
--- a/src/rviz/MapCloudDisplay.cpp
+++ b/src/rviz/MapCloudDisplay.cpp
@@ -1,4 +1,8 @@
 
+#include <QtGui/QApplication>
+#include <QtGui/QMessageBox>
+#include <QtCore/QTimer>
+
 #include <OgreSceneNode.h>
 #include <OgreSceneManager.h>
 
@@ -24,6 +28,7 @@
 #include <rtabmap/MsgConversion.h>
 #include <rtabmap/GetMap.h>
 
+
 namespace rtabmap
 {
 
@@ -412,25 +417,58 @@ void MapCloudDisplay::updateCloudParameters()
 
 void MapCloudDisplay::downloadMap()
 {
-	rtabmap::GetMap getMapSrv;
-	getMapSrv.request.global = true;
-	getMapSrv.request.optimized = true;
-	getMapSrv.request.graphOnly = false;
-	if(!ros::service::call("rtabmap/get_map", getMapSrv))
+	if(download_map_->getBool())
 	{
-		ROS_ERROR("MapCloudDisplay: Can't call \"rtabmap/get_map\" service. "
-				  "Tip: if rtabmap node is not in rtabmap namespace, you can remap the service "
-				  "to \"get_map\" in the launch "
-				  "file like: <remap from=\"rtabmap/get_map\" to=\"get_map\"/>.");
+		rtabmap::GetMap getMapSrv;
+		getMapSrv.request.global = true;
+		getMapSrv.request.optimized = true;
+		getMapSrv.request.graphOnly = false;
+		ros::NodeHandle nh;
+		QMessageBox * messageBox = new QMessageBox(
+				QMessageBox::NoIcon,
+				tr("Calling \"%1\" service...").arg(nh.resolveName("rtabmap/get_map").c_str()),
+				tr("Downloading the map... please wait (rviz could become gray!)"),
+				QMessageBox::NoButton);
+		messageBox->setAttribute(Qt::WA_DeleteOnClose, true);
+		messageBox->show();
+		QApplication::processEvents();
+		uSleep(100); // hack make sure the text in the QMessageBox is shown...
+		QApplication::processEvents();
+		if(!ros::service::call("rtabmap/get_map", getMapSrv))
+		{
+			ROS_ERROR("MapCloudDisplay: Can't call \"%s\" service. "
+					  "Tip: if rtabmap node is not in rtabmap namespace, you can remap the service "
+					  "to \"get_map\" in the launch "
+					  "file like: <remap from=\"rtabmap/get_map\" to=\"get_map\"/>.",
+					  nh.resolveName("rtabmap/get_map").c_str());
+			messageBox->setText(tr("MapCloudDisplay: Can't call \"%1\" service. "
+					  "Tip: if rtabmap node is not in rtabmap namespace, you can remap the service "
+					  "to \"get_map\" in the launch "
+					  "file like: <remap from=\"rtabmap/get_map\" to=\"get_map\"/>.").
+					  arg(nh.resolveName("rtabmap/get_map").c_str()));
+		}
+		else
+		{
+			messageBox->setText(tr("Creating all clouds (%1 nodes downloaded)...").arg(getMapSrv.response.data.poses.size()));
+			QApplication::processEvents();
+			this->reset();
+			processMapData(getMapSrv.response.data);
+			messageBox->setText(tr("Creating all clouds (%1 nodes downloaded)... done!").arg(getMapSrv.response.data.poses.size()));
+
+			QTimer::singleShot(1000, messageBox, SLOT(close()));
+		}
+		download_map_->blockSignals(true);
+		download_map_->setBool(false);
+		download_map_->blockSignals(false);
 	}
 	else
 	{
-		this->reset();
-		processMapData(getMapSrv.response.data);
+		// just stay true if double-clicked on DownloadMap property, let the
+		// first process above finishes
+		download_map_->blockSignals(true);
+		download_map_->setBool(true);
+		download_map_->blockSignals(false);
 	}
-	download_map_->blockSignals(true);
-	download_map_->setBool(false);
-	download_map_->blockSignals(false);
 }
 
 void MapCloudDisplay::causeRetransform()