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

    OpenAirInterface is free software: you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation, either version 3 of the License, or
    (at your option) any later version.


    OpenAirInterface is distributed in the hope that 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 OpenAirInterface.The full GNU General Public License is
   included in this distribution in the file called "COPYING". If not,
   see <http://www.gnu.org/licenses/>.

  Contact Information
  OpenAirInterface Admin: openair_admin@eurecom.fr
  OpenAirInterface Tech : openair_tech@eurecom.fr
  OpenAirInterface Dev  : openair4g-devel@eurecom.fr

  Address      : Eurecom, Compus SophiaTech 450, route des chappes, 06451 Biot, 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);
}