Feature/object memory connected to robot state memory

When I tested IVT on ARMAR-6, I noticed that the provided object poses were not really stable but moved similar to the platform motion. This PR should help to investigate whether using the new memory to retrieve the robot state eliminates these issues. Previously, the robot was just synchronized to the current timestamp but the object detections are from the past (eventually ~200ms) and therefore, the transformation robot->global or camera->global is incorrect.

The major change is thus l.194 in Segment.cpp: ARMARX_CHECK(virtualRobotReader->synchronizeRobot(*robot, timestamp)); Here, now the provided timestamp is used.

ToDo:

• as in most cases, the timestamps of all provided object poses in reportObjectPoses() might be similar, the robot state only needs to be updated once and not for each object pose individually.

source/RobotAPI/libraries/armem_objects/server/instance/Segment.cpp

@@ -151,6 +151,10 @@ namespace armarx::armem::server::obj::instance
         // Build new poses.
         objpose::ObjectPoseSeq newObjectPoses;
         stats.numUpdated = 0;
+
+        // timestamp used to reduce the rpc calls for robot sync 
+        Time robotSyncTimestamp = -1;
+
         for (const objpose::data::ProvidedObjectPose& provided : providedPoses)
         {
             const Time timestamp = armarx::fromIce<Time>(provided.timestamp);
@@ -191,7 +195,12 @@ namespace armarx::armem::server::obj::instance
                 // Update the entity.
                 stats.numUpdated++;
 
-                ARMARX_CHECK(virtualRobotReader->synchronizeRobot(*robot, timestamp));
+                // update the robot to obtain correct local -> global transformation
+                if(robotSyncTimestamp != timestamp)
+                {
+                    ARMARX_CHECK(virtualRobotReader->synchronizeRobot(*robot, timestamp));
+                    robotSyncTimestamp = timestamp;
+                }
 
                 objpose::ObjectPose& newPose = newObjectPoses.emplace_back();
                 if (provided.objectPoseFrame.empty())