#include<ESP32Servo.h>
int tombol = 34;
int count;
int lampu1 = 22;
int lampu2 = 18;
Servo srv;
int trig = 12;
int echo = 14;
int Tinggimax = 200;
void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  Serial.println("Hello, ESP32!");
  pinMode(tombol, INPUT);
  pinMode(lampu1, OUTPUT);
  pinMode(lampu2, OUTPUT);
  srv.attach(13);
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);
}

void loop() {
  // put your main code here, to run repeatedly:
  delay(10); // this speeds up the simulation
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);

  long waktu = pulseIn(echo,HIGH);
  double Tinggi = waktu/58;
  if (Tinggi <= Tinggimax) { 
    Serial.println(Tinggi); }
  else {
    Serial.println("Tinggi Badan Melebihi");
  }


  int hasil = digitalRead(tombol);
  // serial.prinln(hasil);
  if (hasil==1){
      count ++;
      delay (300);
      Serial.println(count);
  if(count ==1){
    Serial.println("Mulai");
    digitalWrite(lampu1, HIGH);
    digitalWrite(lampu2, HIGH);
    srv.write(90);
  }
  if(count ==2){
    Serial.println("Selesai");
    digitalWrite(lampu1, LOW);
    digitalWrite(lampu2, LOW );
    srv.write(0);
    count =0;
  }
  
    
  

  
}
}