CBFPacketBuffer.cpp

Go to the documentation of this file.

#include "CBFPacketBuffer.h"

int CBFPacketBuffer::nbCBFPacketQueued = 0;

CBFPacketBuffer::CBFPacketBuffer()
{
    m_mutex = new QMutex;
    m_paramNetwork = 0;
    m_locationTable = 0;
    m_paramGPS = 0;
    m_HPB = 0;
    m_CBFPBCounter = 0;
}

CBFPacketBuffer::CBFPacketBuffer(ParameterNetwork* paramNetwork, QHash<QByteArray, LocationTableEntry>* locT, GnAddr* gnAddr, FakeGPSProvider* paramGPS, HistoryPacketBuffer* HPB, quint16* SN, QHash<QByteArray, int> *CBFPBCounter)
{
    m_mutex = new QMutex;
    m_paramNetwork = paramNetwork;
    m_locationTable = locT;
    m_gnAddr = gnAddr;
    m_paramGPS = paramGPS;
    m_HPB = HPB;
    sequenceNumber = SN;
    m_CBFPBCounter = CBFPBCounter;
}

CBFPacketBuffer::CBFPacketBuffer(const CBFPacketBuffer& other) : QObject()
{
    this->m_mutex = other.m_mutex;
    this->m_CBFPacketBuffer = other.m_CBFPacketBuffer;
    this->m_paramNetwork = other.m_paramNetwork;
    this->m_locationTable = other.m_locationTable;
    this->m_gnAddr = other.m_gnAddr;
    this->m_paramGPS = other.m_paramGPS;
    this->m_HPB = other.m_HPB;
    this->sequenceNumber = other.sequenceNumber;
    this->m_CBFPBCounter = other.m_CBFPBCounter;
}

int CBFPacketBuffer::addPacket(BasicHeader bh, CommonHeader ch, GBCPacket packet, QByteArray payload, int timeToBuffer)
{
    if(!isDuplicateTimestamp(packet))
    {
        CBFPacketEntry* cbfpe = new CBFPacketEntry(bh, ch, packet, payload, timeToBuffer, m_paramNetwork, m_gnAddr, m_paramGPS, m_HPB, sequenceNumber);

        /* If the number of packet exceed the max buffer size, the first packet will be dropped and the packet will be added to the end of the queue */
        if(nbCBFPacketQueued >= itsGnCbfPacketbufferSize)
        {
            m_CBFPacketBuffer.first()->kill();
            m_CBFPacketBuffer.pop_front();
            nbCBFPacketQueued -= 1;
        }

        if(isDuplicateTimestamp(packet))
        {
            printf("\n\n\n\n\nDUPLICATE CBF GBC\n\n\n\n\n");
            return nbCBFPacketQueued;
        }

        QObject::connect(cbfpe, SIGNAL(packetSent(GBCPacket)), this, SLOT(sendPacket(GBCPacket)));
        QObject::connect(cbfpe, SIGNAL(killMe(GBCPacket)), this, SLOT(stopPacket(GBCPacket)));
        QObject::connect(this, SIGNAL(killAll()), cbfpe, SLOT(kill()));
        m_CBFPacketBuffer.push_back(cbfpe);

        QThread* th = new QThread;
        cbfpe->moveToThread(th);
        QObject::connect(th, SIGNAL(started()), cbfpe, SLOT(execute()));
        th->start();

        return ++nbCBFPacketQueued;
    }
    else
        return -1;
}

