Branch data Line data Source code
1 : : /* SPDX-License-Identifier: BSD-3-Clause
2 : : * Copyright(c) 2020 Inspur Corporation
3 : : */
4 : :
5 : : #include <rte_malloc.h>
6 : : #include <rte_mbuf.h>
7 : : #include <rte_ethdev.h>
8 : :
9 : : #include "gro_udp4.h"
10 : :
11 : : void *
12 : 0 : gro_udp4_tbl_create(uint16_t socket_id,
13 : : uint16_t max_flow_num,
14 : : uint16_t max_item_per_flow)
15 : : {
16 : : struct gro_udp4_tbl *tbl;
17 : : size_t size;
18 : : uint32_t entries_num, i;
19 : :
20 : 0 : entries_num = max_flow_num * max_item_per_flow;
21 : 0 : entries_num = RTE_MIN(entries_num, GRO_UDP4_TBL_MAX_ITEM_NUM);
22 : :
23 [ # # ]: 0 : if (entries_num == 0)
24 : : return NULL;
25 : :
26 : 0 : tbl = rte_zmalloc_socket(__func__,
27 : : sizeof(struct gro_udp4_tbl),
28 : : RTE_CACHE_LINE_SIZE,
29 : : socket_id);
30 [ # # ]: 0 : if (tbl == NULL)
31 : : return NULL;
32 : :
33 : 0 : size = sizeof(struct gro_udp4_item) * entries_num;
34 : 0 : tbl->items = rte_zmalloc_socket(__func__,
35 : : size,
36 : : RTE_CACHE_LINE_SIZE,
37 : : socket_id);
38 [ # # ]: 0 : if (tbl->items == NULL) {
39 : 0 : rte_free(tbl);
40 : 0 : return NULL;
41 : : }
42 : 0 : tbl->max_item_num = entries_num;
43 : :
44 : 0 : size = sizeof(struct gro_udp4_flow) * entries_num;
45 : 0 : tbl->flows = rte_zmalloc_socket(__func__,
46 : : size,
47 : : RTE_CACHE_LINE_SIZE,
48 : : socket_id);
49 [ # # ]: 0 : if (tbl->flows == NULL) {
50 : 0 : rte_free(tbl->items);
51 : 0 : rte_free(tbl);
52 : 0 : return NULL;
53 : : }
54 : : /* INVALID_ARRAY_INDEX indicates an empty flow */
55 [ # # ]: 0 : for (i = 0; i < entries_num; i++)
56 : 0 : tbl->flows[i].start_index = INVALID_ARRAY_INDEX;
57 : 0 : tbl->max_flow_num = entries_num;
58 : :
59 : 0 : return tbl;
60 : : }
61 : :
62 : : void
63 : 0 : gro_udp4_tbl_destroy(void *tbl)
64 : : {
65 : : struct gro_udp4_tbl *udp_tbl = tbl;
66 : :
67 [ # # ]: 0 : if (udp_tbl) {
68 : 0 : rte_free(udp_tbl->items);
69 : 0 : rte_free(udp_tbl->flows);
70 : : }
71 : 0 : rte_free(udp_tbl);
72 : 0 : }
73 : :
74 : : static inline uint32_t
75 : : find_an_empty_item(struct gro_udp4_tbl *tbl)
76 : : {
77 : : uint32_t i;
78 : 0 : uint32_t max_item_num = tbl->max_item_num;
79 : :
80 [ # # ]: 0 : for (i = 0; i < max_item_num; i++)
81 [ # # ]: 0 : if (tbl->items[i].firstseg == NULL)
82 : : return i;
83 : : return INVALID_ARRAY_INDEX;
84 : : }
85 : :
86 : : static inline uint32_t
87 : : find_an_empty_flow(struct gro_udp4_tbl *tbl)
88 : : {
89 : : uint32_t i;
90 : 0 : uint32_t max_flow_num = tbl->max_flow_num;
91 : :
92 [ # # ]: 0 : for (i = 0; i < max_flow_num; i++)
93 [ # # ]: 0 : if (tbl->flows[i].start_index == INVALID_ARRAY_INDEX)
94 : : return i;
95 : : return INVALID_ARRAY_INDEX;
96 : : }
97 : :
98 : : static inline uint32_t
99 : 0 : insert_new_item(struct gro_udp4_tbl *tbl,
100 : : struct rte_mbuf *pkt,
101 : : uint64_t start_time,
102 : : uint32_t prev_idx,
103 : : uint16_t frag_offset,
104 : : uint8_t is_last_frag)
105 : : {
106 : : uint32_t item_idx;
107 : :
108 : : item_idx = find_an_empty_item(tbl);
109 [ # # ]: 0 : if (unlikely(item_idx == INVALID_ARRAY_INDEX))
110 : : return INVALID_ARRAY_INDEX;
111 : :
112 : 0 : tbl->items[item_idx].firstseg = pkt;
113 : 0 : tbl->items[item_idx].lastseg = rte_pktmbuf_lastseg(pkt);
114 : 0 : tbl->items[item_idx].start_time = start_time;
115 : 0 : tbl->items[item_idx].next_pkt_idx = INVALID_ARRAY_INDEX;
116 : 0 : tbl->items[item_idx].frag_offset = frag_offset;
117 : 0 : tbl->items[item_idx].is_last_frag = is_last_frag;
118 : 0 : tbl->items[item_idx].nb_merged = 1;
119 : 0 : tbl->item_num++;
120 : :
121 : : /* if the previous packet exists, chain them together. */
122 [ # # ]: 0 : if (prev_idx != INVALID_ARRAY_INDEX) {
123 : 0 : tbl->items[item_idx].next_pkt_idx =
124 : 0 : tbl->items[prev_idx].next_pkt_idx;
125 : 0 : tbl->items[prev_idx].next_pkt_idx = item_idx;
126 : : }
127 : :
128 : : return item_idx;
129 : : }
130 : :
131 : : static inline uint32_t
132 : : delete_item(struct gro_udp4_tbl *tbl, uint32_t item_idx,
133 : : uint32_t prev_item_idx)
134 : : {
135 : 0 : uint32_t next_idx = tbl->items[item_idx].next_pkt_idx;
136 : :
137 : : /* NULL indicates an empty item */
138 : 0 : tbl->items[item_idx].firstseg = NULL;
139 : 0 : tbl->item_num--;
140 : : if (prev_item_idx != INVALID_ARRAY_INDEX)
141 : : tbl->items[prev_item_idx].next_pkt_idx = next_idx;
142 : :
143 : : return next_idx;
144 : : }
145 : :
146 : : static inline uint32_t
147 : 0 : insert_new_flow(struct gro_udp4_tbl *tbl,
148 : : struct udp4_flow_key *src,
149 : : uint32_t item_idx)
150 : : {
151 : : struct udp4_flow_key *dst;
152 : : uint32_t flow_idx;
153 : :
154 : : flow_idx = find_an_empty_flow(tbl);
155 [ # # ]: 0 : if (unlikely(flow_idx == INVALID_ARRAY_INDEX))
156 : : return INVALID_ARRAY_INDEX;
157 : :
158 : 0 : dst = &(tbl->flows[flow_idx].key);
159 : :
160 : : rte_ether_addr_copy(&(src->eth_saddr), &(dst->eth_saddr));
161 : : rte_ether_addr_copy(&(src->eth_daddr), &(dst->eth_daddr));
162 : 0 : dst->ip_src_addr = src->ip_src_addr;
163 : 0 : dst->ip_dst_addr = src->ip_dst_addr;
164 : 0 : dst->ip_id = src->ip_id;
165 : :
166 : 0 : tbl->flows[flow_idx].start_index = item_idx;
167 : 0 : tbl->flow_num++;
168 : :
169 : 0 : return flow_idx;
170 : : }
171 : :
172 : : /*
173 : : * update the packet length for the flushed packet.
174 : : */
175 : : static inline void
176 : 0 : update_header(struct gro_udp4_item *item)
177 : : {
178 : : struct rte_ipv4_hdr *ipv4_hdr;
179 : 0 : struct rte_mbuf *pkt = item->firstseg;
180 : : uint16_t frag_offset;
181 : :
182 : 0 : ipv4_hdr = rte_pktmbuf_mtod_offset(pkt, struct rte_ipv4_hdr *,
183 : : pkt->l2_len);
184 [ # # ]: 0 : ipv4_hdr->total_length = rte_cpu_to_be_16(pkt->pkt_len -
185 : : pkt->l2_len);
186 : :
187 : : /* Clear MF bit if it is last fragment */
188 [ # # ]: 0 : if (item->is_last_frag) {
189 [ # # ]: 0 : frag_offset = rte_be_to_cpu_16(ipv4_hdr->fragment_offset);
190 : 0 : ipv4_hdr->fragment_offset =
191 [ # # ]: 0 : rte_cpu_to_be_16(frag_offset & ~RTE_IPV4_HDR_MF_FLAG);
192 : : }
193 : 0 : }
194 : :
195 : : int32_t
196 : 0 : gro_udp4_reassemble(struct rte_mbuf *pkt,
197 : : struct gro_udp4_tbl *tbl,
198 : : uint64_t start_time)
199 : : {
200 : : struct rte_ether_hdr *eth_hdr;
201 : : struct rte_ipv4_hdr *ipv4_hdr;
202 : : uint16_t ip_dl;
203 : : uint16_t ip_id, hdr_len;
204 : : uint16_t frag_offset = 0;
205 : : uint8_t is_last_frag;
206 : :
207 : : struct udp4_flow_key key;
208 : : uint32_t cur_idx, prev_idx, item_idx;
209 : : uint32_t i, max_flow_num, remaining_flow_num;
210 : : int cmp;
211 : : uint8_t find;
212 : :
213 : 0 : eth_hdr = rte_pktmbuf_mtod(pkt, struct rte_ether_hdr *);
214 : 0 : ipv4_hdr = (struct rte_ipv4_hdr *)((char *)eth_hdr + pkt->l2_len);
215 [ # # ]: 0 : hdr_len = pkt->l2_len + pkt->l3_len;
216 : :
217 : : /*
218 : : * Don't process non-fragment packet.
219 : : */
220 [ # # ]: 0 : if (!is_ipv4_fragment(ipv4_hdr))
221 : : return -1;
222 : :
223 [ # # ]: 0 : ip_dl = rte_be_to_cpu_16(ipv4_hdr->total_length);
224 : : /* trim the tail padding bytes */
225 [ # # ]: 0 : if (pkt->pkt_len > (uint32_t)(ip_dl + pkt->l2_len))
226 : 0 : rte_pktmbuf_trim(pkt, pkt->pkt_len - ip_dl - pkt->l2_len);
227 : :
228 : : /*
229 : : * Don't process the packet whose payload length is less than or
230 : : * equal to 0.
231 : : */
232 [ # # ]: 0 : if (pkt->pkt_len <= hdr_len)
233 : : return -1;
234 : :
235 [ # # ]: 0 : if (ip_dl <= pkt->l3_len)
236 : : return -1;
237 : :
238 : 0 : ip_dl -= pkt->l3_len;
239 [ # # ]: 0 : ip_id = rte_be_to_cpu_16(ipv4_hdr->packet_id);
240 [ # # ]: 0 : frag_offset = rte_be_to_cpu_16(ipv4_hdr->fragment_offset);
241 : 0 : is_last_frag = ((frag_offset & RTE_IPV4_HDR_MF_FLAG) == 0) ? 1 : 0;
242 : 0 : frag_offset = (uint16_t)(frag_offset & RTE_IPV4_HDR_OFFSET_MASK) << 3;
243 : :
244 : : rte_ether_addr_copy(&(eth_hdr->src_addr), &(key.eth_saddr));
245 : : rte_ether_addr_copy(&(eth_hdr->dst_addr), &(key.eth_daddr));
246 : 0 : key.ip_src_addr = ipv4_hdr->src_addr;
247 : 0 : key.ip_dst_addr = ipv4_hdr->dst_addr;
248 : 0 : key.ip_id = ip_id;
249 : :
250 : : /* Search for a matched flow. */
251 : 0 : max_flow_num = tbl->max_flow_num;
252 : 0 : remaining_flow_num = tbl->flow_num;
253 : : find = 0;
254 [ # # ]: 0 : for (i = 0; i < max_flow_num && remaining_flow_num; i++) {
255 [ # # ]: 0 : if (tbl->flows[i].start_index != INVALID_ARRAY_INDEX) {
256 : : if (is_same_udp4_flow(tbl->flows[i].key, key)) {
257 : : find = 1;
258 : : break;
259 : : }
260 : 0 : remaining_flow_num--;
261 : : }
262 : : }
263 : :
264 : : /*
265 : : * Fail to find a matched flow. Insert a new flow and store the
266 : : * packet into the flow.
267 : : */
268 [ # # ]: 0 : if (find == 0) {
269 : 0 : item_idx = insert_new_item(tbl, pkt, start_time,
270 : : INVALID_ARRAY_INDEX, frag_offset,
271 : : is_last_frag);
272 [ # # ]: 0 : if (unlikely(item_idx == INVALID_ARRAY_INDEX))
273 : : return -1;
274 [ # # ]: 0 : if (insert_new_flow(tbl, &key, item_idx) ==
275 : : INVALID_ARRAY_INDEX) {
276 : : /*
277 : : * Fail to insert a new flow, so delete the
278 : : * stored packet.
279 : : */
280 : : delete_item(tbl, item_idx, INVALID_ARRAY_INDEX);
281 : 0 : return -1;
282 : : }
283 : : return 0;
284 : : }
285 : :
286 : : /*
287 : : * Check all packets in the flow and try to find a neighbor for
288 : : * the input packet.
289 : : */
290 : 0 : cur_idx = tbl->flows[i].start_index;
291 : : prev_idx = cur_idx;
292 : : do {
293 [ # # ]: 0 : cmp = udp4_check_neighbor(&(tbl->items[cur_idx]),
294 : : frag_offset, ip_dl, 0);
295 : : if (cmp) {
296 [ # # ]: 0 : if (merge_two_udp4_packets(&(tbl->items[cur_idx]),
297 : : pkt, cmp, frag_offset,
298 : : is_last_frag, 0))
299 : : return 1;
300 : : /*
301 : : * Fail to merge the two packets, as the packet
302 : : * length is greater than the max value. Store
303 : : * the packet into the flow.
304 : : */
305 [ # # ]: 0 : if (insert_new_item(tbl, pkt, start_time, prev_idx,
306 : : frag_offset, is_last_frag) ==
307 : : INVALID_ARRAY_INDEX)
308 : : return -1;
309 : 0 : return 0;
310 : : }
311 : :
312 : : /* Ensure inserted items are ordered by frag_offset */
313 [ # # ]: 0 : if (frag_offset
314 : : < tbl->items[cur_idx].frag_offset) {
315 : : break;
316 : : }
317 : :
318 : : prev_idx = cur_idx;
319 : 0 : cur_idx = tbl->items[cur_idx].next_pkt_idx;
320 [ # # ]: 0 : } while (cur_idx != INVALID_ARRAY_INDEX);
321 : :
322 : : /* Fail to find a neighbor, so store the packet into the flow. */
323 [ # # ]: 0 : if (cur_idx == tbl->flows[i].start_index) {
324 : : /* Insert it before the first packet of the flow */
325 : 0 : item_idx = insert_new_item(tbl, pkt, start_time,
326 : : INVALID_ARRAY_INDEX, frag_offset,
327 : : is_last_frag);
328 [ # # ]: 0 : if (unlikely(item_idx == INVALID_ARRAY_INDEX))
329 : : return -1;
330 : 0 : tbl->items[item_idx].next_pkt_idx = cur_idx;
331 : 0 : tbl->flows[i].start_index = item_idx;
332 : : } else {
333 [ # # ]: 0 : if (insert_new_item(tbl, pkt, start_time, prev_idx,
334 : : frag_offset, is_last_frag)
335 : : == INVALID_ARRAY_INDEX)
336 : 0 : return -1;
337 : : }
338 : :
339 : : return 0;
340 : : }
341 : :
342 : : static int
343 : 0 : gro_udp4_merge_items(struct gro_udp4_tbl *tbl,
344 : : uint32_t start_idx)
345 : : {
346 : : uint16_t frag_offset;
347 : : uint8_t is_last_frag;
348 : : int16_t ip_dl;
349 : : struct rte_mbuf *pkt;
350 : : int cmp;
351 : : uint32_t item_idx;
352 : : uint16_t hdr_len;
353 : :
354 : 0 : item_idx = tbl->items[start_idx].next_pkt_idx;
355 [ # # ]: 0 : while (item_idx != INVALID_ARRAY_INDEX) {
356 : 0 : pkt = tbl->items[item_idx].firstseg;
357 : 0 : hdr_len = pkt->l2_len + pkt->l3_len;
358 : 0 : ip_dl = pkt->pkt_len - hdr_len;
359 : 0 : frag_offset = tbl->items[item_idx].frag_offset;
360 : 0 : is_last_frag = tbl->items[item_idx].is_last_frag;
361 [ # # ]: 0 : cmp = udp4_check_neighbor(&(tbl->items[start_idx]),
362 : : frag_offset, ip_dl, 0);
363 : : if (cmp) {
364 [ # # ]: 0 : if (merge_two_udp4_packets(
365 : : &(tbl->items[start_idx]),
366 : : pkt, cmp, frag_offset,
367 : : is_last_frag, 0)) {
368 : : item_idx = delete_item(tbl, item_idx,
369 : : INVALID_ARRAY_INDEX);
370 : : tbl->items[start_idx].next_pkt_idx
371 : 0 : = item_idx;
372 : : } else
373 : : return 0;
374 : : } else
375 : : return 0;
376 : : }
377 : :
378 : : return 0;
379 : : }
380 : :
381 : : uint16_t
382 : 0 : gro_udp4_tbl_timeout_flush(struct gro_udp4_tbl *tbl,
383 : : uint64_t flush_timestamp,
384 : : struct rte_mbuf **out,
385 : : uint16_t nb_out)
386 : : {
387 : : uint16_t k = 0;
388 : : uint32_t i, j;
389 : 0 : uint32_t max_flow_num = tbl->max_flow_num;
390 : :
391 [ # # ]: 0 : for (i = 0; i < max_flow_num; i++) {
392 [ # # ]: 0 : if (unlikely(tbl->flow_num == 0))
393 : 0 : return k;
394 : :
395 : 0 : j = tbl->flows[i].start_index;
396 [ # # ]: 0 : while (j != INVALID_ARRAY_INDEX) {
397 [ # # ]: 0 : if (tbl->items[j].start_time <= flush_timestamp) {
398 : 0 : gro_udp4_merge_items(tbl, j);
399 : 0 : out[k++] = tbl->items[j].firstseg;
400 [ # # ]: 0 : if (tbl->items[j].nb_merged > 1)
401 : 0 : update_header(&(tbl->items[j]));
402 : : /*
403 : : * Delete the packet and get the next
404 : : * packet in the flow.
405 : : */
406 : : j = delete_item(tbl, j, INVALID_ARRAY_INDEX);
407 : 0 : tbl->flows[i].start_index = j;
408 [ # # ]: 0 : if (j == INVALID_ARRAY_INDEX)
409 : 0 : tbl->flow_num--;
410 : :
411 [ # # ]: 0 : if (unlikely(k == nb_out))
412 : 0 : return k;
413 : : } else
414 : : /*
415 : : * Flushing packets does not strictly follow
416 : : * timestamp. It does not flush left packets of
417 : : * the flow this time once it finds one item
418 : : * whose start_time is greater than
419 : : * flush_timestamp. So go to check other flows.
420 : : */
421 : : break;
422 : : }
423 : : }
424 : : return k;
425 : : }
426 : :
427 : : uint32_t
428 : 0 : gro_udp4_tbl_pkt_count(void *tbl)
429 : : {
430 : : struct gro_udp4_tbl *gro_tbl = tbl;
431 : :
432 [ # # ]: 0 : if (gro_tbl)
433 : 0 : return gro_tbl->item_num;
434 : :
435 : : return 0;
436 : : }
|
