Add publishing instrumentation

Signed-off-by: Christophe Bedard <bedard.christophe@gmail.com>
ros2 · Mar 27, 2021 · 53c89ab · 53c89ab
1 parent 92ece94
commit 53c89ab
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/rclcpp/include/rclcpp/publisher.hpp b/rclcpp/include/rclcpp/publisher.hpp
@@ -40,6 +40,8 @@
 #include "rclcpp/type_support_decl.hpp"
 #include "rclcpp/visibility_control.hpp"
 
+#include "tracetools/tracetools.h"
+
 namespace rclcpp
 {
 
@@ -279,6 +281,10 @@ class Publisher : public PublisherBase
   void
   do_inter_process_publish(const MessageT & msg)
   {
+    TRACEPOINT(
+      rclcpp_publish,
+      static_cast<const void *>(publisher_handle_.get()),
+      static_cast<const void *>(&msg));
     auto status = rcl_publish(publisher_handle_.get(), &msg, nullptr);
 
     if (RCL_RET_PUBLISHER_INVALID == status) {