import rp2
from machine import Pin
from class_encoder import encoder
import time

led=Pin(25, Pin.OUT)

@rp2.asm_pio(set_init=(rp2.PIO.OUT_LOW,rp2.PIO.OUT_LOW) )    
def mantenimento():    #7istr
    
    
    set(pins,0b01)[31]
    set(pins,0b11)[31]
    set(pins,0b10)[31]
    set(pins,0b00)[31]
    
    wrap()
    
    
sm4=rp2.StateMachine(4,mantenimento,freq=2000,set_base=Pin(14))
sm4.active(1)

n_imp=100

def imp_raggiunti(_):       #  '_' deve essere presente
    global n_imp            #la funzione chiamata da irq de essere prima della creazione oggetto encoder
    print('impulsi raggiunti')
    n_imp=n_imp+10
    aioo.targhet(n_imp)
    led.toggle()

aioo=encoder(0,16,17,n_imp,imp_raggiunti)      
#aioo.target(100)          # n° state machine, pin canale A, pin canale B, n° impulsi target(se zero continuo senza target,funzione IRQ)



while True:
    print(aioo.get())
    time.sleep(2)

        
#    aioo.reset()
#    time.sleep(1)