diff --git a/source/RobotAPI/components/RobotState/RobotStateComponent.cpp b/source/RobotAPI/components/RobotState/RobotStateComponent.cpp index da872952c095ddca5d32a12b55e85952470432af..3d51ac4aa003553fa4ea9a5994951904001c29c2 100644 --- a/source/RobotAPI/components/RobotState/RobotStateComponent.cpp +++ b/source/RobotAPI/components/RobotState/RobotStateComponent.cpp @@ -350,13 +350,13 @@ namespace armarx if (_synchronized) { std::string localRobotName = _synchronized->getName(); - ARMARX_DEBUG << "Comparing " << localRobotName << " and " << robotName << "."; - if (localRobotName == robotName) + ARMARX_DEBUG << "Comparing " << localRobotName << " and " << globalRobotPose.header.agent << "."; + if (localRobotName == globalRobotPose.header.agent) { const IceUtil::Time time = IceUtil::Time::microSeconds(globalRobotPose.header.timestampInMicroSeconds); - insertPose(time, pose); - _synchronized->setGlobalPose(pose); + insertPose(time, globalRobotPose.transform); + _synchronized->setGlobalPose(globalRobotPose.transform); if (_sharedRobotServant) {