//vkljucimo knjiznico servo
#include <Servo.h>

//kje je servo
#define servoM1 11
#define servoM2 10


//X,Y kordinata joysticka
#define X A1
#define Y A0

//pozicije servomotorjev-zacnemo na sredini
int smPos1= 90;
int smPos2= 90;

//ker imamo opravka z knjiznico servo moramo ustvariti spremenljivko


//dekleracija objekta: dva servomotorja
Servo sm1, sm2;


void setup(){
 
  sm1.attach(servoM1);
  sm2.attach(servoM2);
  Serial.begin(9600);

  //servo postavimo na zacetek
  sm1.write(smPos1);
  sm2.write(smPos2);
}

void loop() {
  /* beremo pozicijo joysticka (X = pomik levo, desno; Y = pomik gor, dol).
  S tem lahko prmaknemo servomotor */
  int posX = analogRead(X);
  int posY = analogRead(Y);



  

  // Ce je Joystick pomaknjen DESNO se spodnji servometer pomakne GOR
  if(posX <400){
    if(smPos1>0){
      smPos1--; //Rotira servo meter za -1
      sm1.write(smPos1);
      delay(10);
    }
  }

  // Ce je Joystick pomaknjen LEVO se spodnji servometer pomakne DOL

  else if(posX>600){
    if(smPos1<180);{
    smPos1++; //Rotira servo meter za +1
    sm1.write(smPos1);
    delay(10);
    }
  }

  // Ce je Joystick pomaknjen DOL se zgorni servometer pomakne DOL

  if(posY <400){
    if(smPos2>0){
      smPos2++; //Rotira servomotor za +1
      sm2.write(smPos2);
      delay(10);
    }
  }

  // Ce je Joystick pomaknjen GOR se zgorni servometer pomakne GOR

  else if(posY>600){
    if(smPos2<180);{
    smPos2--; //Rotira servomotor za -1
    sm2.write(smPos2);
    delay(10);
    }
  }
}