Comm.cpp

//------------------------------------------------------------------------------
//This file is part of embKernel. 
//See license.txt for the full license governing this code.
//------------------------------------------------------------------------------

#include "Comm.hpp"
#include "Hw.hpp"

Comm::Comm(int priority, size_t stackSize) :
        mTask(priority, "Comm", stackSize, *this) {

}

Comm::~Comm() {

}

void Comm::run() {
    while (true) {
        mSocket.listen(54000);
        mSocket.accept(Rtos::TICK_INFINITE);
        while (mSocket.isConnected()) {
            LibPktHandler::PKT* pkt;
            LibPktHandler::RESULT result = mPktHandler.recvPkt(mSocket, &pkt, RTOS_CFG_TRACE_BUFFER_SIZE / 2);
            if (result == LibPktHandler::RES_SUCCESS) {
                switch (pkt->hdr.cmd) {
                    case CMD_GET_LEDS: {
                        uint8_t buffer[4];
                        buffer[0] = Hw::sLed1;
                        buffer[1] = Hw::sLed2;
                        buffer[2] = Hw::sLed3;
                        buffer[3] = Hw::sLed4;
                        mPktHandler.sendPkt(mSocket, CMD_GET_LEDS, sizeof(buffer), buffer);
                        break;
                    }
                    case CMD_SET_LEDS: {
                        Hw::sLed1 = pkt->data[0];
                        Hw::sLed2 = pkt->data[1];
                        Hw::sLed3 = pkt->data[2];
                        Hw::sLed4 = pkt->data[3];
                        mPktHandler.sendPkt(mSocket, CMD_SET_LEDS, 4, pkt->data);
                        break;
                    }
                    default:
                        break;
                }
                mPktHandler.freePkt(&pkt);
            }
        }
        mPktHandler.reset();
        mSocket.close();

    }
}