import Adafruit_BBIO.PWM as PWM
import time
# Define PWM pin and servo parameters
PWM_PIN = "P9_14"
PWM_FREQUENCY = 50 # Servo motors typically use a 50Hz frequency
# Initialize PWM
PWM.start(PWM_PIN, 7.5, PWM_FREQUENCY) # Start with 7.5% duty cycle (neutral position)
def set_servo_angle(angle):
# Convert angle to duty cycle
duty_cycle = (0.05 * angle) / 18 + 2.5
PWM.set_duty_cycle(PWM_PIN, duty_cycle)
try:
while True:
for angle in range(0, 181, 10): # Sweep from 0 to 180 degrees
set_servo_angle(angle)
print(f"Servo Angle: {angle} degrees")
time.sleep(0.5)
for angle in range(180, -1, -10): # Sweep back from 180 to 0 degrees
set_servo_angle(angle)
print(f"Servo Angle: {angle} degrees")
time.sleep(0.5)
except KeyboardInterrupt:
print("\nExiting...")
finally:
PWM.stop(PWM_PIN)
PWM.cleanup()
import Adafruit_BBIO.PWM as PWM
import time
# Define PWM pin and servo parameters
PWM_PIN = "P9_14"
PWM_FREQUENCY = 50 # Servo motors typically use a 50Hz frequency
# Initialize PWM
PWM.start(PWM_PIN, 7.5, PWM_FREQUENCY) # Start with 7.5% duty cycle (neutral position)
def set_servo_angle(angle):
# Convert angle to duty cycle
duty_cycle = (0.05 * angle) / 18 + 2.5
PWM.set_duty_cycle(PWM_PIN, duty_cycle)
try:
while True:
for angle in range(0, 181, 10): # Sweep from 0 to 180 degrees
set_servo_angle(angle)
print(f"Servo Angle: {angle} degrees")
time.sleep(0.5)
for angle in range(180, -1, -10): # Sweep back from 180 to 0 degrees
set_servo_angle(angle)
print(f"Servo Angle: {angle} degrees")
time.sleep(0.5)
except KeyboardInterrupt:
print("\nExiting...")
finally:
PWM.stop(PWM_PIN)
PWM.cleanup()
