from class_frequenzimetro2 import frequenzimetro
import time
from machine import Pin


aioo=frequenzimetro(2,125000000,15,100)   #n°sm, frequenza sm, pin ingresso, n°impulsi, funzione interrupt

frequenza=2500            #minima frequenza uscita 10Hz 
#frequenza=frequenza*200        #frequenza minima sm 1908Hz

@rp2.asm_pio(set_init=rp2.PIO.OUT_LOW)
def mantenimento():
    set(pins,1)[24]
    nop()[24]
    nop()[24]
    nop()[24]
    set(pins,0)[24]
    nop()[24]
    nop()[24]
    nop()[24]
    wrap()
    
def cambio_frequenza(frequenza):
    sm0=rp2.StateMachine(0,mantenimento,freq=frequenza*200,set_base=Pin(0))
    sm0.active(1)
    
sm0=rp2.StateMachine(0,mantenimento,freq=frequenza*200,set_base=Pin(0))
sm0.active(1)


while True:
    #if aioo.sm.rx_fifo():
    print(aioo.get(),frequenza)
    #frequenza+=1000
    #cambio_frequenza(frequenza)
    time.sleep(1)

        

#aioo.sm.active(0)                              #accende-spegne state machine
#aioo.sm.active(1)