a
This commit is contained in:
22
walk.py
22
walk.py
@@ -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)
|
||||
|
||||
|
||||
Reference in New Issue
Block a user