From 7aa6b9eecf66111e99bcb14469757a48ec6aaab8 Mon Sep 17 00:00:00 2001 From: Pierre Minssen <pierre.minssen@supelec.fr> Date: Wed, 28 Nov 2018 17:57:15 +0100 Subject: [PATCH] Add new file --- cam_poo.py | 26 ++++++++++++++++++++++++++ 1 file changed, 26 insertions(+) create mode 100644 cam_poo.py diff --git a/cam_poo.py b/cam_poo.py new file mode 100644 index 0000000..183da17 --- /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 + -- GitLab