Python • Re: servo PCA9685

Code:

import timeimport boardimport busioimport adafruit_pca9685# Initialize I2C bus and PCA9685i2c = busio.I2C(board.SCL, board.SDA)pca = adafruit_pca9685.PCA9685(i2c)pca.frequency = 50  # Set PWM frequency to 50Hz (standard for servos)# Define the servo channelSERVO_CHANNEL = 0  # Example channel, adjust according to your setup# Function to set servo angledef set_servo_angle(angle):    # Convert angle to pulse width (assuming standard servo parameters)    pulse_width = int((angle * 1000 / 180) + 1000)    # Set PWM duty cycle to control servo angle    pca.channels[SERVO_CHANNEL].duty_cycle = pulse_width * 4096 // 1000000# Function to de-energize the servodef de_energize_servo():    # Set servo to 90 degrees    set_servo_angle(90)    # Set PWM duty cycle to 0 to stop sending signals to the servo    pca.channels[SERVO_CHANNEL].duty_cycle = 0# Function to re-energize the servodef re_energize_servo():    # Set servo back to 90 degrees    set_servo_angle(90)try:    # Position the servo at 90 degrees    set_servo_angle(90)    # Wait for the servo to reach the desired position    time.sleep(1)    # De-energize the servo    de_energize_servo()    # Your main code logic here    # Re-energize the servo back to 90 degrees    re_energize_servo()    # Your main code logic here    # For example, you can wait for a few seconds before exiting the program    time.sleep(5)except KeyboardInterrupt:    # If you want to clean up when the program is interrupted by Ctrl+C    de_energize_servo()