Minor changes.

src/ground_segmentation_alg.cpp

@@ -165,9 +165,9 @@ void GroundSegmentationAlgorithm::segmentGround(
       //std::cout << "Vertex Pitch = " << ground_ref.data_c[GRND_REF_DATA_C_2_PITCH] << " ;     Vertex Roll = "
       //          << ground_ref.data_c[GRND_REF_DATA_C_1_ROLL] << std::endl;
 
-      assert(
-          vertex_id == ground_ref.data_n[GRND_REF_DATA_N_3_ORIGINAL_INDEX]
-              && "Something unexpected in GroundSegmentationAlgorithm::segmentGround happened! vertex_id not equal to ground_ref.data_n[GRND_REF_DATA_N_3_ORIGINAL_INDEX]!");
+      //assert(
+      //    vertex_id == ground_ref.data_n[GRND_REF_DATA_N_3_ORIGINAL_INDEX]
+       //       && "Something unexpected in GroundSegmentationAlgorithm::segmentGround happened! vertex_id not equal to ground_ref.data_n[GRND_REF_DATA_N_3_ORIGINAL_INDEX]!");
 
       //std::cout << "Converting vertex with id = " << vertex_id << " to marker!" << std::endl;
       //std::cout << "Number of edges for vertex " << vertex_id << " = " << edges[ground_ref.data_n[3]].size() << std::endl;