Trajectoire droite fonctionnelle
This commit is contained in:
commit
cfed6d27b9
30
Messagerie.py
Normal file
30
Messagerie.py
Normal file
@ -0,0 +1,30 @@
|
||||
import struct
|
||||
import serial
|
||||
from time import sleep
|
||||
|
||||
|
||||
def send_msg(message : bytes):
|
||||
message_binaire = struct.pack('BBB{}sB'.format(message.__len__()), 0xFF, 0xFF, message.__len__() + 1, message, 0x00)
|
||||
print(message_binaire)
|
||||
ser.write(message_binaire)
|
||||
|
||||
def msg_envoi_donnees(carte_id: bytes, registre : int, charge_utile : bytes):
|
||||
send_msg(struct.pack('ccBB{}s'.format(charge_utile.__len__()), b'r', carte_id, registre, charge_utile.__len__(), charge_utile))
|
||||
|
||||
def led_on():
|
||||
msg_envoi_donnees(b'D', 0x00, b'\x06')
|
||||
|
||||
def led_off():
|
||||
msg_envoi_donnees(b'D', 0x00, b'\x36')
|
||||
|
||||
if __name__ == "__main__":
|
||||
ser = serial.Serial('/dev/ttyACM0' , 115200)
|
||||
traj = struct.pack('bffff', 0, 0.0, 0.0, 100. , 0.)
|
||||
msg_envoi_donnees(b'P', 0x22, traj)
|
||||
|
||||
while True:
|
||||
|
||||
led_off()
|
||||
sleep(0.5)
|
||||
led_on()
|
||||
sleep(0.5)
|
||||
Loading…
Reference in New Issue
Block a user