int CBFPacketBuffer::addPacket(BasicHeader bh, CommonHeader ch, GUCPacket packet, QByteArray payload, int timeToBuffer)
{
    if(!isDuplicateTimestamp(packet))
    {
        CBFPacketEntry* cbfpe = new CBFPacketEntry(bh, ch, packet, payload, timeToBuffer, m_paramNetwork, m_gnAddr, m_paramGPS, m_HPB, sequenceNumber);

        /* If the number of packet exceed the max buffer size, the first packet will be dropped and the packet will be added to the end of the queue */
        if(nbCBFPacketQueued >= itsGnCbfPacketbufferSize)
        {
            m_CBFPacketBuffer.first()->kill();
            m_CBFPacketBuffer.pop_front();
            nbCBFPacketQueued -= 1;
        }

        if(isDuplicateTimestamp(packet))
        {
            printf("\n\n\n\n\nDUPLICATE CBF GUC\n\n\n\n\n");
            return nbCBFPacketQueued;
        }

        QObject::connect(cbfpe, SIGNAL(packetSent(GUCPacket)), this, SLOT(sendPacket(GUCPacket)));
        QObject::connect(cbfpe, SIGNAL(killMe(GUCPacket)), this, SLOT(stopPacket(GUCPacket)));
        QObject::connect(this, SIGNAL(killAll()), cbfpe, SLOT(kill()));
        m_CBFPacketBuffer.push_back(cbfpe);

        QThread* th = new QThread;
        cbfpe->moveToThread(th);
        QObject::connect(th, SIGNAL(started()), cbfpe, SLOT(execute()));
        th->start();

        return ++nbCBFPacketQueued;
    }
    else
        return -1;
}

int CBFPacketBuffer::addPacket(BasicHeader bh, CommonHeader ch, LSReplyPacket packet, QByteArray payload, int timeToBuffer)
{
    if(!isDuplicateTimestamp(packet))
    {
        CBFPacketEntry* cbfpe = new CBFPacketEntry(bh, ch, packet, payload, timeToBuffer, m_paramNetwork, m_gnAddr, m_paramGPS, m_HPB, sequenceNumber);

        /* If the number of packet exceed the max buffer size, the first packet will be dropped and the packet will be added to the end of the queue */
        if(nbCBFPacketQueued >= itsGnCbfPacketbufferSize)
        {
            m_CBFPacketBuffer.first()->kill();
            m_CBFPacketBuffer.pop_front();
            nbCBFPacketQueued -= 1;
        }

        if(isDuplicateTimestamp(packet))
        {
            printf("\n\n\n\n\nDUPLICATE CBF LSREPLY\n\n\n\n\n");
            return nbCBFPacketQueued;
        }

        QObject::connect(cbfpe, SIGNAL(packetSent(LSReplyPacket)), this, SLOT(sendPacket(LSReplyPacket)));
        QObject::connect(cbfpe, SIGNAL(killMe(LSReplyPacket)), this, SLOT(stopPacket(LSReplyPacket)));
        QObject::connect(this, SIGNAL(killAll()), cbfpe, SLOT(kill()));
        m_CBFPacketBuffer.push_back(cbfpe);

        QThread* th = new QThread;
        cbfpe->moveToThread(th);
        QObject::connect(th, SIGNAL(started()), cbfpe, SLOT(execute()));
        th->start();

        return ++nbCBFPacketQueued;
    }
    else
        return -1;
}

bool CBFPacketBuffer::update(GBCPacket packet, int timeToBuffer)
{
    bool b = false;
    for(QVector<CBFPacketEntry*>::Iterator i = m_CBFPacketBuffer.begin();i != m_CBFPacketBuffer.end(); ++i)
        if(((*i)->commonHeader().headerType() == CommonHeader::headerType_geoAnycast || (*i)->commonHeader().headerType() == CommonHeader::headerType_geoBroadcast) && isDuplicatePacketDetectionTimestampSN((*i)->gbcPacket().soPv().timestamp(), packet.soPv().timestamp(), (*i)->gbcPacket().sequenceNumber(), packet.sequenceNumber()))
        {
            (*i)->restartTimer(timeToBuffer);
            b = true;
        }
    return b;
}

bool CBFPacketBuffer::update(GUCPacket packet, int timeToBuffer)
{
    bool b = false;
    for(QVector<CBFPacketEntry*>::Iterator i = m_CBFPacketBuffer.begin();i != m_CBFPacketBuffer.end(); ++i)
        if((*i)->commonHeader().headerType() == CommonHeader::headerType_geoUnicast && isDuplicatePacketDetectionTimestampSN((*i)->gucPacket().soPv().timestamp(), packet.soPv().timestamp(), (*i)->gucPacket().sequenceNumber(), packet.sequenceNumber()))
        {
            (*i)->restartTimer(timeToBuffer);
            b = true;
        }
    return b;
}

