mirror of
https://forge.apps.education.fr/blender-edutech/jumeaux-numeriques.git
synced 2024-01-27 06:56:18 +01:00
134 lines
4.7 KiB
Python
134 lines
4.7 KiB
Python
from montchg_lib import * # Bibliothèque utilisateur du monte-charge
|
|
|
|
###############################################################################
|
|
# montchg_cmd.py
|
|
# @title: Commandes du monte-charge
|
|
###############################################################################
|
|
|
|
###############################################################################
|
|
# Instructions élémentaires pour le monte-charge
|
|
#
|
|
# Actions (ordre = True ou False) :
|
|
# - Monter le monte-charge (moteur sens trigo) : mot_m(True | False)
|
|
# - Descendre le monte-charge (moteur sens horaire) : mot_d(True | False)
|
|
# - Définir la vitesse du moteur jumeau numérique : mot_vitesse (vitesse) , vitesse en rad / s, si vitesse est omis la valeur par défaut est 125.6 rad /s ( 20 tr / s ))
|
|
# - Définir la vitesse du moteur jumeau réel : mot_vitesse_r (vitesse) , vitesse de 0 à 255, la valeur par défaut est 255 (uniquement sur la maquette Grove)
|
|
#
|
|
# Capteurs (valeur retournée = True ou False) :
|
|
# - Capteur présence cabine niveau 0 : pc_0()
|
|
# - Capteur présence cabine niveau 1 : pc_1()
|
|
#
|
|
# Consignes du pupitre (valeur retournée = True ou False) :
|
|
# - Bouton poussoir appel niveau 0 : ba_0()
|
|
# - Bouton poussoir appel niveau 1 : ba_1()
|
|
#
|
|
# Retours d'information du pupitre (allumer = True ou False) :
|
|
# - Voyant témoin d'étage niveau 0 : voy_0(True | False)
|
|
# - Voyant témoin d'étage niveau 1 : voy_1(True | False)
|
|
#
|
|
# Gestion du temps :
|
|
# - Temporisation en seconde : tempo(duree)
|
|
# - Réinitialisation de la valeur du temp (t) : reset_t()
|
|
#
|
|
# Acquisition de données :
|
|
# - Retourne la valeur de la variable à l'instant : get(variable)
|
|
# - Lancer l'enregistrement : daq([variable1, variable2, ... ])
|
|
# - Afficher les graphiques : plot([variable1, variable2, ... ])
|
|
#
|
|
# Jumelage :
|
|
# - Démarrer le jumelage : jumeau({brochage})
|
|
# - Arrêter le jumelage : jumeau_stop({brochage})
|
|
# - Définir les règles d'activation : jumeau_mode({brochage})
|
|
#
|
|
###############################################################################
|
|
|
|
# Brochage du monte-charge (Grove)
|
|
brochage={
|
|
'pc_0' : ['d',7,'i'], 'pc_1' : ['d',8,'i'],
|
|
'ba_0' : ['a',0,'i'], 'ba_1' : ['a',1,'i'],
|
|
'voy_0' : ['d',5,'o'], 'voy_1' : ['d',6,'o'],
|
|
'mot_v' : ['d',3,'p'], 'mot_s' : ['d',4,'o']}
|
|
|
|
###############################################################################
|
|
# Fonctions
|
|
###############################################################################
|
|
|
|
###############################################################################
|
|
# Commandes
|
|
###############################################################################
|
|
|
|
def commandes():
|
|
|
|
# daq(['mot_angle', 'mot_vitesse', 'cabine_z', 'cabine_vitesse'])
|
|
# plot(['mot_angle', 'mot_vitesse'])
|
|
jumeau(brochage)
|
|
jumeau_mode(True, True, True, True)
|
|
|
|
# Mise en place : Aller au niveau 0
|
|
print ("Monte-charge sans la mémorisation des appels")
|
|
print ("Mise en place : Aller au niveau 0 ...")
|
|
while pc_0() ==False:
|
|
mot_m(False)
|
|
mot_d(True)
|
|
tempo(0.1)
|
|
mot_d(False)
|
|
print ("Mise en place : Aller au niveau 0 : Ok")
|
|
|
|
# Fonctionnement normal
|
|
print ("Attente")
|
|
while True:
|
|
|
|
# Aller au niveau 0
|
|
if ba_0() and pc_0() ==False:
|
|
print ("Déplacement pour le niveau 0 ...")
|
|
voy_0(True)
|
|
while pc_0() ==False:
|
|
mot_m(False)
|
|
mot_d(True)
|
|
tempo(0.1)
|
|
mot_d(False)
|
|
tempo(2) # Temporisation 2s
|
|
voy_0(False)
|
|
print ("Déplacement pour le niveau 0 : Ok")
|
|
print ("Attente")
|
|
|
|
# Aller au niveau 1
|
|
if ba_1() and pc_1() ==False:
|
|
print ("Déplacement pour le niveau 1 ...")
|
|
voy_1(True)
|
|
while pc_1() ==False:
|
|
mot_d(False)
|
|
mot_m(True)
|
|
tempo(0.1)
|
|
mot_m(False)
|
|
tempo(2) # Temporisation 2s
|
|
voy_1(False)
|
|
print ("Déplacement pour le niveau 1 : Ok")
|
|
print ("Attente")
|
|
|
|
tempo(0.1)
|
|
|
|
|
|
###############################################################################
|
|
# En: External call << DONT CHANGE THIS SECTION >>
|
|
# Fr: Appel externe << NE PAS MODIFIER CETTE SECTION >>
|
|
###############################################################################
|
|
|
|
###
|
|
# Variante 1 : Maquette Grove
|
|
# - Maquette Grove : la carte moteur est le shield moteur Arduino CC 4 x 1,2 A DRI0039 (DFROBOT)
|
|
# Variante 2 : Maquette AutoProg
|
|
# - Maquette AutoProg (A4 Technologie) : la carte moteur est le module AutoProg K-AP-MMOT-KIT
|
|
###
|
|
|
|
def cycle():
|
|
commandes()
|
|
fin()
|
|
|
|
if __name__=='start':
|
|
start(cycle)
|
|
if __name__=='stop':
|
|
stop()
|
|
if __name__=='init':
|
|
variant(1) # Variante maquette Grove
|