Add tracepoint for publish_serialized_publish (#1136)

* Add tracepoint for publish_serialized_publish Signed-off-by: h-suzuki <h-suzuki@isp.co.jp> * Add: tracepoint for rcl_take_serialized_message Signed-off-by: h-suzuki <h-suzuki@isp.co.jp> --------- Signed-off-by: h-suzuki <h-suzuki@isp.co.jp>
ros2 · Apr 1, 2024 · b7ed9ab · b7ed9ab
1 parent 1c42509
commit b7ed9ab
Show file tree

Hide file tree

Showing 2 changed files with 2 additions and 0 deletions.
diff --git a/rcl/src/rcl/publisher.c b/rcl/src/rcl/publisher.c
@@ -297,6 +297,7 @@ rcl_publish_serialized_message(
     return RCL_RET_PUBLISHER_INVALID;  // error already set
   }
   RCL_CHECK_ARGUMENT_FOR_NULL(serialized_message, RCL_RET_INVALID_ARGUMENT);
+  TRACETOOLS_TRACEPOINT(rcl_publish, (const void *)publisher, (const void *)serialized_message);
   rmw_ret_t ret = rmw_publish_serialized_message(
     publisher->impl->rmw_handle, serialized_message, allocation);
   if (ret != RMW_RET_OK) {

diff --git a/rcl/src/rcl/subscription.c b/rcl/src/rcl/subscription.c
@@ -644,6 +644,7 @@ rcl_take_serialized_message(
   }
   RCUTILS_LOG_DEBUG_NAMED(
     ROS_PACKAGE_NAME, "Subscription serialized take succeeded: %s", taken ? "true" : "false");
+  TRACETOOLS_TRACEPOINT(rcl_take, (const void *)serialized_message);
   if (!taken) {
     return RCL_RET_SUBSCRIPTION_TAKE_FAILED;
   }