ixgbe: fix multi-process support
[dpdk.git] / lib / librte_pmd_ixgbe / ixgbe_rxtx.c
1 /*-
2  *   BSD LICENSE
3  *
4  *   Copyright(c) 2010-2014 Intel Corporation. All rights reserved.
5  *   Copyright 2014 6WIND S.A.
6  *   All rights reserved.
7  *
8  *   Redistribution and use in source and binary forms, with or without
9  *   modification, are permitted provided that the following conditions
10  *   are met:
11  *
12  *     * Redistributions of source code must retain the above copyright
13  *       notice, this list of conditions and the following disclaimer.
14  *     * Redistributions in binary form must reproduce the above copyright
15  *       notice, this list of conditions and the following disclaimer in
16  *       the documentation and/or other materials provided with the
17  *       distribution.
18  *     * Neither the name of Intel Corporation nor the names of its
19  *       contributors may be used to endorse or promote products derived
20  *       from this software without specific prior written permission.
21  *
22  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
24  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
25  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
26  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
27  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
28  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
29  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
30  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
31  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
32  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33  */
34
35 #include <sys/queue.h>
36
37 #include <stdio.h>
38 #include <stdlib.h>
39 #include <string.h>
40 #include <errno.h>
41 #include <stdint.h>
42 #include <stdarg.h>
43 #include <unistd.h>
44 #include <inttypes.h>
45
46 #include <rte_byteorder.h>
47 #include <rte_common.h>
48 #include <rte_cycles.h>
49 #include <rte_log.h>
50 #include <rte_debug.h>
51 #include <rte_interrupts.h>
52 #include <rte_pci.h>
53 #include <rte_memory.h>
54 #include <rte_memzone.h>
55 #include <rte_launch.h>
56 #include <rte_tailq.h>
57 #include <rte_eal.h>
58 #include <rte_per_lcore.h>
59 #include <rte_lcore.h>
60 #include <rte_atomic.h>
61 #include <rte_branch_prediction.h>
62 #include <rte_ring.h>
63 #include <rte_mempool.h>
64 #include <rte_malloc.h>
65 #include <rte_mbuf.h>
66 #include <rte_ether.h>
67 #include <rte_ethdev.h>
68 #include <rte_prefetch.h>
69 #include <rte_udp.h>
70 #include <rte_tcp.h>
71 #include <rte_sctp.h>
72 #include <rte_string_fns.h>
73 #include <rte_errno.h>
74
75 #include "ixgbe_logs.h"
76 #include "ixgbe/ixgbe_api.h"
77 #include "ixgbe/ixgbe_vf.h"
78 #include "ixgbe_ethdev.h"
79 #include "ixgbe/ixgbe_dcb.h"
80 #include "ixgbe/ixgbe_common.h"
81 #include "ixgbe_rxtx.h"
82
83 #define IXGBE_RSS_OFFLOAD_ALL ( \
84                 ETH_RSS_IPV4 | \
85                 ETH_RSS_IPV4_TCP | \
86                 ETH_RSS_IPV6 | \
87                 ETH_RSS_IPV6_EX | \
88                 ETH_RSS_IPV6_TCP | \
89                 ETH_RSS_IPV6_TCP_EX | \
90                 ETH_RSS_IPV4_UDP | \
91                 ETH_RSS_IPV6_UDP | \
92                 ETH_RSS_IPV6_UDP_EX)
93
94 /* Bit Mask to indicate what bits required for building TX context */
95 #define IXGBE_TX_OFFLOAD_MASK (                  \
96                 PKT_TX_VLAN_PKT |                \
97                 PKT_TX_IP_CKSUM |                \
98                 PKT_TX_L4_MASK |                 \
99                 PKT_TX_TCP_SEG)
100
101 static inline struct rte_mbuf *
102 rte_rxmbuf_alloc(struct rte_mempool *mp)
103 {
104         struct rte_mbuf *m;
105
106         m = __rte_mbuf_raw_alloc(mp);
107         __rte_mbuf_sanity_check_raw(m, 0);
108         return (m);
109 }
110
111
112 #if 1
113 #define RTE_PMD_USE_PREFETCH
114 #endif
115
116 #ifdef RTE_PMD_USE_PREFETCH
117 /*
118  * Prefetch a cache line into all cache levels.
119  */
120 #define rte_ixgbe_prefetch(p)   rte_prefetch0(p)
121 #else
122 #define rte_ixgbe_prefetch(p)   do {} while(0)
123 #endif
124
125 /*********************************************************************
126  *
127  *  TX functions
128  *
129  **********************************************************************/
130
131 /*
132  * Check for descriptors with their DD bit set and free mbufs.
133  * Return the total number of buffers freed.
134  */
135 static inline int __attribute__((always_inline))
136 ixgbe_tx_free_bufs(struct igb_tx_queue *txq)
137 {
138         struct igb_tx_entry *txep;
139         uint32_t status;
140         int i;
141
142         /* check DD bit on threshold descriptor */
143         status = txq->tx_ring[txq->tx_next_dd].wb.status;
144         if (! (status & IXGBE_ADVTXD_STAT_DD))
145                 return 0;
146
147         /*
148          * first buffer to free from S/W ring is at index
149          * tx_next_dd - (tx_rs_thresh-1)
150          */
151         txep = &(txq->sw_ring[txq->tx_next_dd - (txq->tx_rs_thresh - 1)]);
152
153         /* free buffers one at a time */
154         if ((txq->txq_flags & (uint32_t)ETH_TXQ_FLAGS_NOREFCOUNT) != 0) {
155                 for (i = 0; i < txq->tx_rs_thresh; ++i, ++txep) {
156                         txep->mbuf->next = NULL;
157                         rte_mempool_put(txep->mbuf->pool, txep->mbuf);
158                         txep->mbuf = NULL;
159                 }
160         } else {
161                 for (i = 0; i < txq->tx_rs_thresh; ++i, ++txep) {
162                         rte_pktmbuf_free_seg(txep->mbuf);
163                         txep->mbuf = NULL;
164                 }
165         }
166
167         /* buffers were freed, update counters */
168         txq->nb_tx_free = (uint16_t)(txq->nb_tx_free + txq->tx_rs_thresh);
169         txq->tx_next_dd = (uint16_t)(txq->tx_next_dd + txq->tx_rs_thresh);
170         if (txq->tx_next_dd >= txq->nb_tx_desc)
171                 txq->tx_next_dd = (uint16_t)(txq->tx_rs_thresh - 1);
172
173         return txq->tx_rs_thresh;
174 }
175
176 /* Populate 4 descriptors with data from 4 mbufs */
177 static inline void
178 tx4(volatile union ixgbe_adv_tx_desc *txdp, struct rte_mbuf **pkts)
179 {
180         uint64_t buf_dma_addr;
181         uint32_t pkt_len;
182         int i;
183
184         for (i = 0; i < 4; ++i, ++txdp, ++pkts) {
185                 buf_dma_addr = RTE_MBUF_DATA_DMA_ADDR(*pkts);
186                 pkt_len = (*pkts)->data_len;
187
188                 /* write data to descriptor */
189                 txdp->read.buffer_addr = buf_dma_addr;
190                 txdp->read.cmd_type_len =
191                                 ((uint32_t)DCMD_DTYP_FLAGS | pkt_len);
192                 txdp->read.olinfo_status =
193                                 (pkt_len << IXGBE_ADVTXD_PAYLEN_SHIFT);
194                 rte_prefetch0(&(*pkts)->pool);
195         }
196 }
197
198 /* Populate 1 descriptor with data from 1 mbuf */
199 static inline void
200 tx1(volatile union ixgbe_adv_tx_desc *txdp, struct rte_mbuf **pkts)
201 {
202         uint64_t buf_dma_addr;
203         uint32_t pkt_len;
204
205         buf_dma_addr = RTE_MBUF_DATA_DMA_ADDR(*pkts);
206         pkt_len = (*pkts)->data_len;
207
208         /* write data to descriptor */
209         txdp->read.buffer_addr = buf_dma_addr;
210         txdp->read.cmd_type_len =
211                         ((uint32_t)DCMD_DTYP_FLAGS | pkt_len);
212         txdp->read.olinfo_status =
213                         (pkt_len << IXGBE_ADVTXD_PAYLEN_SHIFT);
214         rte_prefetch0(&(*pkts)->pool);
215 }
216
217 /*
218  * Fill H/W descriptor ring with mbuf data.
219  * Copy mbuf pointers to the S/W ring.
220  */
221 static inline void
222 ixgbe_tx_fill_hw_ring(struct igb_tx_queue *txq, struct rte_mbuf **pkts,
223                       uint16_t nb_pkts)
224 {
225         volatile union ixgbe_adv_tx_desc *txdp = &(txq->tx_ring[txq->tx_tail]);
226         struct igb_tx_entry *txep = &(txq->sw_ring[txq->tx_tail]);
227         const int N_PER_LOOP = 4;
228         const int N_PER_LOOP_MASK = N_PER_LOOP-1;
229         int mainpart, leftover;
230         int i, j;
231
232         /*
233          * Process most of the packets in chunks of N pkts.  Any
234          * leftover packets will get processed one at a time.
235          */
236         mainpart = (nb_pkts & ((uint32_t) ~N_PER_LOOP_MASK));
237         leftover = (nb_pkts & ((uint32_t)  N_PER_LOOP_MASK));
238         for (i = 0; i < mainpart; i += N_PER_LOOP) {
239                 /* Copy N mbuf pointers to the S/W ring */
240                 for (j = 0; j < N_PER_LOOP; ++j) {
241                         (txep + i + j)->mbuf = *(pkts + i + j);
242                 }
243                 tx4(txdp + i, pkts + i);
244         }
245
246         if (unlikely(leftover > 0)) {
247                 for (i = 0; i < leftover; ++i) {
248                         (txep + mainpart + i)->mbuf = *(pkts + mainpart + i);
249                         tx1(txdp + mainpart + i, pkts + mainpart + i);
250                 }
251         }
252 }
253
254 static inline uint16_t
255 tx_xmit_pkts(void *tx_queue, struct rte_mbuf **tx_pkts,
256              uint16_t nb_pkts)
257 {
258         struct igb_tx_queue *txq = (struct igb_tx_queue *)tx_queue;
259         volatile union ixgbe_adv_tx_desc *tx_r = txq->tx_ring;
260         uint16_t n = 0;
261
262         /*
263          * Begin scanning the H/W ring for done descriptors when the
264          * number of available descriptors drops below tx_free_thresh.  For
265          * each done descriptor, free the associated buffer.
266          */
267         if (txq->nb_tx_free < txq->tx_free_thresh)
268                 ixgbe_tx_free_bufs(txq);
269
270         /* Only use descriptors that are available */
271         nb_pkts = (uint16_t)RTE_MIN(txq->nb_tx_free, nb_pkts);
272         if (unlikely(nb_pkts == 0))
273                 return 0;
274
275         /* Use exactly nb_pkts descriptors */
276         txq->nb_tx_free = (uint16_t)(txq->nb_tx_free - nb_pkts);
277
278         /*
279          * At this point, we know there are enough descriptors in the
280          * ring to transmit all the packets.  This assumes that each
281          * mbuf contains a single segment, and that no new offloads
282          * are expected, which would require a new context descriptor.
283          */
284
285         /*
286          * See if we're going to wrap-around. If so, handle the top
287          * of the descriptor ring first, then do the bottom.  If not,
288          * the processing looks just like the "bottom" part anyway...
289          */
290         if ((txq->tx_tail + nb_pkts) > txq->nb_tx_desc) {
291                 n = (uint16_t)(txq->nb_tx_desc - txq->tx_tail);
292                 ixgbe_tx_fill_hw_ring(txq, tx_pkts, n);
293
294                 /*
295                  * We know that the last descriptor in the ring will need to
296                  * have its RS bit set because tx_rs_thresh has to be
297                  * a divisor of the ring size
298                  */
299                 tx_r[txq->tx_next_rs].read.cmd_type_len |=
300                         rte_cpu_to_le_32(IXGBE_ADVTXD_DCMD_RS);
301                 txq->tx_next_rs = (uint16_t)(txq->tx_rs_thresh - 1);
302
303                 txq->tx_tail = 0;
304         }
305
306         /* Fill H/W descriptor ring with mbuf data */
307         ixgbe_tx_fill_hw_ring(txq, tx_pkts + n, (uint16_t)(nb_pkts - n));
308         txq->tx_tail = (uint16_t)(txq->tx_tail + (nb_pkts - n));
309
310         /*
311          * Determine if RS bit should be set
312          * This is what we actually want:
313          *   if ((txq->tx_tail - 1) >= txq->tx_next_rs)
314          * but instead of subtracting 1 and doing >=, we can just do
315          * greater than without subtracting.
316          */
317         if (txq->tx_tail > txq->tx_next_rs) {
318                 tx_r[txq->tx_next_rs].read.cmd_type_len |=
319                         rte_cpu_to_le_32(IXGBE_ADVTXD_DCMD_RS);
320                 txq->tx_next_rs = (uint16_t)(txq->tx_next_rs +
321                                                 txq->tx_rs_thresh);
322                 if (txq->tx_next_rs >= txq->nb_tx_desc)
323                         txq->tx_next_rs = (uint16_t)(txq->tx_rs_thresh - 1);
324         }
325
326         /*
327          * Check for wrap-around. This would only happen if we used
328          * up to the last descriptor in the ring, no more, no less.
329          */
330         if (txq->tx_tail >= txq->nb_tx_desc)
331                 txq->tx_tail = 0;
332
333         /* update tail pointer */
334         rte_wmb();
335         IXGBE_PCI_REG_WRITE(txq->tdt_reg_addr, txq->tx_tail);
336
337         return nb_pkts;
338 }
339
340 uint16_t
341 ixgbe_xmit_pkts_simple(void *tx_queue, struct rte_mbuf **tx_pkts,
342                        uint16_t nb_pkts)
343 {
344         uint16_t nb_tx;
345
346         /* Try to transmit at least chunks of TX_MAX_BURST pkts */
347         if (likely(nb_pkts <= RTE_PMD_IXGBE_TX_MAX_BURST))
348                 return tx_xmit_pkts(tx_queue, tx_pkts, nb_pkts);
349
350         /* transmit more than the max burst, in chunks of TX_MAX_BURST */
351         nb_tx = 0;
352         while (nb_pkts) {
353                 uint16_t ret, n;
354                 n = (uint16_t)RTE_MIN(nb_pkts, RTE_PMD_IXGBE_TX_MAX_BURST);
355                 ret = tx_xmit_pkts(tx_queue, &(tx_pkts[nb_tx]), n);
356                 nb_tx = (uint16_t)(nb_tx + ret);
357                 nb_pkts = (uint16_t)(nb_pkts - ret);
358                 if (ret < n)
359                         break;
360         }
361
362         return nb_tx;
363 }
364
365 static inline void
366 ixgbe_set_xmit_ctx(struct igb_tx_queue* txq,
367                 volatile struct ixgbe_adv_tx_context_desc *ctx_txd,
368                 uint64_t ol_flags, union ixgbe_tx_offload tx_offload)
369 {
370         uint32_t type_tucmd_mlhl;
371         uint32_t mss_l4len_idx = 0;
372         uint32_t ctx_idx;
373         uint32_t vlan_macip_lens;
374         union ixgbe_tx_offload tx_offload_mask;
375
376         ctx_idx = txq->ctx_curr;
377         tx_offload_mask.data = 0;
378         type_tucmd_mlhl = 0;
379
380         /* Specify which HW CTX to upload. */
381         mss_l4len_idx |= (ctx_idx << IXGBE_ADVTXD_IDX_SHIFT);
382
383         if (ol_flags & PKT_TX_VLAN_PKT) {
384                 tx_offload_mask.vlan_tci |= ~0;
385         }
386
387         /* check if TCP segmentation required for this packet */
388         if (ol_flags & PKT_TX_TCP_SEG) {
389                 /* implies IP cksum and TCP cksum */
390                 type_tucmd_mlhl = IXGBE_ADVTXD_TUCMD_IPV4 |
391                         IXGBE_ADVTXD_TUCMD_L4T_TCP |
392                         IXGBE_ADVTXD_DTYP_CTXT | IXGBE_ADVTXD_DCMD_DEXT;
393
394                 tx_offload_mask.l2_len |= ~0;
395                 tx_offload_mask.l3_len |= ~0;
396                 tx_offload_mask.l4_len |= ~0;
397                 tx_offload_mask.tso_segsz |= ~0;
398                 mss_l4len_idx |= tx_offload.tso_segsz << IXGBE_ADVTXD_MSS_SHIFT;
399                 mss_l4len_idx |= tx_offload.l4_len << IXGBE_ADVTXD_L4LEN_SHIFT;
400         } else { /* no TSO, check if hardware checksum is needed */
401                 if (ol_flags & PKT_TX_IP_CKSUM) {
402                         type_tucmd_mlhl = IXGBE_ADVTXD_TUCMD_IPV4;
403                         tx_offload_mask.l2_len |= ~0;
404                         tx_offload_mask.l3_len |= ~0;
405                 }
406
407                 switch (ol_flags & PKT_TX_L4_MASK) {
408                 case PKT_TX_UDP_CKSUM:
409                         type_tucmd_mlhl |= IXGBE_ADVTXD_TUCMD_L4T_UDP |
410                                 IXGBE_ADVTXD_DTYP_CTXT | IXGBE_ADVTXD_DCMD_DEXT;
411                         mss_l4len_idx |= sizeof(struct udp_hdr) << IXGBE_ADVTXD_L4LEN_SHIFT;
412                         tx_offload_mask.l2_len |= ~0;
413                         tx_offload_mask.l3_len |= ~0;
414                         break;
415                 case PKT_TX_TCP_CKSUM:
416                         type_tucmd_mlhl |= IXGBE_ADVTXD_TUCMD_L4T_TCP |
417                                 IXGBE_ADVTXD_DTYP_CTXT | IXGBE_ADVTXD_DCMD_DEXT;
418                         mss_l4len_idx |= sizeof(struct tcp_hdr) << IXGBE_ADVTXD_L4LEN_SHIFT;
419                         tx_offload_mask.l2_len |= ~0;
420                         tx_offload_mask.l3_len |= ~0;
421                         tx_offload_mask.l4_len |= ~0;
422                         break;
423                 case PKT_TX_SCTP_CKSUM:
424                         type_tucmd_mlhl |= IXGBE_ADVTXD_TUCMD_L4T_SCTP |
425                                 IXGBE_ADVTXD_DTYP_CTXT | IXGBE_ADVTXD_DCMD_DEXT;
426                         mss_l4len_idx |= sizeof(struct sctp_hdr) << IXGBE_ADVTXD_L4LEN_SHIFT;
427                         tx_offload_mask.l2_len |= ~0;
428                         tx_offload_mask.l3_len |= ~0;
429                         break;
430                 default:
431                         type_tucmd_mlhl |= IXGBE_ADVTXD_TUCMD_L4T_RSV |
432                                 IXGBE_ADVTXD_DTYP_CTXT | IXGBE_ADVTXD_DCMD_DEXT;
433                         break;
434                 }
435         }
436
437         txq->ctx_cache[ctx_idx].flags = ol_flags;
438         txq->ctx_cache[ctx_idx].tx_offload.data  =
439                 tx_offload_mask.data & tx_offload.data;
440         txq->ctx_cache[ctx_idx].tx_offload_mask    = tx_offload_mask;
441
442         ctx_txd->type_tucmd_mlhl = rte_cpu_to_le_32(type_tucmd_mlhl);
443         vlan_macip_lens = tx_offload.l3_len;
444         vlan_macip_lens |= (tx_offload.l2_len << IXGBE_ADVTXD_MACLEN_SHIFT);
445         vlan_macip_lens |= ((uint32_t)tx_offload.vlan_tci << IXGBE_ADVTXD_VLAN_SHIFT);
446         ctx_txd->vlan_macip_lens = rte_cpu_to_le_32(vlan_macip_lens);
447         ctx_txd->mss_l4len_idx   = rte_cpu_to_le_32(mss_l4len_idx);
448         ctx_txd->seqnum_seed     = 0;
449 }
450
451 /*
452  * Check which hardware context can be used. Use the existing match
453  * or create a new context descriptor.
454  */
455 static inline uint32_t
456 what_advctx_update(struct igb_tx_queue *txq, uint64_t flags,
457                 union ixgbe_tx_offload tx_offload)
458 {
459         /* If match with the current used context */
460         if (likely((txq->ctx_cache[txq->ctx_curr].flags == flags) &&
461                 (txq->ctx_cache[txq->ctx_curr].tx_offload.data ==
462                 (txq->ctx_cache[txq->ctx_curr].tx_offload_mask.data & tx_offload.data)))) {
463                         return txq->ctx_curr;
464         }
465
466         /* What if match with the next context  */
467         txq->ctx_curr ^= 1;
468         if (likely((txq->ctx_cache[txq->ctx_curr].flags == flags) &&
469                 (txq->ctx_cache[txq->ctx_curr].tx_offload.data ==
470                 (txq->ctx_cache[txq->ctx_curr].tx_offload_mask.data & tx_offload.data)))) {
471                         return txq->ctx_curr;
472         }
473
474         /* Mismatch, use the previous context */
475         return (IXGBE_CTX_NUM);
476 }
477
478 static inline uint32_t
479 tx_desc_cksum_flags_to_olinfo(uint64_t ol_flags)
480 {
481         uint32_t tmp = 0;
482         if ((ol_flags & PKT_TX_L4_MASK) != PKT_TX_L4_NO_CKSUM)
483                 tmp |= IXGBE_ADVTXD_POPTS_TXSM;
484         if (ol_flags & PKT_TX_IP_CKSUM)
485                 tmp |= IXGBE_ADVTXD_POPTS_IXSM;
486         if (ol_flags & PKT_TX_TCP_SEG)
487                 tmp |= IXGBE_ADVTXD_POPTS_TXSM;
488         return tmp;
489 }
490
491 static inline uint32_t
492 tx_desc_ol_flags_to_cmdtype(uint64_t ol_flags)
493 {
494         uint32_t cmdtype = 0;
495         if (ol_flags & PKT_TX_VLAN_PKT)
496                 cmdtype |= IXGBE_ADVTXD_DCMD_VLE;
497         if (ol_flags & PKT_TX_TCP_SEG)
498                 cmdtype |= IXGBE_ADVTXD_DCMD_TSE;
499         return cmdtype;
500 }
501
502 /* Default RS bit threshold values */
503 #ifndef DEFAULT_TX_RS_THRESH
504 #define DEFAULT_TX_RS_THRESH   32
505 #endif
506 #ifndef DEFAULT_TX_FREE_THRESH
507 #define DEFAULT_TX_FREE_THRESH 32
508 #endif
509
510 /* Reset transmit descriptors after they have been used */
511 static inline int
512 ixgbe_xmit_cleanup(struct igb_tx_queue *txq)
513 {
514         struct igb_tx_entry *sw_ring = txq->sw_ring;
515         volatile union ixgbe_adv_tx_desc *txr = txq->tx_ring;
516         uint16_t last_desc_cleaned = txq->last_desc_cleaned;
517         uint16_t nb_tx_desc = txq->nb_tx_desc;
518         uint16_t desc_to_clean_to;
519         uint16_t nb_tx_to_clean;
520
521         /* Determine the last descriptor needing to be cleaned */
522         desc_to_clean_to = (uint16_t)(last_desc_cleaned + txq->tx_rs_thresh);
523         if (desc_to_clean_to >= nb_tx_desc)
524                 desc_to_clean_to = (uint16_t)(desc_to_clean_to - nb_tx_desc);
525
526         /* Check to make sure the last descriptor to clean is done */
527         desc_to_clean_to = sw_ring[desc_to_clean_to].last_id;
528         if (! (txr[desc_to_clean_to].wb.status & IXGBE_TXD_STAT_DD))
529         {
530                 PMD_TX_FREE_LOG(DEBUG,
531                                 "TX descriptor %4u is not done"
532                                 "(port=%d queue=%d)",
533                                 desc_to_clean_to,
534                                 txq->port_id, txq->queue_id);
535                 /* Failed to clean any descriptors, better luck next time */
536                 return -(1);
537         }
538
539         /* Figure out how many descriptors will be cleaned */
540         if (last_desc_cleaned > desc_to_clean_to)
541                 nb_tx_to_clean = (uint16_t)((nb_tx_desc - last_desc_cleaned) +
542                                                         desc_to_clean_to);
543         else
544                 nb_tx_to_clean = (uint16_t)(desc_to_clean_to -
545                                                 last_desc_cleaned);
546
547         PMD_TX_FREE_LOG(DEBUG,
548                         "Cleaning %4u TX descriptors: %4u to %4u "
549                         "(port=%d queue=%d)",
550                         nb_tx_to_clean, last_desc_cleaned, desc_to_clean_to,
551                         txq->port_id, txq->queue_id);
552
553         /*
554          * The last descriptor to clean is done, so that means all the
555          * descriptors from the last descriptor that was cleaned
556          * up to the last descriptor with the RS bit set
557          * are done. Only reset the threshold descriptor.
558          */
559         txr[desc_to_clean_to].wb.status = 0;
560
561         /* Update the txq to reflect the last descriptor that was cleaned */
562         txq->last_desc_cleaned = desc_to_clean_to;
563         txq->nb_tx_free = (uint16_t)(txq->nb_tx_free + nb_tx_to_clean);
564
565         /* No Error */
566         return (0);
567 }
568
569 uint16_t
570 ixgbe_xmit_pkts(void *tx_queue, struct rte_mbuf **tx_pkts,
571                 uint16_t nb_pkts)
572 {
573         struct igb_tx_queue *txq;
574         struct igb_tx_entry *sw_ring;
575         struct igb_tx_entry *txe, *txn;
576         volatile union ixgbe_adv_tx_desc *txr;
577         volatile union ixgbe_adv_tx_desc *txd;
578         struct rte_mbuf     *tx_pkt;
579         struct rte_mbuf     *m_seg;
580         uint64_t buf_dma_addr;
581         uint32_t olinfo_status;
582         uint32_t cmd_type_len;
583         uint32_t pkt_len;
584         uint16_t slen;
585         uint64_t ol_flags;
586         uint16_t tx_id;
587         uint16_t tx_last;
588         uint16_t nb_tx;
589         uint16_t nb_used;
590         uint64_t tx_ol_req;
591         uint32_t ctx = 0;
592         uint32_t new_ctx;
593         union ixgbe_tx_offload tx_offload = { .data = 0 };
594
595         txq = tx_queue;
596         sw_ring = txq->sw_ring;
597         txr     = txq->tx_ring;
598         tx_id   = txq->tx_tail;
599         txe = &sw_ring[tx_id];
600
601         /* Determine if the descriptor ring needs to be cleaned. */
602         if ((txq->nb_tx_desc - txq->nb_tx_free) > txq->tx_free_thresh) {
603                 ixgbe_xmit_cleanup(txq);
604         }
605
606         rte_prefetch0(&txe->mbuf->pool);
607
608         /* TX loop */
609         for (nb_tx = 0; nb_tx < nb_pkts; nb_tx++) {
610                 new_ctx = 0;
611                 tx_pkt = *tx_pkts++;
612                 pkt_len = tx_pkt->pkt_len;
613
614                 /*
615                  * Determine how many (if any) context descriptors
616                  * are needed for offload functionality.
617                  */
618                 ol_flags = tx_pkt->ol_flags;
619
620                 /* If hardware offload required */
621                 tx_ol_req = ol_flags & IXGBE_TX_OFFLOAD_MASK;
622                 if (tx_ol_req) {
623                         tx_offload.l2_len = tx_pkt->l2_len;
624                         tx_offload.l3_len = tx_pkt->l3_len;
625                         tx_offload.l4_len = tx_pkt->l4_len;
626                         tx_offload.vlan_tci = tx_pkt->vlan_tci;
627                         tx_offload.tso_segsz = tx_pkt->tso_segsz;
628
629                         /* If new context need be built or reuse the exist ctx. */
630                         ctx = what_advctx_update(txq, tx_ol_req,
631                                 tx_offload);
632                         /* Only allocate context descriptor if required*/
633                         new_ctx = (ctx == IXGBE_CTX_NUM);
634                         ctx = txq->ctx_curr;
635                 }
636
637                 /*
638                  * Keep track of how many descriptors are used this loop
639                  * This will always be the number of segments + the number of
640                  * Context descriptors required to transmit the packet
641                  */
642                 nb_used = (uint16_t)(tx_pkt->nb_segs + new_ctx);
643
644                 /*
645                  * The number of descriptors that must be allocated for a
646                  * packet is the number of segments of that packet, plus 1
647                  * Context Descriptor for the hardware offload, if any.
648                  * Determine the last TX descriptor to allocate in the TX ring
649                  * for the packet, starting from the current position (tx_id)
650                  * in the ring.
651                  */
652                 tx_last = (uint16_t) (tx_id + nb_used - 1);
653
654                 /* Circular ring */
655                 if (tx_last >= txq->nb_tx_desc)
656                         tx_last = (uint16_t) (tx_last - txq->nb_tx_desc);
657
658                 PMD_TX_LOG(DEBUG, "port_id=%u queue_id=%u pktlen=%u"
659                            " tx_first=%u tx_last=%u",
660                            (unsigned) txq->port_id,
661                            (unsigned) txq->queue_id,
662                            (unsigned) pkt_len,
663                            (unsigned) tx_id,
664                            (unsigned) tx_last);
665
666                 /*
667                  * Make sure there are enough TX descriptors available to
668                  * transmit the entire packet.
669                  * nb_used better be less than or equal to txq->tx_rs_thresh
670                  */
671                 if (nb_used > txq->nb_tx_free) {
672                         PMD_TX_FREE_LOG(DEBUG,
673                                         "Not enough free TX descriptors "
674                                         "nb_used=%4u nb_free=%4u "
675                                         "(port=%d queue=%d)",
676                                         nb_used, txq->nb_tx_free,
677                                         txq->port_id, txq->queue_id);
678
679                         if (ixgbe_xmit_cleanup(txq) != 0) {
680                                 /* Could not clean any descriptors */
681                                 if (nb_tx == 0)
682                                         return (0);
683                                 goto end_of_tx;
684                         }
685
686                         /* nb_used better be <= txq->tx_rs_thresh */
687                         if (unlikely(nb_used > txq->tx_rs_thresh)) {
688                                 PMD_TX_FREE_LOG(DEBUG,
689                                         "The number of descriptors needed to "
690                                         "transmit the packet exceeds the "
691                                         "RS bit threshold. This will impact "
692                                         "performance."
693                                         "nb_used=%4u nb_free=%4u "
694                                         "tx_rs_thresh=%4u. "
695                                         "(port=%d queue=%d)",
696                                         nb_used, txq->nb_tx_free,
697                                         txq->tx_rs_thresh,
698                                         txq->port_id, txq->queue_id);
699                                 /*
700                                  * Loop here until there are enough TX
701                                  * descriptors or until the ring cannot be
702                                  * cleaned.
703                                  */
704                                 while (nb_used > txq->nb_tx_free) {
705                                         if (ixgbe_xmit_cleanup(txq) != 0) {
706                                                 /*
707                                                  * Could not clean any
708                                                  * descriptors
709                                                  */
710                                                 if (nb_tx == 0)
711                                                         return (0);
712                                                 goto end_of_tx;
713                                         }
714                                 }
715                         }
716                 }
717
718                 /*
719                  * By now there are enough free TX descriptors to transmit
720                  * the packet.
721                  */
722
723                 /*
724                  * Set common flags of all TX Data Descriptors.
725                  *
726                  * The following bits must be set in all Data Descriptors:
727                  *   - IXGBE_ADVTXD_DTYP_DATA
728                  *   - IXGBE_ADVTXD_DCMD_DEXT
729                  *
730                  * The following bits must be set in the first Data Descriptor
731                  * and are ignored in the other ones:
732                  *   - IXGBE_ADVTXD_DCMD_IFCS
733                  *   - IXGBE_ADVTXD_MAC_1588
734                  *   - IXGBE_ADVTXD_DCMD_VLE
735                  *
736                  * The following bits must only be set in the last Data
737                  * Descriptor:
738                  *   - IXGBE_TXD_CMD_EOP
739                  *
740                  * The following bits can be set in any Data Descriptor, but
741                  * are only set in the last Data Descriptor:
742                  *   - IXGBE_TXD_CMD_RS
743                  */
744                 cmd_type_len = IXGBE_ADVTXD_DTYP_DATA |
745                         IXGBE_ADVTXD_DCMD_IFCS | IXGBE_ADVTXD_DCMD_DEXT;
746
747 #ifdef RTE_LIBRTE_IEEE1588
748                 if (ol_flags & PKT_TX_IEEE1588_TMST)
749                         cmd_type_len |= IXGBE_ADVTXD_MAC_1588;
750 #endif
751
752                 olinfo_status = 0;
753                 if (tx_ol_req) {
754
755                         if (ol_flags & PKT_TX_TCP_SEG) {
756                                 /* when TSO is on, paylen in descriptor is the
757                                  * not the packet len but the tcp payload len */
758                                 pkt_len -= (tx_offload.l2_len +
759                                         tx_offload.l3_len + tx_offload.l4_len);
760                         }
761
762                         /*
763                          * Setup the TX Advanced Context Descriptor if required
764                          */
765                         if (new_ctx) {
766                                 volatile struct ixgbe_adv_tx_context_desc *
767                                     ctx_txd;
768
769                                 ctx_txd = (volatile struct
770                                     ixgbe_adv_tx_context_desc *)
771                                     &txr[tx_id];
772
773                                 txn = &sw_ring[txe->next_id];
774                                 rte_prefetch0(&txn->mbuf->pool);
775
776                                 if (txe->mbuf != NULL) {
777                                         rte_pktmbuf_free_seg(txe->mbuf);
778                                         txe->mbuf = NULL;
779                                 }
780
781                                 ixgbe_set_xmit_ctx(txq, ctx_txd, tx_ol_req,
782                                         tx_offload);
783
784                                 txe->last_id = tx_last;
785                                 tx_id = txe->next_id;
786                                 txe = txn;
787                         }
788
789                         /*
790                          * Setup the TX Advanced Data Descriptor,
791                          * This path will go through
792                          * whatever new/reuse the context descriptor
793                          */
794                         cmd_type_len  |= tx_desc_ol_flags_to_cmdtype(ol_flags);
795                         olinfo_status |= tx_desc_cksum_flags_to_olinfo(ol_flags);
796                         olinfo_status |= ctx << IXGBE_ADVTXD_IDX_SHIFT;
797                 }
798
799                 olinfo_status |= (pkt_len << IXGBE_ADVTXD_PAYLEN_SHIFT);
800
801                 m_seg = tx_pkt;
802                 do {
803                         txd = &txr[tx_id];
804                         txn = &sw_ring[txe->next_id];
805                         rte_prefetch0(&txn->mbuf->pool);
806
807                         if (txe->mbuf != NULL)
808                                 rte_pktmbuf_free_seg(txe->mbuf);
809                         txe->mbuf = m_seg;
810
811                         /*
812                          * Set up Transmit Data Descriptor.
813                          */
814                         slen = m_seg->data_len;
815                         buf_dma_addr = RTE_MBUF_DATA_DMA_ADDR(m_seg);
816                         txd->read.buffer_addr =
817                                 rte_cpu_to_le_64(buf_dma_addr);
818                         txd->read.cmd_type_len =
819                                 rte_cpu_to_le_32(cmd_type_len | slen);
820                         txd->read.olinfo_status =
821                                 rte_cpu_to_le_32(olinfo_status);
822                         txe->last_id = tx_last;
823                         tx_id = txe->next_id;
824                         txe = txn;
825                         m_seg = m_seg->next;
826                 } while (m_seg != NULL);
827
828                 /*
829                  * The last packet data descriptor needs End Of Packet (EOP)
830                  */
831                 cmd_type_len |= IXGBE_TXD_CMD_EOP;
832                 txq->nb_tx_used = (uint16_t)(txq->nb_tx_used + nb_used);
833                 txq->nb_tx_free = (uint16_t)(txq->nb_tx_free - nb_used);
834
835                 /* Set RS bit only on threshold packets' last descriptor */
836                 if (txq->nb_tx_used >= txq->tx_rs_thresh) {
837                         PMD_TX_FREE_LOG(DEBUG,
838                                         "Setting RS bit on TXD id="
839                                         "%4u (port=%d queue=%d)",
840                                         tx_last, txq->port_id, txq->queue_id);
841
842                         cmd_type_len |= IXGBE_TXD_CMD_RS;
843
844                         /* Update txq RS bit counters */
845                         txq->nb_tx_used = 0;
846                 }
847                 txd->read.cmd_type_len |= rte_cpu_to_le_32(cmd_type_len);
848         }
849 end_of_tx:
850         rte_wmb();
851
852         /*
853          * Set the Transmit Descriptor Tail (TDT)
854          */
855         PMD_TX_LOG(DEBUG, "port_id=%u queue_id=%u tx_tail=%u nb_tx=%u",
856                    (unsigned) txq->port_id, (unsigned) txq->queue_id,
857                    (unsigned) tx_id, (unsigned) nb_tx);
858         IXGBE_PCI_REG_WRITE(txq->tdt_reg_addr, tx_id);
859         txq->tx_tail = tx_id;
860
861         return (nb_tx);
862 }
863
864 /*********************************************************************
865  *
866  *  RX functions
867  *
868  **********************************************************************/
869 static inline uint64_t
870 rx_desc_hlen_type_rss_to_pkt_flags(uint32_t hl_tp_rs)
871 {
872         uint64_t pkt_flags;
873
874         static uint64_t ip_pkt_types_map[16] = {
875                 0, PKT_RX_IPV4_HDR, PKT_RX_IPV4_HDR_EXT, PKT_RX_IPV4_HDR_EXT,
876                 PKT_RX_IPV6_HDR, 0, 0, 0,
877                 PKT_RX_IPV6_HDR_EXT, 0, 0, 0,
878                 PKT_RX_IPV6_HDR_EXT, 0, 0, 0,
879         };
880
881         static uint64_t ip_rss_types_map[16] = {
882                 0, PKT_RX_RSS_HASH, PKT_RX_RSS_HASH, PKT_RX_RSS_HASH,
883                 0, PKT_RX_RSS_HASH, 0, PKT_RX_RSS_HASH,
884                 PKT_RX_RSS_HASH, 0, 0, 0,
885                 0, 0, 0,  PKT_RX_FDIR,
886         };
887
888 #ifdef RTE_LIBRTE_IEEE1588
889         static uint64_t ip_pkt_etqf_map[8] = {
890                 0, 0, 0, PKT_RX_IEEE1588_PTP,
891                 0, 0, 0, 0,
892         };
893
894         pkt_flags = (hl_tp_rs & IXGBE_RXDADV_PKTTYPE_ETQF) ?
895                         ip_pkt_etqf_map[(hl_tp_rs >> 4) & 0x07] :
896                         ip_pkt_types_map[(hl_tp_rs >> 4) & 0x0F];
897 #else
898         pkt_flags = (hl_tp_rs & IXGBE_RXDADV_PKTTYPE_ETQF) ? 0 :
899                         ip_pkt_types_map[(hl_tp_rs >> 4) & 0x0F];
900
901 #endif
902         return pkt_flags | ip_rss_types_map[hl_tp_rs & 0xF];
903 }
904
905 static inline uint64_t
906 rx_desc_status_to_pkt_flags(uint32_t rx_status)
907 {
908         uint64_t pkt_flags;
909
910         /*
911          * Check if VLAN present only.
912          * Do not check whether L3/L4 rx checksum done by NIC or not,
913          * That can be found from rte_eth_rxmode.hw_ip_checksum flag
914          */
915         pkt_flags = (rx_status & IXGBE_RXD_STAT_VP) ?  PKT_RX_VLAN_PKT : 0;
916
917 #ifdef RTE_LIBRTE_IEEE1588
918         if (rx_status & IXGBE_RXD_STAT_TMST)
919                 pkt_flags = pkt_flags | PKT_RX_IEEE1588_TMST;
920 #endif
921         return pkt_flags;
922 }
923
924 static inline uint64_t
925 rx_desc_error_to_pkt_flags(uint32_t rx_status)
926 {
927         /*
928          * Bit 31: IPE, IPv4 checksum error
929          * Bit 30: L4I, L4I integrity error
930          */
931         static uint64_t error_to_pkt_flags_map[4] = {
932                 0,  PKT_RX_L4_CKSUM_BAD, PKT_RX_IP_CKSUM_BAD,
933                 PKT_RX_IP_CKSUM_BAD | PKT_RX_L4_CKSUM_BAD
934         };
935         return error_to_pkt_flags_map[(rx_status >>
936                 IXGBE_RXDADV_ERR_CKSUM_BIT) & IXGBE_RXDADV_ERR_CKSUM_MSK];
937 }
938
939 #ifdef RTE_LIBRTE_IXGBE_RX_ALLOW_BULK_ALLOC
940 /*
941  * LOOK_AHEAD defines how many desc statuses to check beyond the
942  * current descriptor.
943  * It must be a pound define for optimal performance.
944  * Do not change the value of LOOK_AHEAD, as the ixgbe_rx_scan_hw_ring
945  * function only works with LOOK_AHEAD=8.
946  */
947 #define LOOK_AHEAD 8
948 #if (LOOK_AHEAD != 8)
949 #error "PMD IXGBE: LOOK_AHEAD must be 8\n"
950 #endif
951 static inline int
952 ixgbe_rx_scan_hw_ring(struct igb_rx_queue *rxq)
953 {
954         volatile union ixgbe_adv_rx_desc *rxdp;
955         struct igb_rx_entry *rxep;
956         struct rte_mbuf *mb;
957         uint16_t pkt_len;
958         uint64_t pkt_flags;
959         int s[LOOK_AHEAD], nb_dd;
960         int i, j, nb_rx = 0;
961
962
963         /* get references to current descriptor and S/W ring entry */
964         rxdp = &rxq->rx_ring[rxq->rx_tail];
965         rxep = &rxq->sw_ring[rxq->rx_tail];
966
967         /* check to make sure there is at least 1 packet to receive */
968         if (! (rxdp->wb.upper.status_error & IXGBE_RXDADV_STAT_DD))
969                 return 0;
970
971         /*
972          * Scan LOOK_AHEAD descriptors at a time to determine which descriptors
973          * reference packets that are ready to be received.
974          */
975         for (i = 0; i < RTE_PMD_IXGBE_RX_MAX_BURST;
976              i += LOOK_AHEAD, rxdp += LOOK_AHEAD, rxep += LOOK_AHEAD)
977         {
978                 /* Read desc statuses backwards to avoid race condition */
979                 for (j = LOOK_AHEAD-1; j >= 0; --j)
980                         s[j] = rxdp[j].wb.upper.status_error;
981
982                 /* Compute how many status bits were set */
983                 nb_dd = 0;
984                 for (j = 0; j < LOOK_AHEAD; ++j)
985                         nb_dd += s[j] & IXGBE_RXDADV_STAT_DD;
986
987                 nb_rx += nb_dd;
988
989                 /* Translate descriptor info to mbuf format */
990                 for (j = 0; j < nb_dd; ++j) {
991                         mb = rxep[j].mbuf;
992                         pkt_len = (uint16_t)(rxdp[j].wb.upper.length - rxq->crc_len);
993                         mb->data_len = pkt_len;
994                         mb->pkt_len = pkt_len;
995                         mb->vlan_tci = rxdp[j].wb.upper.vlan;
996                         mb->vlan_tci = rte_le_to_cpu_16(rxdp[j].wb.upper.vlan);
997
998                         /* convert descriptor fields to rte mbuf flags */
999                         pkt_flags  = rx_desc_hlen_type_rss_to_pkt_flags(
1000                                         rxdp[j].wb.lower.lo_dword.data);
1001                         /* reuse status field from scan list */
1002                         pkt_flags |= rx_desc_status_to_pkt_flags(s[j]);
1003                         pkt_flags |= rx_desc_error_to_pkt_flags(s[j]);
1004                         mb->ol_flags = pkt_flags;
1005
1006                         if (likely(pkt_flags & PKT_RX_RSS_HASH))
1007                                 mb->hash.rss = rxdp[j].wb.lower.hi_dword.rss;
1008                         else if (pkt_flags & PKT_RX_FDIR) {
1009                                 mb->hash.fdir.hash =
1010                                         (uint16_t)((rxdp[j].wb.lower.hi_dword.csum_ip.csum)
1011                                                 & IXGBE_ATR_HASH_MASK);
1012                                 mb->hash.fdir.id = rxdp[j].wb.lower.hi_dword.csum_ip.ip_id;
1013                         }
1014                 }
1015
1016                 /* Move mbuf pointers from the S/W ring to the stage */
1017                 for (j = 0; j < LOOK_AHEAD; ++j) {
1018                         rxq->rx_stage[i + j] = rxep[j].mbuf;
1019                 }
1020
1021                 /* stop if all requested packets could not be received */
1022                 if (nb_dd != LOOK_AHEAD)
1023                         break;
1024         }
1025
1026         /* clear software ring entries so we can cleanup correctly */
1027         for (i = 0; i < nb_rx; ++i) {
1028                 rxq->sw_ring[rxq->rx_tail + i].mbuf = NULL;
1029         }
1030
1031
1032         return nb_rx;
1033 }
1034
1035 static inline int
1036 ixgbe_rx_alloc_bufs(struct igb_rx_queue *rxq)
1037 {
1038         volatile union ixgbe_adv_rx_desc *rxdp;
1039         struct igb_rx_entry *rxep;
1040         struct rte_mbuf *mb;
1041         uint16_t alloc_idx;
1042         uint64_t dma_addr;
1043         int diag, i;
1044
1045         /* allocate buffers in bulk directly into the S/W ring */
1046         alloc_idx = (uint16_t)(rxq->rx_free_trigger -
1047                                 (rxq->rx_free_thresh - 1));
1048         rxep = &rxq->sw_ring[alloc_idx];
1049         diag = rte_mempool_get_bulk(rxq->mb_pool, (void *)rxep,
1050                                     rxq->rx_free_thresh);
1051         if (unlikely(diag != 0))
1052                 return (-ENOMEM);
1053
1054         rxdp = &rxq->rx_ring[alloc_idx];
1055         for (i = 0; i < rxq->rx_free_thresh; ++i) {
1056                 /* populate the static rte mbuf fields */
1057                 mb = rxep[i].mbuf;
1058                 rte_mbuf_refcnt_set(mb, 1);
1059                 mb->next = NULL;
1060                 mb->data_off = RTE_PKTMBUF_HEADROOM;
1061                 mb->nb_segs = 1;
1062                 mb->port = rxq->port_id;
1063
1064                 /* populate the descriptors */
1065                 dma_addr = (uint64_t)mb->buf_physaddr + RTE_PKTMBUF_HEADROOM;
1066                 rxdp[i].read.hdr_addr = dma_addr;
1067                 rxdp[i].read.pkt_addr = dma_addr;
1068         }
1069
1070         /* update tail pointer */
1071         rte_wmb();
1072         IXGBE_PCI_REG_WRITE(rxq->rdt_reg_addr, rxq->rx_free_trigger);
1073
1074         /* update state of internal queue structure */
1075         rxq->rx_free_trigger = (uint16_t)(rxq->rx_free_trigger +
1076                                                 rxq->rx_free_thresh);
1077         if (rxq->rx_free_trigger >= rxq->nb_rx_desc)
1078                 rxq->rx_free_trigger = (uint16_t)(rxq->rx_free_thresh - 1);
1079
1080         /* no errors */
1081         return 0;
1082 }
1083
1084 static inline uint16_t
1085 ixgbe_rx_fill_from_stage(struct igb_rx_queue *rxq, struct rte_mbuf **rx_pkts,
1086                          uint16_t nb_pkts)
1087 {
1088         struct rte_mbuf **stage = &rxq->rx_stage[rxq->rx_next_avail];
1089         int i;
1090
1091         /* how many packets are ready to return? */
1092         nb_pkts = (uint16_t)RTE_MIN(nb_pkts, rxq->rx_nb_avail);
1093
1094         /* copy mbuf pointers to the application's packet list */
1095         for (i = 0; i < nb_pkts; ++i)
1096                 rx_pkts[i] = stage[i];
1097
1098         /* update internal queue state */
1099         rxq->rx_nb_avail = (uint16_t)(rxq->rx_nb_avail - nb_pkts);
1100         rxq->rx_next_avail = (uint16_t)(rxq->rx_next_avail + nb_pkts);
1101
1102         return nb_pkts;
1103 }
1104
1105 static inline uint16_t
1106 rx_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts,
1107              uint16_t nb_pkts)
1108 {
1109         struct igb_rx_queue *rxq = (struct igb_rx_queue *)rx_queue;
1110         uint16_t nb_rx = 0;
1111
1112         /* Any previously recv'd pkts will be returned from the Rx stage */
1113         if (rxq->rx_nb_avail)
1114                 return ixgbe_rx_fill_from_stage(rxq, rx_pkts, nb_pkts);
1115
1116         /* Scan the H/W ring for packets to receive */
1117         nb_rx = (uint16_t)ixgbe_rx_scan_hw_ring(rxq);
1118
1119         /* update internal queue state */
1120         rxq->rx_next_avail = 0;
1121         rxq->rx_nb_avail = nb_rx;
1122         rxq->rx_tail = (uint16_t)(rxq->rx_tail + nb_rx);
1123
1124         /* if required, allocate new buffers to replenish descriptors */
1125         if (rxq->rx_tail > rxq->rx_free_trigger) {
1126                 if (ixgbe_rx_alloc_bufs(rxq) != 0) {
1127                         int i, j;
1128                         PMD_RX_LOG(DEBUG, "RX mbuf alloc failed port_id=%u "
1129                                    "queue_id=%u", (unsigned) rxq->port_id,
1130                                    (unsigned) rxq->queue_id);
1131
1132                         rte_eth_devices[rxq->port_id].data->rx_mbuf_alloc_failed +=
1133                                 rxq->rx_free_thresh;
1134
1135                         /*
1136                          * Need to rewind any previous receives if we cannot
1137                          * allocate new buffers to replenish the old ones.
1138                          */
1139                         rxq->rx_nb_avail = 0;
1140                         rxq->rx_tail = (uint16_t)(rxq->rx_tail - nb_rx);
1141                         for (i = 0, j = rxq->rx_tail; i < nb_rx; ++i, ++j)
1142                                 rxq->sw_ring[j].mbuf = rxq->rx_stage[i];
1143
1144                         return 0;
1145                 }
1146         }
1147
1148         if (rxq->rx_tail >= rxq->nb_rx_desc)
1149                 rxq->rx_tail = 0;
1150
1151         /* received any packets this loop? */
1152         if (rxq->rx_nb_avail)
1153                 return ixgbe_rx_fill_from_stage(rxq, rx_pkts, nb_pkts);
1154
1155         return 0;
1156 }
1157
1158 /* split requests into chunks of size RTE_PMD_IXGBE_RX_MAX_BURST */
1159 uint16_t
1160 ixgbe_recv_pkts_bulk_alloc(void *rx_queue, struct rte_mbuf **rx_pkts,
1161                            uint16_t nb_pkts)
1162 {
1163         uint16_t nb_rx;
1164
1165         if (unlikely(nb_pkts == 0))
1166                 return 0;
1167
1168         if (likely(nb_pkts <= RTE_PMD_IXGBE_RX_MAX_BURST))
1169                 return rx_recv_pkts(rx_queue, rx_pkts, nb_pkts);
1170
1171         /* request is relatively large, chunk it up */
1172         nb_rx = 0;
1173         while (nb_pkts) {
1174                 uint16_t ret, n;
1175                 n = (uint16_t)RTE_MIN(nb_pkts, RTE_PMD_IXGBE_RX_MAX_BURST);
1176                 ret = rx_recv_pkts(rx_queue, &rx_pkts[nb_rx], n);
1177                 nb_rx = (uint16_t)(nb_rx + ret);
1178                 nb_pkts = (uint16_t)(nb_pkts - ret);
1179                 if (ret < n)
1180                         break;
1181         }
1182
1183         return nb_rx;
1184 }
1185 #endif /* RTE_LIBRTE_IXGBE_RX_ALLOW_BULK_ALLOC */
1186
1187 uint16_t
1188 ixgbe_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts,
1189                 uint16_t nb_pkts)
1190 {
1191         struct igb_rx_queue *rxq;
1192         volatile union ixgbe_adv_rx_desc *rx_ring;
1193         volatile union ixgbe_adv_rx_desc *rxdp;
1194         struct igb_rx_entry *sw_ring;
1195         struct igb_rx_entry *rxe;
1196         struct rte_mbuf *rxm;
1197         struct rte_mbuf *nmb;
1198         union ixgbe_adv_rx_desc rxd;
1199         uint64_t dma_addr;
1200         uint32_t staterr;
1201         uint32_t hlen_type_rss;
1202         uint16_t pkt_len;
1203         uint16_t rx_id;
1204         uint16_t nb_rx;
1205         uint16_t nb_hold;
1206         uint64_t pkt_flags;
1207
1208         nb_rx = 0;
1209         nb_hold = 0;
1210         rxq = rx_queue;
1211         rx_id = rxq->rx_tail;
1212         rx_ring = rxq->rx_ring;
1213         sw_ring = rxq->sw_ring;
1214         while (nb_rx < nb_pkts) {
1215                 /*
1216                  * The order of operations here is important as the DD status
1217                  * bit must not be read after any other descriptor fields.
1218                  * rx_ring and rxdp are pointing to volatile data so the order
1219                  * of accesses cannot be reordered by the compiler. If they were
1220                  * not volatile, they could be reordered which could lead to
1221                  * using invalid descriptor fields when read from rxd.
1222                  */
1223                 rxdp = &rx_ring[rx_id];
1224                 staterr = rxdp->wb.upper.status_error;
1225                 if (! (staterr & rte_cpu_to_le_32(IXGBE_RXDADV_STAT_DD)))
1226                         break;
1227                 rxd = *rxdp;
1228
1229                 /*
1230                  * End of packet.
1231                  *
1232                  * If the IXGBE_RXDADV_STAT_EOP flag is not set, the RX packet
1233                  * is likely to be invalid and to be dropped by the various
1234                  * validation checks performed by the network stack.
1235                  *
1236                  * Allocate a new mbuf to replenish the RX ring descriptor.
1237                  * If the allocation fails:
1238                  *    - arrange for that RX descriptor to be the first one
1239                  *      being parsed the next time the receive function is
1240                  *      invoked [on the same queue].
1241                  *
1242                  *    - Stop parsing the RX ring and return immediately.
1243                  *
1244                  * This policy do not drop the packet received in the RX
1245                  * descriptor for which the allocation of a new mbuf failed.
1246                  * Thus, it allows that packet to be later retrieved if
1247                  * mbuf have been freed in the mean time.
1248                  * As a side effect, holding RX descriptors instead of
1249                  * systematically giving them back to the NIC may lead to
1250                  * RX ring exhaustion situations.
1251                  * However, the NIC can gracefully prevent such situations
1252                  * to happen by sending specific "back-pressure" flow control
1253                  * frames to its peer(s).
1254                  */
1255                 PMD_RX_LOG(DEBUG, "port_id=%u queue_id=%u rx_id=%u "
1256                            "ext_err_stat=0x%08x pkt_len=%u",
1257                            (unsigned) rxq->port_id, (unsigned) rxq->queue_id,
1258                            (unsigned) rx_id, (unsigned) staterr,
1259                            (unsigned) rte_le_to_cpu_16(rxd.wb.upper.length));
1260
1261                 nmb = rte_rxmbuf_alloc(rxq->mb_pool);
1262                 if (nmb == NULL) {
1263                         PMD_RX_LOG(DEBUG, "RX mbuf alloc failed port_id=%u "
1264                                    "queue_id=%u", (unsigned) rxq->port_id,
1265                                    (unsigned) rxq->queue_id);
1266                         rte_eth_devices[rxq->port_id].data->rx_mbuf_alloc_failed++;
1267                         break;
1268                 }
1269
1270                 nb_hold++;
1271                 rxe = &sw_ring[rx_id];
1272                 rx_id++;
1273                 if (rx_id == rxq->nb_rx_desc)
1274                         rx_id = 0;
1275
1276                 /* Prefetch next mbuf while processing current one. */
1277                 rte_ixgbe_prefetch(sw_ring[rx_id].mbuf);
1278
1279                 /*
1280                  * When next RX descriptor is on a cache-line boundary,
1281                  * prefetch the next 4 RX descriptors and the next 8 pointers
1282                  * to mbufs.
1283                  */
1284                 if ((rx_id & 0x3) == 0) {
1285                         rte_ixgbe_prefetch(&rx_ring[rx_id]);
1286                         rte_ixgbe_prefetch(&sw_ring[rx_id]);
1287                 }
1288
1289                 rxm = rxe->mbuf;
1290                 rxe->mbuf = nmb;
1291                 dma_addr =
1292                         rte_cpu_to_le_64(RTE_MBUF_DATA_DMA_ADDR_DEFAULT(nmb));
1293                 rxdp->read.hdr_addr = dma_addr;
1294                 rxdp->read.pkt_addr = dma_addr;
1295
1296                 /*
1297                  * Initialize the returned mbuf.
1298                  * 1) setup generic mbuf fields:
1299                  *    - number of segments,
1300                  *    - next segment,
1301                  *    - packet length,
1302                  *    - RX port identifier.
1303                  * 2) integrate hardware offload data, if any:
1304                  *    - RSS flag & hash,
1305                  *    - IP checksum flag,
1306                  *    - VLAN TCI, if any,
1307                  *    - error flags.
1308                  */
1309                 pkt_len = (uint16_t) (rte_le_to_cpu_16(rxd.wb.upper.length) -
1310                                       rxq->crc_len);
1311                 rxm->data_off = RTE_PKTMBUF_HEADROOM;
1312                 rte_packet_prefetch((char *)rxm->buf_addr + rxm->data_off);
1313                 rxm->nb_segs = 1;
1314                 rxm->next = NULL;
1315                 rxm->pkt_len = pkt_len;
1316                 rxm->data_len = pkt_len;
1317                 rxm->port = rxq->port_id;
1318
1319                 hlen_type_rss = rte_le_to_cpu_32(rxd.wb.lower.lo_dword.data);
1320                 /* Only valid if PKT_RX_VLAN_PKT set in pkt_flags */
1321                 rxm->vlan_tci = rte_le_to_cpu_16(rxd.wb.upper.vlan);
1322
1323                 pkt_flags = rx_desc_hlen_type_rss_to_pkt_flags(hlen_type_rss);
1324                 pkt_flags = pkt_flags | rx_desc_status_to_pkt_flags(staterr);
1325                 pkt_flags = pkt_flags | rx_desc_error_to_pkt_flags(staterr);
1326                 rxm->ol_flags = pkt_flags;
1327
1328                 if (likely(pkt_flags & PKT_RX_RSS_HASH))
1329                         rxm->hash.rss = rxd.wb.lower.hi_dword.rss;
1330                 else if (pkt_flags & PKT_RX_FDIR) {
1331                         rxm->hash.fdir.hash =
1332                                 (uint16_t)((rxd.wb.lower.hi_dword.csum_ip.csum)
1333                                            & IXGBE_ATR_HASH_MASK);
1334                         rxm->hash.fdir.id = rxd.wb.lower.hi_dword.csum_ip.ip_id;
1335                 }
1336                 /*
1337                  * Store the mbuf address into the next entry of the array
1338                  * of returned packets.
1339                  */
1340                 rx_pkts[nb_rx++] = rxm;
1341         }
1342         rxq->rx_tail = rx_id;
1343
1344         /*
1345          * If the number of free RX descriptors is greater than the RX free
1346          * threshold of the queue, advance the Receive Descriptor Tail (RDT)
1347          * register.
1348          * Update the RDT with the value of the last processed RX descriptor
1349          * minus 1, to guarantee that the RDT register is never equal to the
1350          * RDH register, which creates a "full" ring situtation from the
1351          * hardware point of view...
1352          */
1353         nb_hold = (uint16_t) (nb_hold + rxq->nb_rx_hold);
1354         if (nb_hold > rxq->rx_free_thresh) {
1355                 PMD_RX_LOG(DEBUG, "port_id=%u queue_id=%u rx_tail=%u "
1356                            "nb_hold=%u nb_rx=%u",
1357                            (unsigned) rxq->port_id, (unsigned) rxq->queue_id,
1358                            (unsigned) rx_id, (unsigned) nb_hold,
1359                            (unsigned) nb_rx);
1360                 rx_id = (uint16_t) ((rx_id == 0) ?
1361                                      (rxq->nb_rx_desc - 1) : (rx_id - 1));
1362                 IXGBE_PCI_REG_WRITE(rxq->rdt_reg_addr, rx_id);
1363                 nb_hold = 0;
1364         }
1365         rxq->nb_rx_hold = nb_hold;
1366         return (nb_rx);
1367 }
1368
1369 uint16_t
1370 ixgbe_recv_scattered_pkts(void *rx_queue, struct rte_mbuf **rx_pkts,
1371                           uint16_t nb_pkts)
1372 {
1373         struct igb_rx_queue *rxq;
1374         volatile union ixgbe_adv_rx_desc *rx_ring;
1375         volatile union ixgbe_adv_rx_desc *rxdp;
1376         struct igb_rx_entry *sw_ring;
1377         struct igb_rx_entry *rxe;
1378         struct rte_mbuf *first_seg;
1379         struct rte_mbuf *last_seg;
1380         struct rte_mbuf *rxm;
1381         struct rte_mbuf *nmb;
1382         union ixgbe_adv_rx_desc rxd;
1383         uint64_t dma; /* Physical address of mbuf data buffer */
1384         uint32_t staterr;
1385         uint32_t hlen_type_rss;
1386         uint16_t rx_id;
1387         uint16_t nb_rx;
1388         uint16_t nb_hold;
1389         uint16_t data_len;
1390         uint64_t pkt_flags;
1391
1392         nb_rx = 0;
1393         nb_hold = 0;
1394         rxq = rx_queue;
1395         rx_id = rxq->rx_tail;
1396         rx_ring = rxq->rx_ring;
1397         sw_ring = rxq->sw_ring;
1398
1399         /*
1400          * Retrieve RX context of current packet, if any.
1401          */
1402         first_seg = rxq->pkt_first_seg;
1403         last_seg = rxq->pkt_last_seg;
1404
1405         while (nb_rx < nb_pkts) {
1406         next_desc:
1407                 /*
1408                  * The order of operations here is important as the DD status
1409                  * bit must not be read after any other descriptor fields.
1410                  * rx_ring and rxdp are pointing to volatile data so the order
1411                  * of accesses cannot be reordered by the compiler. If they were
1412                  * not volatile, they could be reordered which could lead to
1413                  * using invalid descriptor fields when read from rxd.
1414                  */
1415                 rxdp = &rx_ring[rx_id];
1416                 staterr = rxdp->wb.upper.status_error;
1417                 if (! (staterr & rte_cpu_to_le_32(IXGBE_RXDADV_STAT_DD)))
1418                         break;
1419                 rxd = *rxdp;
1420
1421                 /*
1422                  * Descriptor done.
1423                  *
1424                  * Allocate a new mbuf to replenish the RX ring descriptor.
1425                  * If the allocation fails:
1426                  *    - arrange for that RX descriptor to be the first one
1427                  *      being parsed the next time the receive function is
1428                  *      invoked [on the same queue].
1429                  *
1430                  *    - Stop parsing the RX ring and return immediately.
1431                  *
1432                  * This policy does not drop the packet received in the RX
1433                  * descriptor for which the allocation of a new mbuf failed.
1434                  * Thus, it allows that packet to be later retrieved if
1435                  * mbuf have been freed in the mean time.
1436                  * As a side effect, holding RX descriptors instead of
1437                  * systematically giving them back to the NIC may lead to
1438                  * RX ring exhaustion situations.
1439                  * However, the NIC can gracefully prevent such situations
1440                  * to happen by sending specific "back-pressure" flow control
1441                  * frames to its peer(s).
1442                  */
1443                 PMD_RX_LOG(DEBUG, "port_id=%u queue_id=%u rx_id=%u "
1444                            "staterr=0x%x data_len=%u",
1445                            (unsigned) rxq->port_id, (unsigned) rxq->queue_id,
1446                            (unsigned) rx_id, (unsigned) staterr,
1447                            (unsigned) rte_le_to_cpu_16(rxd.wb.upper.length));
1448
1449                 nmb = rte_rxmbuf_alloc(rxq->mb_pool);
1450                 if (nmb == NULL) {
1451                         PMD_RX_LOG(DEBUG, "RX mbuf alloc failed port_id=%u "
1452                                    "queue_id=%u", (unsigned) rxq->port_id,
1453                                    (unsigned) rxq->queue_id);
1454                         rte_eth_devices[rxq->port_id].data->rx_mbuf_alloc_failed++;
1455                         break;
1456                 }
1457
1458                 nb_hold++;
1459                 rxe = &sw_ring[rx_id];
1460                 rx_id++;
1461                 if (rx_id == rxq->nb_rx_desc)
1462                         rx_id = 0;
1463
1464                 /* Prefetch next mbuf while processing current one. */
1465                 rte_ixgbe_prefetch(sw_ring[rx_id].mbuf);
1466
1467                 /*
1468                  * When next RX descriptor is on a cache-line boundary,
1469                  * prefetch the next 4 RX descriptors and the next 8 pointers
1470                  * to mbufs.
1471                  */
1472                 if ((rx_id & 0x3) == 0) {
1473                         rte_ixgbe_prefetch(&rx_ring[rx_id]);
1474                         rte_ixgbe_prefetch(&sw_ring[rx_id]);
1475                 }
1476
1477                 /*
1478                  * Update RX descriptor with the physical address of the new
1479                  * data buffer of the new allocated mbuf.
1480                  */
1481                 rxm = rxe->mbuf;
1482                 rxe->mbuf = nmb;
1483                 dma = rte_cpu_to_le_64(RTE_MBUF_DATA_DMA_ADDR_DEFAULT(nmb));
1484                 rxdp->read.hdr_addr = dma;
1485                 rxdp->read.pkt_addr = dma;
1486
1487                 /*
1488                  * Set data length & data buffer address of mbuf.
1489                  */
1490                 data_len = rte_le_to_cpu_16(rxd.wb.upper.length);
1491                 rxm->data_len = data_len;
1492                 rxm->data_off = RTE_PKTMBUF_HEADROOM;
1493
1494                 /*
1495                  * If this is the first buffer of the received packet,
1496                  * set the pointer to the first mbuf of the packet and
1497                  * initialize its context.
1498                  * Otherwise, update the total length and the number of segments
1499                  * of the current scattered packet, and update the pointer to
1500                  * the last mbuf of the current packet.
1501                  */
1502                 if (first_seg == NULL) {
1503                         first_seg = rxm;
1504                         first_seg->pkt_len = data_len;
1505                         first_seg->nb_segs = 1;
1506                 } else {
1507                         first_seg->pkt_len = (uint16_t)(first_seg->pkt_len
1508                                         + data_len);
1509                         first_seg->nb_segs++;
1510                         last_seg->next = rxm;
1511                 }
1512
1513                 /*
1514                  * If this is not the last buffer of the received packet,
1515                  * update the pointer to the last mbuf of the current scattered
1516                  * packet and continue to parse the RX ring.
1517                  */
1518                 if (! (staterr & IXGBE_RXDADV_STAT_EOP)) {
1519                         last_seg = rxm;
1520                         goto next_desc;
1521                 }
1522
1523                 /*
1524                  * This is the last buffer of the received packet.
1525                  * If the CRC is not stripped by the hardware:
1526                  *   - Subtract the CRC length from the total packet length.
1527                  *   - If the last buffer only contains the whole CRC or a part
1528                  *     of it, free the mbuf associated to the last buffer.
1529                  *     If part of the CRC is also contained in the previous
1530                  *     mbuf, subtract the length of that CRC part from the
1531                  *     data length of the previous mbuf.
1532                  */
1533                 rxm->next = NULL;
1534                 if (unlikely(rxq->crc_len > 0)) {
1535                         first_seg->pkt_len -= ETHER_CRC_LEN;
1536                         if (data_len <= ETHER_CRC_LEN) {
1537                                 rte_pktmbuf_free_seg(rxm);
1538                                 first_seg->nb_segs--;
1539                                 last_seg->data_len = (uint16_t)
1540                                         (last_seg->data_len -
1541                                          (ETHER_CRC_LEN - data_len));
1542                                 last_seg->next = NULL;
1543                         } else
1544                                 rxm->data_len =
1545                                         (uint16_t) (data_len - ETHER_CRC_LEN);
1546                 }
1547
1548                 /*
1549                  * Initialize the first mbuf of the returned packet:
1550                  *    - RX port identifier,
1551                  *    - hardware offload data, if any:
1552                  *      - RSS flag & hash,
1553                  *      - IP checksum flag,
1554                  *      - VLAN TCI, if any,
1555                  *      - error flags.
1556                  */
1557                 first_seg->port = rxq->port_id;
1558
1559                 /*
1560                  * The vlan_tci field is only valid when PKT_RX_VLAN_PKT is
1561                  * set in the pkt_flags field.
1562                  */
1563                 first_seg->vlan_tci = rte_le_to_cpu_16(rxd.wb.upper.vlan);
1564                 hlen_type_rss = rte_le_to_cpu_32(rxd.wb.lower.lo_dword.data);
1565                 pkt_flags = rx_desc_hlen_type_rss_to_pkt_flags(hlen_type_rss);
1566                 pkt_flags = (pkt_flags |
1567                                 rx_desc_status_to_pkt_flags(staterr));
1568                 pkt_flags = (pkt_flags |
1569                                 rx_desc_error_to_pkt_flags(staterr));
1570                 first_seg->ol_flags = pkt_flags;
1571
1572                 if (likely(pkt_flags & PKT_RX_RSS_HASH))
1573                         first_seg->hash.rss = rxd.wb.lower.hi_dword.rss;
1574                 else if (pkt_flags & PKT_RX_FDIR) {
1575                         first_seg->hash.fdir.hash =
1576                                 (uint16_t)((rxd.wb.lower.hi_dword.csum_ip.csum)
1577                                            & IXGBE_ATR_HASH_MASK);
1578                         first_seg->hash.fdir.id =
1579                                 rxd.wb.lower.hi_dword.csum_ip.ip_id;
1580                 }
1581
1582                 /* Prefetch data of first segment, if configured to do so. */
1583                 rte_packet_prefetch((char *)first_seg->buf_addr +
1584                         first_seg->data_off);
1585
1586                 /*
1587                  * Store the mbuf address into the next entry of the array
1588                  * of returned packets.
1589                  */
1590                 rx_pkts[nb_rx++] = first_seg;
1591
1592                 /*
1593                  * Setup receipt context for a new packet.
1594                  */
1595                 first_seg = NULL;
1596         }
1597
1598         /*
1599          * Record index of the next RX descriptor to probe.
1600          */
1601         rxq->rx_tail = rx_id;
1602
1603         /*
1604          * Save receive context.
1605          */
1606         rxq->pkt_first_seg = first_seg;
1607         rxq->pkt_last_seg = last_seg;
1608
1609         /*
1610          * If the number of free RX descriptors is greater than the RX free
1611          * threshold of the queue, advance the Receive Descriptor Tail (RDT)
1612          * register.
1613          * Update the RDT with the value of the last processed RX descriptor
1614          * minus 1, to guarantee that the RDT register is never equal to the
1615          * RDH register, which creates a "full" ring situtation from the
1616          * hardware point of view...
1617          */
1618         nb_hold = (uint16_t) (nb_hold + rxq->nb_rx_hold);
1619         if (nb_hold > rxq->rx_free_thresh) {
1620                 PMD_RX_LOG(DEBUG, "port_id=%u queue_id=%u rx_tail=%u "
1621                            "nb_hold=%u nb_rx=%u",
1622                            (unsigned) rxq->port_id, (unsigned) rxq->queue_id,
1623                            (unsigned) rx_id, (unsigned) nb_hold,
1624                            (unsigned) nb_rx);
1625                 rx_id = (uint16_t) ((rx_id == 0) ?
1626                                      (rxq->nb_rx_desc - 1) : (rx_id - 1));
1627                 IXGBE_PCI_REG_WRITE(rxq->rdt_reg_addr, rx_id);
1628                 nb_hold = 0;
1629         }
1630         rxq->nb_rx_hold = nb_hold;
1631         return (nb_rx);
1632 }
1633
1634 /*********************************************************************
1635  *
1636  *  Queue management functions
1637  *
1638  **********************************************************************/
1639
1640 /*
1641  * Rings setup and release.
1642  *
1643  * TDBA/RDBA should be aligned on 16 byte boundary. But TDLEN/RDLEN should be
1644  * multiple of 128 bytes. So we align TDBA/RDBA on 128 byte boundary. This will
1645  * also optimize cache line size effect. H/W supports up to cache line size 128.
1646  */
1647 #define IXGBE_ALIGN 128
1648
1649 /*
1650  * Maximum number of Ring Descriptors.
1651  *
1652  * Since RDLEN/TDLEN should be multiple of 128 bytes, the number of ring
1653  * descriptors should meet the following condition:
1654  *      (num_ring_desc * sizeof(rx/tx descriptor)) % 128 == 0
1655  */
1656 #define IXGBE_MIN_RING_DESC 32
1657 #define IXGBE_MAX_RING_DESC 4096
1658
1659 /*
1660  * Create memzone for HW rings. malloc can't be used as the physical address is
1661  * needed. If the memzone is already created, then this function returns a ptr
1662  * to the old one.
1663  */
1664 static const struct rte_memzone *
1665 ring_dma_zone_reserve(struct rte_eth_dev *dev, const char *ring_name,
1666                       uint16_t queue_id, uint32_t ring_size, int socket_id)
1667 {
1668         char z_name[RTE_MEMZONE_NAMESIZE];
1669         const struct rte_memzone *mz;
1670
1671         snprintf(z_name, sizeof(z_name), "%s_%s_%d_%d",
1672                         dev->driver->pci_drv.name, ring_name,
1673                         dev->data->port_id, queue_id);
1674
1675         mz = rte_memzone_lookup(z_name);
1676         if (mz)
1677                 return mz;
1678
1679 #ifdef RTE_LIBRTE_XEN_DOM0
1680         return rte_memzone_reserve_bounded(z_name, ring_size,
1681                 socket_id, 0, IXGBE_ALIGN, RTE_PGSIZE_2M);
1682 #else
1683         return rte_memzone_reserve_aligned(z_name, ring_size,
1684                 socket_id, 0, IXGBE_ALIGN);
1685 #endif
1686 }
1687
1688 static void
1689 ixgbe_tx_queue_release_mbufs(struct igb_tx_queue *txq)
1690 {
1691         unsigned i;
1692
1693         if (txq->sw_ring != NULL) {
1694                 for (i = 0; i < txq->nb_tx_desc; i++) {
1695                         if (txq->sw_ring[i].mbuf != NULL) {
1696                                 rte_pktmbuf_free_seg(txq->sw_ring[i].mbuf);
1697                                 txq->sw_ring[i].mbuf = NULL;
1698                         }
1699                 }
1700         }
1701 }
1702
1703 static void
1704 ixgbe_tx_free_swring(struct igb_tx_queue *txq)
1705 {
1706         if (txq != NULL &&
1707             txq->sw_ring != NULL)
1708                 rte_free(txq->sw_ring);
1709 }
1710
1711 static void
1712 ixgbe_tx_queue_release(struct igb_tx_queue *txq)
1713 {
1714         if (txq != NULL && txq->ops != NULL) {
1715                 txq->ops->release_mbufs(txq);
1716                 txq->ops->free_swring(txq);
1717                 rte_free(txq);
1718         }
1719 }
1720
1721 void
1722 ixgbe_dev_tx_queue_release(void *txq)
1723 {
1724         ixgbe_tx_queue_release(txq);
1725 }
1726
1727 /* (Re)set dynamic igb_tx_queue fields to defaults */
1728 static void
1729 ixgbe_reset_tx_queue(struct igb_tx_queue *txq)
1730 {
1731         static const union ixgbe_adv_tx_desc zeroed_desc = { .read = {
1732                         .buffer_addr = 0}};
1733         struct igb_tx_entry *txe = txq->sw_ring;
1734         uint16_t prev, i;
1735
1736         /* Zero out HW ring memory */
1737         for (i = 0; i < txq->nb_tx_desc; i++) {
1738                 txq->tx_ring[i] = zeroed_desc;
1739         }
1740
1741         /* Initialize SW ring entries */
1742         prev = (uint16_t) (txq->nb_tx_desc - 1);
1743         for (i = 0; i < txq->nb_tx_desc; i++) {
1744                 volatile union ixgbe_adv_tx_desc *txd = &txq->tx_ring[i];
1745                 txd->wb.status = IXGBE_TXD_STAT_DD;
1746                 txe[i].mbuf = NULL;
1747                 txe[i].last_id = i;
1748                 txe[prev].next_id = i;
1749                 prev = i;
1750         }
1751
1752         txq->tx_next_dd = (uint16_t)(txq->tx_rs_thresh - 1);
1753         txq->tx_next_rs = (uint16_t)(txq->tx_rs_thresh - 1);
1754
1755         txq->tx_tail = 0;
1756         txq->nb_tx_used = 0;
1757         /*
1758          * Always allow 1 descriptor to be un-allocated to avoid
1759          * a H/W race condition
1760          */
1761         txq->last_desc_cleaned = (uint16_t)(txq->nb_tx_desc - 1);
1762         txq->nb_tx_free = (uint16_t)(txq->nb_tx_desc - 1);
1763         txq->ctx_curr = 0;
1764         memset((void*)&txq->ctx_cache, 0,
1765                 IXGBE_CTX_NUM * sizeof(struct ixgbe_advctx_info));
1766 }
1767
1768 static struct ixgbe_txq_ops def_txq_ops = {
1769         .release_mbufs = ixgbe_tx_queue_release_mbufs,
1770         .free_swring = ixgbe_tx_free_swring,
1771         .reset = ixgbe_reset_tx_queue,
1772 };
1773
1774 /* Takes an ethdev and a queue and sets up the tx function to be used based on
1775  * the queue parameters. Used in tx_queue_setup by primary process and then
1776  * in dev_init by secondary process when attaching to an existing ethdev.
1777  */
1778 void
1779 set_tx_function(struct rte_eth_dev *dev, struct igb_tx_queue *txq)
1780 {
1781         /* Use a simple Tx queue (no offloads, no multi segs) if possible */
1782         if (((txq->txq_flags & IXGBE_SIMPLE_FLAGS) == IXGBE_SIMPLE_FLAGS)
1783                         && (txq->tx_rs_thresh >= RTE_PMD_IXGBE_TX_MAX_BURST)) {
1784                 PMD_INIT_LOG(INFO, "Using simple tx code path");
1785 #ifdef RTE_IXGBE_INC_VECTOR
1786                 if (txq->tx_rs_thresh <= RTE_IXGBE_TX_MAX_FREE_BUF_SZ &&
1787                                 (rte_eal_process_type() != RTE_PROC_PRIMARY ||
1788                                         ixgbe_txq_vec_setup(txq) == 0)) {
1789                         PMD_INIT_LOG(INFO, "Vector tx enabled.");
1790                         dev->tx_pkt_burst = ixgbe_xmit_pkts_vec;
1791                 } else
1792 #endif
1793                 dev->tx_pkt_burst = ixgbe_xmit_pkts_simple;
1794         } else {
1795                 PMD_INIT_LOG(INFO, "Using full-featured tx code path");
1796                 PMD_INIT_LOG(INFO,
1797                                 " - txq_flags = %lx " "[IXGBE_SIMPLE_FLAGS=%lx]",
1798                                 (unsigned long)txq->txq_flags,
1799                                 (unsigned long)IXGBE_SIMPLE_FLAGS);
1800                 PMD_INIT_LOG(INFO,
1801                                 " - tx_rs_thresh = %lu " "[RTE_PMD_IXGBE_TX_MAX_BURST=%lu]",
1802                                 (unsigned long)txq->tx_rs_thresh,
1803                                 (unsigned long)RTE_PMD_IXGBE_TX_MAX_BURST);
1804                 dev->tx_pkt_burst = ixgbe_xmit_pkts;
1805         }
1806 }
1807
1808 int
1809 ixgbe_dev_tx_queue_setup(struct rte_eth_dev *dev,
1810                          uint16_t queue_idx,
1811                          uint16_t nb_desc,
1812                          unsigned int socket_id,
1813                          const struct rte_eth_txconf *tx_conf)
1814 {
1815         const struct rte_memzone *tz;
1816         struct igb_tx_queue *txq;
1817         struct ixgbe_hw     *hw;
1818         uint16_t tx_rs_thresh, tx_free_thresh;
1819
1820         PMD_INIT_FUNC_TRACE();
1821         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1822
1823         /*
1824          * Validate number of transmit descriptors.
1825          * It must not exceed hardware maximum, and must be multiple
1826          * of IXGBE_ALIGN.
1827          */
1828         if (((nb_desc * sizeof(union ixgbe_adv_tx_desc)) % IXGBE_ALIGN) != 0 ||
1829             (nb_desc > IXGBE_MAX_RING_DESC) ||
1830             (nb_desc < IXGBE_MIN_RING_DESC)) {
1831                 return -EINVAL;
1832         }
1833
1834         /*
1835          * The following two parameters control the setting of the RS bit on
1836          * transmit descriptors.
1837          * TX descriptors will have their RS bit set after txq->tx_rs_thresh
1838          * descriptors have been used.
1839          * The TX descriptor ring will be cleaned after txq->tx_free_thresh
1840          * descriptors are used or if the number of descriptors required
1841          * to transmit a packet is greater than the number of free TX
1842          * descriptors.
1843          * The following constraints must be satisfied:
1844          *  tx_rs_thresh must be greater than 0.
1845          *  tx_rs_thresh must be less than the size of the ring minus 2.
1846          *  tx_rs_thresh must be less than or equal to tx_free_thresh.
1847          *  tx_rs_thresh must be a divisor of the ring size.
1848          *  tx_free_thresh must be greater than 0.
1849          *  tx_free_thresh must be less than the size of the ring minus 3.
1850          * One descriptor in the TX ring is used as a sentinel to avoid a
1851          * H/W race condition, hence the maximum threshold constraints.
1852          * When set to zero use default values.
1853          */
1854         tx_rs_thresh = (uint16_t)((tx_conf->tx_rs_thresh) ?
1855                         tx_conf->tx_rs_thresh : DEFAULT_TX_RS_THRESH);
1856         tx_free_thresh = (uint16_t)((tx_conf->tx_free_thresh) ?
1857                         tx_conf->tx_free_thresh : DEFAULT_TX_FREE_THRESH);
1858         if (tx_rs_thresh >= (nb_desc - 2)) {
1859                 PMD_INIT_LOG(ERR, "tx_rs_thresh must be less than the number "
1860                              "of TX descriptors minus 2. (tx_rs_thresh=%u "
1861                              "port=%d queue=%d)", (unsigned int)tx_rs_thresh,
1862                              (int)dev->data->port_id, (int)queue_idx);
1863                 return -(EINVAL);
1864         }
1865         if (tx_free_thresh >= (nb_desc - 3)) {
1866                 PMD_INIT_LOG(ERR, "tx_rs_thresh must be less than the "
1867                              "tx_free_thresh must be less than the number of "
1868                              "TX descriptors minus 3. (tx_free_thresh=%u "
1869                              "port=%d queue=%d)",
1870                              (unsigned int)tx_free_thresh,
1871                              (int)dev->data->port_id, (int)queue_idx);
1872                 return -(EINVAL);
1873         }
1874         if (tx_rs_thresh > tx_free_thresh) {
1875                 PMD_INIT_LOG(ERR, "tx_rs_thresh must be less than or equal to "
1876                              "tx_free_thresh. (tx_free_thresh=%u "
1877                              "tx_rs_thresh=%u port=%d queue=%d)",
1878                              (unsigned int)tx_free_thresh,
1879                              (unsigned int)tx_rs_thresh,
1880                              (int)dev->data->port_id,
1881                              (int)queue_idx);
1882                 return -(EINVAL);
1883         }
1884         if ((nb_desc % tx_rs_thresh) != 0) {
1885                 PMD_INIT_LOG(ERR, "tx_rs_thresh must be a divisor of the "
1886                              "number of TX descriptors. (tx_rs_thresh=%u "
1887                              "port=%d queue=%d)", (unsigned int)tx_rs_thresh,
1888                              (int)dev->data->port_id, (int)queue_idx);
1889                 return -(EINVAL);
1890         }
1891
1892         /*
1893          * If rs_bit_thresh is greater than 1, then TX WTHRESH should be
1894          * set to 0. If WTHRESH is greater than zero, the RS bit is ignored
1895          * by the NIC and all descriptors are written back after the NIC
1896          * accumulates WTHRESH descriptors.
1897          */
1898         if ((tx_rs_thresh > 1) && (tx_conf->tx_thresh.wthresh != 0)) {
1899                 PMD_INIT_LOG(ERR, "TX WTHRESH must be set to 0 if "
1900                              "tx_rs_thresh is greater than 1. (tx_rs_thresh=%u "
1901                              "port=%d queue=%d)", (unsigned int)tx_rs_thresh,
1902                              (int)dev->data->port_id, (int)queue_idx);
1903                 return -(EINVAL);
1904         }
1905
1906         /* Free memory prior to re-allocation if needed... */
1907         if (dev->data->tx_queues[queue_idx] != NULL) {
1908                 ixgbe_tx_queue_release(dev->data->tx_queues[queue_idx]);
1909                 dev->data->tx_queues[queue_idx] = NULL;
1910         }
1911
1912         /* First allocate the tx queue data structure */
1913         txq = rte_zmalloc_socket("ethdev TX queue", sizeof(struct igb_tx_queue),
1914                                  RTE_CACHE_LINE_SIZE, socket_id);
1915         if (txq == NULL)
1916                 return (-ENOMEM);
1917
1918         /*
1919          * Allocate TX ring hardware descriptors. A memzone large enough to
1920          * handle the maximum ring size is allocated in order to allow for
1921          * resizing in later calls to the queue setup function.
1922          */
1923         tz = ring_dma_zone_reserve(dev, "tx_ring", queue_idx,
1924                         sizeof(union ixgbe_adv_tx_desc) * IXGBE_MAX_RING_DESC,
1925                         socket_id);
1926         if (tz == NULL) {
1927                 ixgbe_tx_queue_release(txq);
1928                 return (-ENOMEM);
1929         }
1930
1931         txq->nb_tx_desc = nb_desc;
1932         txq->tx_rs_thresh = tx_rs_thresh;
1933         txq->tx_free_thresh = tx_free_thresh;
1934         txq->pthresh = tx_conf->tx_thresh.pthresh;
1935         txq->hthresh = tx_conf->tx_thresh.hthresh;
1936         txq->wthresh = tx_conf->tx_thresh.wthresh;
1937         txq->queue_id = queue_idx;
1938         txq->reg_idx = (uint16_t)((RTE_ETH_DEV_SRIOV(dev).active == 0) ?
1939                 queue_idx : RTE_ETH_DEV_SRIOV(dev).def_pool_q_idx + queue_idx);
1940         txq->port_id = dev->data->port_id;
1941         txq->txq_flags = tx_conf->txq_flags;
1942         txq->ops = &def_txq_ops;
1943         txq->tx_deferred_start = tx_conf->tx_deferred_start;
1944
1945         /*
1946          * Modification to set VFTDT for virtual function if vf is detected
1947          */
1948         if (hw->mac.type == ixgbe_mac_82599_vf)
1949                 txq->tdt_reg_addr = IXGBE_PCI_REG_ADDR(hw, IXGBE_VFTDT(queue_idx));
1950         else
1951                 txq->tdt_reg_addr = IXGBE_PCI_REG_ADDR(hw, IXGBE_TDT(txq->reg_idx));
1952 #ifndef RTE_LIBRTE_XEN_DOM0
1953         txq->tx_ring_phys_addr = (uint64_t) tz->phys_addr;
1954 #else
1955         txq->tx_ring_phys_addr = rte_mem_phy2mch(tz->memseg_id, tz->phys_addr);
1956 #endif
1957         txq->tx_ring = (union ixgbe_adv_tx_desc *) tz->addr;
1958
1959         /* Allocate software ring */
1960         txq->sw_ring = rte_zmalloc_socket("txq->sw_ring",
1961                                 sizeof(struct igb_tx_entry) * nb_desc,
1962                                 RTE_CACHE_LINE_SIZE, socket_id);
1963         if (txq->sw_ring == NULL) {
1964                 ixgbe_tx_queue_release(txq);
1965                 return (-ENOMEM);
1966         }
1967         PMD_INIT_LOG(DEBUG, "sw_ring=%p hw_ring=%p dma_addr=0x%"PRIx64,
1968                      txq->sw_ring, txq->tx_ring, txq->tx_ring_phys_addr);
1969
1970         /* set up vector or scalar TX function as appropriate */
1971         set_tx_function(dev, txq);
1972
1973         txq->ops->reset(txq);
1974
1975         dev->data->tx_queues[queue_idx] = txq;
1976
1977
1978         return (0);
1979 }
1980
1981 static void
1982 ixgbe_rx_queue_release_mbufs(struct igb_rx_queue *rxq)
1983 {
1984         unsigned i;
1985
1986         if (rxq->sw_ring != NULL) {
1987                 for (i = 0; i < rxq->nb_rx_desc; i++) {
1988                         if (rxq->sw_ring[i].mbuf != NULL) {
1989                                 rte_pktmbuf_free_seg(rxq->sw_ring[i].mbuf);
1990                                 rxq->sw_ring[i].mbuf = NULL;
1991                         }
1992                 }
1993 #ifdef RTE_LIBRTE_IXGBE_RX_ALLOW_BULK_ALLOC
1994                 if (rxq->rx_nb_avail) {
1995                         for (i = 0; i < rxq->rx_nb_avail; ++i) {
1996                                 struct rte_mbuf *mb;
1997                                 mb = rxq->rx_stage[rxq->rx_next_avail + i];
1998                                 rte_pktmbuf_free_seg(mb);
1999                         }
2000                         rxq->rx_nb_avail = 0;
2001                 }
2002 #endif
2003         }
2004 }
2005
2006 static void
2007 ixgbe_rx_queue_release(struct igb_rx_queue *rxq)
2008 {
2009         if (rxq != NULL) {
2010                 ixgbe_rx_queue_release_mbufs(rxq);
2011                 rte_free(rxq->sw_ring);
2012                 rte_free(rxq);
2013         }
2014 }
2015
2016 void
2017 ixgbe_dev_rx_queue_release(void *rxq)
2018 {
2019         ixgbe_rx_queue_release(rxq);
2020 }
2021
2022 /*
2023  * Check if Rx Burst Bulk Alloc function can be used.
2024  * Return
2025  *        0: the preconditions are satisfied and the bulk allocation function
2026  *           can be used.
2027  *  -EINVAL: the preconditions are NOT satisfied and the default Rx burst
2028  *           function must be used.
2029  */
2030 static inline int
2031 #ifdef RTE_LIBRTE_IXGBE_RX_ALLOW_BULK_ALLOC
2032 check_rx_burst_bulk_alloc_preconditions(struct igb_rx_queue *rxq)
2033 #else
2034 check_rx_burst_bulk_alloc_preconditions(__rte_unused struct igb_rx_queue *rxq)
2035 #endif
2036 {
2037         int ret = 0;
2038
2039         /*
2040          * Make sure the following pre-conditions are satisfied:
2041          *   rxq->rx_free_thresh >= RTE_PMD_IXGBE_RX_MAX_BURST
2042          *   rxq->rx_free_thresh < rxq->nb_rx_desc
2043          *   (rxq->nb_rx_desc % rxq->rx_free_thresh) == 0
2044          *   rxq->nb_rx_desc<(IXGBE_MAX_RING_DESC-RTE_PMD_IXGBE_RX_MAX_BURST)
2045          * Scattered packets are not supported.  This should be checked
2046          * outside of this function.
2047          */
2048 #ifdef RTE_LIBRTE_IXGBE_RX_ALLOW_BULK_ALLOC
2049         if (!(rxq->rx_free_thresh >= RTE_PMD_IXGBE_RX_MAX_BURST)) {
2050                 PMD_INIT_LOG(DEBUG, "Rx Burst Bulk Alloc Preconditions: "
2051                              "rxq->rx_free_thresh=%d, "
2052                              "RTE_PMD_IXGBE_RX_MAX_BURST=%d",
2053                              rxq->rx_free_thresh, RTE_PMD_IXGBE_RX_MAX_BURST);
2054                 ret = -EINVAL;
2055         } else if (!(rxq->rx_free_thresh < rxq->nb_rx_desc)) {
2056                 PMD_INIT_LOG(DEBUG, "Rx Burst Bulk Alloc Preconditions: "
2057                              "rxq->rx_free_thresh=%d, "
2058                              "rxq->nb_rx_desc=%d",
2059                              rxq->rx_free_thresh, rxq->nb_rx_desc);
2060                 ret = -EINVAL;
2061         } else if (!((rxq->nb_rx_desc % rxq->rx_free_thresh) == 0)) {
2062                 PMD_INIT_LOG(DEBUG, "Rx Burst Bulk Alloc Preconditions: "
2063                              "rxq->nb_rx_desc=%d, "
2064                              "rxq->rx_free_thresh=%d",
2065                              rxq->nb_rx_desc, rxq->rx_free_thresh);
2066                 ret = -EINVAL;
2067         } else if (!(rxq->nb_rx_desc <
2068                (IXGBE_MAX_RING_DESC - RTE_PMD_IXGBE_RX_MAX_BURST))) {
2069                 PMD_INIT_LOG(DEBUG, "Rx Burst Bulk Alloc Preconditions: "
2070                              "rxq->nb_rx_desc=%d, "
2071                              "IXGBE_MAX_RING_DESC=%d, "
2072                              "RTE_PMD_IXGBE_RX_MAX_BURST=%d",
2073                              rxq->nb_rx_desc, IXGBE_MAX_RING_DESC,
2074                              RTE_PMD_IXGBE_RX_MAX_BURST);
2075                 ret = -EINVAL;
2076         }
2077 #else
2078         ret = -EINVAL;
2079 #endif
2080
2081         return ret;
2082 }
2083
2084 /* Reset dynamic igb_rx_queue fields back to defaults */
2085 static void
2086 ixgbe_reset_rx_queue(struct igb_rx_queue *rxq)
2087 {
2088         static const union ixgbe_adv_rx_desc zeroed_desc = { .read = {
2089                         .pkt_addr = 0}};
2090         unsigned i;
2091         uint16_t len;
2092
2093         /*
2094          * By default, the Rx queue setup function allocates enough memory for
2095          * IXGBE_MAX_RING_DESC.  The Rx Burst bulk allocation function requires
2096          * extra memory at the end of the descriptor ring to be zero'd out. A
2097          * pre-condition for using the Rx burst bulk alloc function is that the
2098          * number of descriptors is less than or equal to
2099          * (IXGBE_MAX_RING_DESC - RTE_PMD_IXGBE_RX_MAX_BURST). Check all the
2100          * constraints here to see if we need to zero out memory after the end
2101          * of the H/W descriptor ring.
2102          */
2103 #ifdef RTE_LIBRTE_IXGBE_RX_ALLOW_BULK_ALLOC
2104         if (check_rx_burst_bulk_alloc_preconditions(rxq) == 0)
2105                 /* zero out extra memory */
2106                 len = (uint16_t)(rxq->nb_rx_desc + RTE_PMD_IXGBE_RX_MAX_BURST);
2107         else
2108 #endif
2109                 /* do not zero out extra memory */
2110                 len = rxq->nb_rx_desc;
2111
2112         /*
2113          * Zero out HW ring memory. Zero out extra memory at the end of
2114          * the H/W ring so look-ahead logic in Rx Burst bulk alloc function
2115          * reads extra memory as zeros.
2116          */
2117         for (i = 0; i < len; i++) {
2118                 rxq->rx_ring[i] = zeroed_desc;
2119         }
2120
2121 #ifdef RTE_LIBRTE_IXGBE_RX_ALLOW_BULK_ALLOC
2122         /*
2123          * initialize extra software ring entries. Space for these extra
2124          * entries is always allocated
2125          */
2126         memset(&rxq->fake_mbuf, 0x0, sizeof(rxq->fake_mbuf));
2127         for (i = 0; i < RTE_PMD_IXGBE_RX_MAX_BURST; ++i) {
2128                 rxq->sw_ring[rxq->nb_rx_desc + i].mbuf = &rxq->fake_mbuf;
2129         }
2130
2131         rxq->rx_nb_avail = 0;
2132         rxq->rx_next_avail = 0;
2133         rxq->rx_free_trigger = (uint16_t)(rxq->rx_free_thresh - 1);
2134 #endif /* RTE_LIBRTE_IXGBE_RX_ALLOW_BULK_ALLOC */
2135         rxq->rx_tail = 0;
2136         rxq->nb_rx_hold = 0;
2137         rxq->pkt_first_seg = NULL;
2138         rxq->pkt_last_seg = NULL;
2139 }
2140
2141 int
2142 ixgbe_dev_rx_queue_setup(struct rte_eth_dev *dev,
2143                          uint16_t queue_idx,
2144                          uint16_t nb_desc,
2145                          unsigned int socket_id,
2146                          const struct rte_eth_rxconf *rx_conf,
2147                          struct rte_mempool *mp)
2148 {
2149         const struct rte_memzone *rz;
2150         struct igb_rx_queue *rxq;
2151         struct ixgbe_hw     *hw;
2152         int use_def_burst_func = 1;
2153         uint16_t len;
2154
2155         PMD_INIT_FUNC_TRACE();
2156         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2157
2158         /*
2159          * Validate number of receive descriptors.
2160          * It must not exceed hardware maximum, and must be multiple
2161          * of IXGBE_ALIGN.
2162          */
2163         if (((nb_desc * sizeof(union ixgbe_adv_rx_desc)) % IXGBE_ALIGN) != 0 ||
2164             (nb_desc > IXGBE_MAX_RING_DESC) ||
2165             (nb_desc < IXGBE_MIN_RING_DESC)) {
2166                 return (-EINVAL);
2167         }
2168
2169         /* Free memory prior to re-allocation if needed... */
2170         if (dev->data->rx_queues[queue_idx] != NULL) {
2171                 ixgbe_rx_queue_release(dev->data->rx_queues[queue_idx]);
2172                 dev->data->rx_queues[queue_idx] = NULL;
2173         }
2174
2175         /* First allocate the rx queue data structure */
2176         rxq = rte_zmalloc_socket("ethdev RX queue", sizeof(struct igb_rx_queue),
2177                                  RTE_CACHE_LINE_SIZE, socket_id);
2178         if (rxq == NULL)
2179                 return (-ENOMEM);
2180         rxq->mb_pool = mp;
2181         rxq->nb_rx_desc = nb_desc;
2182         rxq->rx_free_thresh = rx_conf->rx_free_thresh;
2183         rxq->queue_id = queue_idx;
2184         rxq->reg_idx = (uint16_t)((RTE_ETH_DEV_SRIOV(dev).active == 0) ?
2185                 queue_idx : RTE_ETH_DEV_SRIOV(dev).def_pool_q_idx + queue_idx);
2186         rxq->port_id = dev->data->port_id;
2187         rxq->crc_len = (uint8_t) ((dev->data->dev_conf.rxmode.hw_strip_crc) ?
2188                                                         0 : ETHER_CRC_LEN);
2189         rxq->drop_en = rx_conf->rx_drop_en;
2190         rxq->rx_deferred_start = rx_conf->rx_deferred_start;
2191
2192         /*
2193          * Allocate RX ring hardware descriptors. A memzone large enough to
2194          * handle the maximum ring size is allocated in order to allow for
2195          * resizing in later calls to the queue setup function.
2196          */
2197         rz = ring_dma_zone_reserve(dev, "rx_ring", queue_idx,
2198                                    RX_RING_SZ, socket_id);
2199         if (rz == NULL) {
2200                 ixgbe_rx_queue_release(rxq);
2201                 return (-ENOMEM);
2202         }
2203
2204         /*
2205          * Zero init all the descriptors in the ring.
2206          */
2207         memset (rz->addr, 0, RX_RING_SZ);
2208
2209         /*
2210          * Modified to setup VFRDT for Virtual Function
2211          */
2212         if (hw->mac.type == ixgbe_mac_82599_vf) {
2213                 rxq->rdt_reg_addr =
2214                         IXGBE_PCI_REG_ADDR(hw, IXGBE_VFRDT(queue_idx));
2215                 rxq->rdh_reg_addr =
2216                         IXGBE_PCI_REG_ADDR(hw, IXGBE_VFRDH(queue_idx));
2217         }
2218         else {
2219                 rxq->rdt_reg_addr =
2220                         IXGBE_PCI_REG_ADDR(hw, IXGBE_RDT(rxq->reg_idx));
2221                 rxq->rdh_reg_addr =
2222                         IXGBE_PCI_REG_ADDR(hw, IXGBE_RDH(rxq->reg_idx));
2223         }
2224 #ifndef RTE_LIBRTE_XEN_DOM0
2225         rxq->rx_ring_phys_addr = (uint64_t) rz->phys_addr;
2226 #else
2227         rxq->rx_ring_phys_addr = rte_mem_phy2mch(rz->memseg_id, rz->phys_addr);
2228 #endif
2229         rxq->rx_ring = (union ixgbe_adv_rx_desc *) rz->addr;
2230
2231         /*
2232          * Allocate software ring. Allow for space at the end of the
2233          * S/W ring to make sure look-ahead logic in bulk alloc Rx burst
2234          * function does not access an invalid memory region.
2235          */
2236 #ifdef RTE_LIBRTE_IXGBE_RX_ALLOW_BULK_ALLOC
2237         len = (uint16_t)(nb_desc + RTE_PMD_IXGBE_RX_MAX_BURST);
2238 #else
2239         len = nb_desc;
2240 #endif
2241         rxq->sw_ring = rte_zmalloc_socket("rxq->sw_ring",
2242                                           sizeof(struct igb_rx_entry) * len,
2243                                           RTE_CACHE_LINE_SIZE, socket_id);
2244         if (rxq->sw_ring == NULL) {
2245                 ixgbe_rx_queue_release(rxq);
2246                 return (-ENOMEM);
2247         }
2248         PMD_INIT_LOG(DEBUG, "sw_ring=%p hw_ring=%p dma_addr=0x%"PRIx64,
2249                      rxq->sw_ring, rxq->rx_ring, rxq->rx_ring_phys_addr);
2250
2251         /*
2252          * Certain constraints must be met in order to use the bulk buffer
2253          * allocation Rx burst function.
2254          */
2255         use_def_burst_func = check_rx_burst_bulk_alloc_preconditions(rxq);
2256
2257 #ifdef RTE_IXGBE_INC_VECTOR
2258         ixgbe_rxq_vec_setup(rxq);
2259 #endif
2260         /* Check if pre-conditions are satisfied, and no Scattered Rx */
2261         if (!use_def_burst_func && !dev->data->scattered_rx) {
2262 #ifdef RTE_LIBRTE_IXGBE_RX_ALLOW_BULK_ALLOC
2263                 PMD_INIT_LOG(DEBUG, "Rx Burst Bulk Alloc Preconditions are "
2264                              "satisfied. Rx Burst Bulk Alloc function will be "
2265                              "used on port=%d, queue=%d.",
2266                              rxq->port_id, rxq->queue_id);
2267                 dev->rx_pkt_burst = ixgbe_recv_pkts_bulk_alloc;
2268 #ifdef RTE_IXGBE_INC_VECTOR
2269                 if (!ixgbe_rx_vec_condition_check(dev)) {
2270                         PMD_INIT_LOG(INFO, "Vector rx enabled, please make "
2271                                      "sure RX burst size no less than 32.");
2272                         dev->rx_pkt_burst = ixgbe_recv_pkts_vec;
2273                 }
2274 #endif
2275 #endif
2276         } else {
2277                 PMD_INIT_LOG(DEBUG, "Rx Burst Bulk Alloc Preconditions "
2278                              "are not satisfied, Scattered Rx is requested, "
2279                              "or RTE_LIBRTE_IXGBE_RX_ALLOW_BULK_ALLOC is not "
2280                              "enabled (port=%d, queue=%d).",
2281                              rxq->port_id, rxq->queue_id);
2282         }
2283         dev->data->rx_queues[queue_idx] = rxq;
2284
2285         ixgbe_reset_rx_queue(rxq);
2286
2287         return 0;
2288 }
2289
2290 uint32_t
2291 ixgbe_dev_rx_queue_count(struct rte_eth_dev *dev, uint16_t rx_queue_id)
2292 {
2293 #define IXGBE_RXQ_SCAN_INTERVAL 4
2294         volatile union ixgbe_adv_rx_desc *rxdp;
2295         struct igb_rx_queue *rxq;
2296         uint32_t desc = 0;
2297
2298         if (rx_queue_id >= dev->data->nb_rx_queues) {
2299                 PMD_RX_LOG(ERR, "Invalid RX queue id=%d", rx_queue_id);
2300                 return 0;
2301         }
2302
2303         rxq = dev->data->rx_queues[rx_queue_id];
2304         rxdp = &(rxq->rx_ring[rxq->rx_tail]);
2305
2306         while ((desc < rxq->nb_rx_desc) &&
2307                 (rxdp->wb.upper.status_error & IXGBE_RXDADV_STAT_DD)) {
2308                 desc += IXGBE_RXQ_SCAN_INTERVAL;
2309                 rxdp += IXGBE_RXQ_SCAN_INTERVAL;
2310                 if (rxq->rx_tail + desc >= rxq->nb_rx_desc)
2311                         rxdp = &(rxq->rx_ring[rxq->rx_tail +
2312                                 desc - rxq->nb_rx_desc]);
2313         }
2314
2315         return desc;
2316 }
2317
2318 int
2319 ixgbe_dev_rx_descriptor_done(void *rx_queue, uint16_t offset)
2320 {
2321         volatile union ixgbe_adv_rx_desc *rxdp;
2322         struct igb_rx_queue *rxq = rx_queue;
2323         uint32_t desc;
2324
2325         if (unlikely(offset >= rxq->nb_rx_desc))
2326                 return 0;
2327         desc = rxq->rx_tail + offset;
2328         if (desc >= rxq->nb_rx_desc)
2329                 desc -= rxq->nb_rx_desc;
2330
2331         rxdp = &rxq->rx_ring[desc];
2332         return !!(rxdp->wb.upper.status_error & IXGBE_RXDADV_STAT_DD);
2333 }
2334
2335 void
2336 ixgbe_dev_clear_queues(struct rte_eth_dev *dev)
2337 {
2338         unsigned i;
2339
2340         PMD_INIT_FUNC_TRACE();
2341
2342         for (i = 0; i < dev->data->nb_tx_queues; i++) {
2343                 struct igb_tx_queue *txq = dev->data->tx_queues[i];
2344                 if (txq != NULL) {
2345                         txq->ops->release_mbufs(txq);
2346                         txq->ops->reset(txq);
2347                 }
2348         }
2349
2350         for (i = 0; i < dev->data->nb_rx_queues; i++) {
2351                 struct igb_rx_queue *rxq = dev->data->rx_queues[i];
2352                 if (rxq != NULL) {
2353                         ixgbe_rx_queue_release_mbufs(rxq);
2354                         ixgbe_reset_rx_queue(rxq);
2355                 }
2356         }
2357 }
2358
2359 /*********************************************************************
2360  *
2361  *  Device RX/TX init functions
2362  *
2363  **********************************************************************/
2364
2365 /**
2366  * Receive Side Scaling (RSS)
2367  * See section 7.1.2.8 in the following document:
2368  *     "Intel 82599 10 GbE Controller Datasheet" - Revision 2.1 October 2009
2369  *
2370  * Principles:
2371  * The source and destination IP addresses of the IP header and the source
2372  * and destination ports of TCP/UDP headers, if any, of received packets are
2373  * hashed against a configurable random key to compute a 32-bit RSS hash result.
2374  * The seven (7) LSBs of the 32-bit hash result are used as an index into a
2375  * 128-entry redirection table (RETA).  Each entry of the RETA provides a 3-bit
2376  * RSS output index which is used as the RX queue index where to store the
2377  * received packets.
2378  * The following output is supplied in the RX write-back descriptor:
2379  *     - 32-bit result of the Microsoft RSS hash function,
2380  *     - 4-bit RSS type field.
2381  */
2382
2383 /*
2384  * RSS random key supplied in section 7.1.2.8.3 of the Intel 82599 datasheet.
2385  * Used as the default key.
2386  */
2387 static uint8_t rss_intel_key[40] = {
2388         0x6D, 0x5A, 0x56, 0xDA, 0x25, 0x5B, 0x0E, 0xC2,
2389         0x41, 0x67, 0x25, 0x3D, 0x43, 0xA3, 0x8F, 0xB0,
2390         0xD0, 0xCA, 0x2B, 0xCB, 0xAE, 0x7B, 0x30, 0xB4,
2391         0x77, 0xCB, 0x2D, 0xA3, 0x80, 0x30, 0xF2, 0x0C,
2392         0x6A, 0x42, 0xB7, 0x3B, 0xBE, 0xAC, 0x01, 0xFA,
2393 };
2394
2395 static void
2396 ixgbe_rss_disable(struct rte_eth_dev *dev)
2397 {
2398         struct ixgbe_hw *hw;
2399         uint32_t mrqc;
2400
2401         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2402         mrqc = IXGBE_READ_REG(hw, IXGBE_MRQC);
2403         mrqc &= ~IXGBE_MRQC_RSSEN;
2404         IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
2405 }
2406
2407 static void
2408 ixgbe_hw_rss_hash_set(struct ixgbe_hw *hw, struct rte_eth_rss_conf *rss_conf)
2409 {
2410         uint8_t  *hash_key;
2411         uint32_t mrqc;
2412         uint32_t rss_key;
2413         uint64_t rss_hf;
2414         uint16_t i;
2415
2416         hash_key = rss_conf->rss_key;
2417         if (hash_key != NULL) {
2418                 /* Fill in RSS hash key */
2419                 for (i = 0; i < 10; i++) {
2420                         rss_key  = hash_key[(i * 4)];
2421                         rss_key |= hash_key[(i * 4) + 1] << 8;
2422                         rss_key |= hash_key[(i * 4) + 2] << 16;
2423                         rss_key |= hash_key[(i * 4) + 3] << 24;
2424                         IXGBE_WRITE_REG_ARRAY(hw, IXGBE_RSSRK(0), i, rss_key);
2425                 }
2426         }
2427
2428         /* Set configured hashing protocols in MRQC register */
2429         rss_hf = rss_conf->rss_hf;
2430         mrqc = IXGBE_MRQC_RSSEN; /* Enable RSS */
2431         if (rss_hf & ETH_RSS_IPV4)
2432                 mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4;
2433         if (rss_hf & ETH_RSS_IPV4_TCP)
2434                 mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4_TCP;
2435         if (rss_hf & ETH_RSS_IPV6)
2436                 mrqc |= IXGBE_MRQC_RSS_FIELD_IPV6;
2437         if (rss_hf & ETH_RSS_IPV6_EX)
2438                 mrqc |= IXGBE_MRQC_RSS_FIELD_IPV6_EX;
2439         if (rss_hf & ETH_RSS_IPV6_TCP)
2440                 mrqc |= IXGBE_MRQC_RSS_FIELD_IPV6_TCP;
2441         if (rss_hf & ETH_RSS_IPV6_TCP_EX)
2442                 mrqc |= IXGBE_MRQC_RSS_FIELD_IPV6_EX_TCP;
2443         if (rss_hf & ETH_RSS_IPV4_UDP)
2444                 mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4_UDP;
2445         if (rss_hf & ETH_RSS_IPV6_UDP)
2446                 mrqc |= IXGBE_MRQC_RSS_FIELD_IPV6_UDP;
2447         if (rss_hf & ETH_RSS_IPV6_UDP_EX)
2448                 mrqc |= IXGBE_MRQC_RSS_FIELD_IPV6_EX_UDP;
2449         IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
2450 }
2451
2452 int
2453 ixgbe_dev_rss_hash_update(struct rte_eth_dev *dev,
2454                           struct rte_eth_rss_conf *rss_conf)
2455 {
2456         struct ixgbe_hw *hw;
2457         uint32_t mrqc;
2458         uint64_t rss_hf;
2459
2460         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2461
2462         /*
2463          * Excerpt from section 7.1.2.8 Receive-Side Scaling (RSS):
2464          *     "RSS enabling cannot be done dynamically while it must be
2465          *      preceded by a software reset"
2466          * Before changing anything, first check that the update RSS operation
2467          * does not attempt to disable RSS, if RSS was enabled at
2468          * initialization time, or does not attempt to enable RSS, if RSS was
2469          * disabled at initialization time.
2470          */
2471         rss_hf = rss_conf->rss_hf & IXGBE_RSS_OFFLOAD_ALL;
2472         mrqc = IXGBE_READ_REG(hw, IXGBE_MRQC);
2473         if (!(mrqc & IXGBE_MRQC_RSSEN)) { /* RSS disabled */
2474                 if (rss_hf != 0) /* Enable RSS */
2475                         return -(EINVAL);
2476                 return 0; /* Nothing to do */
2477         }
2478         /* RSS enabled */
2479         if (rss_hf == 0) /* Disable RSS */
2480                 return -(EINVAL);
2481         ixgbe_hw_rss_hash_set(hw, rss_conf);
2482         return 0;
2483 }
2484
2485 int
2486 ixgbe_dev_rss_hash_conf_get(struct rte_eth_dev *dev,
2487                             struct rte_eth_rss_conf *rss_conf)
2488 {
2489         struct ixgbe_hw *hw;
2490         uint8_t *hash_key;
2491         uint32_t mrqc;
2492         uint32_t rss_key;
2493         uint64_t rss_hf;
2494         uint16_t i;
2495
2496         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2497         hash_key = rss_conf->rss_key;
2498         if (hash_key != NULL) {
2499                 /* Return RSS hash key */
2500                 for (i = 0; i < 10; i++) {
2501                         rss_key = IXGBE_READ_REG_ARRAY(hw, IXGBE_RSSRK(0), i);
2502                         hash_key[(i * 4)] = rss_key & 0x000000FF;
2503                         hash_key[(i * 4) + 1] = (rss_key >> 8) & 0x000000FF;
2504                         hash_key[(i * 4) + 2] = (rss_key >> 16) & 0x000000FF;
2505                         hash_key[(i * 4) + 3] = (rss_key >> 24) & 0x000000FF;
2506                 }
2507         }
2508
2509         /* Get RSS functions configured in MRQC register */
2510         mrqc = IXGBE_READ_REG(hw, IXGBE_MRQC);
2511         if ((mrqc & IXGBE_MRQC_RSSEN) == 0) { /* RSS is disabled */
2512                 rss_conf->rss_hf = 0;
2513                 return 0;
2514         }
2515         rss_hf = 0;
2516         if (mrqc & IXGBE_MRQC_RSS_FIELD_IPV4)
2517                 rss_hf |= ETH_RSS_IPV4;
2518         if (mrqc & IXGBE_MRQC_RSS_FIELD_IPV4_TCP)
2519                 rss_hf |= ETH_RSS_IPV4_TCP;
2520         if (mrqc & IXGBE_MRQC_RSS_FIELD_IPV6)
2521                 rss_hf |= ETH_RSS_IPV6;
2522         if (mrqc & IXGBE_MRQC_RSS_FIELD_IPV6_EX)
2523                 rss_hf |= ETH_RSS_IPV6_EX;
2524         if (mrqc & IXGBE_MRQC_RSS_FIELD_IPV6_TCP)
2525                 rss_hf |= ETH_RSS_IPV6_TCP;
2526         if (mrqc & IXGBE_MRQC_RSS_FIELD_IPV6_EX_TCP)
2527                 rss_hf |= ETH_RSS_IPV6_TCP_EX;
2528         if (mrqc & IXGBE_MRQC_RSS_FIELD_IPV4_UDP)
2529                 rss_hf |= ETH_RSS_IPV4_UDP;
2530         if (mrqc & IXGBE_MRQC_RSS_FIELD_IPV6_UDP)
2531                 rss_hf |= ETH_RSS_IPV6_UDP;
2532         if (mrqc & IXGBE_MRQC_RSS_FIELD_IPV6_EX_UDP)
2533                 rss_hf |= ETH_RSS_IPV6_UDP_EX;
2534         rss_conf->rss_hf = rss_hf;
2535         return 0;
2536 }
2537
2538 static void
2539 ixgbe_rss_configure(struct rte_eth_dev *dev)
2540 {
2541         struct rte_eth_rss_conf rss_conf;
2542         struct ixgbe_hw *hw;
2543         uint32_t reta;
2544         uint16_t i;
2545         uint16_t j;
2546
2547         PMD_INIT_FUNC_TRACE();
2548         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2549
2550         /*
2551          * Fill in redirection table
2552          * The byte-swap is needed because NIC registers are in
2553          * little-endian order.
2554          */
2555         reta = 0;
2556         for (i = 0, j = 0; i < 128; i++, j++) {
2557                 if (j == dev->data->nb_rx_queues)
2558                         j = 0;
2559                 reta = (reta << 8) | j;
2560                 if ((i & 3) == 3)
2561                         IXGBE_WRITE_REG(hw, IXGBE_RETA(i >> 2),
2562                                         rte_bswap32(reta));
2563         }
2564
2565         /*
2566          * Configure the RSS key and the RSS protocols used to compute
2567          * the RSS hash of input packets.
2568          */
2569         rss_conf = dev->data->dev_conf.rx_adv_conf.rss_conf;
2570         if ((rss_conf.rss_hf & IXGBE_RSS_OFFLOAD_ALL) == 0) {
2571                 ixgbe_rss_disable(dev);
2572                 return;
2573         }
2574         if (rss_conf.rss_key == NULL)
2575                 rss_conf.rss_key = rss_intel_key; /* Default hash key */
2576         ixgbe_hw_rss_hash_set(hw, &rss_conf);
2577 }
2578
2579 #define NUM_VFTA_REGISTERS 128
2580 #define NIC_RX_BUFFER_SIZE 0x200
2581
2582 static void
2583 ixgbe_vmdq_dcb_configure(struct rte_eth_dev *dev)
2584 {
2585         struct rte_eth_vmdq_dcb_conf *cfg;
2586         struct ixgbe_hw *hw;
2587         enum rte_eth_nb_pools num_pools;
2588         uint32_t mrqc, vt_ctl, queue_mapping, vlanctrl;
2589         uint16_t pbsize;
2590         uint8_t nb_tcs; /* number of traffic classes */
2591         int i;
2592
2593         PMD_INIT_FUNC_TRACE();
2594         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2595         cfg = &dev->data->dev_conf.rx_adv_conf.vmdq_dcb_conf;
2596         num_pools = cfg->nb_queue_pools;
2597         /* Check we have a valid number of pools */
2598         if (num_pools != ETH_16_POOLS && num_pools != ETH_32_POOLS) {
2599                 ixgbe_rss_disable(dev);
2600                 return;
2601         }
2602         /* 16 pools -> 8 traffic classes, 32 pools -> 4 traffic classes */
2603         nb_tcs = (uint8_t)(ETH_VMDQ_DCB_NUM_QUEUES / (int)num_pools);
2604
2605         /*
2606          * RXPBSIZE
2607          * split rx buffer up into sections, each for 1 traffic class
2608          */
2609         pbsize = (uint16_t)(NIC_RX_BUFFER_SIZE / nb_tcs);
2610         for (i = 0 ; i < nb_tcs; i++) {
2611                 uint32_t rxpbsize = IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(i));
2612                 rxpbsize &= (~(0x3FF << IXGBE_RXPBSIZE_SHIFT));
2613                 /* clear 10 bits. */
2614                 rxpbsize |= (pbsize << IXGBE_RXPBSIZE_SHIFT); /* set value */
2615                 IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(i), rxpbsize);
2616         }
2617         /* zero alloc all unused TCs */
2618         for (i = nb_tcs; i < ETH_DCB_NUM_USER_PRIORITIES; i++) {
2619                 uint32_t rxpbsize = IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(i));
2620                 rxpbsize &= (~( 0x3FF << IXGBE_RXPBSIZE_SHIFT ));
2621                 /* clear 10 bits. */
2622                 IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(i), rxpbsize);
2623         }
2624
2625         /* MRQC: enable vmdq and dcb */
2626         mrqc = ((num_pools == ETH_16_POOLS) ? \
2627                 IXGBE_MRQC_VMDQRT8TCEN : IXGBE_MRQC_VMDQRT4TCEN );
2628         IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
2629
2630         /* PFVTCTL: turn on virtualisation and set the default pool */
2631         vt_ctl = IXGBE_VT_CTL_VT_ENABLE | IXGBE_VT_CTL_REPLEN;
2632         if (cfg->enable_default_pool) {
2633                 vt_ctl |= (cfg->default_pool << IXGBE_VT_CTL_POOL_SHIFT);
2634         } else {
2635                 vt_ctl |= IXGBE_VT_CTL_DIS_DEFPL;
2636         }
2637
2638         IXGBE_WRITE_REG(hw, IXGBE_VT_CTL, vt_ctl);
2639
2640         /* RTRUP2TC: mapping user priorities to traffic classes (TCs) */
2641         queue_mapping = 0;
2642         for (i = 0; i < ETH_DCB_NUM_USER_PRIORITIES; i++)
2643                 /*
2644                  * mapping is done with 3 bits per priority,
2645                  * so shift by i*3 each time
2646                  */
2647                 queue_mapping |= ((cfg->dcb_queue[i] & 0x07) << (i * 3));
2648
2649         IXGBE_WRITE_REG(hw, IXGBE_RTRUP2TC, queue_mapping);
2650
2651         /* RTRPCS: DCB related */
2652         IXGBE_WRITE_REG(hw, IXGBE_RTRPCS, IXGBE_RMCS_RRM);
2653
2654         /* VLNCTRL: enable vlan filtering and allow all vlan tags through */
2655         vlanctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
2656         vlanctrl |= IXGBE_VLNCTRL_VFE ; /* enable vlan filters */
2657         IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlanctrl);
2658
2659         /* VFTA - enable all vlan filters */
2660         for (i = 0; i < NUM_VFTA_REGISTERS; i++) {
2661                 IXGBE_WRITE_REG(hw, IXGBE_VFTA(i), 0xFFFFFFFF);
2662         }
2663
2664         /* VFRE: pool enabling for receive - 16 or 32 */
2665         IXGBE_WRITE_REG(hw, IXGBE_VFRE(0), \
2666                         num_pools == ETH_16_POOLS ? 0xFFFF : 0xFFFFFFFF);
2667
2668         /*
2669          * MPSAR - allow pools to read specific mac addresses
2670          * In this case, all pools should be able to read from mac addr 0
2671          */
2672         IXGBE_WRITE_REG(hw, IXGBE_MPSAR_LO(0), 0xFFFFFFFF);
2673         IXGBE_WRITE_REG(hw, IXGBE_MPSAR_HI(0), 0xFFFFFFFF);
2674
2675         /* PFVLVF, PFVLVFB: set up filters for vlan tags as configured */
2676         for (i = 0; i < cfg->nb_pool_maps; i++) {
2677                 /* set vlan id in VF register and set the valid bit */
2678                 IXGBE_WRITE_REG(hw, IXGBE_VLVF(i), (IXGBE_VLVF_VIEN | \
2679                                 (cfg->pool_map[i].vlan_id & 0xFFF)));
2680                 /*
2681                  * Put the allowed pools in VFB reg. As we only have 16 or 32
2682                  * pools, we only need to use the first half of the register
2683                  * i.e. bits 0-31
2684                  */
2685                 IXGBE_WRITE_REG(hw, IXGBE_VLVFB(i*2), cfg->pool_map[i].pools);
2686         }
2687 }
2688
2689 /**
2690  * ixgbe_dcb_config_tx_hw_config - Configure general DCB TX parameters
2691  * @hw: pointer to hardware structure
2692  * @dcb_config: pointer to ixgbe_dcb_config structure
2693  */
2694 static void
2695 ixgbe_dcb_tx_hw_config(struct ixgbe_hw *hw,
2696                struct ixgbe_dcb_config *dcb_config)
2697 {
2698         uint32_t reg;
2699         uint32_t q;
2700
2701         PMD_INIT_FUNC_TRACE();
2702         if (hw->mac.type != ixgbe_mac_82598EB) {
2703                 /* Disable the Tx desc arbiter so that MTQC can be changed */
2704                 reg = IXGBE_READ_REG(hw, IXGBE_RTTDCS);
2705                 reg |= IXGBE_RTTDCS_ARBDIS;
2706                 IXGBE_WRITE_REG(hw, IXGBE_RTTDCS, reg);
2707
2708                 /* Enable DCB for Tx with 8 TCs */
2709                 if (dcb_config->num_tcs.pg_tcs == 8) {
2710                         reg = IXGBE_MTQC_RT_ENA | IXGBE_MTQC_8TC_8TQ;
2711                 }
2712                 else {
2713                         reg = IXGBE_MTQC_RT_ENA | IXGBE_MTQC_4TC_4TQ;
2714                 }
2715                 if (dcb_config->vt_mode)
2716                     reg |= IXGBE_MTQC_VT_ENA;
2717                 IXGBE_WRITE_REG(hw, IXGBE_MTQC, reg);
2718
2719                 /* Disable drop for all queues */
2720                 for (q = 0; q < 128; q++)
2721                         IXGBE_WRITE_REG(hw, IXGBE_QDE,
2722                      (IXGBE_QDE_WRITE | (q << IXGBE_QDE_IDX_SHIFT)));
2723
2724                 /* Enable the Tx desc arbiter */
2725                 reg = IXGBE_READ_REG(hw, IXGBE_RTTDCS);
2726                 reg &= ~IXGBE_RTTDCS_ARBDIS;
2727                 IXGBE_WRITE_REG(hw, IXGBE_RTTDCS, reg);
2728
2729                 /* Enable Security TX Buffer IFG for DCB */
2730                 reg = IXGBE_READ_REG(hw, IXGBE_SECTXMINIFG);
2731                 reg |= IXGBE_SECTX_DCB;
2732                 IXGBE_WRITE_REG(hw, IXGBE_SECTXMINIFG, reg);
2733         }
2734         return;
2735 }
2736
2737 /**
2738  * ixgbe_vmdq_dcb_hw_tx_config - Configure general VMDQ+DCB TX parameters
2739  * @dev: pointer to rte_eth_dev structure
2740  * @dcb_config: pointer to ixgbe_dcb_config structure
2741  */
2742 static void
2743 ixgbe_vmdq_dcb_hw_tx_config(struct rte_eth_dev *dev,
2744                         struct ixgbe_dcb_config *dcb_config)
2745 {
2746         struct rte_eth_vmdq_dcb_tx_conf *vmdq_tx_conf =
2747                         &dev->data->dev_conf.tx_adv_conf.vmdq_dcb_tx_conf;
2748         struct ixgbe_hw *hw =
2749                         IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2750
2751         PMD_INIT_FUNC_TRACE();
2752         if (hw->mac.type != ixgbe_mac_82598EB)
2753                 /*PF VF Transmit Enable*/
2754                 IXGBE_WRITE_REG(hw, IXGBE_VFTE(0),
2755                         vmdq_tx_conf->nb_queue_pools == ETH_16_POOLS ? 0xFFFF : 0xFFFFFFFF);
2756
2757         /*Configure general DCB TX parameters*/
2758         ixgbe_dcb_tx_hw_config(hw,dcb_config);
2759         return;
2760 }
2761
2762 static void
2763 ixgbe_vmdq_dcb_rx_config(struct rte_eth_dev *dev,
2764                         struct ixgbe_dcb_config *dcb_config)
2765 {
2766         struct rte_eth_vmdq_dcb_conf *vmdq_rx_conf =
2767                         &dev->data->dev_conf.rx_adv_conf.vmdq_dcb_conf;
2768         struct ixgbe_dcb_tc_config *tc;
2769         uint8_t i,j;
2770
2771         /* convert rte_eth_conf.rx_adv_conf to struct ixgbe_dcb_config */
2772         if (vmdq_rx_conf->nb_queue_pools == ETH_16_POOLS ) {
2773                 dcb_config->num_tcs.pg_tcs = ETH_8_TCS;
2774                 dcb_config->num_tcs.pfc_tcs = ETH_8_TCS;
2775         }
2776         else {
2777                 dcb_config->num_tcs.pg_tcs = ETH_4_TCS;
2778                 dcb_config->num_tcs.pfc_tcs = ETH_4_TCS;
2779         }
2780         /* User Priority to Traffic Class mapping */
2781         for (i = 0; i < ETH_DCB_NUM_USER_PRIORITIES; i++) {
2782                 j = vmdq_rx_conf->dcb_queue[i];
2783                 tc = &dcb_config->tc_config[j];
2784                 tc->path[IXGBE_DCB_RX_CONFIG].up_to_tc_bitmap =
2785                                                 (uint8_t)(1 << j);
2786         }
2787 }
2788
2789 static void
2790 ixgbe_dcb_vt_tx_config(struct rte_eth_dev *dev,
2791                         struct ixgbe_dcb_config *dcb_config)
2792 {
2793         struct rte_eth_vmdq_dcb_tx_conf *vmdq_tx_conf =
2794                         &dev->data->dev_conf.tx_adv_conf.vmdq_dcb_tx_conf;
2795         struct ixgbe_dcb_tc_config *tc;
2796         uint8_t i,j;
2797
2798         /* convert rte_eth_conf.rx_adv_conf to struct ixgbe_dcb_config */
2799         if (vmdq_tx_conf->nb_queue_pools == ETH_16_POOLS ) {
2800                 dcb_config->num_tcs.pg_tcs = ETH_8_TCS;
2801                 dcb_config->num_tcs.pfc_tcs = ETH_8_TCS;
2802         }
2803         else {
2804                 dcb_config->num_tcs.pg_tcs = ETH_4_TCS;
2805                 dcb_config->num_tcs.pfc_tcs = ETH_4_TCS;
2806         }
2807
2808         /* User Priority to Traffic Class mapping */
2809         for (i = 0; i < ETH_DCB_NUM_USER_PRIORITIES; i++) {
2810                 j = vmdq_tx_conf->dcb_queue[i];
2811                 tc = &dcb_config->tc_config[j];
2812                 tc->path[IXGBE_DCB_TX_CONFIG].up_to_tc_bitmap =
2813                                                 (uint8_t)(1 << j);
2814         }
2815         return;
2816 }
2817
2818 static void
2819 ixgbe_dcb_rx_config(struct rte_eth_dev *dev,
2820                 struct ixgbe_dcb_config *dcb_config)
2821 {
2822         struct rte_eth_dcb_rx_conf *rx_conf =
2823                         &dev->data->dev_conf.rx_adv_conf.dcb_rx_conf;
2824         struct ixgbe_dcb_tc_config *tc;
2825         uint8_t i,j;
2826
2827         dcb_config->num_tcs.pg_tcs = (uint8_t)rx_conf->nb_tcs;
2828         dcb_config->num_tcs.pfc_tcs = (uint8_t)rx_conf->nb_tcs;
2829
2830         /* User Priority to Traffic Class mapping */
2831         for (i = 0; i < ETH_DCB_NUM_USER_PRIORITIES; i++) {
2832                 j = rx_conf->dcb_queue[i];
2833                 tc = &dcb_config->tc_config[j];
2834                 tc->path[IXGBE_DCB_RX_CONFIG].up_to_tc_bitmap =
2835                                                 (uint8_t)(1 << j);
2836         }
2837 }
2838
2839 static void
2840 ixgbe_dcb_tx_config(struct rte_eth_dev *dev,
2841                 struct ixgbe_dcb_config *dcb_config)
2842 {
2843         struct rte_eth_dcb_tx_conf *tx_conf =
2844                         &dev->data->dev_conf.tx_adv_conf.dcb_tx_conf;
2845         struct ixgbe_dcb_tc_config *tc;
2846         uint8_t i,j;
2847
2848         dcb_config->num_tcs.pg_tcs = (uint8_t)tx_conf->nb_tcs;
2849         dcb_config->num_tcs.pfc_tcs = (uint8_t)tx_conf->nb_tcs;
2850
2851         /* User Priority to Traffic Class mapping */
2852         for (i = 0; i < ETH_DCB_NUM_USER_PRIORITIES; i++) {
2853                 j = tx_conf->dcb_queue[i];
2854                 tc = &dcb_config->tc_config[j];
2855                 tc->path[IXGBE_DCB_TX_CONFIG].up_to_tc_bitmap =
2856                                                 (uint8_t)(1 << j);
2857         }
2858 }
2859
2860 /**
2861  * ixgbe_dcb_rx_hw_config - Configure general DCB RX HW parameters
2862  * @hw: pointer to hardware structure
2863  * @dcb_config: pointer to ixgbe_dcb_config structure
2864  */
2865 static void
2866 ixgbe_dcb_rx_hw_config(struct ixgbe_hw *hw,
2867                struct ixgbe_dcb_config *dcb_config)
2868 {
2869         uint32_t reg;
2870         uint32_t vlanctrl;
2871         uint8_t i;
2872
2873         PMD_INIT_FUNC_TRACE();
2874         /*
2875          * Disable the arbiter before changing parameters
2876          * (always enable recycle mode; WSP)
2877          */
2878         reg = IXGBE_RTRPCS_RRM | IXGBE_RTRPCS_RAC | IXGBE_RTRPCS_ARBDIS;
2879         IXGBE_WRITE_REG(hw, IXGBE_RTRPCS, reg);
2880
2881         if (hw->mac.type != ixgbe_mac_82598EB) {
2882                 reg = IXGBE_READ_REG(hw, IXGBE_MRQC);
2883                 if (dcb_config->num_tcs.pg_tcs == 4) {
2884                         if (dcb_config->vt_mode)
2885                                 reg = (reg & ~IXGBE_MRQC_MRQE_MASK) |
2886                                         IXGBE_MRQC_VMDQRT4TCEN;
2887                         else {
2888                                 IXGBE_WRITE_REG(hw, IXGBE_VT_CTL, 0);
2889                                 reg = (reg & ~IXGBE_MRQC_MRQE_MASK) |
2890                                         IXGBE_MRQC_RT4TCEN;
2891                         }
2892                 }
2893                 if (dcb_config->num_tcs.pg_tcs == 8) {
2894                         if (dcb_config->vt_mode)
2895                                 reg = (reg & ~IXGBE_MRQC_MRQE_MASK) |
2896                                         IXGBE_MRQC_VMDQRT8TCEN;
2897                         else {
2898                                 IXGBE_WRITE_REG(hw, IXGBE_VT_CTL, 0);
2899                                 reg = (reg & ~IXGBE_MRQC_MRQE_MASK) |
2900                                         IXGBE_MRQC_RT8TCEN;
2901                         }
2902                 }
2903
2904                 IXGBE_WRITE_REG(hw, IXGBE_MRQC, reg);
2905         }
2906
2907         /* VLNCTRL: enable vlan filtering and allow all vlan tags through */
2908         vlanctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
2909         vlanctrl |= IXGBE_VLNCTRL_VFE ; /* enable vlan filters */
2910         IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlanctrl);
2911
2912         /* VFTA - enable all vlan filters */
2913         for (i = 0; i < NUM_VFTA_REGISTERS; i++) {
2914                 IXGBE_WRITE_REG(hw, IXGBE_VFTA(i), 0xFFFFFFFF);
2915         }
2916
2917         /*
2918          * Configure Rx packet plane (recycle mode; WSP) and
2919          * enable arbiter
2920          */
2921         reg = IXGBE_RTRPCS_RRM | IXGBE_RTRPCS_RAC;
2922         IXGBE_WRITE_REG(hw, IXGBE_RTRPCS, reg);
2923
2924         return;
2925 }
2926
2927 static void
2928 ixgbe_dcb_hw_arbite_rx_config(struct ixgbe_hw *hw, uint16_t *refill,
2929                         uint16_t *max,uint8_t *bwg_id, uint8_t *tsa, uint8_t *map)
2930 {
2931         switch (hw->mac.type) {
2932         case ixgbe_mac_82598EB:
2933                 ixgbe_dcb_config_rx_arbiter_82598(hw, refill, max, tsa);
2934                 break;
2935         case ixgbe_mac_82599EB:
2936         case ixgbe_mac_X540:
2937         case ixgbe_mac_X550:
2938         case ixgbe_mac_X550EM_x:
2939                 ixgbe_dcb_config_rx_arbiter_82599(hw, refill, max, bwg_id,
2940                                                   tsa, map);
2941                 break;
2942         default:
2943                 break;
2944         }
2945 }
2946
2947 static void
2948 ixgbe_dcb_hw_arbite_tx_config(struct ixgbe_hw *hw, uint16_t *refill, uint16_t *max,
2949                             uint8_t *bwg_id, uint8_t *tsa, uint8_t *map)
2950 {
2951         switch (hw->mac.type) {
2952         case ixgbe_mac_82598EB:
2953                 ixgbe_dcb_config_tx_desc_arbiter_82598(hw, refill, max, bwg_id,tsa);
2954                 ixgbe_dcb_config_tx_data_arbiter_82598(hw, refill, max, bwg_id,tsa);
2955                 break;
2956         case ixgbe_mac_82599EB:
2957         case ixgbe_mac_X540:
2958         case ixgbe_mac_X550:
2959         case ixgbe_mac_X550EM_x:
2960                 ixgbe_dcb_config_tx_desc_arbiter_82599(hw, refill, max, bwg_id,tsa);
2961                 ixgbe_dcb_config_tx_data_arbiter_82599(hw, refill, max, bwg_id,tsa, map);
2962                 break;
2963         default:
2964                 break;
2965         }
2966 }
2967
2968 #define DCB_RX_CONFIG  1
2969 #define DCB_TX_CONFIG  1
2970 #define DCB_TX_PB      1024
2971 /**
2972  * ixgbe_dcb_hw_configure - Enable DCB and configure
2973  * general DCB in VT mode and non-VT mode parameters
2974  * @dev: pointer to rte_eth_dev structure
2975  * @dcb_config: pointer to ixgbe_dcb_config structure
2976  */
2977 static int
2978 ixgbe_dcb_hw_configure(struct rte_eth_dev *dev,
2979                         struct ixgbe_dcb_config *dcb_config)
2980 {
2981         int     ret = 0;
2982         uint8_t i,pfc_en,nb_tcs;
2983         uint16_t pbsize;
2984         uint8_t config_dcb_rx = 0;
2985         uint8_t config_dcb_tx = 0;
2986         uint8_t tsa[IXGBE_DCB_MAX_TRAFFIC_CLASS] = {0};
2987         uint8_t bwgid[IXGBE_DCB_MAX_TRAFFIC_CLASS] = {0};
2988         uint16_t refill[IXGBE_DCB_MAX_TRAFFIC_CLASS] = {0};
2989         uint16_t max[IXGBE_DCB_MAX_TRAFFIC_CLASS] = {0};
2990         uint8_t map[IXGBE_DCB_MAX_TRAFFIC_CLASS] = {0};
2991         struct ixgbe_dcb_tc_config *tc;
2992         uint32_t max_frame = dev->data->mtu + ETHER_HDR_LEN + ETHER_CRC_LEN;
2993         struct ixgbe_hw *hw =
2994                         IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2995
2996         switch(dev->data->dev_conf.rxmode.mq_mode){
2997         case ETH_MQ_RX_VMDQ_DCB:
2998                 dcb_config->vt_mode = true;
2999                 if (hw->mac.type != ixgbe_mac_82598EB) {
3000                         config_dcb_rx = DCB_RX_CONFIG;
3001                         /*
3002                          *get dcb and VT rx configuration parameters
3003                          *from rte_eth_conf
3004                          */
3005                         ixgbe_vmdq_dcb_rx_config(dev,dcb_config);
3006                         /*Configure general VMDQ and DCB RX parameters*/
3007                         ixgbe_vmdq_dcb_configure(dev);
3008                 }
3009                 break;
3010         case ETH_MQ_RX_DCB:
3011                 dcb_config->vt_mode = false;
3012                 config_dcb_rx = DCB_RX_CONFIG;
3013                 /* Get dcb TX configuration parameters from rte_eth_conf */
3014                 ixgbe_dcb_rx_config(dev,dcb_config);
3015                 /*Configure general DCB RX parameters*/
3016                 ixgbe_dcb_rx_hw_config(hw, dcb_config);
3017                 break;
3018         default:
3019                 PMD_INIT_LOG(ERR, "Incorrect DCB RX mode configuration");
3020                 break;
3021         }
3022         switch (dev->data->dev_conf.txmode.mq_mode) {
3023         case ETH_MQ_TX_VMDQ_DCB:
3024                 dcb_config->vt_mode = true;
3025                 config_dcb_tx = DCB_TX_CONFIG;
3026                 /* get DCB and VT TX configuration parameters from rte_eth_conf */
3027                 ixgbe_dcb_vt_tx_config(dev,dcb_config);
3028                 /*Configure general VMDQ and DCB TX parameters*/
3029                 ixgbe_vmdq_dcb_hw_tx_config(dev,dcb_config);
3030                 break;
3031
3032         case ETH_MQ_TX_DCB:
3033                 dcb_config->vt_mode = false;
3034                 config_dcb_tx = DCB_TX_CONFIG;
3035                 /*get DCB TX configuration parameters from rte_eth_conf*/
3036                 ixgbe_dcb_tx_config(dev,dcb_config);
3037                 /*Configure general DCB TX parameters*/
3038                 ixgbe_dcb_tx_hw_config(hw, dcb_config);
3039                 break;
3040         default:
3041                 PMD_INIT_LOG(ERR, "Incorrect DCB TX mode configuration");
3042                 break;
3043         }
3044
3045         nb_tcs = dcb_config->num_tcs.pfc_tcs;
3046         /* Unpack map */
3047         ixgbe_dcb_unpack_map_cee(dcb_config, IXGBE_DCB_RX_CONFIG, map);
3048         if(nb_tcs == ETH_4_TCS) {
3049                 /* Avoid un-configured priority mapping to TC0 */
3050                 uint8_t j = 4;
3051                 uint8_t mask = 0xFF;
3052                 for (i = 0; i < ETH_DCB_NUM_USER_PRIORITIES - 4; i++)
3053                         mask = (uint8_t)(mask & (~ (1 << map[i])));
3054                 for (i = 0; mask && (i < IXGBE_DCB_MAX_TRAFFIC_CLASS); i++) {
3055                         if ((mask & 0x1) && (j < ETH_DCB_NUM_USER_PRIORITIES))
3056                                 map[j++] = i;
3057                         mask >>= 1;
3058                 }
3059                 /* Re-configure 4 TCs BW */
3060                 for (i = 0; i < nb_tcs; i++) {
3061                         tc = &dcb_config->tc_config[i];
3062                         tc->path[IXGBE_DCB_TX_CONFIG].bwg_percent =
3063                                                 (uint8_t)(100 / nb_tcs);
3064                         tc->path[IXGBE_DCB_RX_CONFIG].bwg_percent =
3065                                                 (uint8_t)(100 / nb_tcs);
3066                 }
3067                 for (; i < IXGBE_DCB_MAX_TRAFFIC_CLASS; i++) {
3068                         tc = &dcb_config->tc_config[i];
3069                         tc->path[IXGBE_DCB_TX_CONFIG].bwg_percent = 0;
3070                         tc->path[IXGBE_DCB_RX_CONFIG].bwg_percent = 0;
3071                 }
3072         }
3073
3074         if(config_dcb_rx) {
3075                 /* Set RX buffer size */
3076                 pbsize = (uint16_t)(NIC_RX_BUFFER_SIZE / nb_tcs);
3077                 uint32_t rxpbsize = pbsize << IXGBE_RXPBSIZE_SHIFT;
3078                 for (i = 0 ; i < nb_tcs; i++) {
3079                         IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(i), rxpbsize);
3080                 }
3081                 /* zero alloc all unused TCs */
3082                 for (; i < ETH_DCB_NUM_USER_PRIORITIES; i++) {
3083                         IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(i), 0);
3084                 }
3085         }
3086         if(config_dcb_tx) {
3087                 /* Only support an equally distributed Tx packet buffer strategy. */
3088                 uint32_t txpktsize = IXGBE_TXPBSIZE_MAX / nb_tcs;
3089                 uint32_t txpbthresh = (txpktsize / DCB_TX_PB) - IXGBE_TXPKT_SIZE_MAX;
3090                 for (i = 0; i < nb_tcs; i++) {
3091                         IXGBE_WRITE_REG(hw, IXGBE_TXPBSIZE(i), txpktsize);
3092                         IXGBE_WRITE_REG(hw, IXGBE_TXPBTHRESH(i), txpbthresh);
3093                 }
3094                 /* Clear unused TCs, if any, to zero buffer size*/
3095                 for (; i < ETH_DCB_NUM_USER_PRIORITIES; i++) {
3096                         IXGBE_WRITE_REG(hw, IXGBE_TXPBSIZE(i), 0);
3097                         IXGBE_WRITE_REG(hw, IXGBE_TXPBTHRESH(i), 0);
3098                 }
3099         }
3100
3101         /*Calculates traffic class credits*/
3102         ixgbe_dcb_calculate_tc_credits_cee(hw, dcb_config,max_frame,
3103                                 IXGBE_DCB_TX_CONFIG);
3104         ixgbe_dcb_calculate_tc_credits_cee(hw, dcb_config,max_frame,
3105                                 IXGBE_DCB_RX_CONFIG);
3106
3107         if(config_dcb_rx) {
3108                 /* Unpack CEE standard containers */
3109                 ixgbe_dcb_unpack_refill_cee(dcb_config, IXGBE_DCB_RX_CONFIG, refill);
3110                 ixgbe_dcb_unpack_max_cee(dcb_config, max);
3111                 ixgbe_dcb_unpack_bwgid_cee(dcb_config, IXGBE_DCB_RX_CONFIG, bwgid);
3112                 ixgbe_dcb_unpack_tsa_cee(dcb_config, IXGBE_DCB_RX_CONFIG, tsa);
3113                 /* Configure PG(ETS) RX */
3114                 ixgbe_dcb_hw_arbite_rx_config(hw,refill,max,bwgid,tsa,map);
3115         }
3116
3117         if(config_dcb_tx) {
3118                 /* Unpack CEE standard containers */
3119                 ixgbe_dcb_unpack_refill_cee(dcb_config, IXGBE_DCB_TX_CONFIG, refill);
3120                 ixgbe_dcb_unpack_max_cee(dcb_config, max);
3121                 ixgbe_dcb_unpack_bwgid_cee(dcb_config, IXGBE_DCB_TX_CONFIG, bwgid);
3122                 ixgbe_dcb_unpack_tsa_cee(dcb_config, IXGBE_DCB_TX_CONFIG, tsa);
3123                 /* Configure PG(ETS) TX */
3124                 ixgbe_dcb_hw_arbite_tx_config(hw,refill,max,bwgid,tsa,map);
3125         }
3126
3127         /*Configure queue statistics registers*/
3128         ixgbe_dcb_config_tc_stats_82599(hw, dcb_config);
3129
3130         /* Check if the PFC is supported */
3131         if(dev->data->dev_conf.dcb_capability_en & ETH_DCB_PFC_SUPPORT) {
3132                 pbsize = (uint16_t) (NIC_RX_BUFFER_SIZE / nb_tcs);
3133                 for (i = 0; i < nb_tcs; i++) {
3134                         /*
3135                         * If the TC count is 8,and the default high_water is 48,
3136                         * the low_water is 16 as default.
3137                         */
3138                         hw->fc.high_water[i] = (pbsize * 3 ) / 4;
3139                         hw->fc.low_water[i] = pbsize / 4;
3140                         /* Enable pfc for this TC */
3141                         tc = &dcb_config->tc_config[i];
3142                         tc->pfc = ixgbe_dcb_pfc_enabled;
3143                 }
3144                 ixgbe_dcb_unpack_pfc_cee(dcb_config, map, &pfc_en);
3145                 if(dcb_config->num_tcs.pfc_tcs == ETH_4_TCS)
3146                         pfc_en &= 0x0F;
3147                 ret = ixgbe_dcb_config_pfc(hw, pfc_en, map);
3148         }
3149
3150         return ret;
3151 }
3152
3153 /**
3154  * ixgbe_configure_dcb - Configure DCB  Hardware
3155  * @dev: pointer to rte_eth_dev
3156  */
3157 void ixgbe_configure_dcb(struct rte_eth_dev *dev)
3158 {
3159         struct ixgbe_dcb_config *dcb_cfg =
3160                         IXGBE_DEV_PRIVATE_TO_DCB_CFG(dev->data->dev_private);
3161         struct rte_eth_conf *dev_conf = &(dev->data->dev_conf);
3162
3163         PMD_INIT_FUNC_TRACE();
3164
3165         /* check support mq_mode for DCB */
3166         if ((dev_conf->rxmode.mq_mode != ETH_MQ_RX_VMDQ_DCB) &&
3167             (dev_conf->rxmode.mq_mode != ETH_MQ_RX_DCB))
3168                 return;
3169
3170         if (dev->data->nb_rx_queues != ETH_DCB_NUM_QUEUES)
3171                 return;
3172
3173         /** Configure DCB hardware **/
3174         ixgbe_dcb_hw_configure(dev,dcb_cfg);
3175
3176         return;
3177 }
3178
3179 /*
3180  * VMDq only support for 10 GbE NIC.
3181  */
3182 static void
3183 ixgbe_vmdq_rx_hw_configure(struct rte_eth_dev *dev)
3184 {
3185         struct rte_eth_vmdq_rx_conf *cfg;
3186         struct ixgbe_hw *hw;
3187         enum rte_eth_nb_pools num_pools;
3188         uint32_t mrqc, vt_ctl, vlanctrl;
3189         uint32_t vmolr = 0;
3190         int i;
3191
3192         PMD_INIT_FUNC_TRACE();
3193         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
3194         cfg = &dev->data->dev_conf.rx_adv_conf.vmdq_rx_conf;
3195         num_pools = cfg->nb_queue_pools;
3196
3197         ixgbe_rss_disable(dev);
3198
3199         /* MRQC: enable vmdq */
3200         mrqc = IXGBE_MRQC_VMDQEN;
3201         IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
3202
3203         /* PFVTCTL: turn on virtualisation and set the default pool */
3204         vt_ctl = IXGBE_VT_CTL_VT_ENABLE | IXGBE_VT_CTL_REPLEN;
3205         if (cfg->enable_default_pool)
3206                 vt_ctl |= (cfg->default_pool << IXGBE_VT_CTL_POOL_SHIFT);
3207         else
3208                 vt_ctl |= IXGBE_VT_CTL_DIS_DEFPL;
3209
3210         IXGBE_WRITE_REG(hw, IXGBE_VT_CTL, vt_ctl);
3211
3212         for (i = 0; i < (int)num_pools; i++) {
3213                 vmolr = ixgbe_convert_vm_rx_mask_to_val(cfg->rx_mode, vmolr);
3214                 IXGBE_WRITE_REG(hw, IXGBE_VMOLR(i), vmolr);
3215         }
3216
3217         /* VLNCTRL: enable vlan filtering and allow all vlan tags through */
3218         vlanctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
3219         vlanctrl |= IXGBE_VLNCTRL_VFE ; /* enable vlan filters */
3220         IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlanctrl);
3221
3222         /* VFTA - enable all vlan filters */
3223         for (i = 0; i < NUM_VFTA_REGISTERS; i++)
3224                 IXGBE_WRITE_REG(hw, IXGBE_VFTA(i), UINT32_MAX);
3225
3226         /* VFRE: pool enabling for receive - 64 */
3227         IXGBE_WRITE_REG(hw, IXGBE_VFRE(0), UINT32_MAX);
3228         if (num_pools == ETH_64_POOLS)
3229                 IXGBE_WRITE_REG(hw, IXGBE_VFRE(1), UINT32_MAX);
3230
3231         /*
3232          * MPSAR - allow pools to read specific mac addresses
3233          * In this case, all pools should be able to read from mac addr 0
3234          */
3235         IXGBE_WRITE_REG(hw, IXGBE_MPSAR_LO(0), UINT32_MAX);
3236         IXGBE_WRITE_REG(hw, IXGBE_MPSAR_HI(0), UINT32_MAX);
3237
3238         /* PFVLVF, PFVLVFB: set up filters for vlan tags as configured */
3239         for (i = 0; i < cfg->nb_pool_maps; i++) {
3240                 /* set vlan id in VF register and set the valid bit */
3241                 IXGBE_WRITE_REG(hw, IXGBE_VLVF(i), (IXGBE_VLVF_VIEN | \
3242                                 (cfg->pool_map[i].vlan_id & IXGBE_RXD_VLAN_ID_MASK)));
3243                 /*
3244                  * Put the allowed pools in VFB reg. As we only have 16 or 64
3245                  * pools, we only need to use the first half of the register
3246                  * i.e. bits 0-31
3247                  */
3248                 if (((cfg->pool_map[i].pools >> 32) & UINT32_MAX) == 0)
3249                         IXGBE_WRITE_REG(hw, IXGBE_VLVFB(i*2), \
3250                                         (cfg->pool_map[i].pools & UINT32_MAX));
3251                 else
3252                         IXGBE_WRITE_REG(hw, IXGBE_VLVFB((i*2+1)), \
3253                                         ((cfg->pool_map[i].pools >> 32) \
3254                                         & UINT32_MAX));
3255
3256         }
3257
3258         /* PFDMA Tx General Switch Control Enables VMDQ loopback */
3259         if (cfg->enable_loop_back) {
3260                 IXGBE_WRITE_REG(hw, IXGBE_PFDTXGSWC, IXGBE_PFDTXGSWC_VT_LBEN);
3261                 for (i = 0; i < RTE_IXGBE_VMTXSW_REGISTER_COUNT; i++)
3262                         IXGBE_WRITE_REG(hw, IXGBE_VMTXSW(i), UINT32_MAX);
3263         }
3264
3265         IXGBE_WRITE_FLUSH(hw);
3266 }
3267
3268 /*
3269  * ixgbe_dcb_config_tx_hw_config - Configure general VMDq TX parameters
3270  * @hw: pointer to hardware structure
3271  */
3272 static void
3273 ixgbe_vmdq_tx_hw_configure(struct ixgbe_hw *hw)
3274 {
3275         uint32_t reg;
3276         uint32_t q;
3277
3278         PMD_INIT_FUNC_TRACE();
3279         /*PF VF Transmit Enable*/
3280         IXGBE_WRITE_REG(hw, IXGBE_VFTE(0), UINT32_MAX);
3281         IXGBE_WRITE_REG(hw, IXGBE_VFTE(1), UINT32_MAX);
3282
3283         /* Disable the Tx desc arbiter so that MTQC can be changed */
3284         reg = IXGBE_READ_REG(hw, IXGBE_RTTDCS);
3285         reg |= IXGBE_RTTDCS_ARBDIS;
3286         IXGBE_WRITE_REG(hw, IXGBE_RTTDCS, reg);
3287
3288         reg = IXGBE_MTQC_VT_ENA | IXGBE_MTQC_64VF;
3289         IXGBE_WRITE_REG(hw, IXGBE_MTQC, reg);
3290
3291         /* Disable drop for all queues */
3292         for (q = 0; q < IXGBE_MAX_RX_QUEUE_NUM; q++)
3293                 IXGBE_WRITE_REG(hw, IXGBE_QDE,
3294                   (IXGBE_QDE_WRITE | (q << IXGBE_QDE_IDX_SHIFT)));
3295
3296         /* Enable the Tx desc arbiter */
3297         reg = IXGBE_READ_REG(hw, IXGBE_RTTDCS);
3298         reg &= ~IXGBE_RTTDCS_ARBDIS;
3299         IXGBE_WRITE_REG(hw, IXGBE_RTTDCS, reg);
3300
3301         IXGBE_WRITE_FLUSH(hw);
3302
3303         return;
3304 }
3305
3306 static int
3307 ixgbe_alloc_rx_queue_mbufs(struct igb_rx_queue *rxq)
3308 {
3309         struct igb_rx_entry *rxe = rxq->sw_ring;
3310         uint64_t dma_addr;
3311         unsigned i;
3312
3313         /* Initialize software ring entries */
3314         for (i = 0; i < rxq->nb_rx_desc; i++) {
3315                 volatile union ixgbe_adv_rx_desc *rxd;
3316                 struct rte_mbuf *mbuf = rte_rxmbuf_alloc(rxq->mb_pool);
3317                 if (mbuf == NULL) {
3318                         PMD_INIT_LOG(ERR, "RX mbuf alloc failed queue_id=%u",
3319                                      (unsigned) rxq->queue_id);
3320                         return (-ENOMEM);
3321                 }
3322
3323                 rte_mbuf_refcnt_set(mbuf, 1);
3324                 mbuf->next = NULL;
3325                 mbuf->data_off = RTE_PKTMBUF_HEADROOM;
3326                 mbuf->nb_segs = 1;
3327                 mbuf->port = rxq->port_id;
3328
3329                 dma_addr =
3330                         rte_cpu_to_le_64(RTE_MBUF_DATA_DMA_ADDR_DEFAULT(mbuf));
3331                 rxd = &rxq->rx_ring[i];
3332                 rxd->read.hdr_addr = dma_addr;
3333                 rxd->read.pkt_addr = dma_addr;
3334                 rxe[i].mbuf = mbuf;
3335         }
3336
3337         return 0;
3338 }
3339
3340 static int
3341 ixgbe_dev_mq_rx_configure(struct rte_eth_dev *dev)
3342 {
3343         struct ixgbe_hw *hw =
3344                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
3345
3346         if (hw->mac.type == ixgbe_mac_82598EB)
3347                 return 0;
3348
3349         if (RTE_ETH_DEV_SRIOV(dev).active == 0) {
3350                 /*
3351                  * SRIOV inactive scheme
3352                  * any DCB/RSS w/o VMDq multi-queue setting
3353                  */
3354                 switch (dev->data->dev_conf.rxmode.mq_mode) {
3355                         case ETH_MQ_RX_RSS:
3356                                 ixgbe_rss_configure(dev);
3357                                 break;
3358
3359                         case ETH_MQ_RX_VMDQ_DCB:
3360                                 ixgbe_vmdq_dcb_configure(dev);
3361                                 break;
3362
3363                         case ETH_MQ_RX_VMDQ_ONLY:
3364                                 ixgbe_vmdq_rx_hw_configure(dev);
3365                                 break;
3366
3367                         case ETH_MQ_RX_NONE:
3368                                 /* if mq_mode is none, disable rss mode.*/
3369                         default: ixgbe_rss_disable(dev);
3370                 }
3371         } else {
3372                 switch (RTE_ETH_DEV_SRIOV(dev).active) {
3373                 /*
3374                  * SRIOV active scheme
3375                  * FIXME if support DCB/RSS together with VMDq & SRIOV
3376                  */
3377                 case ETH_64_POOLS:
3378                         IXGBE_WRITE_REG(hw, IXGBE_MRQC, IXGBE_MRQC_VMDQEN);
3379                         break;
3380
3381                 case ETH_32_POOLS:
3382                         IXGBE_WRITE_REG(hw, IXGBE_MRQC, IXGBE_MRQC_VMDQRT4TCEN);
3383                         break;
3384
3385                 case ETH_16_POOLS:
3386                         IXGBE_WRITE_REG(hw, IXGBE_MRQC, IXGBE_MRQC_VMDQRT8TCEN);
3387                         break;
3388                 default:
3389                         PMD_INIT_LOG(ERR, "invalid pool number in IOV mode");
3390                 }
3391         }
3392
3393         return 0;
3394 }
3395
3396 static int
3397 ixgbe_dev_mq_tx_configure(struct rte_eth_dev *dev)
3398 {
3399         struct ixgbe_hw *hw =
3400                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
3401         uint32_t mtqc;
3402         uint32_t rttdcs;
3403
3404         if (hw->mac.type == ixgbe_mac_82598EB)
3405                 return 0;
3406
3407         /* disable arbiter before setting MTQC */
3408         rttdcs = IXGBE_READ_REG(hw, IXGBE_RTTDCS);
3409         rttdcs |= IXGBE_RTTDCS_ARBDIS;
3410         IXGBE_WRITE_REG(hw, IXGBE_RTTDCS, rttdcs);
3411
3412         if (RTE_ETH_DEV_SRIOV(dev).active == 0) {
3413                 /*
3414                  * SRIOV inactive scheme
3415                  * any DCB w/o VMDq multi-queue setting
3416                  */
3417                 if (dev->data->dev_conf.txmode.mq_mode == ETH_MQ_TX_VMDQ_ONLY)
3418                         ixgbe_vmdq_tx_hw_configure(hw);
3419                 else {
3420                         mtqc = IXGBE_MTQC_64Q_1PB;
3421                         IXGBE_WRITE_REG(hw, IXGBE_MTQC, mtqc);
3422                 }
3423         } else {
3424                 switch (RTE_ETH_DEV_SRIOV(dev).active) {
3425
3426                 /*
3427                  * SRIOV active scheme
3428                  * FIXME if support DCB together with VMDq & SRIOV
3429                  */
3430                 case ETH_64_POOLS:
3431                         mtqc = IXGBE_MTQC_VT_ENA | IXGBE_MTQC_64VF;
3432                         break;
3433                 case ETH_32_POOLS:
3434                         mtqc = IXGBE_MTQC_VT_ENA | IXGBE_MTQC_32VF;
3435                         break;
3436                 case ETH_16_POOLS:
3437                         mtqc = IXGBE_MTQC_VT_ENA | IXGBE_MTQC_RT_ENA |
3438                                 IXGBE_MTQC_8TC_8TQ;
3439                         break;
3440                 default:
3441                         mtqc = IXGBE_MTQC_64Q_1PB;
3442                         PMD_INIT_LOG(ERR, "invalid pool number in IOV mode");
3443                 }
3444                 IXGBE_WRITE_REG(hw, IXGBE_MTQC, mtqc);
3445         }
3446
3447         /* re-enable arbiter */
3448         rttdcs &= ~IXGBE_RTTDCS_ARBDIS;
3449         IXGBE_WRITE_REG(hw, IXGBE_RTTDCS, rttdcs);
3450
3451         return 0;
3452 }
3453
3454 /*
3455  * Initializes Receive Unit.
3456  */
3457 int
3458 ixgbe_dev_rx_init(struct rte_eth_dev *dev)
3459 {
3460         struct ixgbe_hw     *hw;
3461         struct igb_rx_queue *rxq;
3462         struct rte_pktmbuf_pool_private *mbp_priv;
3463         uint64_t bus_addr;
3464         uint32_t rxctrl;
3465         uint32_t fctrl;
3466         uint32_t hlreg0;
3467         uint32_t maxfrs;
3468         uint32_t srrctl;
3469         uint32_t rdrxctl;
3470         uint32_t rxcsum;
3471         uint16_t buf_size;
3472         uint16_t i;
3473
3474         PMD_INIT_FUNC_TRACE();
3475         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
3476
3477         /*
3478          * Make sure receives are disabled while setting
3479          * up the RX context (registers, descriptor rings, etc.).
3480          */
3481         rxctrl = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
3482         IXGBE_WRITE_REG(hw, IXGBE_RXCTRL, rxctrl & ~IXGBE_RXCTRL_RXEN);
3483
3484         /* Enable receipt of broadcasted frames */
3485         fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
3486         fctrl |= IXGBE_FCTRL_BAM;
3487         fctrl |= IXGBE_FCTRL_DPF;
3488         fctrl |= IXGBE_FCTRL_PMCF;
3489         IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
3490
3491         /*
3492          * Configure CRC stripping, if any.
3493          */
3494         hlreg0 = IXGBE_READ_REG(hw, IXGBE_HLREG0);
3495         if (dev->data->dev_conf.rxmode.hw_strip_crc)
3496                 hlreg0 |= IXGBE_HLREG0_RXCRCSTRP;
3497         else
3498                 hlreg0 &= ~IXGBE_HLREG0_RXCRCSTRP;
3499
3500         /*
3501          * Configure jumbo frame support, if any.
3502          */
3503         if (dev->data->dev_conf.rxmode.jumbo_frame == 1) {
3504                 hlreg0 |= IXGBE_HLREG0_JUMBOEN;
3505                 maxfrs = IXGBE_READ_REG(hw, IXGBE_MAXFRS);
3506                 maxfrs &= 0x0000FFFF;
3507                 maxfrs |= (dev->data->dev_conf.rxmode.max_rx_pkt_len << 16);
3508                 IXGBE_WRITE_REG(hw, IXGBE_MAXFRS, maxfrs);
3509         } else
3510                 hlreg0 &= ~IXGBE_HLREG0_JUMBOEN;
3511
3512         /*
3513          * If loopback mode is configured for 82599, set LPBK bit.
3514          */
3515         if (hw->mac.type == ixgbe_mac_82599EB &&
3516                         dev->data->dev_conf.lpbk_mode == IXGBE_LPBK_82599_TX_RX)
3517                 hlreg0 |= IXGBE_HLREG0_LPBK;
3518         else
3519                 hlreg0 &= ~IXGBE_HLREG0_LPBK;
3520
3521         IXGBE_WRITE_REG(hw, IXGBE_HLREG0, hlreg0);
3522
3523         /* Setup RX queues */
3524         for (i = 0; i < dev->data->nb_rx_queues; i++) {
3525                 rxq = dev->data->rx_queues[i];
3526
3527                 /*
3528                  * Reset crc_len in case it was changed after queue setup by a
3529                  * call to configure.
3530                  */
3531                 rxq->crc_len = (uint8_t)
3532                                 ((dev->data->dev_conf.rxmode.hw_strip_crc) ? 0 :
3533                                 ETHER_CRC_LEN);
3534
3535                 /* Setup the Base and Length of the Rx Descriptor Rings */
3536                 bus_addr = rxq->rx_ring_phys_addr;
3537                 IXGBE_WRITE_REG(hw, IXGBE_RDBAL(rxq->reg_idx),
3538                                 (uint32_t)(bus_addr & 0x00000000ffffffffULL));
3539                 IXGBE_WRITE_REG(hw, IXGBE_RDBAH(rxq->reg_idx),
3540                                 (uint32_t)(bus_addr >> 32));
3541                 IXGBE_WRITE_REG(hw, IXGBE_RDLEN(rxq->reg_idx),
3542                                 rxq->nb_rx_desc * sizeof(union ixgbe_adv_rx_desc));
3543                 IXGBE_WRITE_REG(hw, IXGBE_RDH(rxq->reg_idx), 0);
3544                 IXGBE_WRITE_REG(hw, IXGBE_RDT(rxq->reg_idx), 0);
3545
3546                 /* Configure the SRRCTL register */
3547 #ifdef RTE_HEADER_SPLIT_ENABLE
3548                 /*
3549                  * Configure Header Split
3550                  */
3551                 if (dev->data->dev_conf.rxmode.header_split) {
3552                         if (hw->mac.type == ixgbe_mac_82599EB) {
3553                                 /* Must setup the PSRTYPE register */
3554                                 uint32_t psrtype;
3555                                 psrtype = IXGBE_PSRTYPE_TCPHDR |
3556                                         IXGBE_PSRTYPE_UDPHDR   |
3557                                         IXGBE_PSRTYPE_IPV4HDR  |
3558                                         IXGBE_PSRTYPE_IPV6HDR;
3559                                 IXGBE_WRITE_REG(hw, IXGBE_PSRTYPE(rxq->reg_idx), psrtype);
3560                         }
3561                         srrctl = ((dev->data->dev_conf.rxmode.split_hdr_size <<
3562                                    IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT) &
3563                                   IXGBE_SRRCTL_BSIZEHDR_MASK);
3564                         srrctl |= E1000_SRRCTL_DESCTYPE_HDR_SPLIT_ALWAYS;
3565                 } else
3566 #endif
3567                         srrctl = IXGBE_SRRCTL_DESCTYPE_ADV_ONEBUF;
3568
3569                 /* Set if packets are dropped when no descriptors available */
3570                 if (rxq->drop_en)
3571                         srrctl |= IXGBE_SRRCTL_DROP_EN;
3572
3573                 /*
3574                  * Configure the RX buffer size in the BSIZEPACKET field of
3575                  * the SRRCTL register of the queue.
3576                  * The value is in 1 KB resolution. Valid values can be from
3577                  * 1 KB to 16 KB.
3578                  */
3579                 mbp_priv = rte_mempool_get_priv(rxq->mb_pool);
3580                 buf_size = (uint16_t) (mbp_priv->mbuf_data_room_size -
3581                                        RTE_PKTMBUF_HEADROOM);
3582                 srrctl |= ((buf_size >> IXGBE_SRRCTL_BSIZEPKT_SHIFT) &
3583                            IXGBE_SRRCTL_BSIZEPKT_MASK);
3584                 IXGBE_WRITE_REG(hw, IXGBE_SRRCTL(rxq->reg_idx), srrctl);
3585
3586                 buf_size = (uint16_t) ((srrctl & IXGBE_SRRCTL_BSIZEPKT_MASK) <<
3587                                        IXGBE_SRRCTL_BSIZEPKT_SHIFT);
3588
3589                 /* It adds dual VLAN length for supporting dual VLAN */
3590                 if ((dev->data->dev_conf.rxmode.max_rx_pkt_len +
3591                                 2 * IXGBE_VLAN_TAG_SIZE) > buf_size){
3592                         if (!dev->data->scattered_rx)
3593                                 PMD_INIT_LOG(DEBUG, "forcing scatter mode");
3594                         dev->data->scattered_rx = 1;
3595 #ifdef RTE_IXGBE_INC_VECTOR
3596                         dev->rx_pkt_burst = ixgbe_recv_scattered_pkts_vec;
3597 #else
3598                         dev->rx_pkt_burst = ixgbe_recv_scattered_pkts;
3599 #endif
3600                 }
3601         }
3602
3603         if (dev->data->dev_conf.rxmode.enable_scatter) {
3604                 if (!dev->data->scattered_rx)
3605                         PMD_INIT_LOG(DEBUG, "forcing scatter mode");
3606 #ifdef RTE_IXGBE_INC_VECTOR
3607                 dev->rx_pkt_burst = ixgbe_recv_scattered_pkts_vec;
3608 #else
3609                 dev->rx_pkt_burst = ixgbe_recv_scattered_pkts;
3610 #endif
3611                 dev->data->scattered_rx = 1;
3612         }
3613
3614         /*
3615          * Device configured with multiple RX queues.
3616          */
3617         ixgbe_dev_mq_rx_configure(dev);
3618
3619         /*
3620          * Setup the Checksum Register.
3621          * Disable Full-Packet Checksum which is mutually exclusive with RSS.
3622          * Enable IP/L4 checkum computation by hardware if requested to do so.
3623          */
3624         rxcsum = IXGBE_READ_REG(hw, IXGBE_RXCSUM);
3625         rxcsum |= IXGBE_RXCSUM_PCSD;
3626         if (dev->data->dev_conf.rxmode.hw_ip_checksum)
3627                 rxcsum |= IXGBE_RXCSUM_IPPCSE;
3628         else
3629                 rxcsum &= ~IXGBE_RXCSUM_IPPCSE;
3630
3631         IXGBE_WRITE_REG(hw, IXGBE_RXCSUM, rxcsum);
3632
3633         if (hw->mac.type == ixgbe_mac_82599EB) {
3634                 rdrxctl = IXGBE_READ_REG(hw, IXGBE_RDRXCTL);
3635                 if (dev->data->dev_conf.rxmode.hw_strip_crc)
3636                         rdrxctl |= IXGBE_RDRXCTL_CRCSTRIP;
3637                 else
3638                         rdrxctl &= ~IXGBE_RDRXCTL_CRCSTRIP;
3639                 rdrxctl &= ~IXGBE_RDRXCTL_RSCFRSTSIZE;
3640                 IXGBE_WRITE_REG(hw, IXGBE_RDRXCTL, rdrxctl);
3641         }
3642
3643         return 0;
3644 }
3645
3646 /*
3647  * Initializes Transmit Unit.
3648  */
3649 void
3650 ixgbe_dev_tx_init(struct rte_eth_dev *dev)
3651 {
3652         struct ixgbe_hw     *hw;
3653         struct igb_tx_queue *txq;
3654         uint64_t bus_addr;
3655         uint32_t hlreg0;
3656         uint32_t txctrl;
3657         uint16_t i;
3658
3659         PMD_INIT_FUNC_TRACE();
3660         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
3661
3662         /* Enable TX CRC (checksum offload requirement) and hw padding
3663          * (TSO requirement) */
3664         hlreg0 = IXGBE_READ_REG(hw, IXGBE_HLREG0);
3665         hlreg0 |= (IXGBE_HLREG0_TXCRCEN | IXGBE_HLREG0_TXPADEN);
3666         IXGBE_WRITE_REG(hw, IXGBE_HLREG0, hlreg0);
3667
3668         /* Setup the Base and Length of the Tx Descriptor Rings */
3669         for (i = 0; i < dev->data->nb_tx_queues; i++) {
3670                 txq = dev->data->tx_queues[i];
3671
3672                 bus_addr = txq->tx_ring_phys_addr;
3673                 IXGBE_WRITE_REG(hw, IXGBE_TDBAL(txq->reg_idx),
3674                                 (uint32_t)(bus_addr & 0x00000000ffffffffULL));
3675                 IXGBE_WRITE_REG(hw, IXGBE_TDBAH(txq->reg_idx),
3676                                 (uint32_t)(bus_addr >> 32));
3677                 IXGBE_WRITE_REG(hw, IXGBE_TDLEN(txq->reg_idx),
3678                                 txq->nb_tx_desc * sizeof(union ixgbe_adv_tx_desc));
3679                 /* Setup the HW Tx Head and TX Tail descriptor pointers */
3680                 IXGBE_WRITE_REG(hw, IXGBE_TDH(txq->reg_idx), 0);
3681                 IXGBE_WRITE_REG(hw, IXGBE_TDT(txq->reg_idx), 0);
3682
3683                 /*
3684                  * Disable Tx Head Writeback RO bit, since this hoses
3685                  * bookkeeping if things aren't delivered in order.
3686                  */
3687                 switch (hw->mac.type) {
3688                         case ixgbe_mac_82598EB:
3689                                 txctrl = IXGBE_READ_REG(hw,
3690                                                         IXGBE_DCA_TXCTRL(txq->reg_idx));
3691                                 txctrl &= ~IXGBE_DCA_TXCTRL_DESC_WRO_EN;
3692                                 IXGBE_WRITE_REG(hw, IXGBE_DCA_TXCTRL(txq->reg_idx),
3693                                                 txctrl);
3694                                 break;
3695
3696                         case ixgbe_mac_82599EB:
3697                         case ixgbe_mac_X540:
3698                         case ixgbe_mac_X550:
3699                         case ixgbe_mac_X550EM_x:
3700                         default:
3701                                 txctrl = IXGBE_READ_REG(hw,
3702                                                 IXGBE_DCA_TXCTRL_82599(txq->reg_idx));
3703                                 txctrl &= ~IXGBE_DCA_TXCTRL_DESC_WRO_EN;
3704                                 IXGBE_WRITE_REG(hw, IXGBE_DCA_TXCTRL_82599(txq->reg_idx),
3705                                                 txctrl);
3706                                 break;
3707                 }
3708         }
3709
3710         /* Device configured with multiple TX queues. */
3711         ixgbe_dev_mq_tx_configure(dev);
3712 }
3713
3714 /*
3715  * Set up link for 82599 loopback mode Tx->Rx.
3716  */
3717 static inline void
3718 ixgbe_setup_loopback_link_82599(struct ixgbe_hw *hw)
3719 {
3720         PMD_INIT_FUNC_TRACE();
3721
3722         if (ixgbe_verify_lesm_fw_enabled_82599(hw)) {
3723                 if (hw->mac.ops.acquire_swfw_sync(hw, IXGBE_GSSR_MAC_CSR_SM) !=
3724                                 IXGBE_SUCCESS) {
3725                         PMD_INIT_LOG(ERR, "Could not enable loopback mode");
3726                         /* ignore error */
3727                         return;
3728                 }
3729         }
3730
3731         /* Restart link */
3732         IXGBE_WRITE_REG(hw,
3733                         IXGBE_AUTOC,
3734                         IXGBE_AUTOC_LMS_10G_LINK_NO_AN | IXGBE_AUTOC_FLU);
3735         ixgbe_reset_pipeline_82599(hw);
3736
3737         hw->mac.ops.release_swfw_sync(hw, IXGBE_GSSR_MAC_CSR_SM);
3738         msec_delay(50);
3739 }
3740
3741
3742 /*
3743  * Start Transmit and Receive Units.
3744  */
3745 void
3746 ixgbe_dev_rxtx_start(struct rte_eth_dev *dev)
3747 {
3748         struct ixgbe_hw     *hw;
3749         struct igb_tx_queue *txq;
3750         struct igb_rx_queue *rxq;
3751         uint32_t txdctl;
3752         uint32_t dmatxctl;
3753         uint32_t rxctrl;
3754         uint16_t i;
3755
3756         PMD_INIT_FUNC_TRACE();
3757         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
3758
3759         for (i = 0; i < dev->data->nb_tx_queues; i++) {
3760                 txq = dev->data->tx_queues[i];
3761                 /* Setup Transmit Threshold Registers */
3762                 txdctl = IXGBE_READ_REG(hw, IXGBE_TXDCTL(txq->reg_idx));
3763                 txdctl |= txq->pthresh & 0x7F;
3764                 txdctl |= ((txq->hthresh & 0x7F) << 8);
3765                 txdctl |= ((txq->wthresh & 0x7F) << 16);
3766                 IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(txq->reg_idx), txdctl);
3767         }
3768
3769         if (hw->mac.type != ixgbe_mac_82598EB) {
3770                 dmatxctl = IXGBE_READ_REG(hw, IXGBE_DMATXCTL);
3771                 dmatxctl |= IXGBE_DMATXCTL_TE;
3772                 IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL, dmatxctl);
3773         }
3774
3775         for (i = 0; i < dev->data->nb_tx_queues; i++) {
3776                 txq = dev->data->tx_queues[i];
3777                 if (!txq->tx_deferred_start)
3778                         ixgbe_dev_tx_queue_start(dev, i);
3779         }
3780
3781         for (i = 0; i < dev->data->nb_rx_queues; i++) {
3782                 rxq = dev->data->rx_queues[i];
3783                 if (!rxq->rx_deferred_start)
3784                         ixgbe_dev_rx_queue_start(dev, i);
3785         }
3786
3787         /* Enable Receive engine */
3788         rxctrl = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
3789         if (hw->mac.type == ixgbe_mac_82598EB)
3790                 rxctrl |= IXGBE_RXCTRL_DMBYPS;
3791         rxctrl |= IXGBE_RXCTRL_RXEN;
3792         hw->mac.ops.enable_rx_dma(hw, rxctrl);
3793
3794         /* If loopback mode is enabled for 82599, set up the link accordingly */
3795         if (hw->mac.type == ixgbe_mac_82599EB &&
3796                         dev->data->dev_conf.lpbk_mode == IXGBE_LPBK_82599_TX_RX)
3797                 ixgbe_setup_loopback_link_82599(hw);
3798
3799 }
3800
3801 /*
3802  * Start Receive Units for specified queue.
3803  */
3804 int
3805 ixgbe_dev_rx_queue_start(struct rte_eth_dev *dev, uint16_t rx_queue_id)
3806 {
3807         struct ixgbe_hw     *hw;
3808         struct igb_rx_queue *rxq;
3809         uint32_t rxdctl;
3810         int poll_ms;
3811
3812         PMD_INIT_FUNC_TRACE();
3813         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
3814
3815         if (rx_queue_id < dev->data->nb_rx_queues) {
3816                 rxq = dev->data->rx_queues[rx_queue_id];
3817
3818                 /* Allocate buffers for descriptor rings */
3819                 if (ixgbe_alloc_rx_queue_mbufs(rxq) != 0) {
3820                         PMD_INIT_LOG(ERR, "Could not alloc mbuf for queue:%d",
3821                                      rx_queue_id);
3822                         return -1;
3823                 }
3824                 rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(rxq->reg_idx));
3825                 rxdctl |= IXGBE_RXDCTL_ENABLE;
3826                 IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(rxq->reg_idx), rxdctl);
3827
3828                 /* Wait until RX Enable ready */
3829                 poll_ms = RTE_IXGBE_REGISTER_POLL_WAIT_10_MS;
3830                 do {
3831                         rte_delay_ms(1);
3832                         rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(rxq->reg_idx));
3833                 } while (--poll_ms && !(rxdctl & IXGBE_RXDCTL_ENABLE));
3834                 if (!poll_ms)
3835                         PMD_INIT_LOG(ERR, "Could not enable Rx Queue %d",
3836                                      rx_queue_id);
3837                 rte_wmb();
3838                 IXGBE_WRITE_REG(hw, IXGBE_RDH(rxq->reg_idx), 0);
3839                 IXGBE_WRITE_REG(hw, IXGBE_RDT(rxq->reg_idx), rxq->nb_rx_desc - 1);
3840         } else
3841                 return -1;
3842
3843         return 0;
3844 }
3845
3846 /*
3847  * Stop Receive Units for specified queue.
3848  */
3849 int
3850 ixgbe_dev_rx_queue_stop(struct rte_eth_dev *dev, uint16_t rx_queue_id)
3851 {
3852         struct ixgbe_hw     *hw;
3853         struct igb_rx_queue *rxq;
3854         uint32_t rxdctl;
3855         int poll_ms;
3856
3857         PMD_INIT_FUNC_TRACE();
3858         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
3859
3860         if (rx_queue_id < dev->data->nb_rx_queues) {
3861                 rxq = dev->data->rx_queues[rx_queue_id];
3862
3863                 rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(rxq->reg_idx));
3864                 rxdctl &= ~IXGBE_RXDCTL_ENABLE;
3865                 IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(rxq->reg_idx), rxdctl);
3866
3867                 /* Wait until RX Enable ready */
3868                 poll_ms = RTE_IXGBE_REGISTER_POLL_WAIT_10_MS;
3869                 do {
3870                         rte_delay_ms(1);
3871                         rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(rxq->reg_idx));
3872                 } while (--poll_ms && (rxdctl | IXGBE_RXDCTL_ENABLE));
3873                 if (!poll_ms)
3874                         PMD_INIT_LOG(ERR, "Could not disable Rx Queue %d",
3875                                      rx_queue_id);
3876
3877                 rte_delay_us(RTE_IXGBE_WAIT_100_US);
3878
3879                 ixgbe_rx_queue_release_mbufs(rxq);
3880                 ixgbe_reset_rx_queue(rxq);
3881         } else
3882                 return -1;
3883
3884         return 0;
3885 }
3886
3887
3888 /*
3889  * Start Transmit Units for specified queue.
3890  */
3891 int
3892 ixgbe_dev_tx_queue_start(struct rte_eth_dev *dev, uint16_t tx_queue_id)
3893 {
3894         struct ixgbe_hw     *hw;
3895         struct igb_tx_queue *txq;
3896         uint32_t txdctl;
3897         int poll_ms;
3898
3899         PMD_INIT_FUNC_TRACE();
3900         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
3901
3902         if (tx_queue_id < dev->data->nb_tx_queues) {
3903                 txq = dev->data->tx_queues[tx_queue_id];
3904                 txdctl = IXGBE_READ_REG(hw, IXGBE_TXDCTL(txq->reg_idx));
3905                 txdctl |= IXGBE_TXDCTL_ENABLE;
3906                 IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(txq->reg_idx), txdctl);
3907
3908                 /* Wait until TX Enable ready */
3909                 if (hw->mac.type == ixgbe_mac_82599EB) {
3910                         poll_ms = RTE_IXGBE_REGISTER_POLL_WAIT_10_MS;
3911                         do {
3912                                 rte_delay_ms(1);
3913                                 txdctl = IXGBE_READ_REG(hw,
3914                                         IXGBE_TXDCTL(txq->reg_idx));
3915                         } while (--poll_ms && !(txdctl & IXGBE_TXDCTL_ENABLE));
3916                         if (!poll_ms)
3917                                 PMD_INIT_LOG(ERR, "Could not enable "
3918                                              "Tx Queue %d", tx_queue_id);
3919                 }
3920                 rte_wmb();
3921                 IXGBE_WRITE_REG(hw, IXGBE_TDH(txq->reg_idx), 0);
3922                 IXGBE_WRITE_REG(hw, IXGBE_TDT(txq->reg_idx), 0);
3923         } else
3924                 return -1;
3925
3926         return 0;
3927 }
3928
3929 /*
3930  * Stop Transmit Units for specified queue.
3931  */
3932 int
3933 ixgbe_dev_tx_queue_stop(struct rte_eth_dev *dev, uint16_t tx_queue_id)
3934 {
3935         struct ixgbe_hw     *hw;
3936         struct igb_tx_queue *txq;
3937         uint32_t txdctl;
3938         uint32_t txtdh, txtdt;
3939         int poll_ms;
3940
3941         PMD_INIT_FUNC_TRACE();
3942         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
3943
3944         if (tx_queue_id < dev->data->nb_tx_queues) {
3945                 txq = dev->data->tx_queues[tx_queue_id];
3946
3947                 /* Wait until TX queue is empty */
3948                 if (hw->mac.type == ixgbe_mac_82599EB) {
3949                         poll_ms = RTE_IXGBE_REGISTER_POLL_WAIT_10_MS;
3950                         do {
3951                                 rte_delay_us(RTE_IXGBE_WAIT_100_US);
3952                                 txtdh = IXGBE_READ_REG(hw,
3953                                                 IXGBE_TDH(txq->reg_idx));
3954                                 txtdt = IXGBE_READ_REG(hw,
3955                                                 IXGBE_TDT(txq->reg_idx));
3956                         } while (--poll_ms && (txtdh != txtdt));
3957                         if (!poll_ms)
3958                                 PMD_INIT_LOG(ERR, "Tx Queue %d is not empty "
3959                                              "when stopping.", tx_queue_id);
3960                 }
3961
3962                 txdctl = IXGBE_READ_REG(hw, IXGBE_TXDCTL(txq->reg_idx));
3963                 txdctl &= ~IXGBE_TXDCTL_ENABLE;
3964                 IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(txq->reg_idx), txdctl);
3965
3966                 /* Wait until TX Enable ready */
3967                 if (hw->mac.type == ixgbe_mac_82599EB) {
3968                         poll_ms = RTE_IXGBE_REGISTER_POLL_WAIT_10_MS;
3969                         do {
3970                                 rte_delay_ms(1);
3971                                 txdctl = IXGBE_READ_REG(hw,
3972                                                 IXGBE_TXDCTL(txq->reg_idx));
3973                         } while (--poll_ms && (txdctl | IXGBE_TXDCTL_ENABLE));
3974                         if (!poll_ms)
3975                                 PMD_INIT_LOG(ERR, "Could not disable "
3976                                              "Tx Queue %d", tx_queue_id);
3977                 }
3978
3979                 if (txq->ops != NULL) {
3980                         txq->ops->release_mbufs(txq);
3981                         txq->ops->reset(txq);
3982                 }
3983         } else
3984                 return -1;
3985
3986         return 0;
3987 }
3988
3989 /*
3990  * [VF] Initializes Receive Unit.
3991  */
3992 int
3993 ixgbevf_dev_rx_init(struct rte_eth_dev *dev)
3994 {
3995         struct ixgbe_hw     *hw;
3996         struct igb_rx_queue *rxq;
3997         struct rte_pktmbuf_pool_private *mbp_priv;
3998         uint64_t bus_addr;
3999         uint32_t srrctl;
4000         uint16_t buf_size;
4001         uint16_t i;
4002         int ret;
4003
4004         PMD_INIT_FUNC_TRACE();
4005         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
4006
4007         /*
4008          * When the VF driver issues a IXGBE_VF_RESET request, the PF driver
4009          * disables the VF receipt of packets if the PF MTU is > 1500.
4010          * This is done to deal with 82599 limitations that imposes
4011          * the PF and all VFs to share the same MTU.
4012          * Then, the PF driver enables again the VF receipt of packet when
4013          * the VF driver issues a IXGBE_VF_SET_LPE request.
4014          * In the meantime, the VF device cannot be used, even if the VF driver
4015          * and the Guest VM network stack are ready to accept packets with a
4016          * size up to the PF MTU.
4017          * As a work-around to this PF behaviour, force the call to
4018          * ixgbevf_rlpml_set_vf even if jumbo frames are not used. This way,
4019          * VF packets received can work in all cases.
4020          */
4021         ixgbevf_rlpml_set_vf(hw,
4022                 (uint16_t)dev->data->dev_conf.rxmode.max_rx_pkt_len);
4023
4024         /* Setup RX queues */
4025         dev->rx_pkt_burst = ixgbe_recv_pkts;
4026         for (i = 0; i < dev->data->nb_rx_queues; i++) {
4027                 rxq = dev->data->rx_queues[i];
4028
4029                 /* Allocate buffers for descriptor rings */
4030                 ret = ixgbe_alloc_rx_queue_mbufs(rxq);
4031                 if (ret)
4032                         return ret;
4033
4034                 /* Setup the Base and Length of the Rx Descriptor Rings */
4035                 bus_addr = rxq->rx_ring_phys_addr;
4036
4037                 IXGBE_WRITE_REG(hw, IXGBE_VFRDBAL(i),
4038                                 (uint32_t)(bus_addr & 0x00000000ffffffffULL));
4039                 IXGBE_WRITE_REG(hw, IXGBE_VFRDBAH(i),
4040                                 (uint32_t)(bus_addr >> 32));
4041                 IXGBE_WRITE_REG(hw, IXGBE_VFRDLEN(i),
4042                                 rxq->nb_rx_desc * sizeof(union ixgbe_adv_rx_desc));
4043                 IXGBE_WRITE_REG(hw, IXGBE_VFRDH(i), 0);
4044                 IXGBE_WRITE_REG(hw, IXGBE_VFRDT(i), 0);
4045
4046
4047                 /* Configure the SRRCTL register */
4048 #ifdef RTE_HEADER_SPLIT_ENABLE
4049                 /*
4050                  * Configure Header Split
4051                  */
4052                 if (dev->data->dev_conf.rxmode.header_split) {
4053
4054                         /* Must setup the PSRTYPE register */
4055                         uint32_t psrtype;
4056                         psrtype = IXGBE_PSRTYPE_TCPHDR |
4057                                 IXGBE_PSRTYPE_UDPHDR   |
4058                                 IXGBE_PSRTYPE_IPV4HDR  |
4059                                 IXGBE_PSRTYPE_IPV6HDR;
4060
4061                         IXGBE_WRITE_REG(hw, IXGBE_VFPSRTYPE(i), psrtype);
4062
4063                         srrctl = ((dev->data->dev_conf.rxmode.split_hdr_size <<
4064                                    IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT) &
4065                                   IXGBE_SRRCTL_BSIZEHDR_MASK);
4066                         srrctl |= E1000_SRRCTL_DESCTYPE_HDR_SPLIT_ALWAYS;
4067                 } else
4068 #endif
4069                         srrctl = IXGBE_SRRCTL_DESCTYPE_ADV_ONEBUF;
4070
4071                 /* Set if packets are dropped when no descriptors available */
4072                 if (rxq->drop_en)
4073                         srrctl |= IXGBE_SRRCTL_DROP_EN;
4074
4075                 /*
4076                  * Configure the RX buffer size in the BSIZEPACKET field of
4077                  * the SRRCTL register of the queue.
4078                  * The value is in 1 KB resolution. Valid values can be from
4079                  * 1 KB to 16 KB.
4080                  */
4081                 mbp_priv = rte_mempool_get_priv(rxq->mb_pool);
4082                 buf_size = (uint16_t) (mbp_priv->mbuf_data_room_size -
4083                                        RTE_PKTMBUF_HEADROOM);
4084                 srrctl |= ((buf_size >> IXGBE_SRRCTL_BSIZEPKT_SHIFT) &
4085                            IXGBE_SRRCTL_BSIZEPKT_MASK);
4086
4087                 /*
4088                  * VF modification to write virtual function SRRCTL register
4089                  */
4090                 IXGBE_WRITE_REG(hw, IXGBE_VFSRRCTL(i), srrctl);
4091
4092                 buf_size = (uint16_t) ((srrctl & IXGBE_SRRCTL_BSIZEPKT_MASK) <<
4093                                        IXGBE_SRRCTL_BSIZEPKT_SHIFT);
4094
4095                 /* It adds dual VLAN length for supporting dual VLAN */
4096                 if ((dev->data->dev_conf.rxmode.max_rx_pkt_len +
4097                                 2 * IXGBE_VLAN_TAG_SIZE) > buf_size) {
4098                         if (!dev->data->scattered_rx)
4099                                 PMD_INIT_LOG(DEBUG, "forcing scatter mode");
4100                         dev->data->scattered_rx = 1;
4101 #ifdef RTE_IXGBE_INC_VECTOR
4102                         dev->rx_pkt_burst = ixgbe_recv_scattered_pkts_vec;
4103 #else
4104                         dev->rx_pkt_burst = ixgbe_recv_scattered_pkts;
4105 #endif
4106                 }
4107         }
4108
4109         if (dev->data->dev_conf.rxmode.enable_scatter) {
4110                 if (!dev->data->scattered_rx)
4111                         PMD_INIT_LOG(DEBUG, "forcing scatter mode");
4112 #ifdef RTE_IXGBE_INC_VECTOR
4113                 dev->rx_pkt_burst = ixgbe_recv_scattered_pkts_vec;
4114 #else
4115                 dev->rx_pkt_burst = ixgbe_recv_scattered_pkts;
4116 #endif
4117                 dev->data->scattered_rx = 1;
4118         }
4119
4120         return 0;
4121 }
4122
4123 /*
4124  * [VF] Initializes Transmit Unit.
4125  */
4126 void
4127 ixgbevf_dev_tx_init(struct rte_eth_dev *dev)
4128 {
4129         struct ixgbe_hw     *hw;
4130         struct igb_tx_queue *txq;
4131         uint64_t bus_addr;
4132         uint32_t txctrl;
4133         uint16_t i;
4134
4135         PMD_INIT_FUNC_TRACE();
4136         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
4137
4138         /* Setup the Base and Length of the Tx Descriptor Rings */
4139         for (i = 0; i < dev->data->nb_tx_queues; i++) {
4140                 txq = dev->data->tx_queues[i];
4141                 bus_addr = txq->tx_ring_phys_addr;
4142                 IXGBE_WRITE_REG(hw, IXGBE_VFTDBAL(i),
4143                                 (uint32_t)(bus_addr & 0x00000000ffffffffULL));
4144                 IXGBE_WRITE_REG(hw, IXGBE_VFTDBAH(i),
4145                                 (uint32_t)(bus_addr >> 32));
4146                 IXGBE_WRITE_REG(hw, IXGBE_VFTDLEN(i),
4147                                 txq->nb_tx_desc * sizeof(union ixgbe_adv_tx_desc));
4148                 /* Setup the HW Tx Head and TX Tail descriptor pointers */
4149                 IXGBE_WRITE_REG(hw, IXGBE_VFTDH(i), 0);
4150                 IXGBE_WRITE_REG(hw, IXGBE_VFTDT(i), 0);
4151
4152                 /*
4153                  * Disable Tx Head Writeback RO bit, since this hoses
4154                  * bookkeeping if things aren't delivered in order.
4155                  */
4156                 txctrl = IXGBE_READ_REG(hw,
4157                                 IXGBE_VFDCA_TXCTRL(i));
4158                 txctrl &= ~IXGBE_DCA_TXCTRL_DESC_WRO_EN;
4159                 IXGBE_WRITE_REG(hw, IXGBE_VFDCA_TXCTRL(i),
4160                                 txctrl);
4161         }
4162 }
4163
4164 /*
4165  * [VF] Start Transmit and Receive Units.
4166  */
4167 void
4168 ixgbevf_dev_rxtx_start(struct rte_eth_dev *dev)
4169 {
4170         struct ixgbe_hw     *hw;
4171         struct igb_tx_queue *txq;
4172         struct igb_rx_queue *rxq;
4173         uint32_t txdctl;
4174         uint32_t rxdctl;
4175         uint16_t i;
4176         int poll_ms;
4177
4178         PMD_INIT_FUNC_TRACE();
4179         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
4180
4181         for (i = 0; i < dev->data->nb_tx_queues; i++) {
4182                 txq = dev->data->tx_queues[i];
4183                 /* Setup Transmit Threshold Registers */
4184                 txdctl = IXGBE_READ_REG(hw, IXGBE_VFTXDCTL(i));
4185                 txdctl |= txq->pthresh & 0x7F;
4186                 txdctl |= ((txq->hthresh & 0x7F) << 8);
4187                 txdctl |= ((txq->wthresh & 0x7F) << 16);
4188                 IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(i), txdctl);
4189         }
4190
4191         for (i = 0; i < dev->data->nb_tx_queues; i++) {
4192
4193                 txdctl = IXGBE_READ_REG(hw, IXGBE_VFTXDCTL(i));
4194                 txdctl |= IXGBE_TXDCTL_ENABLE;
4195                 IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(i), txdctl);
4196
4197                 poll_ms = 10;
4198                 /* Wait until TX Enable ready */
4199                 do {
4200                         rte_delay_ms(1);
4201                         txdctl = IXGBE_READ_REG(hw, IXGBE_VFTXDCTL(i));
4202                 } while (--poll_ms && !(txdctl & IXGBE_TXDCTL_ENABLE));
4203                 if (!poll_ms)
4204                         PMD_INIT_LOG(ERR, "Could not enable Tx Queue %d", i);
4205         }
4206         for (i = 0; i < dev->data->nb_rx_queues; i++) {
4207
4208                 rxq = dev->data->rx_queues[i];
4209
4210                 rxdctl = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(i));
4211                 rxdctl |= IXGBE_RXDCTL_ENABLE;
4212                 IXGBE_WRITE_REG(hw, IXGBE_VFRXDCTL(i), rxdctl);
4213
4214                 /* Wait until RX Enable ready */
4215                 poll_ms = 10;
4216                 do {
4217                         rte_delay_ms(1);
4218                         rxdctl = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(i));
4219                 } while (--poll_ms && !(rxdctl & IXGBE_RXDCTL_ENABLE));
4220                 if (!poll_ms)
4221                         PMD_INIT_LOG(ERR, "Could not enable Rx Queue %d", i);
4222                 rte_wmb();
4223                 IXGBE_WRITE_REG(hw, IXGBE_VFRDT(i), rxq->nb_rx_desc - 1);
4224
4225         }
4226 }