import bge # Bibliothèque Blender Game Engine (UPBGE) import twin_threading # Multithreading (multitâches) from twin_serial import jumeau, jumeau_stop, serial_close, jumeau_mode_system, jumeau_mode_object # Liaison série from twin_daq import get, daq, csv_generate, plot, plot_generate # Acquisition des données import time ############################################################################### # volrou_lib.py # @title: Bibliothèque utilisateur du volet roulant # @project: Blender-EduTech # @lang: fr # @authors: Philippe Roy # @copyright: Copyright (C) 2022-2024 Philippe Roy # @license: GNU GPL ############################################################################### # Récupérer la scène UPBGE scene = bge.logic.getCurrentScene() # UPBGE constants JUST_ACTIVATED = bge.logic.KX_INPUT_JUST_ACTIVATED JUST_RELEASED = bge.logic.KX_INPUT_JUST_RELEASED ACTIVATE = bge.logic.KX_INPUT_ACTIVE # JUST_DEACTIVATED = bge.logic.KX_SENSOR_JUST_DEACTIVATED # Threads de commandes threads_cmd=[] # Threads de visualisation de données threads_plot=[] ############################################################################### # Voyant ############################################################################### # Ordre pour allumer le voyant témoin mode automatique def voy_auto (order): scene.objects['Led auto']['activated']=order ############################################################################### # Actionneurs ############################################################################### # Ordre pour le moteur pour monter le volet def mot_m (order): scene.objects['Moteur']['up']=order # Ordre pour le moteur pour descendre le volet def mot_d (order): scene.objects['Moteur']['down']=order # Réglage de la vitesse du moteur numérique def mot_vitesse (speed=125.6): scene.objects['Moteur']['speed_setting']=speed # Vitesse du moteur numérique : 125.6 rad /s ( 20 tr / s ) # Réglage de la vitesse du moteur réel (de 0 à 255, uniquement sur la maquette Grove) # Valeur par défaut est 255 def mot_vitesse_r (speed=255): scene.objects['Moteur']['speed_real_setting']=speed ############################################################################### # Capteurs # Priorité à l'activation (binaire) ou la valeur la plus grande (numérique) ############################################################################### # Compte-rendu du capteur fin de course volet en haut def fdc_h (): if scene.objects['Microrupteur haut']['activated'] or scene.objects['Microrupteur haut']['activated_real']: return True return False # Compte-rendu du capteur fin de course volet en bas def fdc_b(): if scene.objects['Microrupteur bas']['activated'] or scene.objects['Microrupteur bas']['activated_real']: return True return False # Compte-rendu du capteur de luminosité def lum(): if scene.objects['Recepteur LDR']['value'] > scene.objects['Recepteur LDR']['value_real']: return (scene.objects['Recepteur LDR']['value']) return (scene.objects['Recepteur LDR']['value_real']) ############################################################################### # Boutons poussoirs ############################################################################### # Compte-rendu du bouton monter volet def bp_m (): if scene.objects['Bp monter']['activated'] or scene.objects['Bp monter']['activated_real']: return True return False # Compte-rendu du bouton arrêt volet def bp_a (): if scene.objects['Bp arret']['activated'] or scene.objects['Bp arret']['activated_real']: return True return False # Compte-rendu du bouton descendre volet def bp_d (): if scene.objects['Bp descendre']['activated'] or scene.objects['Bp descendre']['activated_real']: return True return False # Compte-rendu du bouton poussoir mode automatique def bp_auto (): if scene.objects['Bp auto']['activated'] or scene.objects['Bp auto']['activated_real']: return True return False # Compte-rendu du bouton à glissière mode automatique def bg_auto (): if scene.objects['Bg auto']['activated'] or scene.objects['Bg auto']['activated_real']: return True return False ############################################################################### # Jumelage ############################################################################### # Mode de jumelage (règles d'activation) def jumeau_mode (input_real=True, input_digital=True, output_real=True, output_digital=True): input_objs = ['Bp monter', 'Bp arret', 'Bp descendre', 'Bp auto', 'Bg auto', 'Microrupteur haut', 'Microrupteur bas', 'Recepteur LDR'] output_objs = ['Moteur', 'Led auto'] jumeau_mode_system (input_objs, output_objs, input_real, input_digital, output_real, output_digital) ############################################################################### # Cycle ############################################################################### ## # Temporisation ## def tempo (duree): time.sleep(duree) ## # t (temps) ## def get_t (): # return truncate(scene.objects['System']['time'], 3) return round(scene.objects['System']['time'], 3) def set_t (date): scene.objects['System']['time']=date def reset_t (): scene.objects['System']['time']=0 ## # Départ ## def start(fct): twin_threading.start(threads_cmd, "commands", fct) ## # Variante # # Variante 0 : valeur par défaut : boutons 'bp_auto' et 'bg_auto' absents -> il faut donc définir obligatoirement la variante. # Variante 1 : Maquette Grove + bouton auto à glissière : # - Maquette Grove : la carte moteur est le shield moteur Arduino CC 4 x 1,2 A DRI0039 (DFROBOT) # - Le mode automatique s'active et se désactive avec le bouton à glissière bg_auto # Variante 2 : Maquette Grove + bouton auto poussoir : # - Maquette Grove : la carte moteur est le shield moteur Arduino CC 4 x 1,2 A DRI0039 (DFROBOT) # - Le mode automatique s'active avec le bouton poussoir bp_auto et se désactive avec l'appui sur bp_m, bp_a ou bp_d. # Variante 3 : Maquette AutoProg + bouton auto poussoir : # - Maquette AutoProg (A4 Technologie) : la carte moteur est le module AutoProg K-AP-MMOT-KIT # - Le mode automatique s'active avec le bouton poussoir bp_auto et se désactive avec l'appui sur bp_m, bp_a ou bp_d. # # La variante 3 correspond à la maquette de 4A technologie. # # Configuration des variantes du modèle 3D -> variant_dict : # 'nom de l'objet 3D' : liste des variantes où l'objet est présent. # Les objets hors dictionnaire sont présent quelque soit la variante sélectionnée. ## def variant(variant_num): var_txt = [ "variante 1 : maquette Grove + bouton auto à glissière", "variante 2 : maquette Grove + bouton auto poussoir", "variante 3 : maquette AutoProg + bouton auto poussoir"] if variant_num != scene.objects['System']['variant']: print ("Variante de la maquette numérique et réelle :", var_txt[variant_num-1]) scene.objects['System']['variant']=variant_num # Affichage des éléments spécifiques de la variante variant_dict = {'Bg auto':[1], 'Bg auto-on':[1], 'Bp auto':[2,3]} variant_list = list(variant_dict) for name in variant_list: if variant_num in variant_dict[name]: scene.objects[name].setVisible(True,True) scene.objects[name].restorePhysics() else: scene.objects[name].setVisible(False,True) scene.objects[name].suspendPhysics() ## # Arrêt ## def stop(): # Jumeau if scene.objects['System']['twins']: serial_close(scene.objects['System']['board']) time.sleep(1) # Suivi de données if scene.objects['System']['daq']: csv_generate() if scene.objects['System']['plot']: plot_generate(threads_plot) # Thread twin_threading.stop(threads_cmd, "commands") ## # Fin naturelle ## def end(): fin() def fin(): if scene.objects['System']['debug_thread']: print ("Thread commands is arrived.") time.sleep(0.125) scene.objects['System']['thread_cmd']=False time.sleep(0.125)