ReceivePackets.cpp

Go to the documentation of this file.

#include <ReceivePackets.h>

ReceivePackets::ReceivePackets(ParameterConfiguration* paramConfig)
{
    m_paramConf = paramConfig;
}

ReceivePackets::~ReceivePackets()
{

}

int ReceivePackets::receive()
{
    char errbuf[PCAP_ERRBUF_SIZE] = {'\0'};
    char filter_exp[BUF_SIZ];
    struct bpf_program fp;
    bpf_u_int32 mask;
    bpf_u_int32 net;
    struct pcap_pkthdr header;


    memset(&net, 0, sizeof net);
    memset(&mask, 0, sizeof mask);

    if(pcap_lookupnet(m_paramConf->interface().toStdString().c_str(), &net, &mask, errbuf) == -1)
    {
        fprintf(stderr, "Couldn't find a network for interface '%s' : %s.\n", m_paramConf->interface().toStdString().c_str(), errbuf);
        net = 0;
        mask = 0;
        return pcapError_interfaceNotFound;
    }

    m_handle = pcap_open_live(m_paramConf->interface().toStdString().c_str(), BUF_SIZ, 0, 1, errbuf);
    if(m_handle == NULL)
    {
        printf("Couldn't open interface '%s' : %s.\n", m_paramConf->interface().toStdString().c_str(), errbuf);
        return pcapError_interfaceNotOpen;
    }

    if(pcap_datalink(m_handle) != DLT_EN10MB) {
        printf("'%s' has no Ethernet header or can't handle it.\n", m_paramConf->interface().toStdString().c_str());
        return pcapError_ethernetHeader;
    }

    uchar* packet;
    while(1)
    {
        sprintf(filter_exp, "ether proto 0x8947 and !(ether src %02x:%02x:%02x:%02x:%02x:%02x)",
                m_paramConf->mid(0), m_paramConf->mid(1), m_paramConf->mid(2), m_paramConf->mid(3), m_paramConf->mid(4), m_paramConf->mid(5));

        if(pcap_compile(m_handle, &fp, filter_exp, 0, net) == -1)
        {
            fprintf(stderr, "Couldn't compile the filtre '%s' : %s.\n", filter_exp, pcap_geterr(m_handle));
            return pcapError_filtreCompile;
        }

        if(pcap_setfilter(m_handle, &fp) == -1)
        {
            fprintf(stderr, "Couldn't install the filter '%s' : %s.\n", filter_exp, pcap_geterr(m_handle));
            return pcapError_filtreInstall;
        }

        m_changeFilter = false;
        printf("\n\nFiltreChange\n\n");
        while(!m_changeFilter)
        {
            packet = (u_char*)pcap_next(m_handle, &header);
            if(packet)
            {
                qDebug() << "G5 packet received";
                emit packetReceived(QByteArray((char*)packet, header.len));
            }
            else
                qDebug() << "PCAP_Next breaked";
        }
    }
    return pcapError_success;
}