CHG: print modbus config in hardware_interface

Author: slimasziom

robotiq_hande_driver/hardware/include/robotiq_hande_driver/communication.hpp

@@ -85,13 +85,6 @@ class Communication {
     int configure() {
         int result;
 
-        printf(
-            "Connecting to: %s, %d, %c, %d, %d\n",
-            tty_port_,
-            baudrate_,
-            parity_,
-            data_bits_,
-            stop_bit_);
         mb_ = modbus_new_rtu(tty_port_, baudrate_, parity_, data_bits_, stop_bit_);
         modbus_set_slave(mb_, slave_id_);
         modbus_set_debug(mb_, DEBUG_MODBUS);

robotiq_hande_driver/hardware/src/hande_hardware_interface.cpp

@@ -74,10 +74,21 @@ HWI::CallbackReturn RobotiqHandeHardwareInterface::on_configure(
     const rlccp_lc::State& /*previous_state*/) {
     int result;
 
+    RCLCPP_INFO(
+        get_logger(),
+        "Connecting to tty:%s, baudrate:%d, parity:%c, data_bits:%d, stop_bit:%d",
+        tty_port_.c_str(),
+        baudrate_,
+        parity_,
+        data_bits_,
+        stop_bit_);
     result = gripper_driver_.configure();
 
-    RCLCPP_INFO(get_logger(), "Configured Hand-E Gripper: %d", result);
-    if(result == FAILURE_MODBUS) return HWI::CallbackReturn::FAILURE;
+    if(result == FAILURE_MODBUS) {
+        RCLCPP_INFO(get_logger(), "Failed to configure Hand-E Gripper");
+        return HWI::CallbackReturn::FAILURE;
+    }
+    RCLCPP_INFO(get_logger(), "Configured Hand-E Gripper");
     return HWI::CallbackReturn::SUCCESS;
 }