Lionel Gauthier
91e6729d46
git-svn-id: http://svn.eurecom.fr/openair4G/trunk@5169 818b1a75-f10b-46b9-bf7c-635c3b92a50f
98 lines
3.8 KiB
C
Executable File
98 lines
3.8 KiB
C
Executable File
/*******************************************************************************
|
|
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);
|
|
}
|
|
|