From e9626f41a8ef7b7bb2f28cd3f8b846b516bfc6bd Mon Sep 17 00:00:00 2001
From: Pierre Gergondet <pierre.gergondet@gmail.com>
Date: Mon, 24 Jul 2023 15:08:09 +0900
Subject: [PATCH] [Replay] Always forward kinematics after updating the output

---
 plugins/Replay/src/Replay.cpp | 1 +
 1 file changed, 1 insertion(+)

diff --git a/plugins/Replay/src/Replay.cpp b/plugins/Replay/src/Replay.cpp
index dc2211d248..a1a9aab02d 100644
--- a/plugins/Replay/src/Replay.cpp
+++ b/plugins/Replay/src/Replay.cpp
@@ -45,6 +45,7 @@ void log_to_robot(const mc_rtc::log::FlatLog & log, mc_rbdyn::Robot & robot, boo
     robot.mbc().q[static_cast<size_t>(mbcIdx)][0] = qOut[i];
   }
   if(robot.mb().joint(0).dof() == 6) { robot.posW(get<sva::PTransformd>(log, "ff", robot.name(), is_main, idx)); }
+  else { robot.forwardKinematics(); }
 }
 
 template<typename CppT>