int Trig = 27;
int Echo = 35;
int distance;


void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  Serial.println("Hello, ESP32!");
  pinMode(Trig, OUTPUT);
  pinMode(Echo, INPUT);
  pinMode(32, OUTPUT);
  pinMode(33, OUTPUT);
  pinMode(25, OUTPUT);
  pinMode(26, OUTPUT);
  pinMode(34, INPUT);
}

void loop() {
   int swch =digitalRead(34);
  Serial.println(swch);
  digitalWrite(Trig, HIGH);
  delay(100);
  digitalWrite(Trig, LOW);
  int reading = (pulseIn(Echo,HIGH));
  distance = (reading * 0.034/2)+1;
  if (swch == 1)
  {
   if (distance<50) 
  {
  digitalWrite(32,HIGH);
  digitalWrite(26, LOW);
  digitalWrite(33, LOW);
  digitalWrite(25, LOW);
  }
  else if  (distance<100)
  {
  digitalWrite(32,LOW);
  digitalWrite(33, HIGH);
  digitalWrite(26, LOW);
  digitalWrite(25, LOW);
  }
  else if  (distance<200)
  {
  digitalWrite(32,LOW);
  digitalWrite(33, LOW);
  digitalWrite(25, HIGH);
  digitalWrite(26, LOW);
  }
  else if (distance>300)
  {
  digitalWrite(32,LOW);
  digitalWrite(33, LOW);
  digitalWrite(25, LOW);
  digitalWrite(26, HIGH);
  }
  }
  else
  {
    digitalWrite(32,LOW);
  digitalWrite(26, LOW);
  digitalWrite(33, LOW);
  digitalWrite(25, LOW);

  }

  
    Serial.println("Ok, received");
  Serial.println(distance);

  // put your main code here, to run repeatedly:
  delay(10); // this speeds up the simulation
}