PROYECTO II B 2024 » Grupo 4B-2024

import RPi.GPIO as GPIO

import time

# Configuración del GPIO

GPIO.setmode(GPIO.BCM)  # Usar la numeración BCM

GPIO.setup(9, GPIO.OUT)  # Configurar GPIO 9 como salida (ajustar el pin si es necesario)

# Configurar PWM en el pin 9 con una frecuencia de 50 Hz

pwm = GPIO.PWM(9, 50)

pwm.start(0)  # Iniciar PWM con ciclo de trabajo 0%

def set_angle(angle):

    """Configura el ángulo del servo (0 a 180 grados)."""

    duty_cycle = 2 + (angle / 18)  # Mapear ángulo a ciclo de trabajo

    pwm.ChangeDutyCycle(duty_cycle)  # Cambiar ciclo de trabajo para ajustar el ángulo

    time.sleep(0.5)  # Espera para que el servo se mueva

def rotate_servo():

    """Gira el servomotor durante 4 segundos y luego lo detiene."""

    start_time = time.time()  # Registrar el tiempo de inicio

    while time.time() - start_time < 4:  # Hacerlo durante 4 segundos

        # Movimiento de ida y vuelta (0 a 180 y luego 180 a 0)

        for angle in range(0, 181):  # Mover el servo de 0 a 180 grados

            set_angle(angle)

            if time.time() - start_time >= 4:

                return  # Si han pasado 4 segundos, detener el servo

        for angle in range(180, -1, -1):  # Mover el servo de 180 a 0 grados

            set_angle(angle)

            if time.time() - start_time >= 4:

                return  # Si han pasado 4 segundos, detener el servo

# Iniciar el movimiento del servo

try:

    rotate_servo()  # Girar el servo durante 4 segundos

finally:

    pwm.stop()  # Detener el PWM

    GPIO.cleanup()  # Limpiar la configuración de los GPIO