a
This commit is contained in:
14
thr3.py
14
thr3.py
@@ -15,16 +15,25 @@ DELAY = 1
|
|||||||
|
|
||||||
# Movement functions
|
# Movement functions
|
||||||
def move_leg(servo1, servo2):
|
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[servo1].angle = ANGLE_START
|
||||||
kit.servo[servo2].angle = ANGLE_START
|
kit.servo[servo2].angle = ANGLE_START
|
||||||
|
print(f"Servos {servo1} and {servo2} set to ANGLE_START: {ANGLE_START}")
|
||||||
time.sleep(DELAY)
|
time.sleep(DELAY)
|
||||||
|
|
||||||
kit.servo[servo1].angle = ANGLE_MIDDLE
|
kit.servo[servo1].angle = ANGLE_MIDDLE
|
||||||
|
print(f"Servo {servo1} set to ANGLE_MIDDLE: {ANGLE_MIDDLE}")
|
||||||
time.sleep(DELAY)
|
time.sleep(DELAY)
|
||||||
|
|
||||||
kit.servo[servo2].angle = ANGLE_MIDDLE
|
kit.servo[servo2].angle = ANGLE_MIDDLE
|
||||||
|
print(f"Servo {servo2} set to ANGLE_MIDDLE: {ANGLE_MIDDLE}")
|
||||||
time.sleep(DELAY)
|
time.sleep(DELAY)
|
||||||
|
|
||||||
kit.servo[servo1].angle = ANGLE_NEUTRAL
|
kit.servo[servo1].angle = ANGLE_NEUTRAL
|
||||||
|
print(f"Servo {servo1} set to ANGLE_NEUTRAL: {ANGLE_NEUTRAL}")
|
||||||
|
|
||||||
kit.servo[servo2].angle = ANGLE_NEUTRAL
|
kit.servo[servo2].angle = ANGLE_NEUTRAL
|
||||||
|
print(f"Servo {servo2} set to ANGLE_NEUTRAL: {ANGLE_NEUTRAL}")
|
||||||
|
|
||||||
def left_leg_0():
|
def left_leg_0():
|
||||||
move_leg(0, 6)
|
move_leg(0, 6)
|
||||||
@@ -70,7 +79,10 @@ def group_2():
|
|||||||
# Main loop
|
# Main loop
|
||||||
if __name__ == "__main__":
|
if __name__ == "__main__":
|
||||||
while True:
|
while True:
|
||||||
|
print("Executing Group 1 movements...")
|
||||||
group_1()
|
group_1()
|
||||||
time.sleep(DELAY)
|
time.sleep(DELAY)
|
||||||
|
|
||||||
|
print("Executing Group 2 movements...")
|
||||||
group_2()
|
group_2()
|
||||||
time.sleep(DELAY)
|
time.sleep(DELAY)
|
||||||
|
|||||||
Reference in New Issue
Block a user