PROYECTO II B 2024 » Grupo 4B-2024

# -*- coding: utf-8 -*-

import RPi.GPIO as GPIO

import time

GPIO.setmode(GPIO.BCM)

TRIG = 3  # Pin Trigger

ECHO = 4  # Pin Echo

GPIO.setup(TRIG, GPIO.OUT)

GPIO.setup(ECHO, GPIO.IN)

def medir_distancia():

    # Asegúrate de que Trigger esté en bajo

    GPIO.output(TRIG, False)

    time.sleep(2)

    # Enviar pulso de 10us al Trigger

    GPIO.output(TRIG, True)

    time.sleep(0.00001)

    GPIO.output(TRIG, False)

    # Medir tiempo de respuesta del Echo

    while GPIO.input(ECHO) == 0:

        pulso_inicio = time.time()

    while GPIO.input(ECHO) == 1:

        pulso_fin = time.time()

    # Calcular la duración del pulso

    duracion_pulso = pulso_fin - pulso_inicio

    # Calcular distancia (34300 cm/s es la velocidad del sonido)

    distancia = duracion_pulso * 17150  # cm

    distancia = round(distancia, 2)

    return distancia

try:

    while True:

        distancia = medir_distancia()

        print("Distancia:", distancia, "cm")

        time.sleep(1)

except KeyboardInterrupt:

    print("\nSaliendo...")

finally:

    GPIO.cleanup()