2 * netsniff-ng - the packet sniffing beast
3 * By Daniel Borkmann <daniel@netsniff-ng.org>
4 * Copyright 2009, 2010 Daniel Borkmann.
5 * Subject to the GPL, version 2.
12 * "I love the smell of 10GbE in the morning. Smells like ... victory."
13 * - W. Richard Stevens, "Secret Teachings of the UNIX Environment"
18 #include <linux/if_packet.h>
19 #include <linux/socket.h>
20 #include <linux/sockios.h>
21 #include <sys/ioctl.h>
31 # define PACKET_FANOUT 18
32 # define PACKET_FANOUT_POLICY_HASH 0
33 # define PACKET_FANOUT_POLICY_LB 1
34 # define PACKET_FANOUT_POLICY_DEFAULT PACKET_FANOUT_HASH
38 struct tpacket2_hdr tp_h __aligned_tpacket
;
39 struct sockaddr_ll s_ll
__align_tpacket(sizeof(struct tpacket2_hdr
));
46 struct tpacket_req layout
;
47 struct sockaddr_ll s_ll
;
50 static inline void next_rnd_slot(unsigned int *it
, struct ring
*ring
)
52 *it
= rand() % ring
->layout
.tp_frame_nr
;
55 #define RING_SIZE_FALLBACK (1 << 26)
57 static inline unsigned int ring_size(char *ifname
, unsigned int size
)
63 * Device bitrate in bytes times two as ring size.
64 * Fallback => ~ 64,00 MB
65 * 10 MBit => ~ 2,38 MB
66 * 54 MBit => ~ 12,88 MB
67 * 100 MBit => ~ 23,84 MB
68 * 300 MBit => ~ 71,52 MB
69 * 1.000 MBit => ~ 238,42 MB
70 * 10.000 MBit => ~ 2.384.18 MB
72 size
= device_bitrate(ifname
);
73 size
= (size
* 1000000) / 8;
76 size
= RING_SIZE_FALLBACK
;
78 return round_up_cacheline(size
);
86 static inline unsigned int ring_frame_size(struct ring
*ring
)
88 return ring
->layout
.tp_frame_size
;
91 static inline void tpacket_hdr_clone(struct tpacket2_hdr
*thdrd
,
92 struct tpacket2_hdr
*thdrs
)
94 thdrd
->tp_sec
= thdrs
->tp_sec
;
95 thdrd
->tp_nsec
= thdrs
->tp_nsec
;
96 thdrd
->tp_snaplen
= thdrs
->tp_snaplen
;
97 thdrd
->tp_len
= thdrs
->tp_len
;
101 # define POLLRDNORM 0x0040
104 # define POLLWRNORM 0x0100
107 # define POLLRDHUP 0x2000
110 #define POLL_NEXT_PKT 0
111 #define POLL_MOVE_OUT 1
113 static inline void prepare_polling(int sock
, struct pollfd
*pfd
)
115 memset(pfd
, 0, sizeof(*pfd
));
118 pfd
->events
= POLLIN
| POLLRDNORM
| POLLERR
;
121 static inline void set_sockopt_fanout(int sock
, unsigned int fanout_id
,
122 unsigned int fanout_type
)
124 unsigned int fanout_arg
= (fanout_id
| (fanout_type
<< 16));
125 int ret
= setsockopt(sock
, SOL_PACKET
, PACKET_FANOUT
, &fanout_arg
,
128 panic("No packet fanout support!\n");
131 static inline void set_sockopt_tpacket(int sock
)
133 int ret
, val
= TPACKET_V2
;
135 ret
= setsockopt(sock
, SOL_PACKET
, PACKET_VERSION
, &val
, sizeof(val
));
137 panic("Cannot set tpacketv2!\n");
140 #if defined(__WITH_HARDWARE_TIMESTAMPING)
141 # include <linux/net_tstamp.h>
143 static inline void set_sockopt_hwtimestamp(int sock
, const char *dev
)
146 struct hwtstamp_config hwconfig
;
149 memset(&hwconfig
, 0, sizeof(hwconfig
));
150 hwconfig
.tx_type
= HWTSTAMP_TX_ON
;
151 hwconfig
.rx_filter
= HWTSTAMP_FILTER_ALL
;
153 memset(&ifr
, 0, sizeof(ifr
));
154 strlcpy(ifr
.ifr_name
, dev
, sizeof(ifr
.ifr_name
));
155 ifr
.ifr_data
= &hwconfig
;
157 ret
= ioctl(sock
, SIOCSHWTSTAMP
, &ifr
);
161 timesource
= SOF_TIMESTAMPING_RAW_HARDWARE
;
163 ret
= setsockopt(sock
, SOL_PACKET
, PACKET_TIMESTAMP
, ×ource
,
166 panic("Cannot set timestamping!\n");
169 static inline void set_sockopt_hwtimestamp(int sock
, const char *dev
)
173 #endif /* defined(__WITH_HARDWARE_TIMESTAMPING) */