import time
from machine import Pin
import rp2


@rp2.asm_pio(set_init=(rp2.PIO.OUT_LOW))
def blink_1hz():
    # Cycles: 1 + 1 + 6 + 32 * (30 + 1) = 1000
    irq(0)
   
    set(pins, 1)
    set(x, 31)                  [5]
    label("delay_high")
    nop()                       [29]
    jmp(x_dec, "delay_high")

    # Cycles: 1 + 1 + 6 + 32 * (30 + 1) = 1000
    nop()
    set(pins, 0)
    set(x, 31)                  [5]
    label("delay_low")
    nop()                       [29]
    jmp(x_dec, "delay_low")


# Instans af statemaskine
sm = rp2.StateMachine(0, blink_1hz, freq=2000, set_base=(Pin(0)))
sm2 = rp2.StateMachine(1, blink_1hz, freq=4000, set_base=(Pin(1)))


# Interrupt handler
#sm.irq(lambda p: print(time.ticks_ms()))

# Start maskine
sm.active(1)
sm2.active(1)