This commit is contained in:
2024-12-25 18:31:08 +01:00
parent 750d42471b
commit 5bfe2296e8

14
thr3.py
View File

@@ -15,16 +15,25 @@ DELAY = 1
# Movement functions
def move_leg(servo1, servo2):
"""Moves a pair of servos synchronously."""
"""Moves a pair of servos synchronously and prints their positions."""
kit.servo[servo1].angle = ANGLE_START
kit.servo[servo2].angle = ANGLE_START
print(f"Servos {servo1} and {servo2} set to ANGLE_START: {ANGLE_START}")
time.sleep(DELAY)
kit.servo[servo1].angle = ANGLE_MIDDLE
print(f"Servo {servo1} set to ANGLE_MIDDLE: {ANGLE_MIDDLE}")
time.sleep(DELAY)
kit.servo[servo2].angle = ANGLE_MIDDLE
print(f"Servo {servo2} set to ANGLE_MIDDLE: {ANGLE_MIDDLE}")
time.sleep(DELAY)
kit.servo[servo1].angle = ANGLE_NEUTRAL
print(f"Servo {servo1} set to ANGLE_NEUTRAL: {ANGLE_NEUTRAL}")
kit.servo[servo2].angle = ANGLE_NEUTRAL
print(f"Servo {servo2} set to ANGLE_NEUTRAL: {ANGLE_NEUTRAL}")
def left_leg_0():
move_leg(0, 6)
@@ -70,7 +79,10 @@ def group_2():
# Main loop
if __name__ == "__main__":
while True:
print("Executing Group 1 movements...")
group_1()
time.sleep(DELAY)
print("Executing Group 2 movements...")
group_2()
time.sleep(DELAY)