caReceptionManagement.cpp

Go to the documentation of this file.

#include "caReceptionManagement.h"

caReceptionManagement::caReceptionManagement(ParameterNetwork *network)
{
    quint16 port = network->camDestinationPort(), portInfo = network->camDestinationPortInfo();
    cam2app = new QUdpSocket(this);
    m_internalSocket = new QUdpSocket(this);
    m_internalSocket->bind();
    cam2app->bind();
    network->addPort("CAMReceptionManagement", cam2app->localPort());
    network->addBTPPort(port, portInfo, m_internalSocket->localPort());
    qDebug() << network->internalBTPPort(port, portInfo);
    QObject::connect(m_internalSocket, SIGNAL(readyRead()), this, SLOT(readDatagram()));
    appPort = network->internalPort("Application");
    qDebug() << "appPort" << appPort;
}

caReceptionManagement::~caReceptionManagement()
{
    cam2app->close();
    m_internalSocket->close();
}

//void caReceptionManagement::execute(){}

void caReceptionManagement::readDatagram()
{
    QNetworkDatagram data;

    while(m_internalSocket->hasPendingDatagrams())
    {
        qDebug() << "Receiving CAM";
        data = m_internalSocket->receiveDatagram();

        if(decodeCam(data.data()))
        {
            camEventIndication(data.data());
        }
    }
}

bool caReceptionManagement::decodeCam(QByteArray data)
{
    CAM_t *receivedCAM = 0;
    asn_dec_rval_t rval;

    print_hexa((unsigned char*)data.data(), data.length());
    rval = uper_decode_complete(NULL, &asn_DEF_CAM, (void**)&receivedCAM, data.data(), data.length());
    if(rval.code != RC_OK)
    {
        fprintf(stderr, "Unable to decode CAM: %s\n", rval.code == RC_FAIL ? "RC_FAIL" : "RC_WMORE");
        return false;
    }

    if(receivedCAM->header.protocolVersion != protocolVersion_currentVersion)
    {
        fprintf(stderr, "CAM received has wrong protocol version: %ld instead of %d\n", receivedCAM->header.protocolVersion, protocolVersion_currentVersion);
        return false;
    }

    if(receivedCAM->header.messageID != messageID_cam)
    {
        fprintf(stderr, "CAM received has wrong message ID: %ld instead of %d\n", receivedCAM->header.messageID, messageID_cam);
        return false;
    }

    printf("CAM decoded :\n");
    //asn_fprint(stdout, &asn_DEF_CAM, receivedCAM);

    return true;
}

void caReceptionManagement::camEventIndication(QByteArray packet)
{
    quint8 mt = UpperTesterPrimitives::PRIMITIVE_utCamEventInd;

    QByteArray resUt;
    QDataStream ds(&resUt, QIODevice::WriteOnly);
    ds << mt;
    ds << (quint16)packet.length();
    ds.writeRawData(packet.data(), packet.length());
    qDebug() << packet.length() << "bytes sent to" << appPort;
    qDebug() << resUt.toHex();

    cam2app->writeDatagram(resUt, QHostAddress::LocalHost, appPort);
}