from time import sleep
from DialityCoreSerialProtocol import START_BYTE
import serial


if __name__ == "__main__":

    serialConnection = serial.Serial(port='/dev/ttyUSB1', baudrate=115200)

    packet = bytearray([int.from_bytes(START_BYTE,byteorder="big"), 0,0,1,2,0])

    crc = sum(packet)
    n = len(packet)
    packet[n-1] = crc


    packet2 = packet + packet[0:3]
    serialConnection.write(packet2)
    sleep(0.1)
    packet3 = packet[3:] + packet
    serialConnection.write(packet3)
    sleep(0.1)
    for i in range(2,5):
        packetA = packet[0:i]
        packetB = packet[i:]

        serialConnection.write(packetA)

        sleep(0.1)

        serialConnection.write(packetB)

        sleep(0.1)

    serialConnection.write(packet[0:2])
    sleep(0.1)
    serialConnection.write(packet)
    sleep(0.1)
    serialConnection.write(packet)