from machine import Pin, PWM
import utime

# Primer motor
pinE1 = Pin(5, Pin.OUT, value=0)  # Pin habilitador para el primer motor
pinD1 = Pin(0, Pin.OUT)           # Pin de dirección para el primer motor
pwm1 = PWM(Pin(4))                # Pin de control PWM para el primer motor
pwm1.duty_u16(32768)              # Establece la intensidad del PWM
pwm1.freq(100)                    # Frecuencia PWM

# Segundo motor
pinE2 = Pin(15, Pin.OUT, value=0) # Pin habilitador para el segundo motor
pinD2 = Pin(2, Pin.OUT)           # Pin de dirección para el segundo motor
pwm2 = PWM(Pin(13))               # Pin de control PWM para el segundo motor
pwm2.duty_u16(32768)              # Establece la intensidad del PWM
pwm2.freq(100)                    # Frecuencia PWM

speed = 10  # Velocidad

# Función para mover el primer motor
def movx1(timet1, speed1):        
    pinE1.on()     # Habilita el primer motor
    pinD1.off()    # Dirección del primer motor (giro a derecha)
       
    for i in range(0, timet1):
        pwm1.freq(speed1)
        utime.sleep(.1)
    
    pinE1.off()    # Desactiva el primer motor

# Función para mover el segundo motor
def movx2(timet2, speed2):        
    pinE2.on()     # Habilita el segundo motor
    pinD2.off()    # Dirección del segundo motor (giro a derecha)
    
    for i in range(0, timet2):
        pwm2.freq(speed2)
        utime.sleep(.1)
    
    pinE2.off()    # Desactiva el segundo motor

# Bucle principal
while 1:
    movx1(1, speed)  # Mueve el primer motor
    movx2(1, speed)  # Mueve el segundo motor
    utime.sleep_ms(5000)  # Espera de 5 segundos