import threading
import time
from adafruit_servokit import ServoKit # type: ignore

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[3].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=())
while True:
    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()
    leg0.join()
    leg2.join()
    leg4.join()
    time.sleep(1)
    leg1.start()
    leg3.start()
    leg5.start()
    leg1.join()
    leg3.join()
    leg5.join()