import os, sys, io
import M5
from M5 import *
import m5ui
import lvgl as lv
from unit import LightUnit
import time

# --- DÉCLARATION DES VARIABLES ---
page0 = None
label0 = None
label1 = None
light_0 = None
obstacle_present = None
seuil = None
lecture = None

# Configuration des séries
nb_series_visees = 1
mesures_par_serie = 5

compteur_passages = 0
temps_precedent = 0
compteur_absolu = 0

fichier_csv = None


def setup():
    global page0, label0, label1, light_0, fichier_csv, seuil, obstacle_present

    M5.begin()
    Widgets.setRotation(1)
    m5ui.init()
    obstacle_present = False
    seuil = 50000

    # Interface graphique
    page0 = m5ui.M5Page(bg_c=0x222222) 
    label0 = m5ui.M5Label("Initialisation...", x=20, y=68, text_c=0xffffff, bg_c=0x222222, bg_opa=0, font=lv.font_montserrat_14, parent=page0)
    label1 = m5ui.M5Label("T = --- s", x=20, y=153, text_c=0xffffff, bg_c=0x222222, bg_opa=0, font=lv.font_montserrat_14, parent=page0)

    light_0 = LightUnit((33, 32))
    page0.screen_load()

    # Fichier CSV
    fichier_csv = open('mesures_pendule.csv', 'w')
    fichier_csv.write("Serie;Mesure_Serie;Mesure_Absolue;Periode_s\n")
    fichier_csv.flush()


def faire_acquisitions():
    global compteur_passages, temps_precedent, compteur_absolu, fichier_csv, lecture, obstacle_present, seuil

    for num_serie in range(1, nb_series_visees + 1):
        serie_validee = False

        while not serie_validee:
            mesures_serie = []
            compteur_passages = 0
            temps_precedent = 0
            obstacle_present = False

            label0.set_text(f"Serie {num_serie}/{nb_series_visees}")
            label1.set_text("Lancez le pendule !")

            # --- CAPTURE DES MESURES DE LA SÉRIE ---
            while len(mesures_serie) < mesures_par_serie:
                M5.update()
                lecture = light_0.get_analog_value()

                # 1. Attente de la coupure du faisceau (Front montant)
                if lecture > seuil and not obstacle_present:
                    temps_actuel = time.ticks_ms()
                    obstacle_present = True
                    compteur_passages += 1

                    # 2. Filtrage des fronts impairs (Période complète T)
                    if compteur_passages % 2 != 0:
                        if temps_precedent != 0:
                            diff = time.ticks_diff(temps_actuel, temps_precedent)
                            periode_s = diff / 1000.0
                            mesures_serie.append(periode_s)
                            
                            label0.set_text(f"Serie {num_serie} | Mesure : {len(mesures_serie)}/{mesures_par_serie}")
                            label1.set_text(f"T = {round(periode_s, 4)} s")
                        else:
                            label0.set_text("Chrono lance...")
                            label1.set_text("En attente de T...")
                        
                        # Mise à jour du temps de référence à chaque période
                        temps_precedent = temps_actuel

                # 3. Attente de la sortie du pendule (Front descendant)
                elif lecture <= seuil and obstacle_present:
                    obstacle_present = False

                time.sleep_ms(1)

            # --- CHOIX : VALIDATION OU REJET DE LA SÉRIE (Hors de la boucle d'acquisition) ---
            label0.set_text(f"Serie {num_serie} finie !")
            label1.set_text("A: Valider | B: Rejeter")
            time.sleep(0.5)

            attente_bouton = True
            while attente_bouton:
                M5.update()

                # BOUTON A : Enregistrement
                if BtnA.isPressed():
                    for i, p in enumerate(mesures_serie):
                        compteur_absolu += 1
                        valeur_fr = str(p).replace('.', ',')
                        fichier_csv.write(f"{num_serie};{i + 1};{compteur_absolu};{valeur_fr}\n")

                    fichier_csv.flush()
                    label0.set_text(f"Serie {num_serie} enregistree !")
                    label1.set_text("OK !")
                    
                    serie_validee = True
                    attente_bouton = False
                    time.sleep(1)

                # BOUTON B : Rejet
                elif BtnB.isPressed():
                    label0.set_text(f"Serie {num_serie} rejetee !")
                    label1.set_text("Recommencement...")
                    
                    attente_bouton = False
                    time.sleep(1)

                time.sleep_ms(10)

    # --- FIN DU TP ---
    label0.set_text("TP TERMINE !")
    label1.set_text(f"{compteur_absolu} mesures sauvees")
    fichier_csv.close()

    while True:
        M5.update()
        time.sleep_ms(100)


if __name__ == '__main__':
    try:
        setup()
        faire_acquisitions()
    except (Exception, KeyboardInterrupt) as e:
        try:
            if fichier_csv:
                fichier_csv.close()
            m5ui.deinit()
            from utility import print_error_msg
            print_error_msg(e)
        except ImportError:
            print("please update to latest firmware")