Add new file

cam_poo.py

+class Camera:
+    def __init__(self, seq_num : hex):
+        self.seq_num = seq_num      #erreur du capteur UWB (p pour précision...)
+        self.VV = 09
+        self.WW = 09
+
+    def abs2payload(self, LYZ: list ) -> list #L[0]="YYYY" L[1]="ZZZZ"
+        payload = "81010602" #Absolute postition
+        payload = payload + self.VV + self.WW #add move speed
+            for i in L: #add position
+                for j in i:
+                    payload = payload + "0" + j
+            payload = payload + "FF" #end byte
+            payloadtype = "0100"
+                    # nouvelle coordonnée réelle après itération
+        return [payloadtype, payload]
+
+    def payload2message(self, payloadL : list) -> hex
+        payloadtype = payload[0]
+        payload = payloadL[1]
+        payloadlenght = "0F" # a coder
+        header = payloadtype + payloadlenght
+        header = header + ('0'*(8-len(str(seq_num)))+str(seq_num))
+        message = header + payload
+        return message
+