diff --git a/src/modelec/src/arm_controller.cpp b/src/modelec/src/arm_controller.cpp index 9e5d221..8ebabcc 100644 --- a/src/modelec/src/arm_controller.cpp +++ b/src/modelec/src/arm_controller.cpp @@ -32,10 +32,11 @@ namespace Modelec { subscription_ = this->create_subscription( "arm_control", 10, [this](const modelec_interface::msg::ServoMode::SharedPtr msg) { - // control the message + RCLCPP_INFO(this->get_logger(), "Received message"); if (msg->is_arm) { ControlArm(msg); } else if (pince_pins.find(msg->pin) != pince_pins.end()) { + RCLCPP_INFO(this->get_logger(), "Control pince"); ControlPince(msg); } });