import utime
import machine
import serial, time


CKP_H = machine.Pin(16, machine.Pin.OUT)
CKP_L = machine.Pin(17, machine.Pin.OUT)

COUNT_TOTAL = 360
GRADES = 720

RPM = 6000

N_TOOTH = 36
CKP_STATE = True
CKP_K1 = 6000000

N_TOOTH_NULL = 1
POS_TOOTH_NULL = 400
POS_TOOTH_NULL_END = 500
N_TOOTH_CTRL = False


print("Hello, Pi Pico!")

CKP_LIST   = [0,0,1,1,0,0,1,1,0,0,1,1,0,0,1,1,0,0,1,1,0,0,1,1,0,0,1,1,0,0,1,1,0,0,1,1,0]
CMP_1_LIST = [0,0,0,0,0,0,0,0,0,0,0,0,1,1,1,1,1,1,1,1,0,0,0,0,0,0,0,0,0,0,0]

while True:
    
    CKP_K2 = N_TOOTH*RPM
    CKP_SLEEP = CKP_K1/CKP_K2
    
    for COUNT in range(N_TOOTH):
        CKP_H.value(CKP_LIST[COUNT])
        if CKP_LIST[COUNT] == 0:
            CKP_L.value(1)
        else:
            CKP_L.value(0)
        utime.sleep_ms(int(CKP_SLEEP))