# Neu khoang cach < 10 cm -> bat den
# Neu lon hon -> tat den
from machine import Pin, time_pulse_us
import time
TRIG_PIN = 27
ECHO_PIN = 14
trig = Pin(TRIG_PIN, Pin.OUT)
echo = Pin(ECHO_PIN, Pin.IN)
led = Pin(12, Pin.OUT)
while True:
# Tinh toan khoang cah
# Neu d < 10 => bat den
# neu d >= 10 => tat den
trig.on()
time.sleep_us(10)
trig.off()
duration = time_pulse_us(echo, 1);
d = duration/58
print("Khoang cach: ", d," cm")
if( d < 10):
led.on()
else:
led.off()
time.sleep(1)