This commit is contained in:
2024-12-25 13:24:12 +01:00
parent 82a127008c
commit 33746aeab6

30
calibration.py Normal file
View File

@@ -0,0 +1,30 @@
import time
from adafruit_servokit import ServoKit
# Initialize ServoKit
kit = ServoKit(channels=16)
# Constants for angles
ANGLE_START = 0
ANGLE_MIDDLE = 110
# Constants for delay
DELAY = 1
# Function to move a leg with user input
def move_leg_with_prompt(leg, angle):
print(f"Leg {leg}: Currently at {kit.servo[leg].angle if kit.servo[leg].angle is not None else 'unknown'}. Moving to {angle}.")
input("Press Enter to continue...")
kit.servo[leg].angle = angle
time.sleep(DELAY)
# Main function
def main():
legs = [0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11]
while True:
for leg in legs:
move_leg_with_prompt(leg, ANGLE_START)
move_leg_with_prompt(leg, ANGLE_MIDDLE)
if __name__ == "__main__":
main()