[Replay] Always forward kinematics after updating the output

jrl-umi3218 · Jul 24, 2023 · e9626f4 · e9626f4
1 parent 94c4d8f
commit e9626f4
Showing 1 changed file with 1 addition and 0 deletions.
diff --git 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>