Fix issue ros2#749

Signed-off-by: Sukhvansh2004 <[email protected]>
Sukhvansh2004 · Jan 15, 2025 · 1fb6d46 · 1fb6d46
1 parent b269fb9
commit 1fb6d46
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/tf2/src/buffer_core.cpp b/tf2/src/buffer_core.cpp
@@ -1613,11 +1613,11 @@ void BufferCore::_chainAsVector(
     }
     // Erase all duplicate items from frame_chain
     if (n > 0u) {
-      source_frame_chain.erase(source_frame_chain.begin() + (n - 1u), source_frame_chain.end());
+      source_frame_chain.erase(source_frame_chain.begin() + (n + 1u), source_frame_chain.end());
     }
 
     if (m < target_frame_chain.size()) {
-      for (size_t i = 0u; i <= m; ++i) {
+      for (size_t i = m; i >= 0; --i) {
         source_frame_chain.push_back(target_frame_chain[i]);
       }
     }