/*
 * Created by ArduinoGetStarted.com
 *
 * This example code is in the public domain
 *
 * Tutorial page: https://arduinogetstarted.com/tutorials/arduino-touch-sensor-led
 */

//const int TOUCH_SENSOR_PIN1  = 2;// Arduino pin connected to the OUTPUT pin of touch sensor
//const int TOUCH_SENSOR_PIN2  = 23;
#define Trigpin 14
#define Echopin 15
const int LED_PIN0           = 26;
const int LED_PIN1           = 3; // Arduino pin connected to LED's pin
const int LED_PIN2           = 4;
const int LED_PIN3           = 5;
const int LED_PIN11           = 6;
const int LED_PIN12           = 7;
const int LED_PIN13           = 8;
const int LED_PIN14          = 9;
const int LED_PIN15           = 10;
const int LED_PIN16           = 11;
const int LED_PIN17          = 22;
const int LED_PIN18          = 24;
const int LED_PIN21          = 25;
const int LED_PIN22          = 27;
const int LED_PIN23          = 28;
const int LED_PIN24          = 29;
const int LED_PIN25          = 30;
const int LED_PIN31          = 22;//pin 17
float distance;
int duration;
int ll = 700;


void setup() {
 // Serial.begin(9600);               // initialize serial
  //pinMode(TOUCH_SENSOR_PIN1, INPUT); // set arduino pin to input mode
  //pinMode(TOUCH_SENSOR_PIN2, INPUT);
  pinMode (Trigpin, OUTPUT);
  pinMode (Echopin, INPUT);
  pinMode(LED_PIN0, OUTPUT);
  pinMode(LED_PIN1, OUTPUT);         // set arduino pin to output mode
  pinMode(LED_PIN2, OUTPUT);
  pinMode(LED_PIN3, OUTPUT);
  pinMode(LED_PIN11, OUTPUT);
  pinMode(LED_PIN12, OUTPUT);
  pinMode(LED_PIN13, OUTPUT);
  pinMode(LED_PIN14, OUTPUT);
  pinMode(LED_PIN15, OUTPUT);
  pinMode(LED_PIN16, OUTPUT);
  pinMode(LED_PIN17, OUTPUT);
  pinMode(LED_PIN18, OUTPUT);
  pinMode(LED_PIN21, OUTPUT);
  pinMode(LED_PIN22, OUTPUT);
  pinMode(LED_PIN22, OUTPUT);
  pinMode(LED_PIN23, OUTPUT);
  pinMode(LED_PIN24, OUTPUT);
  pinMode(LED_PIN25, OUTPUT);
  pinMode(LED_PIN31, OUTPUT);//pin 16 common
  Serial.begin(9600);
    digitalWrite(LED_PIN0, LOW); // turn on
    digitalWrite(LED_PIN1, LOW);
    digitalWrite(LED_PIN2, LOW);
    digitalWrite(LED_PIN3, LOW);
    digitalWrite(LED_PIN11, LOW);
    digitalWrite(LED_PIN12, LOW);
    digitalWrite(LED_PIN13, LOW);
    digitalWrite(LED_PIN14, LOW);
    digitalWrite(LED_PIN15, LOW);
    digitalWrite(LED_PIN16, LOW);
    digitalWrite(LED_PIN17, LOW);
    digitalWrite(LED_PIN18, LOW);
    digitalWrite(LED_PIN21, LOW);
    digitalWrite(LED_PIN22, LOW);
    digitalWrite(LED_PIN23, LOW);
    digitalWrite(LED_PIN24, LOW);
    digitalWrite(LED_PIN25, LOW);
    digitalWrite(LED_PIN31, LOW);
}
void loop() {
  //int touchState1 = digitalRead(TOUCH_SENSOR_PIN1); // read new state
  //if (touchState1 == HIGH) {
   // Serial.println("The sensor is being touched");
  digitalWrite(Trigpin, LOW);
  delayMicroseconds(2);
  digitalWrite(Trigpin, HIGH);
  delayMicroseconds(10);
  digitalWrite(Trigpin, LOW);
  duration = pulseIn(Echopin, HIGH);
  distance = duration * 0.034 / 2;
  delay (ll);
  Serial.println (" ");
  Serial.print ("Distance = ");
  Serial.print (distance);
  Serial.print (" CM");
  Serial.println (" ");

  if (distance<=5)
  {
    Serial.println ("The sensor is activated");
    digitalWrite(LED_PIN0, HIGH); // turn on
    delay(1000);
    digitalWrite(LED_PIN1, HIGH);
    digitalWrite(LED_PIN2, HIGH);
    digitalWrite(LED_PIN3, HIGH);
    delay(1000);
    digitalWrite(LED_PIN1, LOW);
    delay(500);
    digitalWrite(LED_PIN1, HIGH);
    delay(100);
    digitalWrite(LED_PIN11, HIGH);
    delay(100);
    digitalWrite(LED_PIN12, HIGH);
    delay(100);
    digitalWrite(LED_PIN13, HIGH);
    delay(100);
    digitalWrite(LED_PIN14, HIGH);
    delay(100);
    digitalWrite(LED_PIN15, HIGH);
    delay(100);
    digitalWrite(LED_PIN16, HIGH);
    delay(100);
    digitalWrite(LED_PIN17, HIGH);
    delay(100);
    digitalWrite(LED_PIN18, HIGH);
    delay(100);
    digitalWrite(LED_PIN2, LOW);
    delay(500);
    digitalWrite(LED_PIN2, HIGH);
    delay(100);
    digitalWrite(LED_PIN21, HIGH);
    delay(100);
    digitalWrite(LED_PIN22, HIGH);
    delay(100);
    digitalWrite(LED_PIN23, HIGH);
    delay(100);
    digitalWrite(LED_PIN24, HIGH);
    delay(100);
    digitalWrite(LED_PIN25, HIGH);
    delay(100);
    digitalWrite(LED_PIN3, LOW);
    delay(500);
    digitalWrite(LED_PIN3, HIGH);
    delay(100);
    digitalWrite(LED_PIN17, LOW);
    delay(1000);
    digitalWrite(LED_PIN31, HIGH);
    delay(3000);
  }
  else
  //if (touchState1 == LOW) {
    Serial.println("The sensor is untouched");
    digitalWrite(LED_PIN0, LOW); // turn on
    digitalWrite(LED_PIN1, LOW);
    digitalWrite(LED_PIN2, LOW);
    digitalWrite(LED_PIN3, LOW);
    digitalWrite(LED_PIN11, LOW);
    digitalWrite(LED_PIN12, LOW);
    digitalWrite(LED_PIN13, LOW);
    digitalWrite(LED_PIN14, LOW);
    digitalWrite(LED_PIN15, LOW);
    digitalWrite(LED_PIN16, LOW);
    digitalWrite(LED_PIN17, LOW);
    digitalWrite(LED_PIN18, LOW);
    digitalWrite(LED_PIN21, LOW);
    digitalWrite(LED_PIN22, LOW);
    digitalWrite(LED_PIN23, LOW);
    digitalWrite(LED_PIN24, LOW);
    digitalWrite(LED_PIN25, LOW);
    digitalWrite(LED_PIN31, LOW);
  }
  /*int touchState2 = digitalRead(TOUCH_SENSOR_PIN2); // read new state
  if (touchState2 == HIGH){
   // Serial.println("The sensor is being touched");
    digitalWrite(LED_PIN10, HIGH); // turn on
    digitalWrite(LED_PIN11, HIGH);
    digitalWrite(LED_PIN12, HIGH);
    digitalWrite(LED_PIN4, HIGH);
    digitalWrite(LED_PIN5, HIGH);
    digitalWrite(LED_PIN6, HIGH);
    digitalWrite(LED_PIN7, HIGH);
    digitalWrite(LED_PIN8, HIGH);
    digitalWrite(LED_PIN9, HIGH);
  }
  else
  if (touchState2 == LOW) {
   // Serial.println("The sensor is untouched");
    digitalWrite(LED_PIN10, LOW);
    digitalWrite(LED_PIN11, LOW);
    digitalWrite(LED_PIN12, LOW);
    digitalWrite(LED_PIN4, LOW);
    digitalWrite(LED_PIN5, LOW);
    digitalWrite(LED_PIN6, LOW);
    digitalWrite(LED_PIN7, LOW);
    digitalWrite(LED_PIN8, LOW);
    digitalWrite(LED_PIN9, LOW);  // turn off
  }
*/