bool CBFPacketBuffer::update(LSReplyPacket packet, int timeToBuffer)
{
    bool b = false;
    for(QVector<CBFPacketEntry*>::Iterator i = m_CBFPacketBuffer.begin();i != m_CBFPacketBuffer.end(); ++i)
        if((*i)->commonHeader().headerType() == CommonHeader::headerType_locationService && (*i)->commonHeader().headerSubType() == CommonHeader::headerSubTypeLocationService_Reply && isDuplicatePacketDetectionTimestampSN((*i)->lsReplyPacket().soPv().timestamp(), packet.soPv().timestamp(), (*i)->lsReplyPacket().sequenceNumber(), packet.sequenceNumber()))
        {
            (*i)->restartTimer(timeToBuffer);
            b = true;
        }
    return b;
}

bool CBFPacketBuffer::isDuplicateTimestamp(GBCPacket packet)
{
    bool b = false;
    for(QVector<CBFPacketEntry*>::Iterator i = m_CBFPacketBuffer.begin();i != m_CBFPacketBuffer.end(); ++i)
        if(((*i)->commonHeader().headerType() == CommonHeader::headerType_geoAnycast || (*i)->commonHeader().headerType() == CommonHeader::headerType_geoBroadcast) && isDuplicatePacketDetectionTimestampSN((*i)->gbcPacket().soPv().timestamp(), packet.soPv().timestamp(), (*i)->gbcPacket().sequenceNumber(), packet.sequenceNumber()))
            b = true;
    return b;
}

bool CBFPacketBuffer::isDuplicateTimestamp(GUCPacket packet)
{
    bool b = false;
    for(QVector<CBFPacketEntry*>::Iterator i = m_CBFPacketBuffer.begin();i != m_CBFPacketBuffer.end(); ++i)
        if((*i)->commonHeader().headerType() == CommonHeader::headerType_geoUnicast && isDuplicatePacketDetectionTimestampSN((*i)->gucPacket().soPv().timestamp(), packet.soPv().timestamp(), (*i)->gucPacket().sequenceNumber(), packet.sequenceNumber()))
            b = true;
    return b;
}

bool CBFPacketBuffer::isDuplicateTimestamp(LSReplyPacket packet)
{
    bool b = false;
    for(QVector<CBFPacketEntry*>::Iterator i = m_CBFPacketBuffer.begin();i != m_CBFPacketBuffer.end(); ++i)
        if((*i)->commonHeader().headerType() == CommonHeader::headerType_locationService && (*i)->commonHeader().headerSubType() == CommonHeader::headerSubTypeLocationService_Reply && isDuplicatePacketDetectionTimestampSN((*i)->lsReplyPacket().soPv().timestamp(), packet.soPv().timestamp(), (*i)->lsReplyPacket().sequenceNumber(), packet.sequenceNumber()))
            b = true;
    return b;
}

bool CBFPacketBuffer::erase(GBCPacket packet)
{
    bool b = false;
    int j = 0;
    for(QVector<CBFPacketEntry*>::Iterator i = m_CBFPacketBuffer.begin();j < m_CBFPacketBuffer.size(); ++i, j++)
        if(isDuplicatePacketDetectionTimestampSN((*i)->gbcPacket().soPv().timestamp(), packet.soPv().timestamp(), (*i)->gbcPacket().sequenceNumber(), packet.sequenceNumber()))
        {
            (*i)->kill();
            nbCBFPacketQueued -= 1;
            b = true;
            m_CBFPacketBuffer.erase(i);
        }
    return b;
}

