from machine import Pin
import time

# Configurações dos pinos para o primeiro motor
DIR_PIN_MOTOR1 = 12
STEP_PIN_MOTOR1 = 14

# Configurações dos pinos para o segundo motor
DIR_PIN_MOTOR2 = 13
STEP_PIN_MOTOR2 = 15

steps_per_rev = 200

def step_motor(step_pin, dir_pin, steps_per_rev, delay):
    dir_pin.on()  # Define o sentido horário

    # Gira o motor no sentido horário
    for i in range(steps_per_rev):
        step_pin.on()
        time.sleep_us(delay)
        step_pin.off()
        time.sleep_us(delay)

    time.sleep(1)

    dir_pin.off()  # Define o sentido anti-horário

    # Gira o motor no sentido anti-horário
    for i in range(steps_per_rev):
        step_pin.on()
        time.sleep_us(delay)
        step_pin.off()
        time.sleep_us(delay)

    time.sleep(1)

def setup():
    print("Inicializando...")
    # Configuração do primeiro motor
    step_pin_motor1 = Pin(STEP_PIN_MOTOR1, Pin.OUT)
    dir_pin_motor1 = Pin(DIR_PIN_MOTOR1, Pin.OUT)

    # Configuração do segundo motor
    step_pin_motor2 = Pin(STEP_PIN_MOTOR2, Pin.OUT)
    dir_pin_motor2 = Pin(DIR_PIN_MOTOR2, Pin.OUT)

    # Controlando o primeiro motor
    print("Controlando o primeiro motor...")
    step_motor(step_pin_motor1, dir_pin_motor1, steps_per_rev, 2000)

    # Controlando o segundo motor
    print("Controlando o segundo motor...")
    step_motor(step_pin_motor2, dir_pin_motor2, steps_per_rev, 1000)

setup()