diff --git a/params/iri_ground_segmentation.yaml b/params/iri_ground_segmentation.yaml
deleted file mode 100644
index 1ad78c94ee5233a5110b36beb6a5704be4e5fad6..0000000000000000000000000000000000000000
--- a/params/iri_ground_segmentation.yaml
+++ /dev/null
@@ -1,27 +0,0 @@
-iri_ground_segmentation: {
-  sensor_height: 0.27, #1.10,
-
-  mahalanobis_threshold: 2.0, #3.0,
-
-  z_initial_std_dev: 0.1, #0.04,
-  initial_angular_std_dev_deg: 2.0, #1.333,
-
-  ground_reference_search_resolution_deg: 30.0, #30.0,
-
-  elevation_grid_resolution: 1.0, #0.1,
-
-  angle_reduction_factor: 0.8, #0.5, #0.666, 
-  search_limit_in_shadow_area: 1.2, #2.2, #2.2, #3.0,
-
-  distance_to_virtual_references_in_shadow_area: 1.2, #2.75,
-
-  propagation_z_additive_noise_per_meter: 0.04,
-  propagation_additive_noise_deg_per_meter: 0.666, #0.025,
-  z_observation_std_dev: 0.1, #0.1,
-
-  robot_width: 1.05,
-  safety_margin: 0.5,
-
-  measure_performance: false,
-  show_dense_reconstruction: false
-}
diff --git a/src/ground_segmentation_alg.cpp b/src/ground_segmentation_alg.cpp
index 8323a8231dd27ae5e46213af9d4bd706ca793b1a..6f2c0b638a406b804f623349d8235445fd78182b 100644
--- a/src/ground_segmentation_alg.cpp
+++ b/src/ground_segmentation_alg.cpp
@@ -70,6 +70,12 @@ void GroundSegmentationAlgorithm::segmentGround(pcl::PointCloud<pcl::PointXYZRGB
     vertex.pose.position.x = ground_ref.x;
     vertex.pose.position.y = ground_ref.y;
     vertex.pose.position.z = ground_ref.z;
+
+    vertex.pose.orientation.x = 0.0;
+    vertex.pose.orientation.y = 0.0;
+    vertex.pose.orientation.z = 0.0;
+    vertex.pose.orientation.w = 1.0;
+
     vertex.scale.x = 0.15;
     vertex.scale.y = 0.15;
     vertex.scale.z = 0.30;
@@ -112,6 +118,11 @@ void GroundSegmentationAlgorithm::segmentGround(pcl::PointCloud<pcl::PointXYZRGB
 
       edge.scale.x = 0.05;
 
+      edge.pose.orientation.x = 0.0;
+      edge.pose.orientation.y = 0.0;
+      edge.pose.orientation.z = 0.0;
+      edge.pose.orientation.w = 1.0;
+
       edge.color.a = 0.7; // Don't forget to set the alpha!
       edge.color.r = 0.8;
       edge.color.g = 0.53;