aboutsummaryrefslogtreecommitdiffstats
path: root/tests/osmo-pcap-test/l2_eth.c
blob: 3171fd7b90ecee9e5dd2974bf04bcb4e08b386c5 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
/*
 * (C) 2012 by Pablo Neira Ayuso <pablo@gnumonks.org>
 * (C) 2012 by On Waves ehf <http://www.on-waves.com>
 *
 * This program 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 2 of the License, or
 * (at your option) any later vers
 */

#include <stdlib.h>
#include <arpa/inet.h>
#include <netinet/ip.h>
#include <linux/if_ether.h>
#include <pcap/dlt.h>

#include "proto.h"

#define PRINT_CMP(...)

static int unsigned l2_eth_pkt_l3proto_num(const uint8_t *pkt)
{
	const struct ethhdr *eh = (const struct ethhdr *)pkt;
	switch(ntohs(eh->h_proto)) {
	case ETH_P_IP:
		return htons(AF_INET);
	default:
		return eh->h_proto;
	}
}

static unsigned int l2_eth_pkt_l2hdr_len(const uint8_t *pkt)
{

	return ETH_HLEN;
}

static struct osmo_pcap_proto_l2 eth = {
	//.l2protonum	= ETH_P_IP,
	.l2protonum	= DLT_EN10MB,
	.l2pkt_hdr_len	= l2_eth_pkt_l2hdr_len,
	.l3pkt_proto	= l2_eth_pkt_l3proto_num,
};

void l2_eth_init(void)
{
	osmo_pcap_proto_l2_register(&eth);
}