implementing queueing

cflib_groundstation/groundstation_socket.py

+from queue import Queue
 import socket
 import os
 import collections
@@ -8,7 +9,7 @@ socket_path = './cflib_groundstation.socket'
 
 class GroundstationSocket():
     metadata = collections.namedtuple("metadata", ["msg_type", "msg_id", "data_len"])
-    def groundstation_connect(self):
+    def groundstation_connect(self, inputQueue: Queue):
         # remove the socket file if it already exists
         try:
             os.unlink(socket_path)
@@ -45,8 +46,9 @@ class GroundstationSocket():
                     print("There was an error decoding the packet")
                     break
 
-                #TODO: Add the message to the main function queue, which will
+                #Add the message to the main function queue, which will
                 #which will send the appropriate command to the quad.
+                inputQueue.put(message)
         finally:
             # close the connection
             self.connection.close()
@@ -149,7 +151,6 @@ class MessageTypeID(Enum):
     SEND_RT_ID = 20
     MAX_TYPE_ID = 21
 
-if __name__ == '__main__':
-    GroundstationSocket().groundstation_connect()
+
 
 

cflib_groundstation/main.py

-
+from email import message
+from queue import Queue
+from threading import Thread
+from groundstation_socket import GroundstationSocket
+from crazyflie_connection import CrazyflieConnection
 
 
 class main():
-    print("main")
+    def __init__(self) -> None:
\ No newline at end of file
+        self.inputQueue = Queue()
+        self.outputQueue = Queue()
+        
+
+
+    def processCommands(self):
+        gs = GroundstationSocket()
+        self.inThread = Thread(target = gs.groundstation_connect, args = (self.inputQueue,))
+        self.inThread.start()
+        while True:
+            if self.inputQueue.not_empty:
+                command = self.inputQueue.get()
+                print(command)
+                msg_type = command["msg_type"]
+                print(msg_type)
+                
+
+                
+
+
+
+if __name__ == '__main__':
+    main().processCommands()
+    
+    
\ No newline at end of file