Ajout de la fonction de détection de carte
This commit is contained in:
parent
2d6339e294
commit
f1a4a5c7cd
40
IdentificationCartes.py
Normal file
40
IdentificationCartes.py
Normal file
@ -0,0 +1,40 @@
|
|||||||
|
import serial
|
||||||
|
from time import sleep
|
||||||
|
from LectureReception import lire_message
|
||||||
|
|
||||||
|
|
||||||
|
def ping(ser: serial.Serial):
|
||||||
|
# lecture de 1 octet à l'adresse 0.
|
||||||
|
if ser.in_waiting:
|
||||||
|
ser.read(ser.in_waiting) # On vide le tampon
|
||||||
|
|
||||||
|
# On teste la carte actionneur
|
||||||
|
ser.write(b'?')
|
||||||
|
sleep(0.01)
|
||||||
|
if ser.in_waiting:
|
||||||
|
message = ser.read(ser.in_waiting) # On vide le tampon
|
||||||
|
if(message[0] == b'A'[0]):
|
||||||
|
print("Carte Actionneur")
|
||||||
|
else:
|
||||||
|
print("Carte inconue : " + str(message))
|
||||||
|
return
|
||||||
|
|
||||||
|
# On teste les cartes au protocole "com_v2" (détection, propulsion)
|
||||||
|
ser.write(b'\xFF\xFF\x05dD\x00\x01\x00')
|
||||||
|
sleep(0.01)
|
||||||
|
messages, tmp = lire_message(ser, b'')
|
||||||
|
if messages is not []:
|
||||||
|
if messages[0][0] == b'D'[0]:
|
||||||
|
print("Carte de détection")
|
||||||
|
return
|
||||||
|
if messages[0][0] == b'P'[0]:
|
||||||
|
print("Carte de propulsion")
|
||||||
|
return
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
if __name__ == "__main__":
|
||||||
|
ser = serial.Serial('/dev/ttyACM0' , 115200)
|
||||||
|
while(1):
|
||||||
|
ping(ser)
|
||||||
|
sleep(1)
|
||||||
Loading…
Reference in New Issue
Block a user