#include <Arduino.h>

// Definirajte pinove na Arduino Uno
const int enablePin1 = 6; // Pin za omogućavanje motora 1
const int a1Pin1 = 2; // Pin A1 motora 1
const int a2Pin1 = 3; // Pin A2 motora 1
const int b1Pin1 = 4; // Pin B1 motora 1
const int b2Pin1 = 5; // Pin B2 motora 1

const int enablePin2 = 7; // Pin za omogućavanje motora 2
const int a1Pin2 = 8; // Pin A1 motora 2
const int a2Pin2 = 9; // Pin A2 motora 2
const int b1Pin2 = 10; // Pin B1 motora 2
const int b2Pin2 = 11; // Pin B2 motora 2

void setup() {
  // Inicijalizirati pinove kao izlaze
  pinMode(enablePin1, OUTPUT);
  pinMode(a1Pin1, OUTPUT);
  pinMode(a2Pin1, OUTPUT);
  pinMode(b1Pin1, OUTPUT);
  pinMode(b2Pin1, OUTPUT);

  pinMode(enablePin2, OUTPUT);
  pinMode(a1Pin2, OUTPUT);
  pinMode(a2Pin2, OUTPUT);
  pinMode(b1Pin2, OUTPUT);
  pinMode(b2Pin2, OUTPUT);
}

void loop() {
  // Omogućavanje motora 1
  digitalWrite(enablePin1, HIGH);

  // Korakom motora 1 u kaznu smjeru
  digitalWrite(a1Pin1, HIGH);
  digitalWrite(a2Pin1, LOW);
  digitalWrite(b1Pin1, HIGH);
  digitalWrite(b2Pin1, LOW);
  delay(10); // Čekaj 1 sekund

  // Korakom motora 1 u suprotnu smjeru
  digitalWrite(a1Pin1, LOW);
  digitalWrite(a2Pin1, HIGH);
  digitalWrite(b1Pin1, LOW);
  digitalWrite(b2Pin1, HIGH);
  delay(100); // Čekaj 1 sekund

  // Omogućavanje motora 2
  digitalWrite(enablePin2, HIGH);

  // Korakom motora 2 u kaznu smjeru
  digitalWrite(a1Pin2, HIGH);
  digitalWrite(a2Pin2, LOW);
  digitalWrite(b1Pin2, HIGH);
  digitalWrite(b2Pin2, LOW);
  delay(100); // Čekaj 1 sekund

  // Korakom motora 2 u suprotnu smjeru
  digitalWrite(a1Pin2, LOW);
  digitalWrite(a2Pin2, HIGH);
  digitalWrite(b1Pin2, LOW);
  digitalWrite(b2Pin2, HIGH);
  delay(100); // Čekaj 1 sekund

}