LibRtosTraceNet.cpp

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

#include "LibRtosTraceNet.hpp"

LibTraceRtosNet::LibTraceRtosNet(int priority, size_t stackSize, uint16_t port) :
        mTask(priority, "RTOS_TRACE", stackSize, *this) {
    mPort = port;
}

LibTraceRtosNet::~LibTraceRtosNet() {
}

void LibTraceRtosNet::run() {
    while (true) {
        mSocket.listen(mPort);
        mSocket.accept(Rtos::TICK_INFINITE);
        Rtos::clearTraceBuffer();
        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_TASK_NAME: {
                        RtosTask* task = (RtosTask*) ((uint32_t*) pkt->data)[0];
                        mPktHandler.sendPkt(mSocket, CMD_GET_TASK_NAME, strlen(task->getName()), task->getName());
                        break;
                    }
                    case GET_CLOCK_FREQUENCY: {
                        uint32_t frequency = RTOS_CFG_CPU_FREQUENCY;
                        mPktHandler.sendPkt(mSocket, GET_CLOCK_FREQUENCY, 4, &frequency);
                        break;
                    }
                    case CMD_GET_TASK_STACK: {
                        RtosTask* task = (RtosTask*) ((uint32_t*) pkt->data)[0];
                        uint32_t param[3];
                        param[0] = (uint32_t) task;
                        param[1] = task->getStackSize();
                        param[2] = task->getFreeStackSize();
                        mPktHandler.sendPkt(mSocket, CMD_GET_TASK_STACK, sizeof(param), param);
                        break;
                    }
                    default:
                        break;
                }
                mPktHandler.freePkt(&pkt);
            }

            Rtos::TRACE_TAG* tag;
            int count = Rtos::getTraceBuffer(&tag);
            if (count > 0) {
                mPktHandler.sendPkt(mSocket, CMD_SEND_TRACE_TAGS, count * sizeof(Rtos::TRACE_TAG), tag);
                Rtos::releaseBuffer(count);
            }
            else if (count < 0) { //Buffer full error
                mPktHandler.sendPkt(mSocket, CMD_BUFFER_FULL, 0, 0, Rtos::convertMsToTick(5000));
                break;
            }
        }
        mPktHandler.reset();
        mSocket.close();
    }
}