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