#include <Servo.h>

#define JSwPin1 2
#define LEDPin 4
#define servo1Pin 9
#define servo2Pin 10

Servo s1;
Servo s2;
int servo1Pos, servo2Pos;
int XRead, YRead;
void setup() {
  // put your setup code here, to run once:
 pinMode(JSwPin1, INPUT_PULLUP);
 pinMode(LEDPin, OUTPUT);
 pinMode(servo1Pin,OUTPUT);
 pinMode(servo2Pin,OUTPUT);
 s1.attach(servo1Pin);
 s2.attach(servo2Pin);
 Serial.begin(9600);
 Serial.println("Interfacing Joystick with Arduino Uno to control Servo"); 
 digitalWrite(JSwPin1, HIGH);
}

void loop() {
  // put your main code here, to run repeatedly:
 
 //4.3.2
 /*
  XRead = analogRead(A0);
  YRead = analogRead(A1);
  Serial.println("X position = " + String(XRead) + " Y position = " + String(YRead));
  if (digitalRead(JSwPin) == LOW){
    digitalWrite(LEDPin,HIGH);
    delay(500);
    digitalWrite(LEDPin,LOW);}
    delay(500);
    */
  //4.3.3
 /*
  XRead = analogRead(A0);
  servoPos = map(XRead, 0,1023,0,180);
  s1.write(servoPos);
*/
//4.3.4 Laser Beam Gun
  XRead = analogRead(A0);
  YRead = analogRead(A1);
  servo1Pos = map(XRead, 0,1023,0,180);
  s1.write(servo1Pos);
  servo2Pos = map(YRead, 0,1023,0,180);
  s2.write(servo2Pos);
  if (digitalRead(JSwPin1) == LOW){
    digitalWrite(LEDPin,HIGH);
    delay(500);
    digitalWrite(LEDPin,LOW);}
    delay(100);  
  }