Skip to content
Snippets Groups Projects
Commit b7269af5 authored by Fabian Reister's avatar Fabian Reister
Browse files

RobotStateComponent: fixing reportGlobalRobotPose

parent dd58461a
No related branches found
No related tags found
1 merge request!124new types: PoseStamped and VelocityStamped
......@@ -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)
{
......
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