//vkljucimo knjiznico servo
#include <Servo.h>
//kje je servo
#define servoM1 11
#define servoM2 10
//X,Y kordinata yojsticka
#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() {
int posX = analogRead(X);
int posY = analogRead(Y);
if(posX < 400)
{
if(smPos1>0)
{
smPos1--;
sm1.write(smPos1);
delay(10);
}
}
else if(posX>600)
{
if(smPos1<180)
{
smPos1++;
sm1.write(smPos1);
delay(10);
}
}
if(posY <400)
{
if(smPos2>0)
{
smPos2--;
sm2.write(smPos2);
delay(10);
}
}
else if(posY > 600)
{
if(smPos2<180)
{
smPos2++;
sm2.write(smPos2);
delay(10);
}
}
}