diff --git a/source/RobotAPI/libraries/armem_robot_state/server/common/Visu.cpp b/source/RobotAPI/libraries/armem_robot_state/server/common/Visu.cpp
index e68119affae5664f232dba25c679a8cce9fbdd10..6935862bcd6b5159b8a7cb820b9a2ab4c9f64381 100644
--- a/source/RobotAPI/libraries/armem_robot_state/server/common/Visu.cpp
+++ b/source/RobotAPI/libraries/armem_robot_state/server/common/Visu.cpp
@@ -110,6 +110,8 @@ namespace armarx::armem::server::robot_state
                 Eigen::Affine3f from = pose;
                 Eigen::Affine3f to = pose * frame;
 
+                pose = to;
+
                 layerFrames.add(viz::Arrow(robotName + std::to_string(++i)).fromTo(from.translation(), to.translation()));
             }
         }