36 lines
961 B
Python
36 lines
961 B
Python
import time
|
|
from adafruit_servokit import ServoKit
|
|
|
|
# Initialize ServoKit
|
|
kit = ServoKit(channels=16)
|
|
|
|
# Constants for delay
|
|
DELAY = 1
|
|
|
|
# Function to move a specified leg to a specified angle
|
|
def move_leg(leg, angle):
|
|
print(f"Moving leg {leg} to angle {angle}.")
|
|
kit.servo[leg].angle = angle
|
|
time.sleep(DELAY)
|
|
|
|
# Main function
|
|
def main():
|
|
while True:
|
|
try:
|
|
leg = int(input("Enter the leg number (0-15): "))
|
|
if leg < 0 or leg > 15:
|
|
print("Invalid leg number. Please enter a number between 0 and 15.")
|
|
continue
|
|
|
|
angle = int(input("Enter the angle (0-180): "))
|
|
if angle < 0 or angle > 180:
|
|
print("Invalid angle. Please enter a number between 0 and 180.")
|
|
continue
|
|
|
|
move_leg(leg, angle)
|
|
except ValueError:
|
|
print("Invalid input. Please enter numeric values.")
|
|
|
|
if __name__ == "__main__":
|
|
main()
|