from machine import Pin, I2C, PWM
from ssd1306 import SSD1306_I2C
import utime
i2c=I2C(0,sda=Pin(0), scl=Pin(1), freq=400000)
oled = SSD1306_I2C(128, 64, i2c)
trigger=Pin(3,Pin.OUT)
echo=Pin(2,Pin.IN)
red = Pin(16, Pin.OUT)
green = Pin(18, Pin.OUT)
blue = Pin(20, Pin.OUT)
pwm = PWM(Pin(14))
pwm.freq(50)
buzzer = PWM(Pin(15))
buzzer.freq(500)
def ultra():
trigger.low()
utime.sleep_us(2)
trigger.high()
utime.sleep_us(5)
trigger.low()
while echo.value()==0:
apagado=utime.ticks_us()
while echo.value()==1:
encendido=utime.ticks_us()
duracion=encendido-apagado
distancia=duracion/29.4/2
return int(distancia)
while True:
dist = ultra()
print("La distancia al objeto es : ", dist, " cm")
oled = SSD1306_I2C(128, 64, i2c)
oled.text("Dist: " + str(dist) + " cm", 0, 0)
if dist < 15:
red.value(1)
green.value(0)
blue.value(0)
pwm.duty_u16(8000)
buzzer.duty_u16(30000)
oled.text("PELIGRO: CERCA", 0, 20)
oled.text("Servo: Abierto", 0, 40)
elif dist >= 15 and dist <= 40:
red.value(0)
green.value(0)
blue.value(1)
pwm.duty_u16(5000)
buzzer.duty_u16(0)
oled.text("PRECAUCION", 0, 20)
oled.text("Servo: Medio", 0, 40)
else:
red.value(0)
green.value(1)
blue.value(0)
pwm.duty_u16(2000)
buzzer.duty_u16(0)
oled.text("ZONA SEGURA", 0, 20)
oled.text("Servo: Cerrado", 0, 40)
oled.show()
utime.sleep(0.5)Loading
ssd1306
ssd1306