#define STEP_PIN 2    // Пін для керування кроками
#define DIR_PIN 3     // Пін для напрямку руху

void setup() {
  Serial.begin(9600);
  pinMode(STEP_PIN, OUTPUT);
  pinMode(DIR_PIN, OUTPUT);
        Serial.println("Введіть команду 'F' для руху вперед, або 'B' для руху назад");
}

void loop() {
  if (Serial.available() > 0) {
    char command = Serial.read();
    
    if (command == 'F') {
      Serial.println("Вперед");
      digitalWrite(DIR_PIN, HIGH);  // Встановлюємо напрямок руху вперед
      stepMotor(100, 5);  // Кількість кроків та затримка між кроками
    } else if (command == 'B') {
      Serial.println("Назад");
      digitalWrite(DIR_PIN, LOW);  // Встановлюємо напрямок руху назад
      stepMotor(100, 5);  // Кількість кроків та затримка між кроками
    }
  }
}

void stepMotor(int steps, int delay_ms) {
  for (int i = 0; i < steps; i++) {
    digitalWrite(STEP_PIN, HIGH);
    delay(delay_ms);
    digitalWrite(STEP_PIN, LOW);
    delay(delay_ms);
  }
}