2 *------------------------------------------------------------------
3 * Copyright (c) 2018 Cisco and/or its affiliates.
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at:
8 * http://www.apache.org/licenses/LICENSE-2.0
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 *------------------------------------------------------------------
18 #include <vlib/vlib.h>
19 #include <vlib/unix/unix.h>
20 #include <vlib/pci/pci.h>
21 #include <vnet/ethernet/ethernet.h>
22 #include <vnet/interface/rx_queue_funcs.h>
26 #define foreach_avf_input_error \
27 _(BUFFER_ALLOC, "buffer alloc error")
31 #define _(f,s) AVF_INPUT_ERROR_##f,
32 foreach_avf_input_error
37 static __clib_unused char *avf_input_error_strings[] = {
39 foreach_avf_input_error
43 #define AVF_INPUT_REFILL_TRESHOLD 32
45 static_always_inline void
46 avf_rx_desc_write (avf_rx_desc_t * d, u64 addr)
48 #ifdef CLIB_HAVE_VEC256
49 u64x4 v = { addr, 0, 0, 0 };
50 u64x4_store_unaligned (v, (void *) d);
57 static_always_inline void
58 avf_rxq_refill (vlib_main_t * vm, vlib_node_runtime_t * node, avf_rxq_t * rxq,
61 u16 n_refill, mask, n_alloc, slot, size;
63 avf_rx_desc_t *d, *first_d;
68 n_refill = mask - rxq->n_enqueued;
69 if (PREDICT_TRUE (n_refill <= AVF_INPUT_REFILL_TRESHOLD))
72 slot = (rxq->next - n_refill - 1) & mask;
74 n_refill &= ~7; /* round to 8 */
76 vlib_buffer_alloc_to_ring_from_pool (vm, rxq->bufs, slot, size, n_refill,
77 rxq->buffer_pool_index);
79 if (PREDICT_FALSE (n_alloc != n_refill))
81 vlib_error_count (vm, node->node_index,
82 AVF_INPUT_ERROR_BUFFER_ALLOC, 1);
84 vlib_buffer_free_from_ring (vm, rxq->bufs, slot, size, n_alloc);
88 rxq->n_enqueued += n_alloc;
91 ASSERT (slot % 8 == 0);
99 vlib_get_buffers_with_offset (vm, rxq->bufs + slot, p, 8,
100 sizeof (vlib_buffer_t));
101 avf_rx_desc_write (d + 0, pointer_to_uword (p[0]));
102 avf_rx_desc_write (d + 1, pointer_to_uword (p[1]));
103 avf_rx_desc_write (d + 2, pointer_to_uword (p[2]));
104 avf_rx_desc_write (d + 3, pointer_to_uword (p[3]));
105 avf_rx_desc_write (d + 4, pointer_to_uword (p[4]));
106 avf_rx_desc_write (d + 5, pointer_to_uword (p[5]));
107 avf_rx_desc_write (d + 6, pointer_to_uword (p[6]));
108 avf_rx_desc_write (d + 7, pointer_to_uword (p[7]));
112 vlib_get_buffers (vm, rxq->bufs + slot, b, 8);
113 avf_rx_desc_write (d + 0, vlib_buffer_get_pa (vm, b[0]));
114 avf_rx_desc_write (d + 1, vlib_buffer_get_pa (vm, b[1]));
115 avf_rx_desc_write (d + 2, vlib_buffer_get_pa (vm, b[2]));
116 avf_rx_desc_write (d + 3, vlib_buffer_get_pa (vm, b[3]));
117 avf_rx_desc_write (d + 4, vlib_buffer_get_pa (vm, b[4]));
118 avf_rx_desc_write (d + 5, vlib_buffer_get_pa (vm, b[5]));
119 avf_rx_desc_write (d + 6, vlib_buffer_get_pa (vm, b[6]));
120 avf_rx_desc_write (d + 7, vlib_buffer_get_pa (vm, b[7]));
124 slot = (slot + 8) & mask;
128 clib_atomic_store_rel_n (rxq->qrx_tail, slot);
132 static_always_inline uword
133 avf_rx_attach_tail (vlib_main_t * vm, vlib_buffer_t * bt, vlib_buffer_t * b,
134 u64 qw1, avf_rx_tail_t * t)
136 vlib_buffer_t *hb = b;
137 u32 tlnifb = 0, i = 0;
139 if (qw1 & AVF_RXD_STATUS_EOP)
142 while ((qw1 & AVF_RXD_STATUS_EOP) == 0)
144 ASSERT (i < AVF_RX_MAX_DESC_IN_CHAIN - 1);
145 ASSERT (qw1 & AVF_RXD_STATUS_DD);
147 b->next_buffer = t->buffers[i];
148 b->flags |= VLIB_BUFFER_NEXT_PRESENT;
149 b = vlib_get_buffer (vm, b->next_buffer);
150 vlib_buffer_copy_template (b, bt);
151 tlnifb += b->current_length = qw1 >> AVF_RXD_LEN_SHIFT;
155 hb->total_length_not_including_first_buffer = tlnifb;
156 hb->flags |= VLIB_BUFFER_TOTAL_LENGTH_VALID;
160 static_always_inline uword
161 avf_process_rx_burst (vlib_main_t * vm, vlib_node_runtime_t * node,
162 avf_per_thread_data_t * ptd, u32 n_left,
166 vlib_buffer_t **b = ptd->bufs;
167 u64 *qw1 = ptd->qw1s;
168 avf_rx_tail_t *tail = ptd->tails;
169 uword n_rx_bytes = 0;
171 /* copy template into local variable - will save per packet load */
172 vlib_buffer_copy_template (&bt, &ptd->buffer_template);
178 vlib_prefetch_buffer_header (b[8], LOAD);
179 vlib_prefetch_buffer_header (b[9], LOAD);
180 vlib_prefetch_buffer_header (b[10], LOAD);
181 vlib_prefetch_buffer_header (b[11], LOAD);
184 vlib_buffer_copy_template (b[0], &bt);
185 vlib_buffer_copy_template (b[1], &bt);
186 vlib_buffer_copy_template (b[2], &bt);
187 vlib_buffer_copy_template (b[3], &bt);
189 n_rx_bytes += b[0]->current_length = qw1[0] >> AVF_RXD_LEN_SHIFT;
190 n_rx_bytes += b[1]->current_length = qw1[1] >> AVF_RXD_LEN_SHIFT;
191 n_rx_bytes += b[2]->current_length = qw1[2] >> AVF_RXD_LEN_SHIFT;
192 n_rx_bytes += b[3]->current_length = qw1[3] >> AVF_RXD_LEN_SHIFT;
196 n_rx_bytes += avf_rx_attach_tail (vm, &bt, b[0], qw1[0], tail + 0);
197 n_rx_bytes += avf_rx_attach_tail (vm, &bt, b[1], qw1[1], tail + 1);
198 n_rx_bytes += avf_rx_attach_tail (vm, &bt, b[2], qw1[2], tail + 2);
199 n_rx_bytes += avf_rx_attach_tail (vm, &bt, b[3], qw1[3], tail + 3);
202 VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b[0]);
203 VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b[1]);
204 VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b[2]);
205 VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b[3]);
215 vlib_buffer_copy_template (b[0], &bt);
217 n_rx_bytes += b[0]->current_length = qw1[0] >> AVF_RXD_LEN_SHIFT;
220 n_rx_bytes += avf_rx_attach_tail (vm, &bt, b[0], qw1[0], tail + 0);
222 VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b[0]);
233 static_always_inline uword
234 avf_device_input_inline (vlib_main_t * vm, vlib_node_runtime_t * node,
235 vlib_frame_t * frame, avf_device_t * ad, u16 qid)
237 avf_main_t *am = &avf_main;
238 vnet_main_t *vnm = vnet_get_main ();
239 u32 thr_idx = vlib_get_thread_index ();
240 avf_per_thread_data_t *ptd =
241 vec_elt_at_index (am->per_thread_data, thr_idx);
242 avf_rxq_t *rxq = vec_elt_at_index (ad->rxqs, qid);
243 u32 n_trace, n_rx_packets = 0, n_rx_bytes = 0;
246 u32 *bi, *to_next, n_left_to_next;
247 vlib_buffer_t *bt = &ptd->buffer_template;
248 u32 next_index = VNET_DEVICE_INPUT_NEXT_ETHERNET_INPUT;
249 u16 next = rxq->next;
250 u16 size = rxq->size;
252 avf_rx_desc_t *d, *fd = rxq->descs;
253 #ifdef CLIB_HAVE_VEC256
254 u64x4 q1x4, or_q1x4 = { 0 };
255 u64x4 dd_eop_mask4 = u64x4_splat (AVF_RXD_STATUS_DD | AVF_RXD_STATUS_EOP);
256 #elif defined(CLIB_HAVE_VEC128)
257 u32x4 q1x4_lo, q1x4_hi, or_q1x4 = { 0 };
258 u32x4 dd_eop_mask4 = u32x4_splat (AVF_RXD_STATUS_DD | AVF_RXD_STATUS_EOP);
261 /* is there anything on the ring */
263 if ((d->qword[1] & AVF_RXD_STATUS_DD) == 0)
266 if (PREDICT_FALSE (ad->per_interface_next_index != ~0))
267 next_index = ad->per_interface_next_index;
269 if (PREDICT_FALSE (vnet_device_input_have_features (ad->sw_if_index)))
270 vnet_feature_start_device_input_x1 (ad->sw_if_index, &next_index, bt);
272 vlib_get_new_next_frame (vm, node, next_index, to_next, n_left_to_next);
274 /* fetch up to AVF_RX_VECTOR_SZ from the rx ring, unflatten them and
275 copy needed data from descriptor to rx vector */
278 while (n_rx_packets < AVF_RX_VECTOR_SZ)
280 if (next + 11 < size)
283 CLIB_PREFETCH ((void *) (fd + (next + stride)),
284 CLIB_CACHE_LINE_BYTES, LOAD);
285 CLIB_PREFETCH ((void *) (fd + (next + stride + 1)),
286 CLIB_CACHE_LINE_BYTES, LOAD);
287 CLIB_PREFETCH ((void *) (fd + (next + stride + 2)),
288 CLIB_CACHE_LINE_BYTES, LOAD);
289 CLIB_PREFETCH ((void *) (fd + (next + stride + 3)),
290 CLIB_CACHE_LINE_BYTES, LOAD);
293 #ifdef CLIB_HAVE_VEC256
294 if (n_rx_packets >= AVF_RX_VECTOR_SZ - 4 || next >= size - 4)
297 q1x4 = u64x4_gather ((void *) &d[0].qword[1], (void *) &d[1].qword[1],
298 (void *) &d[2].qword[1], (void *) &d[3].qword[1]);
300 /* not all packets are ready or at least one of them is chained */
301 if (!u64x4_is_equal (q1x4 & dd_eop_mask4, dd_eop_mask4))
305 u64x4_store_unaligned (q1x4, ptd->qw1s + n_rx_packets);
306 #elif defined(CLIB_HAVE_VEC128)
307 if (n_rx_packets >= AVF_RX_VECTOR_SZ - 4 || next >= size - 4)
311 u32x4_gather ((void *) &d[0].qword[1], (void *) &d[1].qword[1],
312 (void *) &d[2].qword[1], (void *) &d[3].qword[1]);
314 /* not all packets are ready or at least one of them is chained */
315 if (!u32x4_is_equal (q1x4_lo & dd_eop_mask4, dd_eop_mask4))
318 q1x4_hi = u32x4_gather (
319 (void *) &d[0].qword[1] + 4, (void *) &d[1].qword[1] + 4,
320 (void *) &d[2].qword[1] + 4, (void *) &d[3].qword[1] + 4);
323 ptd->qw1s[n_rx_packets + 0] = (u64) q1x4_hi[0] << 32 | (u64) q1x4_lo[0];
324 ptd->qw1s[n_rx_packets + 1] = (u64) q1x4_hi[1] << 32 | (u64) q1x4_lo[1];
325 ptd->qw1s[n_rx_packets + 2] = (u64) q1x4_hi[2] << 32 | (u64) q1x4_lo[2];
326 ptd->qw1s[n_rx_packets + 3] = (u64) q1x4_hi[3] << 32 | (u64) q1x4_lo[3];
328 #if defined(CLIB_HAVE_VEC256) || defined(CLIB_HAVE_VEC128)
329 vlib_buffer_copy_indices (bi, rxq->bufs + next, 4);
332 next = (next + 4) & mask;
339 CLIB_PREFETCH ((void *) (fd + ((next + 8) & mask)),
340 CLIB_CACHE_LINE_BYTES, LOAD);
342 if (avf_rxd_is_not_dd (d))
345 bi[0] = rxq->bufs[next];
347 /* deal with chained buffers */
348 if (PREDICT_FALSE (avf_rxd_is_not_eop (d)))
351 u16 tail_next = next;
352 avf_rx_tail_t *tail = ptd->tails + n_rx_packets;
356 tail_next = (tail_next + 1) & mask;
359 /* bail out in case of incomplete transaction */
360 if (avf_rxd_is_not_dd (td))
363 or_qw1 |= tail->qw1s[tail_desc] = td[0].qword[1];
364 tail->buffers[tail_desc] = rxq->bufs[tail_next];
367 while (avf_rxd_is_not_eop (td));
369 n_tail_desc += tail_desc;
372 or_qw1 |= ptd->qw1s[n_rx_packets] = d[0].qword[1];
375 next = (next + 1) & mask;
382 if (n_rx_packets == 0)
386 rxq->n_enqueued -= n_rx_packets + n_tail_desc;
388 #if defined(CLIB_HAVE_VEC256) || defined(CLIB_HAVE_VEC128)
389 or_qw1 |= or_q1x4[0] | or_q1x4[1] | or_q1x4[2] | or_q1x4[3];
392 vlib_get_buffers (vm, to_next, ptd->bufs, n_rx_packets);
394 vnet_buffer (bt)->sw_if_index[VLIB_RX] = ad->sw_if_index;
395 vnet_buffer (bt)->sw_if_index[VLIB_TX] = ~0;
396 bt->buffer_pool_index = rxq->buffer_pool_index;
400 n_rx_bytes = avf_process_rx_burst (vm, node, ptd, n_rx_packets, 1);
402 n_rx_bytes = avf_process_rx_burst (vm, node, ptd, n_rx_packets, 0);
404 /* packet trace if enabled */
405 if (PREDICT_FALSE ((n_trace = vlib_get_trace_count (vm, node))))
407 u32 n_left = n_rx_packets, i = 0, j;
410 while (n_trace && n_left)
412 vlib_buffer_t *b = vlib_get_buffer (vm, bi[0]);
415 (vm, node, next_index, b, /* follow_chain */ 0)))
417 avf_input_trace_t *tr =
418 vlib_add_trace (vm, node, b, sizeof (*tr));
419 tr->next_index = next_index;
421 tr->hw_if_index = ad->hw_if_index;
422 tr->qw1s[0] = ptd->qw1s[i];
423 for (j = 1; j < AVF_RX_MAX_DESC_IN_CHAIN; j++)
424 tr->qw1s[j] = ptd->tails[i].qw1s[j - 1];
434 vlib_set_trace_count (vm, node, n_trace);
437 if (PREDICT_TRUE (next_index == VNET_DEVICE_INPUT_NEXT_ETHERNET_INPUT))
439 vlib_next_frame_t *nf;
441 ethernet_input_frame_t *ef;
442 nf = vlib_node_runtime_get_next_frame (vm, node, next_index);
443 f = vlib_get_frame (vm, nf->frame);
444 f->flags = ETH_INPUT_FRAME_F_SINGLE_SW_IF_IDX;
446 ef = vlib_frame_scalar_args (f);
447 ef->sw_if_index = ad->sw_if_index;
448 ef->hw_if_index = ad->hw_if_index;
450 if ((or_qw1 & AVF_RXD_ERROR_IPE) == 0)
451 f->flags |= ETH_INPUT_FRAME_F_IP4_CKSUM_OK;
452 vlib_frame_no_append (f);
455 n_left_to_next -= n_rx_packets;
456 vlib_put_next_frame (vm, node, next_index, n_left_to_next);
458 vlib_increment_combined_counter (vnm->interface_main.combined_sw_if_counters
459 + VNET_INTERFACE_COUNTER_RX, thr_idx,
460 ad->hw_if_index, n_rx_packets, n_rx_bytes);
464 if (ad->flags & AVF_DEVICE_F_VA_DMA)
465 avf_rxq_refill (vm, node, rxq, 1 /* use_va_dma */ );
467 avf_rxq_refill (vm, node, rxq, 0 /* use_va_dma */ );
472 VLIB_NODE_FN (avf_input_node) (vlib_main_t * vm, vlib_node_runtime_t * node,
473 vlib_frame_t * frame)
476 vnet_hw_if_rxq_poll_vector_t *pv;
478 pv = vnet_hw_if_get_rxq_poll_vector (vm, node);
480 for (int i = 0; i < vec_len (pv); i++)
482 avf_device_t *ad = avf_get_device (pv[i].dev_instance);
483 if ((ad->flags & AVF_DEVICE_F_ADMIN_UP) == 0)
485 n_rx += avf_device_input_inline (vm, node, frame, ad, pv[i].queue_id);
492 VLIB_REGISTER_NODE (avf_input_node) = {
494 .sibling_of = "device-input",
495 .format_trace = format_avf_input_trace,
496 .type = VLIB_NODE_TYPE_INPUT,
497 .state = VLIB_NODE_STATE_DISABLED,
498 .n_errors = AVF_INPUT_N_ERROR,
499 .error_strings = avf_input_error_strings,
500 .flags = VLIB_NODE_FLAG_TRACE_SUPPORTED,
507 * fd.io coding-style-patch-verification: ON
510 * eval: (c-set-style "gnu")