//www.elegoo.com
//2016.12.09

#define B 11 
#define LED 4
const int SW_pin = 7; // digital pin connected to switch output
const int X_pin = A0; // analog pin connected to X output
const int Y_pin = A1; // analog pin connected to Y output

#define PIN_TRIG 3
#define PIN_ECHO 2
#define P 6
#define R 5

void setup() {
  pinMode(SW_pin, INPUT);
  pinMode(B,OUTPUT);
  digitalWrite(SW_pin, HIGH);
  Serial.begin(9600);
  pinMode(LED, OUTPUT);

  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
  pinMode(P, OUTPUT);
  pinMode(R, OUTPUT);
}

void loop() {
  Serial.print("Switch:  ");
  Serial.print(digitalRead(SW_pin));
  Serial.print("\n");
  Serial.print("X-axis: ");
  Serial.print(analogRead(X_pin));
  Serial.print("\n");
  Serial.print("Y-axis: ");
  Serial.println(analogRead(Y_pin));
  Serial.print("\n\n");
  delay(500);

  if (digitalRead(SW_pin) == 1) {
  digitalWrite(LED, HIGH);
  tone(11, 277, 500); //D flat


  }
  else {
    digitalWrite(LED,LOW);
  }
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);


  int duration = pulseIn(PIN_ECHO, HIGH);
  int distance = (duration / 2) / 29.1;
  Serial.print("Distance in CM: ");
  Serial.println(distance);


if (distance > 20 ) {
  digitalWrite(P, HIGH);
  digitalWrite(R, LOW);
}
else {
  digitalWrite(P, LOW);
  digitalWrite(R, HIGH);
}
}