fix: aron stuff

source/VisionX/components/image_processor/OpenPoseEstimation/Memory/RGBDPoseEstimationWithMemoryWriter/RGBDPoseEstimationWithMemoryWriter.cpp

@@ -106,13 +106,10 @@ namespace armarx
                     posGlobal.position.x() = keypoint.globalX;
                     posGlobal.position.y() = keypoint.globalY;
                     posGlobal.position.z() = keypoint.globalZ;
-                    kp.positionGlobal = posGlobal;
+                    kp.positionGlobal = FramedPosition(posGlobal.position, armarx::GlobalFrame, posGlobal.header.agent);
 
-                    FramedPosition pos = FramedPosition(Eigen::Vector3f(keypoint.x, keypoint.y, keypoint.z), cameraNodeName, localRobot->getName());
-                    armarx::arondto::FramedPosition posRobot;
-                    posRobot.header.agent = localRobot->getName();
-                    posRobot.header.frame = localRobot->getRootNode()->getName();
-                    posRobot.position = pos.toRootFrame(localRobot)->toEigen();
+                    FramedPosition pos(Eigen::Vector3f(keypoint.x, keypoint.y, keypoint.z), cameraNodeName, localRobot->getName());
+                    armarx::FramedPosition posRobot(pos.toRootFrame(localRobot)->toEigen(), localRobot->getRootNode()->getName(), localRobot->getName());
                     kp.positionRobot = posRobot;
 
                     armarx::human::arondto::Keypoint2D kp2;
@@ -269,4 +266,3 @@ namespace armarx
         }
     }
 }
-