diff --git a/surface/include/pcl/surface/impl/organized_fast_mesh.hpp b/surface/include/pcl/surface/impl/organized_fast_mesh.hpp
index 8428be0e38c..9e6fe0a5e25 100644
--- a/surface/include/pcl/surface/impl/organized_fast_mesh.hpp
+++ b/surface/include/pcl/surface/impl/organized_fast_mesh.hpp
@@ -114,9 +114,9 @@ pcl::OrganizedFastMesh<PointInT>::makeQuadMesh (std::vector<pcl::Vertices>& poly
                                      index_down += triangle_pixel_size_,
                                      index_down_right += triangle_pixel_size_)
     {
-      if (isValidQuad (i, index_down, index_right, index_down_right))
+      if (isValidQuad (i, index_right, index_down_right, index_down))
         if (store_shadowed_faces_ || !isShadowedQuad (i, index_right, index_down_right, index_down))
-          addQuad (i, index_down, index_right, index_down_right, idx++, polygons);
+          addQuad (i, index_right, index_down_right, index_down, idx++, polygons);
     }
   }
   polygons.resize (idx);