diff --git a/examples/RGBDMapping/main.cpp b/examples/RGBDMapping/main.cpp
index 78d01777..ed4f5ff2 100644
--- a/examples/RGBDMapping/main.cpp
+++ b/examples/RGBDMapping/main.cpp
@@ -251,5 +251,7 @@ int main(int argc, char * argv[])
 		printf("Saving rtabmap_trajectory.txt... failed!\n");
 	}
 
+	rtabmap->close(false);
+
 	return 0;
 }