from DialityCoreCanProtocol import DialityCanMessenger
from DialityCoreCanProtocol import DialityPacket
from time import sleep




diality_messenger = DialityCanMessenger()


# Building response message
response_req_id = 0x03
response_packet = DialityPacket.buildPacket(response_req_id, [1, 2])

# Building Sync response message
sync_req_id = 0x05
sync_packet = DialityPacket.buildPacket(sync_req_id, [0x06, 0x02])

# Building Sync message
sync_req_id = 0x05
sync_packet_2 = DialityPacket.buildPacket(sync_req_id, [1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15])


channel_id = 0x01

print("")
print("o -> response")
print(". -> Sync")
print("")


def respondToCommand(packet):

    diality_messenger.send(channel_id, response_packet)
    print("o", end='', flush=True)


# Register response command for the DG
diality_messenger.registerSyncFunction(channel_id, response_req_id, respondToCommand)
diality_messenger.start()


# This is the main loop
while True:

    diality_messenger.send(channel_id, sync_packet_2)
    print(".", end='', flush=True)

    sleep(1)