diff --git a/src/bio_pkg/bio_pkg/bio_node.py b/src/bio_pkg/bio_pkg/bio_node.py
index 2f5d580..8785d3a 100644
--- a/src/bio_pkg/bio_pkg/bio_node.py
+++ b/src/bio_pkg/bio_pkg/bio_node.py
@@ -138,8 +138,8 @@ class SerialRelay(Node):
             self.send_cmd(command)
         # Servos, only send if not zero
         if msg.servo_id != 0:
-            command = "can_relay_tovic,citadel,25," + str(msg.servo_id) + "," + str(msg.servo_position) + "\n"
-            self.send_cmd(command)        
+            command = "can_relay_tovic,citadel,25," + str(msg.servo_id) + "," + str(int(msg.servo_state)) + "\n"
+            self.send_cmd(command)
         
 
         # LSS (SCYTHE)
diff --git a/src/ros2_interfaces_pkg b/src/ros2_interfaces_pkg
index 021dd0c..aec2208 160000
--- a/src/ros2_interfaces_pkg
+++ b/src/ros2_interfaces_pkg
@@ -1 +1 @@
-Subproject commit 021dd0c3dd0bdbad0e653388fa6c73188257dd9b
+Subproject commit aec22081e3deb6f7092bb79393ecb234193a75ab