diff --git a/src/modelec/src/arm_controller.cpp b/src/modelec/src/arm_controller.cpp index 6f3c9f5..9e5d221 100644 --- a/src/modelec/src/arm_controller.cpp +++ b/src/modelec/src/arm_controller.cpp @@ -22,6 +22,8 @@ namespace Modelec { if (rclcpp::spin_until_future_complete(this->get_node_base_interface(), res) == rclcpp::FutureReturnCode::SUCCESS) { if (!res.get()->success) { RCLCPP_ERROR(this->get_logger(), "Failed to add servo on pin %d", pin); + } else { + RCLCPP_INFO(this->get_logger(), "Added servo on pin %d", pin); } } else { RCLCPP_ERROR(this->get_logger(), "Service call failed");