add logs of which setpoint is being sent

This commit is contained in:
Sem van der Hoeven
2023-05-15 11:02:30 +02:00
parent d50758cb73
commit fa4af5b39f

View File

@@ -343,12 +343,12 @@ private:
} }
if (current_control_mode == CONTROL_MODE_VELOCITY) if (current_control_mode == CONTROL_MODE_VELOCITY)
{ {
// RCLCPP_INFO(this->get_logger(), "Sending velocity setpoint"); RCLCPP_INFO(this->get_logger(), "Sending velocity setpoint");
send_velocity_setpoint(); send_velocity_setpoint();
} }
else if (current_control_mode == CONTROL_MODE_POSITION) else if (current_control_mode == CONTROL_MODE_POSITION)
{ {
// RCLCPP_INFO(this->get_logger(), "Sending position setpoint"); RCLCPP_INFO(this->get_logger(), "Sending position setpoint");
send_position_setpoint(); send_position_setpoint();
} }
new_setpoint = false; new_setpoint = false;