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