#include <Servo.h>

const int servoPins[] = {3, 5, 9, 10, 11};
const int buttonPins[] = {2, 4, 6, 7, 8};
const int switchPin = 12;
const int numServos = 5;

Servo servos[numServos];
int positions[numServos]; // trenutne pozicije servo motora (0–180)

void setup() {
  for (int i = 0; i < numServos; i++) {
    servos[i].attach(servoPins[i]);
    positions[i] = 90;  // Srednja pozicija
    servos[i].write(positions[i]);
    pinMode(buttonPins[i], INPUT);
  }
  pinMode(switchPin, INPUT);
}

void loop() {
  bool direction = digitalRead(switchPin); // LOW = levo, HIGH = desno

  for (int i = 0; i < numServos; i++) {
    if (digitalRead(buttonPins[i]) == HIGH) {
      if (direction && positions[i] < 180) {
        positions[i]++;
      } else if (!direction && positions[i] > 0) {
        positions[i]--;
      }
      servos[i].write(positions[i]);
      delay(15); // Podešava brzinu pomeranja
    }
  }
}