Add publish/take messages

dhood · dhood · commit 88b8bee2b466 · 2017-11-21T15:46:42.000-08:00
diff --git a/rcl/src/rcl/publisher.c b/rcl/src/rcl/publisher.c
@@ -202,6 +202,7 @@ rcl_publisher_get_default_options()
 rcl_ret_t
 rcl_publish(const rcl_publisher_t * publisher, const void * ros_message)
 {
+  RCUTILS_LOG_DEBUG_NAMED(ROS_PACKAGE_NAME, "Publisher publishing message")
   if (!rcl_publisher_is_valid(publisher)) {
     return RCL_RET_PUBLISHER_INVALID;
   }
diff --git a/rcl/src/rcl/subscription.c b/rcl/src/rcl/subscription.c
@@ -207,6 +207,7 @@ rcl_take(
   void * ros_message,
   rmw_message_info_t * message_info)
 {
+  RCUTILS_LOG_DEBUG_NAMED(ROS_PACKAGE_NAME, "Subscription taking message")
   RCL_CHECK_ARGUMENT_FOR_NULL(subscription, RCL_RET_INVALID_ARGUMENT, rcl_get_default_allocator());
   const rcl_subscription_options_t * options = rcl_subscription_get_options(subscription);
   if (!options) {
@@ -231,7 +232,7 @@ rcl_take(
     return RCL_RET_ERROR;
   }
   RCUTILS_LOG_DEBUG_NAMED(
-    ROS_PACKAGE_NAME, "Subscription take request succeeded: %s", taken ? "true" : "false")
+    ROS_PACKAGE_NAME, "Subscription take succeeded: %s", taken ? "true" : "false")
   if (!taken) {
     return RCL_RET_SUBSCRIPTION_TAKE_FAILED;
   }

Original file line number	Diff line number	Diff line change
`@@ -202,6 +202,7 @@ rcl_publisher_get_default_options()`
`202`	`202`	`rcl_ret_t`
`203`	`203`	`rcl_publish(const rcl_publisher_t * publisher, const void * ros_message)`
`204`	`204`	`{`
	`205`	`+ RCUTILS_LOG_DEBUG_NAMED(ROS_PACKAGE_NAME, "Publisher publishing message")`
`205`	`206`	`if (!rcl_publisher_is_valid(publisher)) {`
`206`	`207`	`return RCL_RET_PUBLISHER_INVALID;`
`207`	`208`	`}`
Original file line number	Diff line number	Diff line change
`@@ -207,6 +207,7 @@ rcl_take(`
`207`	`207`	`void * ros_message,`
`208`	`208`	`rmw_message_info_t * message_info)`
`209`	`209`	`{`
	`210`	`+ RCUTILS_LOG_DEBUG_NAMED(ROS_PACKAGE_NAME, "Subscription taking message")`
`210`	`211`	`RCL_CHECK_ARGUMENT_FOR_NULL(subscription, RCL_RET_INVALID_ARGUMENT, rcl_get_default_allocator());`
`211`	`212`	`const rcl_subscription_options_t * options = rcl_subscription_get_options(subscription);`
`212`	`213`	`if (!options) {`
`@@ -231,7 +232,7 @@ rcl_take(`
`231`	`232`	`return RCL_RET_ERROR;`
`232`	`233`	`}`
`233`	`234`	`RCUTILS_LOG_DEBUG_NAMED(`
`234`		`- ROS_PACKAGE_NAME, "Subscription take request succeeded: %s", taken ? "true" : "false")`
	`235`	`+ ROS_PACKAGE_NAME, "Subscription take succeeded: %s", taken ? "true" : "false")`
`235`	`236`	`if (!taken) {`
`236`	`237`	`return RCL_RET_SUBSCRIPTION_TAKE_FAILED;`
`237`	`238`	`}`