diff --git a/src/slam3d_pkg/config/rtabmap_mkmini-real.yaml b/src/slam3d_pkg/config/rtabmap_mkmini-real.yaml
index be3c1a4..ae46beb 100755
--- a/src/slam3d_pkg/config/rtabmap_mkmini-real.yaml
+++ b/src/slam3d_pkg/config/rtabmap_mkmini-real.yaml
@@ -51,7 +51,7 @@ rtabmap:
     Grid/MinGroundHeight: "-0.2"
     Grid/MaxObstacleHeight: "1.0"
     Grid/RayTracing: "false"
-    Grid/3D: "false"
+    Grid/3D: "true"
     RGBD/OptimizeMaxError: "0.5"
 
     RGBD/LinearUpdate: "0.05"