This commit is contained in:
2024-12-25 23:22:21 +01:00
parent b1f329b9f4
commit daf93d162d

22
walk.py
View File

@@ -27,25 +27,25 @@ SERVO_ANGLES = {
# Movement functions
def move_leg(servo1, servo2):
"""Moves a pair of servos synchronously and prints their positions."""
front1, back1, neutral1 = SERVO_ANGLES[servo1]
front2, back2, neutral2 = SERVO_ANGLES[servo2]
up1, down, neutral1 = SERVO_ANGLES[servo1]
front, back, neutral2 = SERVO_ANGLES[servo2]
kit.servo[servo1].angle = front1
kit.servo[servo1].angle = up1
time.sleep(DELAY)
kit.servo[servo2].angle = front2
print(f"Servos {servo1} and {servo2} set to FRONT angles: {front1}, {front2}")
kit.servo[servo2].angle = front
print(f"Servos {servo1} and {servo2} set to UP and FRONT angles: {up1}, {front}")
time.sleep(DELAY)
kit.servo[servo1].angle = back1
print(f"Servo {servo1} set to BACK angle: {back1}")
kit.servo[servo1].angle = down
print(f"Servo {servo1} set to DOWN angle: {down}")
time.sleep(DELAY)
kit.servo[servo2].angle = back2
print(f"Servo {servo2} set to BACK angle: {back2}")
kit.servo[servo2].angle = back
print(f"Servo {servo2} set to BACK angle: {back}")
time.sleep(DELAY)
kit.servo[servo1].angle = front1
print(f"Servo {servo1} set to FRONT angle: {front1}")
kit.servo[servo1].angle = up1
print(f"Servo {servo1} set to UP angle: {up1}")
time.sleep(DELAY)