GNDataRequest.cpp

Go to the documentation of this file.

#include <GNDataRequest.h>

QByteArray gnDataRequestToBin(gnDataRequest_t gnDR)
{
    QByteArray rawPacket;
    QDataStream ds(&rawPacket, QIODevice::WriteOnly);

    quint8 opts = 0;
    if(gnDR.maximumPacketLifeTime)
        opts |= 1 << 7;
    if(gnDR.repetitionInterval)
        opts |= 1 << 6;
    if(gnDR.maximumRepetitionTime)
        opts |= 1 << 5;
    if(gnDR.maximumHopLimit)
        opts |= 1 << 4;

    ds << opts;

    ds << (quint8) gnDR.upperProtocolEntity;
    ds << (quint8) gnDR.packetTransportType;
    ds << gnDR.packetTransportSubType;
    ds << gnDR.destinationPort;
    ds << gnDR.destinationPortInfo;
    ds << (quint8) gnDR.destinationAddress.present;

    if(gnDR.destinationAddress.present == destinationAddress_PR_MID)
    {
        ds << gnDR.destinationAddress.choice.gnAddr.stationType_StationCountryCode;
        ds.writeRawData((char*)gnDR.destinationAddress.choice.gnAddr.mid, 6);
    }
    if(gnDR.destinationAddress.present == destinationAddress_PR_DestinationArea)
    {
        ds << gnDR.destinationAddress.choice.destinationArea.angle;
        ds << gnDR.destinationAddress.choice.destinationArea.distanceA;
        ds << gnDR.destinationAddress.choice.destinationArea.distanceB;
        ds << gnDR.destinationAddress.choice.destinationArea.geoAreaPosLatitude;
        ds << gnDR.destinationAddress.choice.destinationArea.geoAreaPosLongitude;
    }

    ds << (quint8) gnDR.gnCommunicationProfile;
    if(gnDR.maximumPacketLifeTime != 0)
        ds.writeRawData(gnDR.maximumPacketLifeTime->toHex(), LifeTime::helper_size);
    if(gnDR.repetitionInterval != 0)
        ds << *gnDR.repetitionInterval;
    if(gnDR.maximumRepetitionTime != 0)
        ds << *gnDR.maximumRepetitionTime;
    if(gnDR.maximumHopLimit != 0)
        ds << *gnDR.maximumHopLimit;

    ds.writeRawData(gnDR.trafficClass.toHex(), TrafficClass::helper_size);
    ds << (quint16) gnDR.payload.length();
    ds.writeRawData(gnDR.payload, gnDR.payload.length());

    return rawPacket;
}

gnDataRequest_t gnDataRequestFromBin(QByteArray rawPacket)
{
    gnDataRequest_t gnDR;
    gnDR.maximumPacketLifeTime = 0;
    gnDR.repetitionInterval = 0;
    gnDR.maximumRepetitionTime = 0;
    gnDR.maximumHopLimit = 0;

    char* data= rawPacket.data();
    int offset = 0;
    quint8 opt = 0;

    opt = extractUInt(data, 1, &offset);

    if(opt & (1 << 7))
        gnDR.maximumPacketLifeTime = (LifeTime*) calloc(1, sizeof *gnDR.maximumPacketLifeTime);
    if(opt & (1 << 6))
        gnDR.repetitionInterval = (quint16*) calloc(1, sizeof *gnDR.repetitionInterval);
    if(opt & (1 << 5))
        gnDR.maximumRepetitionTime = (quint16*) calloc(1, sizeof *gnDR.maximumRepetitionTime);
    if(opt & (1 << 4))
        gnDR.maximumHopLimit = (quint8*) calloc(1, sizeof *gnDR.maximumHopLimit);

    gnDR.upperProtocolEntity = (CommonHeader::e_upperProtocolEntity) extractUInt(data, 1, &offset);

    gnDR.packetTransportType = (CommonHeader::e_headerType) extractUInt(data, 1, &offset);
    gnDR.packetTransportSubType = extractUInt(data, 1, &offset);
    gnDR.destinationPort = extractUInt(data, 2, &offset);
    gnDR.destinationPortInfo = extractUInt(data, 2, &offset);
    gnDR.destinationAddress.present = (e_destinationAddress_PR_present) extractUInt(data, 1, &offset);

    if(gnDR.destinationAddress.present == destinationAddress_PR_MID)
    {
        gnDR.destinationAddress.choice.gnAddr.stationType_StationCountryCode = extractUInt(data, 2, &offset);
        for(int i=0; i < 6; i++)
            gnDR.destinationAddress.choice.gnAddr.mid[i] = extractUInt(data, 1, &offset);
    }

    if(gnDR.destinationAddress.present == destinationAddress_PR_DestinationArea)
    {
        gnDR.destinationAddress.choice.destinationArea.angle = extractUInt(data, 2, &offset);
        gnDR.destinationAddress.choice.destinationArea.distanceA = extractUInt(data, 2, &offset);
        gnDR.destinationAddress.choice.destinationArea.distanceB = extractUInt(data, 2, &offset);
        gnDR.destinationAddress.choice.destinationArea.geoAreaPosLatitude = extractInt(data, 4, &offset);
        gnDR.destinationAddress.choice.destinationArea.geoAreaPosLongitude = extractInt(data, 4, &offset);
    }

    gnDR.gnCommunicationProfile = (e_gnCommunicationProfile) extractUInt(data, 1, &offset);
    if(gnDR.maximumPacketLifeTime)
        *gnDR.maximumPacketLifeTime = LifeTime(extractUInt(data, 1, &offset));
    if(gnDR.repetitionInterval)
        *gnDR.repetitionInterval = extractUInt(data, 2, &offset);
    if(gnDR.maximumRepetitionTime)
        *gnDR.maximumRepetitionTime = extractUInt(data, 2, &offset);
    if(gnDR.maximumHopLimit)
        *gnDR.maximumHopLimit = extractUInt(data, 1, &offset);

    gnDR.trafficClass = TrafficClass(extractUInt(data, 1, &offset));
    quint16 plLen = extractUInt(data, 2, &offset);

    gnDR.payload = QByteArray(data + offset, plLen-2);

    return gnDR;
}