int trig=25;
int echo=26;
float d;
void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  Serial.println("Hello, ESP32!");
  pinMode(echo, INPUT);
  pinMode(trig, OUTPUT);
  pinMode(12, OUTPUT);
  pinMode(14, OUTPUT);
  pinMode(23, OUTPUT);
  
}

int ultrasonic(){
  digitalWrite(trig, LOW);
  delay(100);
  digitalWrite(trig, HIGH);
  delay(100);
  digitalWrite(trig, LOW);
  d=pulseIn(echo,HIGH);
  return(d*0.034/2);
  delay(1000);

}

void loop() {
  int distance=ultrasonic();

  Serial.println(String(ultrasonic()));

   if(distance<200) {
    digitalWrite(12, HIGH);
    digitalWrite(14, LOW);
    tone(23,3000);
  } 
  else
  {
   digitalWrite(14, HIGH);
   digitalWrite(12, LOW);
   tone(23,6000);
   
   
  }

 
}