import sys
import time

from src.components.usb_586x import USB_586x

class config:
    id = None
    updated= None

if "--5862" in sys.argv:
    config.id = "USB-5862,BID#0"
    out_size = in_size = 16
else:
    config.id = "USB-5860,BID#0"
    out_size = in_size = 8

digital_io = USB_586x(config)
digital_io.start()

out_num = 0
n_in_bytes = int(in_size/8)
while True:
    out_bit = out_num % 8
    out_byte = int(out_num/8)
    res = digital_io.set_bit(out_byte, out_bit, 1)
    time.sleep(0.5)
    res2 = digital_io.set_bit(out_byte, out_bit, 0)
    input_data = digital_io.get()
    if "--5862" in sys.argv:
        print("in:{} {} out:{}".format(bytes(input_data[0]),bytes(input_data[1]), out_num))
    else:
        print("in:{} out:{}".format(bytes(input_data[0]), out_num))
    time.sleep(0.5)
    out_num += 1
    if out_num == out_size:
        out_num = 0