Skip to content
Snippets Groups Projects
Commit 09ea02a0 authored by SecondHandsIntegrationAccount's avatar SecondHandsIntegrationAccount
Browse files

fixed setting of global pose of robot in RobotStateComponent

parent 46028e48
No related branches found
No related tags found
No related merge requests found
......@@ -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);
}
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment