Skip to content
Snippets Groups Projects
Commit 81613111 authored by Mirko Wächter's avatar Mirko Wächter
Browse files

used optimized version for syncing the robot in RobotIK

parent cd8f5e4c
No related branches found
No related tags found
No related merge requests found
......@@ -39,6 +39,7 @@
#include <Core/core/system/ArmarXDataPath.h>
#include <Core/core/ArmarXManager.h>
#include <Core/core/ArmarXObjectScheduler.h>
#include <RobotAPI/libraries/core/remoterobot/RemoteRobot.h>
#include <algorithm>
#include <set>
......@@ -574,13 +575,7 @@ namespace armarx
void RobotIK::synchRobot() const
{
std::lock_guard<std::recursive_mutex> lock(_modifyRobotModelMutex);
VirtualRobot::RobotConfigPtr robotConfig = _robotModel->getConfig();
BOOST_FOREACH(auto roboNode, robotConfig->getNodes())
{
SharedRobotNodeInterfacePrx sharedRoboNode = _synchronizedRobot->getRobotNode(roboNode->getName());
float val = sharedRoboNode->getJointValue();
_robotModel->getRobotNode(roboNode->getName())->setJointValue(val);
}
RemoteRobot::synchronizeLocalClone(_robotModel, _synchronizedRobot);
}
}
......
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