78 lines
1.7 KiB
Python
78 lines
1.7 KiB
Python
import threading
|
|
import time
|
|
from adafruit_servokit import ServoKit
|
|
|
|
kit = ServoKit(channels=16)
|
|
|
|
#leg = int(input("leg"))
|
|
def left2():
|
|
kit.servo[2].angle = 0
|
|
kit.servo[8].angle = 0
|
|
time.sleep(1)
|
|
kit.servo[2].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[8].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[2].angle = 0
|
|
def left1():
|
|
kit.servo[1].angle = 0
|
|
kit.servo[7].angle = 0
|
|
time.sleep(1)
|
|
kit.servo[1].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[7].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[1].angle = 0
|
|
def left0():
|
|
kit.servo[0].angle = 0
|
|
kit.servo[6].angle = 0
|
|
time.sleep(1)
|
|
kit.servo[0].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[6].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[0].angle = 0
|
|
def right5():
|
|
kit.servo[5].angle = 0
|
|
kit.servo[11].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[5].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[11].angle = 0
|
|
time.sleep(1)
|
|
kit.servo[5].angle = 0
|
|
def right4():
|
|
kit.servo[4].angle = 0
|
|
kit.servo[10].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[4].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[10].angle = 0
|
|
time.sleep(1)
|
|
kit.servo[4].angle = 0
|
|
def right3():
|
|
kit.servo[3].angle = 0
|
|
kit.servo[9].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[3].angle = 110
|
|
time.sleep(1)
|
|
kit.servo[9].angle = 0
|
|
time.sleep(1)
|
|
kit.servo[leg].angle = 0
|
|
|
|
|
|
leg0 = threading.Thread(target=left0, args=())
|
|
leg1 = threading.Thread(target=left1, args=())
|
|
leg2 = threading.Thread(target=left2, args=())
|
|
leg3 = threading.Thread(target=right3, args=())
|
|
leg4 = threading.Thread(target=right4, args=())
|
|
leg5 = threading.Thread(target=right5, args=())
|
|
leg0.start()
|
|
leg2.start()
|
|
leg4.start()
|
|
time.sleep(3)
|
|
leg1.start()
|
|
leg3.start()
|
|
leg5.start()
|
|
|