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