diff --git a/thr3.py b/thr3.py index 2a2e315..1f5c377 100644 --- a/thr3.py +++ b/thr3.py @@ -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)