ropy/twins/rp_maqueen-relay.py

111 lines
3.4 KiB
Python

from microbit import uart, sleep
from microbit import *
import radio
###############################################################################
# rp_twins_maqueen-relay.py
# @title: Jumeau Maqueen : Programme de la carte microbit du relai
# @project: Ropy (Blender-EduTech)
# @lang: fr
# @authors: Philippe Roy <philippe.roy@ac-grenoble.fr>
# @copyright: Copyright (C) 2022 Philippe Roy
# @license: GNU GPL
###############################################################################
###############################################################################
# Initialisation
###############################################################################
attente_image = Image("00000:00000:00300:00000:00000")
display.show(attente_image) # Témoin de fonctionnement
balise_image = Image("00300:03630:36963:03630:00300")
radio.config(group=1, queue=4, length=8)
radio.on()
uart.init(baudrate= 115200) # Initialisation du port série
###############################################################################
# Écoute du port série en relayage vers la radio
###############################################################################
temps_avancer=20
temps_tourner=20
temps_marquer=20
temps_forer=40
temps_colision=40
while True:
while not uart.any(): # Attente d'un message
pass
display.show(' ') # Sinon bug ?
msg = uart.readline()
# Avancer : AV
if msg[0] ==65 and msg[1] ==86 : # Code ASCII : 65 (A) puis 86 (V)
display.show(Image.ARROW_N)
radio.send("AV")
sleep(temps_avancer)
radio.send("ST")
# Reculer : RE
if msg[0] ==82 and msg[1] ==69 : # Code ASCII : 82 (R) puis 69 (E)
display.show(Image.ARROW_S)
radio.send("RE")
sleep(temps_avancer)
radio.send("ST")
# Gauche : GA
if msg[0] ==71 and msg[1] ==65 : # Code ASCII : 71 (G) puis 65 (A)
display.show(Image.ARROW_W)
radio.send("GA")
sleep(temps_tourner)
radio.send("ST")
# Droite : DR
if msg[0] ==68 and msg[1] ==69 : # Code ASCII : 82 (D) puis 82 (R)
display.show(Image.ARROW_E)
radio.send("DR")
sleep(temps_tourner)
radio.send("ST")
# Marquer : MA
if msg[0] ==77 and msg[1] ==65 : # Code ASCII : 77 (M) puis 65 (A)
display.show(balise_image)
sleep(temps_marquer)
# Forer : FO
if msg[0] ==70 and msg[1] ==79 : # Code ASCII : 70 (F) puis 79 (O)
display.show(Image.DIAMOND)
sleep(temps_forer)
# Colision : CO
if msg[0] ==67 and msg[1] ==79 : # Code ASCII : 67 (C) puis 79 (O)
display.show(Image.SKULL)
sleep(temps_colision)
# Configuration : CF
if msg[0] ==67 and msg[1] ==70 : # Code ASCII : 67 (C) puis 70 (F)
display.scroll ("CF")
radio.send("CF")
# Boucle d'écoute spécifique à la configuration
while True:
while not uart.any(): # Attente d'un message
pass
display.show(' ')
msg = uart.readline()
if msg[0] ==70 and msg[1] ==67 : # Code ASCII : 70 (F) puis 67 (C) -> sortie de la configuration
break
# display.scroll (msg[:-1])
radio.send(str(msg[:-1]))
# display.scroll ("FC")
radio.send("FC")
# Fin : FI
if msg[0] ==70 and msg[1] ==73 : # Code ASCII : 70 (F) puis 73 (I)
display.show(attente_image) # Témoin de fonctionnement
sleep(400)