diff --git a/joy2twist/src/joy2twist_node.cpp b/joy2twist/src/joy2twist_node.cpp index 8525fd2..cf94c99 100644 --- a/joy2twist/src/joy2twist_node.cpp +++ b/joy2twist/src/joy2twist_node.cpp @@ -85,7 +85,8 @@ void Joy2TwistNode::joy_cb(const MsgJoy::SharedPtr joy_msg) if (e_stop_present_) { if (joy_msg->buttons.at(button_index_.e_stop_trigger) && !e_stop_state_) { - twist_pub_->publish(twist_msg); // stop the robot before trying to call e-stop trigger service + // Stop the robot before trying to call the e-stop trigger service + twist_pub_->publish(twist_msg); call_trigger_service(e_stop_trigger_client_); } else if ( joy_msg->buttons.at(button_index_.enable_e_stop_reset) &&