From b51ba8798bd69aa0bf0ce64400255f9f9a669753 Mon Sep 17 00:00:00 2001
From: matlabbe <matlabbe@gmail.com>
Date: Tue, 26 May 2026 01:09:34 +0000
Subject: [PATCH] Fixed output rwo_step when inputs are organized

---
 rtabmap_util/src/nodelets/point_cloud_assembler.cpp | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/rtabmap_util/src/nodelets/point_cloud_assembler.cpp b/rtabmap_util/src/nodelets/point_cloud_assembler.cpp
index 90fad992..a180fe66 100644
--- a/rtabmap_util/src/nodelets/point_cloud_assembler.cpp
+++ b/rtabmap_util/src/nodelets/point_cloud_assembler.cpp
@@ -401,8 +401,8 @@ private:
 #else
 							pcl::concatenatePointCloud(*assembled, *(*iter), *assembledTmp);
 #endif
-							//Make sure row_step is the sum of both
-							assembledTmp->row_step = assembled->row_step + (*iter)->row_step;
+							// Make sure row_step is updated
+							assembledTmp->row_step = assembledTmp->point_step * assembledTmp->width;
 							assembled = assembledTmp;
 						}
 					}