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#ifndef QEMU_ETH_H
27#define QEMU_ETH_H
28
29#include "qemu/bswap.h"
30#include "qemu/iov.h"
31
32#define ETH_ALEN 6
33#define ETH_HLEN 14
34#define ETH_ZLEN 60
35
36struct eth_header {
37 uint8_t h_dest[ETH_ALEN];
38 uint8_t h_source[ETH_ALEN];
39 uint16_t h_proto;
40};
41
42struct vlan_header {
43 uint16_t h_tci;
44 uint16_t h_proto;
45};
46
47struct ip_header {
48 uint8_t ip_ver_len;
49 uint8_t ip_tos;
50 uint16_t ip_len;
51 uint16_t ip_id;
52 uint16_t ip_off;
53 uint8_t ip_ttl;
54 uint8_t ip_p;
55 uint16_t ip_sum;
56 uint32_t ip_src, ip_dst;
57};
58
59typedef struct tcp_header {
60 uint16_t th_sport;
61 uint16_t th_dport;
62 uint32_t th_seq;
63 uint32_t th_ack;
64 uint16_t th_offset_flags;
65
66 uint16_t th_win;
67 uint16_t th_sum;
68 uint16_t th_urp;
69} tcp_header;
70
71#define TCP_FLAGS_ONLY(flags) ((flags) & 0x3f)
72
73#define TCP_HEADER_FLAGS(tcp) \
74 TCP_FLAGS_ONLY(be16_to_cpu((tcp)->th_offset_flags))
75
76#define TCP_FLAG_ACK 0x10
77
78#define TCP_HEADER_DATA_OFFSET(tcp) \
79 (((be16_to_cpu((tcp)->th_offset_flags) >> 12) & 0xf) << 2)
80
81typedef struct udp_header {
82 uint16_t uh_sport;
83 uint16_t uh_dport;
84 uint16_t uh_ulen;
85 uint16_t uh_sum;
86} udp_header;
87
88typedef struct ip_pseudo_header {
89 uint32_t ip_src;
90 uint32_t ip_dst;
91 uint8_t zeros;
92 uint8_t ip_proto;
93 uint16_t ip_payload;
94} ip_pseudo_header;
95
96
97struct in6_address {
98 union {
99 uint8_t __u6_addr8[16];
100 } __in6_u;
101};
102
103struct ip6_header {
104 union {
105 struct ip6_hdrctl {
106 uint32_t ip6_un1_flow;
107
108 uint16_t ip6_un1_plen;
109 uint8_t ip6_un1_nxt;
110 uint8_t ip6_un1_hlim;
111 } ip6_un1;
112 uint8_t ip6_un2_vfc;
113 struct ip6_ecn_access {
114 uint8_t ip6_un3_vfc;
115 uint8_t ip6_un3_ecn;
116 } ip6_un3;
117 } ip6_ctlun;
118 struct in6_address ip6_src;
119 struct in6_address ip6_dst;
120};
121
122typedef struct ip6_pseudo_header {
123 struct in6_address ip6_src;
124 struct in6_address ip6_dst;
125 uint32_t len;
126 uint8_t zero[3];
127 uint8_t next_hdr;
128} ip6_pseudo_header;
129
130struct ip6_ext_hdr {
131 uint8_t ip6r_nxt;
132 uint8_t ip6r_len;
133};
134
135struct ip6_ext_hdr_routing {
136 uint8_t nxt;
137 uint8_t len;
138 uint8_t rtype;
139 uint8_t segleft;
140 uint8_t rsvd[4];
141};
142
143struct ip6_option_hdr {
144#define IP6_OPT_PAD1 (0x00)
145#define IP6_OPT_HOME (0xC9)
146 uint8_t type;
147 uint8_t len;
148};
149
150struct udp_hdr {
151 uint16_t uh_sport;
152 uint16_t uh_dport;
153 uint16_t uh_ulen;
154 uint16_t uh_sum;
155};
156
157struct tcp_hdr {
158 u_short th_sport;
159 u_short th_dport;
160 uint32_t th_seq;
161 uint32_t th_ack;
162#ifdef HOST_WORDS_BIGENDIAN
163 u_char th_off : 4,
164 th_x2:4;
165#else
166 u_char th_x2 : 4,
167 th_off:4;
168#endif
169
170#define TH_ELN 0x1
171#define TH_ECN 0x2
172#define TH_FS 0x4
173
174 u_char th_flags;
175#define TH_FIN 0x01
176#define TH_SYN 0x02
177#define TH_RST 0x04
178#define TH_PUSH 0x08
179#define TH_ACK 0x10
180#define TH_URG 0x20
181#define TH_ECE 0x40
182#define TH_CWR 0x80
183 u_short th_win;
184 u_short th_sum;
185 u_short th_urp;
186};
187
188#define ip6_nxt ip6_ctlun.ip6_un1.ip6_un1_nxt
189#define ip6_ecn_acc ip6_ctlun.ip6_un3.ip6_un3_ecn
190#define ip6_plen ip6_ctlun.ip6_un1.ip6_un1_plen
191
192#define PKT_GET_ETH_HDR(p) \
193 ((struct eth_header *)(p))
194#define PKT_GET_VLAN_HDR(p) \
195 ((struct vlan_header *) (((uint8_t *)(p)) + sizeof(struct eth_header)))
196#define PKT_GET_DVLAN_HDR(p) \
197 (PKT_GET_VLAN_HDR(p) + 1)
198#define PKT_GET_IP_HDR(p) \
199 ((struct ip_header *)(((uint8_t *)(p)) + eth_get_l2_hdr_length(p)))
200#define IP_HDR_GET_LEN(p) \
201 ((ldub_p(p + offsetof(struct ip_header, ip_ver_len)) & 0x0F) << 2)
202#define IP_HDR_GET_P(p) \
203 (ldub_p(p + offsetof(struct ip_header, ip_p)))
204#define PKT_GET_IP_HDR_LEN(p) \
205 (IP_HDR_GET_LEN(PKT_GET_IP_HDR(p)))
206#define PKT_GET_IP6_HDR(p) \
207 ((struct ip6_header *) (((uint8_t *)(p)) + eth_get_l2_hdr_length(p)))
208#define IP_HEADER_VERSION(ip) \
209 (((ip)->ip_ver_len >> 4) & 0xf)
210#define IP4_IS_FRAGMENT(ip) \
211 ((be16_to_cpu((ip)->ip_off) & (IP_OFFMASK | IP_MF)) != 0)
212
213#define ETH_P_IP (0x0800)
214#define ETH_P_ARP (0x0806)
215#define ETH_P_IPV6 (0x86dd)
216#define ETH_P_VLAN (0x8100)
217#define ETH_P_DVLAN (0x88a8)
218#define ETH_P_NCSI (0x88f8)
219#define ETH_P_UNKNOWN (0xffff)
220#define VLAN_VID_MASK 0x0fff
221#define IP_HEADER_VERSION_4 (4)
222#define IP_HEADER_VERSION_6 (6)
223#define IP_PROTO_TCP (6)
224#define IP_PROTO_UDP (17)
225#define IPTOS_ECN_MASK 0x03
226#define IPTOS_ECN(x) ((x) & IPTOS_ECN_MASK)
227#define IPTOS_ECN_CE 0x03
228#define IP6_ECN_MASK 0xC0
229#define IP6_ECN(x) ((x) & IP6_ECN_MASK)
230#define IP6_ECN_CE 0xC0
231#define IP4_DONT_FRAGMENT_FLAG (1 << 14)
232
233#define IS_SPECIAL_VLAN_ID(x) \
234 (((x) == 0) || ((x) == 0xFFF))
235
236#define ETH_MAX_L2_HDR_LEN \
237 (sizeof(struct eth_header) + 2 * sizeof(struct vlan_header))
238
239#define ETH_MAX_IP4_HDR_LEN (60)
240#define ETH_MAX_IP_DGRAM_LEN (0xFFFF)
241
242#define IP_FRAG_UNIT_SIZE (8)
243#define IP_FRAG_ALIGN_SIZE(x) ((x) & ~0x7)
244#define IP_RF 0x8000
245#define IP_DF 0x4000
246#define IP_MF 0x2000
247#define IP_OFFMASK 0x1fff
248
249#define IP6_EXT_GRANULARITY (8)
250
251
252
253#define IP6_HOP_BY_HOP (0)
254#define IP6_ROUTING (43)
255#define IP6_FRAGMENT (44)
256#define IP6_ESP (50)
257#define IP6_AUTHENTICATION (51)
258#define IP6_NONE (59)
259#define IP6_DESTINATON (60)
260#define IP6_MOBILITY (135)
261
262static inline int is_multicast_ether_addr(const uint8_t *addr)
263{
264 return 0x01 & addr[0];
265}
266
267static inline int is_broadcast_ether_addr(const uint8_t *addr)
268{
269 return (addr[0] & addr[1] & addr[2] & addr[3] & addr[4] & addr[5]) == 0xff;
270}
271
272static inline int is_unicast_ether_addr(const uint8_t *addr)
273{
274 return !is_multicast_ether_addr(addr);
275}
276
277typedef enum {
278 ETH_PKT_UCAST = 0xAABBCC00,
279 ETH_PKT_BCAST,
280 ETH_PKT_MCAST
281} eth_pkt_types_e;
282
283static inline eth_pkt_types_e
284get_eth_packet_type(const struct eth_header *ehdr)
285{
286 if (is_broadcast_ether_addr(ehdr->h_dest)) {
287 return ETH_PKT_BCAST;
288 } else if (is_multicast_ether_addr(ehdr->h_dest)) {
289 return ETH_PKT_MCAST;
290 } else {
291 return ETH_PKT_UCAST;
292 }
293}
294
295static inline uint32_t
296eth_get_l2_hdr_length(const void *p)
297{
298 uint16_t proto = be16_to_cpu(PKT_GET_ETH_HDR(p)->h_proto);
299 struct vlan_header *hvlan = PKT_GET_VLAN_HDR(p);
300 switch (proto) {
301 case ETH_P_VLAN:
302 return sizeof(struct eth_header) + sizeof(struct vlan_header);
303 case ETH_P_DVLAN:
304 if (be16_to_cpu(hvlan->h_proto) == ETH_P_VLAN) {
305 return sizeof(struct eth_header) + 2 * sizeof(struct vlan_header);
306 } else {
307 return sizeof(struct eth_header) + sizeof(struct vlan_header);
308 }
309 default:
310 return sizeof(struct eth_header);
311 }
312}
313
314static inline uint32_t
315eth_get_l2_hdr_length_iov(const struct iovec *iov, int iovcnt)
316{
317 uint8_t p[sizeof(struct eth_header) + sizeof(struct vlan_header)];
318 size_t copied = iov_to_buf(iov, iovcnt, 0, p, ARRAY_SIZE(p));
319
320 if (copied < ARRAY_SIZE(p)) {
321 return copied;
322 }
323
324 return eth_get_l2_hdr_length(p);
325}
326
327static inline uint16_t
328eth_get_pkt_tci(const void *p)
329{
330 uint16_t proto = be16_to_cpu(PKT_GET_ETH_HDR(p)->h_proto);
331 struct vlan_header *hvlan = PKT_GET_VLAN_HDR(p);
332 switch (proto) {
333 case ETH_P_VLAN:
334 case ETH_P_DVLAN:
335 return be16_to_cpu(hvlan->h_tci);
336 default:
337 return 0;
338 }
339}
340
341size_t
342eth_strip_vlan(const struct iovec *iov, int iovcnt, size_t iovoff,
343 uint8_t *new_ehdr_buf,
344 uint16_t *payload_offset, uint16_t *tci);
345
346size_t
347eth_strip_vlan_ex(const struct iovec *iov, int iovcnt, size_t iovoff,
348 uint16_t vet, uint8_t *new_ehdr_buf,
349 uint16_t *payload_offset, uint16_t *tci);
350
351uint16_t
352eth_get_l3_proto(const struct iovec *l2hdr_iov, int iovcnt, size_t l2hdr_len);
353
354void eth_setup_vlan_headers_ex(struct eth_header *ehdr, uint16_t vlan_tag,
355 uint16_t vlan_ethtype, bool *is_new);
356
357static inline void
358eth_setup_vlan_headers(struct eth_header *ehdr, uint16_t vlan_tag,
359 bool *is_new)
360{
361 eth_setup_vlan_headers_ex(ehdr, vlan_tag, ETH_P_VLAN, is_new);
362}
363
364
365uint8_t eth_get_gso_type(uint16_t l3_proto, uint8_t *l3_hdr, uint8_t l4proto);
366
367typedef struct eth_ip6_hdr_info_st {
368 uint8_t l4proto;
369 size_t full_hdr_len;
370 struct ip6_header ip6_hdr;
371 bool has_ext_hdrs;
372 bool rss_ex_src_valid;
373 struct in6_address rss_ex_src;
374 bool rss_ex_dst_valid;
375 struct in6_address rss_ex_dst;
376 bool fragment;
377} eth_ip6_hdr_info;
378
379typedef struct eth_ip4_hdr_info_st {
380 struct ip_header ip4_hdr;
381 bool fragment;
382} eth_ip4_hdr_info;
383
384typedef struct eth_l4_hdr_info_st {
385 union {
386 struct tcp_header tcp;
387 struct udp_header udp;
388 } hdr;
389
390 bool has_tcp_data;
391} eth_l4_hdr_info;
392
393void eth_get_protocols(const struct iovec *iov, int iovcnt,
394 bool *isip4, bool *isip6,
395 bool *isudp, bool *istcp,
396 size_t *l3hdr_off,
397 size_t *l4hdr_off,
398 size_t *l5hdr_off,
399 eth_ip6_hdr_info *ip6hdr_info,
400 eth_ip4_hdr_info *ip4hdr_info,
401 eth_l4_hdr_info *l4hdr_info);
402
403void eth_setup_ip4_fragmentation(const void *l2hdr, size_t l2hdr_len,
404 void *l3hdr, size_t l3hdr_len,
405 size_t l3payload_len,
406 size_t frag_offset, bool more_frags);
407
408void
409eth_fix_ip4_checksum(void *l3hdr, size_t l3hdr_len);
410
411uint32_t
412eth_calc_ip4_pseudo_hdr_csum(struct ip_header *iphdr,
413 uint16_t csl,
414 uint32_t *cso);
415
416uint32_t
417eth_calc_ip6_pseudo_hdr_csum(struct ip6_header *iphdr,
418 uint16_t csl,
419 uint8_t l4_proto,
420 uint32_t *cso);
421
422bool
423eth_parse_ipv6_hdr(const struct iovec *pkt, int pkt_frags,
424 size_t ip6hdr_off, eth_ip6_hdr_info *info);
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439bool eth_pad_short_frame(uint8_t *padded_pkt, size_t *padded_buflen,
440 const void *pkt, size_t pkt_size);
441
442#endif
443
