#include <Servo.h>

Servo servo1;
Servo servo2;
Servo servo3;
Servo* selectedServo = nullptr;

void setup() {
  servo1.attach(9);  //servo1
  servo2.attach(10);  //servo2
  servo3.attach(11);   //servo3

  Serial.begin(9600);
  Serial.println("Izberi servo i vnesi agol!");
  Serial.println("--------------------------------------");
}

void loop() {
  if (Serial.available() > 0) {
    int br_na_servo = Serial.parseInt();

    if (br_na_servo >= 1 && br_na_servo <= 3) {
      if (br_na_servo == 1) {
        selectedServo = &servo1;
      } else if (br_na_servo == 2) {
        selectedServo = &servo2;
      } else if (br_na_servo == 3) {
        selectedServo = &servo3;
      }

      int pozicija = Serial.parseInt();

      if (pozicija >= 0 && pozicija <= 180) {
        selectedServo->write(pozicija);
        Serial.print("Izbrano e servo br:");
        Serial.print(br_na_servo);
        Serial.print("  agol:");
        Serial.println(pozicija);
      } else {
        Serial.println("Nevaliden vnes na agol!");
      }
    } else {
      Serial.println("Nevaliden izbor na servo!");
    }
    while (Serial.available() > 0) {
      Serial.read();
    }
  }
}