Add logs on failed take response/request (#107)

Author: Mauro Passerino

rclcpp/src/rclcpp/client.cpp

@@ -93,6 +93,10 @@ ClientBase::take_type_erased_response(void * response_out, rmw_request_id_t & re
     &request_header_out,
     response_out);
   if (RCL_RET_CLIENT_TAKE_FAILED == ret) {
+    RCLCPP_ERROR(
+      rclcpp::get_logger("rclcpp"),
+      "Error in take_type_erased_response: RCL_RET_CLIENT_TAKE_FAILED. "
+      "Service name: %s", get_service_name());
     return false;
   } else if (RCL_RET_OK != ret) {
     rclcpp::exceptions::throw_from_rcl_error(ret);

rclcpp/src/rclcpp/service.cpp

@@ -61,6 +61,10 @@ ServiceBase::take_type_erased_request(void * request_out, rmw_request_id_t & req
     &request_id_out,
     request_out);
   if (RCL_RET_SERVICE_TAKE_FAILED == ret) {
+    RCLCPP_ERROR(
+      rclcpp::get_logger("rclcpp"),
+      "Error in take_type_erased_request: RCL_RET_SERVICE_TAKE_FAILED. "
+      "Service name: %s", get_service_name());
     return false;
   } else if (RCL_RET_OK != ret) {
     rclcpp::exceptions::throw_from_rcl_error(ret);