toid_interaction/package.xml

@@ -14,6 +14,7 @@
 
   <depend>python3-serial</depend>
   <depend>python3-gpiozero</depend>
+  <depend>toid_msgs</depend>
 
   <export>
     <build_type>ament_python</build_type>

toid_interaction/toid_interaction/interaction_node.py

@@ -1,4 +1,6 @@
 import rclpy
+import rclpy.callback_groups
+import rclpy.executors
 from rclpy.node import Node
 from std_srvs.srv import Empty
 
@@ -14,7 +16,6 @@ from toid_msgs.srv import SendString
 
 from rclpy.action.server import ServerGoalHandle
 from rclpy.action.server import ActionServer
-import asyncio
 
 
 class InteracitionNode(Node):
@@ -41,8 +42,10 @@ class InteracitionNode(Node):
         self.output_pin_ = OutputDevice(27)
 
         self.start_pin_action_ = ActionServer(
-            self, EmptyAction, "/start_plug", execute_callback=self.start_plug_action_cb
+            self, EmptyAction, "/start_plug", execute_callback=self.start_plug_action_cb,
+            callback_group=rclpy.callback_groups.ReentrantCallbackGroup()
         )
+
         self.get_logger().info("Action 'start_plug' ready.")
 
 
@@ -93,9 +96,9 @@ class InteracitionNode(Node):
 
     async def start_plug_action_cb(self, goal_handle: ServerGoalHandle):
         while not self.btn_.is_active:
-            await asyncio.sleep(0.1)
+            pass
         while self.btn_.is_active:
-            await asyncio.sleep(0.1)
+            pass
         goal_handle.succeed()
         return EmptyAction.Result()
 
@@ -104,8 +107,7 @@ def main(args=None):
     rclpy.init(args=args)
 
     node = InteracitionNode()
-    rclpy.spin(node)
-
+    rclpy.executors.MultiThreadedExecutor().spin(node)
     rclpy.shutdown()