# Importar librerías
import time
import machine
import sys
from machine import Pin  # Librería de GPIO del RPI PICO 

# Definición de Funciones
def dectobin(num):
  textb=""
  ii=128
  for a in range(0,8,1):
    if num & ii ==0:
      textb=textb+"0"
    else:
      textb=textb+"1"
    ii=ii>>1
  return textb

def salp(num,lista):
  for pins in lista:
    Pin(pins,Pin.OUT)
  ii=128
  for pins in lista:
    if ((num & ii) !=0):
      Pin(pins,Pin.OUT).value(1)
    else:
      Pin(pins,Pin.OUT).value(0)
    ii=ii>>1

def main():
    boton1 = None
    boton2 = None
    boton3 = None
    boton4 = None
    # Configuración de hardware
    print("Motores")
    if sys.platform == "esp32":
        leds1 = [21, 19, 18, 5]  # Pines para ESP32
        leds2 = [17, 16, 4, 2]   # Pines para ESP32
        boton1 = machine.Pin(33, machine.Pin.IN, machine.Pin.PULL_UP)  # Botón 1 - GPIO 32
        boton2 = machine.Pin(32, machine.Pin.IN, machine.Pin.PULL_UP)
        boton3 = machine.Pin(35, machine.Pin.IN, machine.Pin.PULL_UP)
        boton4 = machine.Pin(34, machine.Pin.IN, machine.Pin.PULL_UP)
    elif sys.platform == "rp2":
        leds1 = [2, 3, 4, 5]  # Pines para Raspberry Pi Pico
        leds2 = [6, 7, 8, 9]
        boton1 = machine.Pin(18, machine.Pin.IN, machine.Pin.PULL_UP)  # Botón en GPIO 1 con resistencia pull-up
        boton2 = machine.Pin(19, machine.Pin.IN, machine.Pin.PULL_UP)
        boton3 = machine.Pin(20, machine.Pin.IN, machine.Pin.PULL_UP)
        boton4 = machine.Pin(21, machine.Pin.IN, machine.Pin.PULL_UP)
    # Inicialización de Variables
    cont1 = 1  # Empieza con 00000001 en binario
    cont2 = 1
    # Bucle infinito
    while True:
        if boton1.value() == 0:  
            time.sleep(0.1)  
            
            if boton2.value() == 0:  
                cont1 <<= 1  
                if cont1 > 128: 
                    cont1 = 8
            else:  
                cont1 >>= 1  
                if cont1 < 8:
                    cont1 = 128  
        if boton3.value() == 0:  
            time.sleep(0.1)  
            
            if boton4.value() == 0:  
                cont2 <<= 1  
                if cont2 > 128:  
                    cont2 = 8
            else:  
                cont2 >>= 1  
                if cont2 < 8:
                    cont2 = 128  

        salp(cont1, leds1)
        salp(cont2, leds2)
        time.sleep(0.2)  # Pequeña pausa para evitar múltiples activaciones
if __name__ == '__main__':
    main()