Add: tracepoint for subscribe serialized_message (#145)

* Add: tracepoint for take_serialized_message Signed-off-by: h-suzuki <[email protected]> * Fix: TRACETOOLS_TRACEPOINT args Signed-off-by: h-suzuki <[email protected]> * Update rmw_connextdds_common/src/common/rmw_subscription.cpp Co-authored-by: Christophe Bedard <[email protected]> Signed-off-by: h-suzuki-isp <[email protected]> * Update rmw_connextdds_common/src/common/rmw_subscription.cpp Co-authored-by: Christophe Bedard <[email protected]> Signed-off-by: h-suzuki-isp <[email protected]> --------- Signed-off-by: h-suzuki <[email protected]> Signed-off-by: h-suzuki-isp <[email protected]> Co-authored-by: Christophe Bedard <[email protected]>
ros2 · Apr 1, 2024 · b8c410c · b8c410c
1 parent 98fc0e9
commit b8c410c
Showing 1 changed file with 20 additions and 2 deletions.
diff --git a/rmw_connextdds_common/src/common/rmw_subscription.cpp b/rmw_connextdds_common/src/common/rmw_subscription.cpp
@@ -386,7 +386,16 @@ rmw_api_connextdds_take_serialized_message(
   RMW_Connext_Subscriber * const sub_impl =
     reinterpret_cast<RMW_Connext_Subscriber *>(subscription->data);
 
-  return sub_impl->take_serialized(serialized_message, nullptr, taken);
+  rmw_ret_t rc = sub_impl->take_serialized(serialized_message, nullptr, taken);
+
+  TRACETOOLS_TRACEPOINT(
+    rmw_take,
+    subscription,
+    serialized_message,
+    0LL,
+    *taken);
+
+  return rc;
 }
 
 
@@ -413,7 +422,16 @@ rmw_api_connextdds_take_serialized_message_with_info(
   RMW_Connext_Subscriber * const sub_impl =
     reinterpret_cast<RMW_Connext_Subscriber *>(subscription->data);
 
-  return sub_impl->take_serialized(serialized_message, message_info, taken);
+  rmw_ret_t rc = sub_impl->take_serialized(serialized_message, message_info, taken);
+
+  TRACETOOLS_TRACEPOINT(
+    rmw_take,
+    subscription,
+    serialized_message,
+    (message_info ? message_info->source_timestamp : 0LL),
+    *taken);
+
+  return rc;
 }