## Declaracion de librerias
from machine import Pin
import time

## Configuracion de puertos GPIO
#Son las asignaciones de los pines de la raspberry
pinEnabled = Pin(13, Pin.OUT, value = 0)
pinStep = Pin(15, Pin.OUT)
pinDirection = Pin(14, Pin.OUT, value = 1)
boton_direccion = Pin(18, machine.Pin.IN, machine.Pin.PULL_DOWN)
boton_velocidad = Pin(17, machine.Pin.IN, machine.Pin.PULL_DOWN)
boton_pasos = Pin(16, machine.Pin.IN, machine.Pin.PULL_DOWN)

#pinEnabled.on() #Habilitar el Enabled del TB6600

#stepsPerRevolution = 200 #200 pasos por revolucion (1.8° por paso)
#Son las distintas velocidades a las que puede girar la manecilla
velocidad = (5,10,30,100,500) #Retraso entre paso 
bandera = 1 #Bandera para cambio de direccion de giro
contador_velocidad = 0

## Programa principal
while True: #Ciclo infinito
    if boton_direccion.value() == 1 and bandera == 0: #Control del boton rojo
        time.sleep_ms(100) #Anti rebote
        print('Sentido a favor de manecillas')
        pinDirection.on()
        bandera = 1
    elif boton_direccion.value() == 1 and bandera == 1:
        time.sleep_ms(100)
        print('Sentido en contra de las manecillas')
        pinDirection.off()
        bandera = 0
    #El boton rojo determina hacia donde gira la manecilla
    if boton_velocidad.value() == 1: #Control del boton azul
        time.sleep_ms(100)
        while boton_velocidad.value() == 1:
            pass
        time.sleep_ms(100)
        contador_velocidad += 1
        time.sleep_ms(100)
        D = "Cambio de velocidad = " + str(velocidad[contador_velocidad]) # Arreglo a presentar
        print(D)
        if contador_velocidad >= 4:
            contador_velocidad = 0 #Si el valor del boton es mayor a 4, este se reinicia
    #El boton azul determina la velocidad a la que gira la manecilla
    if boton_pasos.value() == 1: #Control del boton verde
        pinStep.on()
        time.sleep_ms(100)
        pinStep.off()
        time.sleep_ms(100)
    #El boton verde hace que se mueva la manecilla conforme a los valores
    #del boton rojo y azul