diff --git a/cam_poo.py b/cam_poo.py new file mode 100644 index 0000000000000000000000000000000000000000..183da17c807e1d22406e33635e1efe6564ba3ead --- /dev/null +++ b/cam_poo.py @@ -0,0 +1,26 @@ +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 +