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
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
|
/*
* netsniff-ng - the packet sniffing beast
* Copyright 2009, 2010 Daniel Borkmann.
* Subject to the GPL, version 2.
*/
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <sys/mman.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <arpa/inet.h>
#include <linux/if_ether.h>
#include "xmalloc.h"
#include "die.h"
#include "ring_rx.h"
#include "built_in.h"
void destroy_rx_ring(int sock, struct ring *ring)
{
int ret;
munmap(ring->mm_space, ring->mm_len);
ring->mm_len = 0;
fmemset(&ring->layout, 0, sizeof(ring->layout));
ret = setsockopt(sock, SOL_PACKET, PACKET_RX_RING, &ring->layout,
sizeof(ring->layout));
if (unlikely(ret))
panic("Cannot destroy the RX_RING: %s!\n", strerror(errno));
xfree(ring->frames);
}
void setup_rx_ring_layout(int sock, struct ring *ring, unsigned int size,
bool jumbo_support, bool v3)
{
fmemset(&ring->layout, 0, sizeof(ring->layout));
ring->layout.tp_block_size = (jumbo_support ?
getpagesize() << 4 :
getpagesize() << 2);
ring->layout.tp_frame_size = (jumbo_support ?
TPACKET_ALIGNMENT << 12 :
TPACKET_ALIGNMENT << 7);
ring->layout.tp_block_nr = size / ring->layout.tp_block_size;
ring->layout.tp_frame_nr = ring->layout.tp_block_size /
ring->layout.tp_frame_size *
ring->layout.tp_block_nr;
if (v3) {
/* Pass out, if this will ever change and we do crap on it! */
build_bug_on(offsetof(struct tpacket_req, tp_frame_nr) !=
offsetof(struct tpacket_req3, tp_frame_nr) &&
sizeof(struct tpacket_req) !=
offsetof(struct tpacket_req3, tp_retire_blk_tov));
ring->layout3.tp_retire_blk_tov = 0;
ring->layout3.tp_sizeof_priv = 0;
ring->layout3.tp_feature_req_word = 0;
set_sockopt_tpacket_v3(sock);
} else {
set_sockopt_tpacket_v2(sock);
}
ring_verify_layout(ring);
}
void create_rx_ring(int sock, struct ring *ring, int verbose)
{
int ret;
bool v3 = get_sockopt_tpacket(sock) == TPACKET_V3;
retry:
ret = setsockopt(sock, SOL_PACKET, PACKET_RX_RING, &ring->raw,
v3 ? sizeof(ring->layout3) : sizeof(ring->layout));
if (errno == ENOMEM && ring->layout.tp_block_nr > 1) {
ring->layout.tp_block_nr >>= 1;
ring->layout.tp_frame_nr = ring->layout.tp_block_size /
ring->layout.tp_frame_size *
ring->layout.tp_block_nr;
goto retry;
}
if (ret < 0)
panic("Cannot allocate RX_RING!\n");
ring->mm_len = ring->layout.tp_block_size * ring->layout.tp_block_nr;
if (verbose) {
printf("RX: %.2Lf MiB, %u Frames, each %u Byte allocated\n",
(long double) ring->mm_len / (1 << 20),
ring->layout.tp_frame_nr, ring->layout.tp_frame_size);
}
}
void mmap_rx_ring(int sock, struct ring *ring)
{
mmap_ring_generic(sock, ring);
}
void alloc_rx_ring_frames(int sock, struct ring *ring)
{
int num;
size_t size;
bool v3 = get_sockopt_tpacket(sock) == TPACKET_V3;
if (v3) {
num = ring->layout3.tp_block_nr;
size = ring->layout3.tp_block_size;
} else {
num = ring->layout.tp_frame_nr;
size = ring->layout.tp_frame_size;
}
alloc_ring_frames_generic(ring, num, size);
}
void bind_rx_ring(int sock, struct ring *ring, int ifindex)
{
bind_ring_generic(sock, ring, ifindex);
}
|
