//quack
#include<MobaTools.h>

MoToServo elevServo;
MoToServo alerServo;
MoToServo ruddServo;

int red = 3;
int yellow = 2;
int green = 4;

int rightJs_x;
int rightJs_y;

int leftJs_x;
int leftJs_y;

int servo1_valx;
int servo1_valy;

int servo2_valx;
int servo2_valy;


void setup()
{

Serial.begin(9600);
pinMode(A0,INPUT);
pinMode(A1,INPUT);

pinMode(A2,INPUT);
pinMode(A3,INPUT);

pinMode(2, INPUT);


elevServo.attach(10);
alerServo.attach(11);
ruddServo.attach(6);

elevServo.write(0);
alerServo.write(0);
ruddServo.write(0);

elevServo.setSpeed(80);
alerServo.setSpeed(80);
ruddServo.setSpeed(80);



}

void safetyCheck()
{
  if(digitalRead(2) == 1)
  {
servo1_valx=map(rightJs_x,0,1023,40,140);
servo1_valy=map(rightJs_y,0,1023,40,140);

servo2_valx=map(leftJs_x,0,1023,40,140);
servo2_valy=map(leftJs_y,0,1023,40,140);
  }
  if(digitalRead(2) == 0);
servo1_valx=map(rightJs_x,0,1023,0,180);
servo1_valy=map(rightJs_y,0,1023,0,180);

servo2_valx=map(leftJs_x,0,1023,0,180);
servo2_valy=map(leftJs_y,0,1023,0,180);
}
void loop()
{

rightJs_x=analogRead(A0);
rightJs_y=analogRead(A1);

leftJs_x=analogRead(A2);
leftJs_y=analogRead(A3);

safetyCheck();

elevServo.write(servo1_valx);
alerServo.write(servo1_valy);
ruddServo.write(servo2_valy);

//motor code

Serial.println(digitalRead(2));

if(digitalRead(2) == 1)
{
digitalWrite(4, HIGH);
}

if(digitalRead(2) == 0)
{
digitalWrite(4, LOW);
}
}