workaround for pose update

source/RobotAPI/libraries/robotstate/remote/ArmarPose.cpp

@@ -286,8 +286,8 @@ namespace armarx
         Matrix4f m = Matrix4f::Identity();
         ARMARX_CHECK_EXPRESSION(c_orientation);
         ARMARX_CHECK_EXPRESSION(c_position);
-        m.block<3,3>(0,0) = c_orientation->toEigen();
-        m.block<3,1>(0,3) = c_position->toEigen();
+        m.block<3,3>(0,0) = QuaternionPtr::dynamicCast(orientation)->toEigen();
+        m.block<3,1>(0,3) = Vector3Ptr::dynamicCast(position)->toEigen();
         return m;
     }