bool CBFPacketBuffer::erase(GUCPacket packet)
{
    bool b = false;
    int j = 0;
    for(QVector<CBFPacketEntry*>::Iterator i = m_CBFPacketBuffer.begin();j < m_CBFPacketBuffer.size(); ++i, j++)
        if(isDuplicatePacketDetectionTimestampSN((*i)->gucPacket().soPv().timestamp(), packet.soPv().timestamp(), (*i)->gucPacket().sequenceNumber(), packet.sequenceNumber()))
        {
            (*i)->kill();
            m_CBFPacketBuffer.erase(i);
            nbCBFPacketQueued -= 1;
            b = true;
        }
    return b;
}

bool CBFPacketBuffer::erase(LSReplyPacket packet)
{
    bool b = false;
    int j = 0;
    for(QVector<CBFPacketEntry*>::Iterator i = m_CBFPacketBuffer.begin();j < m_CBFPacketBuffer.size(); ++i, j++)
        if(isDuplicatePacketDetectionTimestampSN((*i)->lsReplyPacket().soPv().timestamp(), packet.soPv().timestamp(), (*i)->lsReplyPacket().sequenceNumber(), packet.sequenceNumber()))
        {
            (*i)->kill();
            m_CBFPacketBuffer.erase(i);
            nbCBFPacketQueued -= 1;
            b = true;
        }
    return b;
}

void CBFPacketBuffer::clear()
{
    emit killAll();
    m_CBFPacketBuffer.clear();
    nbCBFPacketQueued = 0;
}

void CBFPacketBuffer::sendPacket(GBCPacket packet)
{
    erase(packet);
    m_CBFPBCounter->erase(m_CBFPBCounter->find(QByteArray(QByteArray(packet.soPv().gnAddr().toHex(), GnAddr::helper_size)+QByteArray(packet.soPv().timestamp(), 32)+QByteArray(packet.sequenceNumber(), 16), GnAddr::helper_size+32+16)));
    emit lpvSent();
}

void CBFPacketBuffer::sendPacket(GUCPacket packet)
{
    erase(packet);
    m_CBFPBCounter->erase(m_CBFPBCounter->find(QByteArray(QByteArray(packet.soPv().gnAddr().toHex(), GnAddr::helper_size)+QByteArray(packet.soPv().timestamp(), 32)+QByteArray(packet.sequenceNumber(), 16), GnAddr::helper_size+32+16)));
    emit lpvSent();
}

void CBFPacketBuffer::sendPacket(LSReplyPacket packet)
{
    erase(packet);
    m_CBFPBCounter->erase(m_CBFPBCounter->find(QByteArray(QByteArray(packet.soPv().gnAddr().toHex(), GnAddr::helper_size)+QByteArray(packet.soPv().timestamp(), 32)+QByteArray(packet.sequenceNumber(), 16), GnAddr::helper_size+32+16)));
    emit lpvSent();
}

void CBFPacketBuffer::stopPacket(GBCPacket packet)
{
    erase(packet);
    m_CBFPBCounter->erase(m_CBFPBCounter->find(QByteArray(QByteArray(packet.soPv().gnAddr().toHex(), GnAddr::helper_size)+QByteArray(packet.soPv().timestamp(), 32)+QByteArray(packet.sequenceNumber(), 16), GnAddr::helper_size+32+16)));
}

void CBFPacketBuffer::stopPacket(GUCPacket packet)
{
    erase(packet);
    m_CBFPBCounter->erase(m_CBFPBCounter->find(QByteArray(QByteArray(packet.soPv().gnAddr().toHex(), GnAddr::helper_size)+QByteArray(packet.soPv().timestamp(), 32)+QByteArray(packet.sequenceNumber(), 16), GnAddr::helper_size+32+16)));
}

void CBFPacketBuffer::stopPacket(LSReplyPacket packet)
{
    erase(packet);
    m_CBFPBCounter->erase(m_CBFPBCounter->find(QByteArray(QByteArray(packet.soPv().gnAddr().toHex(), GnAddr::helper_size)+QByteArray(packet.soPv().timestamp(), 32)+QByteArray(packet.sequenceNumber(), 16), GnAddr::helper_size+32+16)));
}