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