From 09ea02a021ea5e49920a132ffdf6f43e0bf7b437 Mon Sep 17 00:00:00 2001
From: SecondHandsIntegrationAccount <NotAvailable@secondhands.eu>
Date: Fri, 10 Jun 2016 15:12:01 +0200
Subject: [PATCH] fixed setting of global pose of robot in RobotStateComponent

---
 source/RobotAPI/components/RobotState/RobotStateComponent.cpp | 4 +---
 1 file changed, 1 insertion(+), 3 deletions(-)

diff --git a/source/RobotAPI/components/RobotState/RobotStateComponent.cpp b/source/RobotAPI/components/RobotState/RobotStateComponent.cpp
index ebbc4f01a..891bcee55 100644
--- a/source/RobotAPI/components/RobotState/RobotStateComponent.cpp
+++ b/source/RobotAPI/components/RobotState/RobotStateComponent.cpp
@@ -193,13 +193,11 @@ namespace armarx
         }
 
         clone->setJointValues(config.jointMap);
-        clone->setGlobalPose(FramedPosePtr::dynamicCast(config.globalPose)->toEigen());
         SharedRobotServantPtr p = new SharedRobotServant(clone);
         p->setTimestamp(IceUtil::Time::microSecondsDouble(time));
         auto result = getObjectAdapter()->addWithUUID(p);
         // virtal robot clone is buggy -> set global pose here
-        p->setGlobalPose(new Pose(_synchronized->getGlobalPose()));
-
+        p->setGlobalPose(config.globalPose);
 
         return SharedRobotInterfacePrx::uncheckedCast(result);
     }
-- 
GitLab