Lecture Fonctionnnelle de la carte de réception
This commit is contained in:
parent
9c17953485
commit
2d6339e294
@ -6,12 +6,16 @@ from time import time
|
||||
|
||||
ser = serial.Serial('/dev/ttyACM0' , 115200)
|
||||
|
||||
def ping(ser):
|
||||
# lecture de 1 octet à l'adresse 0.
|
||||
ser.write(b'\xFF\xFF\x05dD\x00\x01\x00')
|
||||
pass
|
||||
|
||||
def lecture_Detection(ser):
|
||||
ser.write(b'\xFF\xFF\x05dP\x00\x0C\x00')
|
||||
ser.write(b'\xFF\xFF\x05dD\x00\x0C\x00')
|
||||
messages, tmp = lire_message(ser, b'')
|
||||
for message in messages:
|
||||
print("{:.3f} {}".format(time(), message[1]))
|
||||
print("{:.3f} {} {} {} {} {} {}".format(time(), message[2], message[3], message[4], message[5], message[6], message[7]))
|
||||
|
||||
def check_message(message, offset):
|
||||
offset = offset + 3 # on saut '\xFF\xFF + id'
|
||||
@ -19,9 +23,13 @@ def check_message(message, offset):
|
||||
taille_message = message[0+offset]
|
||||
if(len(message) > taille_message + offset):
|
||||
if(message[taille_message+offset] == 0):
|
||||
return message[0+offset:taille_message+offset]
|
||||
return message[offset-1:taille_message+offset]
|
||||
return None
|
||||
|
||||
# Renvoi les message lus.
|
||||
# Les deux octets de début \xFF \xFF ne sont pas contenu dans le message
|
||||
# octet 0 : id_carte émettrice
|
||||
# octet 1 : Nombre d'octets reçus
|
||||
def lire_message(ser, old_data):
|
||||
data = old_data
|
||||
nb_read = ser.in_waiting
|
||||
@ -46,7 +54,7 @@ if __name__ == "__main__":
|
||||
data = b''
|
||||
while 1:
|
||||
lecture_Detection(ser)
|
||||
sleep(0.001)
|
||||
sleep(0.01)
|
||||
|
||||
while(1):
|
||||
messages, data = lire_message(ser, data)
|
||||
|
||||
Loading…
Reference in New Issue
Block a user