/*******************************************************************************
Eurecom OpenAirInterface core network
Copyright(c) 1999 - 2014 Eurecom

This program is free software; you can redistribute it and/or modify it
under the terms and conditions of the GNU General Public License,
version 2, as published by the Free Software Foundation.

This program is distributed in the hope it will be useful, but WITHOUT
ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
more details.

You should have received a copy of the GNU General Public License along with
this program; if not, write to the Free Software Foundation, Inc.,
51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.

The full GNU General Public License is included in this distribution in
the file called "COPYING".

Contact Information
Openair Admin: openair_admin@eurecom.fr
Openair Tech : openair_tech@eurecom.fr
Forums       : http://forums.eurecom.fsr/openairinterface
Address      : EURECOM,
               Campus SophiaTech,
               450 Route des Chappes,
               CS 50193
               06904 Biot Sophia Antipolis cedex,
               FRANCE
*******************************************************************************/
/*! \file sgi_pcap.c
* \brief
* \author Lionel Gauthier
* \company Eurecom
* \email: lionel.gauthier@eurecom.fr
*/
#include <string.h>
#include "sgi.h"


//---------------------------------------------------------------------------------------------------------------------
void* sgi_pcap_fw_2_gtpv1u_thread(void* args_p)
{
    bpf_u_int32                       netaddr = 0, mask = 0;  // To store network address and netmask
    struct bpf_program                filter;  // Place to store the BPF filter program
    char                              errbuf[PCAP_ERRBUF_SIZE];  // Error buffer
    struct pcap_pkthdr                pkthdr;  // Packet information (timestamp, size...)
    const unsigned char              *packet = NULL; // Received raw data
    char                              filter_string[] = "";
    sgi_data_t                       *sgi_data_p;

    sgi_data_p = (sgi_data_t*)args_p;

    SGI_IF_DEBUG("[PCAP] Device is %s and iif is %d\n", sgi_data_p->interface_name, sgi_data_p->interface_index);

    memset(errbuf, 0, PCAP_ERRBUF_SIZE);

    sgi_data_p->pcap_descr = pcap_open_live(sgi_data_p->interface_name, SGI_PCAPMAXBYTES2CAPTURE, 0, SGI_PCAPTIMEDELAYKERNEL2USERSPACE, errbuf);
    if (sgi_data_p->pcap_descr == NULL)
    	SGI_IF_ERROR("Error %s", errbuf);
    else if (*errbuf)
    	SGI_IF_WARNING("Warning %s\n", errbuf);

// Look up info from the capture device
    if (pcap_lookupnet(sgi_data_p->interface_name, &netaddr, &mask, errbuf) == -1) {
    	SGI_IF_ERROR("Can't get netmask for device %s\n", sgi_data_p->interface_name);
        netaddr = 0;
        mask = 0;
        pthread_exit(NULL);
    }

// Compiles the filter expression into a BPF filter program
    if (pcap_compile(sgi_data_p->pcap_descr, &filter, filter_string, 0, mask) == -1) {
    	SGI_IF_ERROR("Couldn't parse filter : %s\n", pcap_geterr(sgi_data_p->pcap_descr));
        pthread_exit(NULL);
   }
// Load the filter program into the packet capture device
    if (pcap_setfilter(sgi_data_p->pcap_descr, &filter) == -1) {
    	SGI_IF_ERROR("Couldn't install filter: %s\n", pcap_geterr(sgi_data_p->pcap_descr));
        pthread_exit(NULL);
    }

    pthread_setcancelstate(PTHREAD_CANCEL_ENABLE, NULL);
    sgi_data_p->thread_started = 1;
    while (1) {
        packet = pcap_next(sgi_data_p->pcap_descr, &pkthdr);    // Get one packet

        if ( ( pkthdr.len > 0 ) && ( packet != NULL ) ){
        	sgi_print_hex_octets(packet, pkthdr.len);
            if (packet[54] == 0x85) { // case ROUTER SOLICITATION WITH ETHERNET HEADER
            }
        }
    }
    pthread_exit(NULL);
}