#define trigPin 22
#define echoPin 21
#define ledRed 12
#define ledGr 14

float duration_us,distance_cm

void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  Serial.println("Daneen Meedsen");
  pinMode(trigPin, INPUT);
  pinMode(echoPin, OUTPUT);
  pinMode(ledRed, OUTPUT);
  pinMode(ledGr, OUTPUT);
}

void loop() {
  // put your main code here, to run repeatedly:
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  duration_us = pulseIn(echoPin,HIGH);
  distance_cm = 0.017*duration_us ;

  if (distance_cm >= 100) {
    digitalWrite(ledGr, HIGH);
    digitalWrite(ledRed, LOW);
  } else {
    digitalWrite(ledGr, LOW);
    digitalWrite(ledRed, HIGH);
  }

  Serial.print("distance: ");
  Serial.print(distance_cm);
  Serial.println("cm");
  delay(500); // this speeds up the simulation
}

//ชุดคำสั่งที่ 3