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