#include "WorkerDesktop.hpp"

bool WorkerDesktop::handleMessage(uint32_t queueID)
{

    QueueHandle_t queue = queues[queueID];

    std::string qname = queueNameMap[queue];
    LOG_INFO("[ServiceDesktop:Worker] Received data from queue: %s", qname.c_str());

    static std::string receiveMsg;
    static std::string *sendMsg;

    if (qname == SERVICE_QUEUE_NAME) {
        LOG_ERROR("[ServiceDesktop:Worker] Service Queue invoked but not implemented!");
    }

    if (qname == RECEIVE_QUEUE_BUFFER_NAME) {
        if (xQueueReceive(queue, &receiveMsg, 0) != pdTRUE)
            return false;

        ParserFsm::msgChunk.assign(receiveMsg.begin(), receiveMsg.end());
        while (!ParserFsm::msgChunk.empty()) {
            send_event(MessageDataEvt(service));
        }
    }

    // TODO: Consider moving sendBuffer receive to bsp driver
    if (qname == SEND_QUEUE_BUFFER_NAME) {
        if (xQueueReceive(queue, &sendMsg, 0) != pdTRUE)
            return false;

        bsp::usbCDCSend(sendMsg);
    }

    return true;
}

bool WorkerDesktop::init(std::list<sys::WorkerQueueInfo> queues)
{
    Worker::init(queues);

    if ((bsp::usbCDCInit(Worker::getQueueByName("receiveQueueBuffer")) < 0)) {
        LOG_ERROR("won't start desktop service without serial port");
        return false;
    }

    EndpointFsm::sendQueue = Worker::getQueueByName("sendQueueBuffer");

    fsm_list::start();

    return true;
}

bool WorkerDesktop::deinit(void)
{
    Worker::deinit();
    return true;
}