#include <Arduino.h>

const int enablePin1 = 6;
const int dirPin1 = 8;
const int stepPin1 = 9;

const int enablePin2 = 7;
const int dirPin2 = 10;
const int stepPin2 = 11;

void setup() {
  pinMode(enablePin1, OUTPUT);
  pinMode(dirPin1, OUTPUT);
  pinMode(stepPin1, OUTPUT);

  pinMode(enablePin2, OUTPUT);
  pinMode(dirPin2, OUTPUT);
  pinMode(stepPin2, OUTPUT);

  digitalWrite(enablePin1, LOW); // A4988 se aktivira kada je ENABLE = LOW
  digitalWrite(enablePin2, LOW);
}

void loop() {
  // Motor 1 u jednu stranu
  digitalWrite(dirPin1, HIGH);
  for (int i = 0; i < 200; i++) {
    digitalWrite(stepPin1, HIGH);
    delayMicroseconds(500);
    digitalWrite(stepPin1, LOW);
    delayMicroseconds(500);
  }

  delay(500);

  // Motor 1 u drugu stranu
  digitalWrite(dirPin1, LOW);
  for (int i = 0; i < 200; i++) {
    digitalWrite(stepPin1, HIGH);
    delayMicroseconds(500);
    digitalWrite(stepPin1, LOW);
    delayMicroseconds(500);
  }

  delay(500);

  // Motor 2 u jednu stranu
  digitalWrite(dirPin2, HIGH);
  for (int i = 0; i < 200; i++) {
    digitalWrite(stepPin2, HIGH);
    delayMicroseconds(500);
    digitalWrite(stepPin2, LOW);
    delayMicroseconds(500);
  }

  delay(500);

  // Motor 2 u drugu stranu
  digitalWrite(dirPin2, LOW);
  for (int i = 0; i < 200; i++) {
    digitalWrite(stepPin2, HIGH);
    delayMicroseconds(500);
    digitalWrite(stepPin2, LOW);
    delayMicroseconds(500);
  }

  delay(500);
}