mirror of
https://forge.apps.education.fr/blender-edutech/jumeaux-numeriques.git
synced 2024-01-27 06:56:18 +01:00
102 lines
4.3 KiB
Python
102 lines
4.3 KiB
Python
from porcou_lib import * # Bibliothèque utilisateur du portail coulissant
|
|
|
|
###############################################################################
|
|
# porcou_cmd.py
|
|
# @title: Commandes du portail coulissant
|
|
###############################################################################
|
|
|
|
###############################################################################
|
|
# Instructions élémentaires pour le portail coulissant
|
|
#
|
|
# Actions (ordre = True ou False) :
|
|
# - Gyrophare : gyr(True | False)
|
|
# - Ouvrir le portail (moteur sens trigo) : mot_o(True | False)
|
|
# - Fermer le portail (moteur sens horaire) : mot_f(True | False)
|
|
# - Emetteur pour le capteur barrage IR : ir_emet(True | False)
|
|
#
|
|
# Capteurs (valeur retournée = True ou False) :
|
|
# - Capteur fin de course portail ouvert : fdc_o()
|
|
# - Capteur fin de course portail fermé : fdc_f()
|
|
# - Capteur barrage IR (absence d'obstacle) : ir_recep()
|
|
#
|
|
# Consignes du pupitre (valeur retournée = True ou False) :
|
|
# - Bouton poussoir coté rue : bp_ext()
|
|
# - Bouton poussoir coté cour : bp_int()
|
|
#
|
|
# Gestion du temps :
|
|
# - Temporisation en seconde : tempo(duree)
|
|
#
|
|
###############################################################################
|
|
|
|
# Brochage du portail coulissant
|
|
brochage={}
|
|
|
|
###############################################################################
|
|
# Fonctions
|
|
###############################################################################
|
|
|
|
###############################################################################
|
|
# Commandes
|
|
###############################################################################
|
|
|
|
def commandes():
|
|
|
|
# Init -> Ouverture
|
|
while fdc_o() ==False :
|
|
gyr(True)
|
|
mot_f(False)
|
|
mot_o(True)
|
|
mot_o(False)
|
|
gyr(False)
|
|
|
|
# Fermeture
|
|
mot_digitset (10) # 1,3 rad/s par défaut
|
|
|
|
tf_d,xf_d, af_d= get('t'), get('portail_x'), get('mot_angle')
|
|
print ("Début fermeture : portail_x : "+str(round(get('portail_x'),3)) + " - mot_angle : " + str(round(get('mot_angle'),3)))
|
|
while fdc_f() ==False :
|
|
gyr(True)
|
|
mot_o(False)
|
|
mot_f(True)
|
|
mot_pas, mot_vitesse, portail_pas, portail_vitesse= get('mot_pas'), get('mot_vitesse'), get('portail_pas'), get('portail_vitesse')
|
|
mot_f(False)
|
|
gyr(False)
|
|
|
|
mot_digitset () # 1,3 rad/s par défaut
|
|
print ("Fin fermeture : portail_x : "+str(round(get('portail_x'),3)) + " - mot_angle : " + str(round(get('mot_angle'),3)))
|
|
tf_f,xf_f, af_f= get('t'), get('portail_x'), get('mot_angle')
|
|
print ("")
|
|
print ("Fermeture : "+str(round(tf_f-tf_d,3)) +" s - distance : " +str(round(xf_f-xf_d,3))+" mm - angle : " +str(round(af_f-af_d,3))+
|
|
" rad - portail_vitesse : " +str(round(portail_vitesse,3))+" mm/s - moteur_vitesse : " +str(round(mot_vitesse,3))+
|
|
" rad/s - portail_pas : " +str(round(portail_pas,3))+" mm/impulsion - moteur_pas : " +str(round(mot_pas,3))+" rad/impulsion")
|
|
|
|
# Ouverture
|
|
print ("")
|
|
to_d,xo_d, ao_d= get('t'), get('portail_x'), get('mot_angle')
|
|
print ("Début ouverture : portail_x : "+str(round(get('portail_x'),3)) + " - mot_angle : " + str(round(get('mot_angle'),3)))
|
|
while fdc_o() ==False :
|
|
gyr(True)
|
|
mot_f(False)
|
|
mot_o(True)
|
|
mot_pas, mot_vitesse, portail_pas, portail_vitesse= get('mot_pas'), get('mot_vitesse'), get('portail_pas'), get('portail_vitesse')
|
|
mot_o(False)
|
|
gyr(False)
|
|
print ("Fin ouverture : portail_x : "+str(round(get('portail_x'),3)) + " - mot_angle : " + str(round(get('mot_angle'),3)))
|
|
to_f,xo_f, ao_f= get('t'), get('portail_x'), get('mot_angle')
|
|
print ("")
|
|
print ("Ouverture : "+str(round(to_f-to_d,3)) +" s - distance : " +str(round(xo_f-xo_d,3))+" mm - angle : " +str(round(ao_f-ao_d,3))+
|
|
" rad - portail_vitesse : " +str(round(portail_vitesse,3))+" mm/s - moteur_vitesse : " +str(round(mot_vitesse,3))+
|
|
" rad/s - portail_pas : " +str(round(portail_pas,3))+" mm/impulsion - moteur_pas : " +str(round(mot_pas,3))+" rad/impulsion")
|
|
|
|
fin() # A garder
|
|
|
|
###############################################################################
|
|
# En: External call << DONT CHANGE THIS SECTION >>
|
|
# Fr: Appel externe << NE PAS MODIFIER CETTE SECTION >>
|
|
###############################################################################
|
|
|
|
if __name__=='start':
|
|
thread_cmd_start(commandes)
|
|
if __name__=='stop':
|
|
stop()
|