jumeaux-numeriques/volet_roulant/volrou_lib.py

215 lines
6.9 KiB
Python

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 <philippe.roy@ac-grenoble.fr>
# @copyright: Copyright (C) 2022-2023 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 )
###############################################################################
# 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 1 : 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 2 : Le mode automatique s'active et se désactive avec le bouton à glissière bg_auto.
#
# La variante 1 correspond à la maquette réelle 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.
# Par défaut les objets sont présents quelque soit la variante sélectionnée.
##
def variant(variant_num):
if variant_num != scene.objects['System']['variant']:
print ("Variante de la maquette numérique:", variant_num)
scene.objects['System']['variant']=variant_num
variant_dict = {'Bp auto':[1], 'Bg auto':[2], 'Bg auto-on':[2]}
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)