Merge tag 'rdma-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/roland...
[pandora-kernel.git] / drivers / net / ethernet / intel / ixgbe / ixgbe_lib.c
1 /*******************************************************************************
2
3   Intel 10 Gigabit PCI Express Linux driver
4   Copyright(c) 1999 - 2012 Intel Corporation.
5
6   This program is free software; you can redistribute it and/or modify it
7   under the terms and conditions of the GNU General Public License,
8   version 2, as published by the Free Software Foundation.
9
10   This program is distributed in the hope it will be useful, but WITHOUT
11   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12   FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
13   more details.
14
15   You should have received a copy of the GNU General Public License along with
16   this program; if not, write to the Free Software Foundation, Inc.,
17   51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
18
19   The full GNU General Public License is included in this distribution in
20   the file called "COPYING".
21
22   Contact Information:
23   e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
24   Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
25
26 *******************************************************************************/
27
28 #include "ixgbe.h"
29 #include "ixgbe_sriov.h"
30
31 #ifdef CONFIG_IXGBE_DCB
32 /**
33  * ixgbe_cache_ring_dcb_sriov - Descriptor ring to register mapping for SR-IOV
34  * @adapter: board private structure to initialize
35  *
36  * Cache the descriptor ring offsets for SR-IOV to the assigned rings.  It
37  * will also try to cache the proper offsets if RSS/FCoE are enabled along
38  * with VMDq.
39  *
40  **/
41 static bool ixgbe_cache_ring_dcb_sriov(struct ixgbe_adapter *adapter)
42 {
43 #ifdef IXGBE_FCOE
44         struct ixgbe_ring_feature *fcoe = &adapter->ring_feature[RING_F_FCOE];
45 #endif /* IXGBE_FCOE */
46         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
47         int i;
48         u16 reg_idx;
49         u8 tcs = netdev_get_num_tc(adapter->netdev);
50
51         /* verify we have DCB queueing enabled before proceeding */
52         if (tcs <= 1)
53                 return false;
54
55         /* verify we have VMDq enabled before proceeding */
56         if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
57                 return false;
58
59         /* start at VMDq register offset for SR-IOV enabled setups */
60         reg_idx = vmdq->offset * __ALIGN_MASK(1, ~vmdq->mask);
61         for (i = 0; i < adapter->num_rx_queues; i++, reg_idx++) {
62                 /* If we are greater than indices move to next pool */
63                 if ((reg_idx & ~vmdq->mask) >= tcs)
64                         reg_idx = __ALIGN_MASK(reg_idx, ~vmdq->mask);
65                 adapter->rx_ring[i]->reg_idx = reg_idx;
66         }
67
68         reg_idx = vmdq->offset * __ALIGN_MASK(1, ~vmdq->mask);
69         for (i = 0; i < adapter->num_tx_queues; i++, reg_idx++) {
70                 /* If we are greater than indices move to next pool */
71                 if ((reg_idx & ~vmdq->mask) >= tcs)
72                         reg_idx = __ALIGN_MASK(reg_idx, ~vmdq->mask);
73                 adapter->tx_ring[i]->reg_idx = reg_idx;
74         }
75
76 #ifdef IXGBE_FCOE
77         /* nothing to do if FCoE is disabled */
78         if (!(adapter->flags & IXGBE_FLAG_FCOE_ENABLED))
79                 return true;
80
81         /* The work is already done if the FCoE ring is shared */
82         if (fcoe->offset < tcs)
83                 return true;
84
85         /* The FCoE rings exist separately, we need to move their reg_idx */
86         if (fcoe->indices) {
87                 u16 queues_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
88                 u8 fcoe_tc = ixgbe_fcoe_get_tc(adapter);
89
90                 reg_idx = (vmdq->offset + vmdq->indices) * queues_per_pool;
91                 for (i = fcoe->offset; i < adapter->num_rx_queues; i++) {
92                         reg_idx = __ALIGN_MASK(reg_idx, ~vmdq->mask) + fcoe_tc;
93                         adapter->rx_ring[i]->reg_idx = reg_idx;
94                         reg_idx++;
95                 }
96
97                 reg_idx = (vmdq->offset + vmdq->indices) * queues_per_pool;
98                 for (i = fcoe->offset; i < adapter->num_tx_queues; i++) {
99                         reg_idx = __ALIGN_MASK(reg_idx, ~vmdq->mask) + fcoe_tc;
100                         adapter->tx_ring[i]->reg_idx = reg_idx;
101                         reg_idx++;
102                 }
103         }
104
105 #endif /* IXGBE_FCOE */
106         return true;
107 }
108
109 /* ixgbe_get_first_reg_idx - Return first register index associated with ring */
110 static void ixgbe_get_first_reg_idx(struct ixgbe_adapter *adapter, u8 tc,
111                                     unsigned int *tx, unsigned int *rx)
112 {
113         struct net_device *dev = adapter->netdev;
114         struct ixgbe_hw *hw = &adapter->hw;
115         u8 num_tcs = netdev_get_num_tc(dev);
116
117         *tx = 0;
118         *rx = 0;
119
120         switch (hw->mac.type) {
121         case ixgbe_mac_82598EB:
122                 /* TxQs/TC: 4   RxQs/TC: 8 */
123                 *tx = tc << 2; /* 0, 4,  8, 12, 16, 20, 24, 28 */
124                 *rx = tc << 3; /* 0, 8, 16, 24, 32, 40, 48, 56 */
125                 break;
126         case ixgbe_mac_82599EB:
127         case ixgbe_mac_X540:
128                 if (num_tcs > 4) {
129                         /*
130                          * TCs    : TC0/1 TC2/3 TC4-7
131                          * TxQs/TC:    32    16     8
132                          * RxQs/TC:    16    16    16
133                          */
134                         *rx = tc << 4;
135                         if (tc < 3)
136                                 *tx = tc << 5;          /*   0,  32,  64 */
137                         else if (tc < 5)
138                                 *tx = (tc + 2) << 4;    /*  80,  96 */
139                         else
140                                 *tx = (tc + 8) << 3;    /* 104, 112, 120 */
141                 } else {
142                         /*
143                          * TCs    : TC0 TC1 TC2/3
144                          * TxQs/TC:  64  32    16
145                          * RxQs/TC:  32  32    32
146                          */
147                         *rx = tc << 5;
148                         if (tc < 2)
149                                 *tx = tc << 6;          /*  0,  64 */
150                         else
151                                 *tx = (tc + 4) << 4;    /* 96, 112 */
152                 }
153         default:
154                 break;
155         }
156 }
157
158 /**
159  * ixgbe_cache_ring_dcb - Descriptor ring to register mapping for DCB
160  * @adapter: board private structure to initialize
161  *
162  * Cache the descriptor ring offsets for DCB to the assigned rings.
163  *
164  **/
165 static bool ixgbe_cache_ring_dcb(struct ixgbe_adapter *adapter)
166 {
167         struct net_device *dev = adapter->netdev;
168         unsigned int tx_idx, rx_idx;
169         int tc, offset, rss_i, i;
170         u8 num_tcs = netdev_get_num_tc(dev);
171
172         /* verify we have DCB queueing enabled before proceeding */
173         if (num_tcs <= 1)
174                 return false;
175
176         rss_i = adapter->ring_feature[RING_F_RSS].indices;
177
178         for (tc = 0, offset = 0; tc < num_tcs; tc++, offset += rss_i) {
179                 ixgbe_get_first_reg_idx(adapter, tc, &tx_idx, &rx_idx);
180                 for (i = 0; i < rss_i; i++, tx_idx++, rx_idx++) {
181                         adapter->tx_ring[offset + i]->reg_idx = tx_idx;
182                         adapter->rx_ring[offset + i]->reg_idx = rx_idx;
183                         adapter->tx_ring[offset + i]->dcb_tc = tc;
184                         adapter->rx_ring[offset + i]->dcb_tc = tc;
185                 }
186         }
187
188         return true;
189 }
190
191 #endif
192 /**
193  * ixgbe_cache_ring_sriov - Descriptor ring to register mapping for sriov
194  * @adapter: board private structure to initialize
195  *
196  * SR-IOV doesn't use any descriptor rings but changes the default if
197  * no other mapping is used.
198  *
199  */
200 static bool ixgbe_cache_ring_sriov(struct ixgbe_adapter *adapter)
201 {
202 #ifdef IXGBE_FCOE
203         struct ixgbe_ring_feature *fcoe = &adapter->ring_feature[RING_F_FCOE];
204 #endif /* IXGBE_FCOE */
205         struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
206         struct ixgbe_ring_feature *rss = &adapter->ring_feature[RING_F_RSS];
207         int i;
208         u16 reg_idx;
209
210         /* only proceed if VMDq is enabled */
211         if (!(adapter->flags & IXGBE_FLAG_VMDQ_ENABLED))
212                 return false;
213
214         /* start at VMDq register offset for SR-IOV enabled setups */
215         reg_idx = vmdq->offset * __ALIGN_MASK(1, ~vmdq->mask);
216         for (i = 0; i < adapter->num_rx_queues; i++, reg_idx++) {
217 #ifdef IXGBE_FCOE
218                 /* Allow first FCoE queue to be mapped as RSS */
219                 if (fcoe->offset && (i > fcoe->offset))
220                         break;
221 #endif
222                 /* If we are greater than indices move to next pool */
223                 if ((reg_idx & ~vmdq->mask) >= rss->indices)
224                         reg_idx = __ALIGN_MASK(reg_idx, ~vmdq->mask);
225                 adapter->rx_ring[i]->reg_idx = reg_idx;
226         }
227
228 #ifdef IXGBE_FCOE
229         /* FCoE uses a linear block of queues so just assigning 1:1 */
230         for (; i < adapter->num_rx_queues; i++, reg_idx++)
231                 adapter->rx_ring[i]->reg_idx = reg_idx;
232
233 #endif
234         reg_idx = vmdq->offset * __ALIGN_MASK(1, ~vmdq->mask);
235         for (i = 0; i < adapter->num_tx_queues; i++, reg_idx++) {
236 #ifdef IXGBE_FCOE
237                 /* Allow first FCoE queue to be mapped as RSS */
238                 if (fcoe->offset && (i > fcoe->offset))
239                         break;
240 #endif
241                 /* If we are greater than indices move to next pool */
242                 if ((reg_idx & rss->mask) >= rss->indices)
243                         reg_idx = __ALIGN_MASK(reg_idx, ~vmdq->mask);
244                 adapter->tx_ring[i]->reg_idx = reg_idx;
245         }
246
247 #ifdef IXGBE_FCOE
248         /* FCoE uses a linear block of queues so just assigning 1:1 */
249         for (; i < adapter->num_tx_queues; i++, reg_idx++)
250                 adapter->tx_ring[i]->reg_idx = reg_idx;
251
252 #endif
253
254         return true;
255 }
256
257 /**
258  * ixgbe_cache_ring_rss - Descriptor ring to register mapping for RSS
259  * @adapter: board private structure to initialize
260  *
261  * Cache the descriptor ring offsets for RSS to the assigned rings.
262  *
263  **/
264 static bool ixgbe_cache_ring_rss(struct ixgbe_adapter *adapter)
265 {
266         int i;
267
268         for (i = 0; i < adapter->num_rx_queues; i++)
269                 adapter->rx_ring[i]->reg_idx = i;
270         for (i = 0; i < adapter->num_tx_queues; i++)
271                 adapter->tx_ring[i]->reg_idx = i;
272
273         return true;
274 }
275
276 /**
277  * ixgbe_cache_ring_register - Descriptor ring to register mapping
278  * @adapter: board private structure to initialize
279  *
280  * Once we know the feature-set enabled for the device, we'll cache
281  * the register offset the descriptor ring is assigned to.
282  *
283  * Note, the order the various feature calls is important.  It must start with
284  * the "most" features enabled at the same time, then trickle down to the
285  * least amount of features turned on at once.
286  **/
287 static void ixgbe_cache_ring_register(struct ixgbe_adapter *adapter)
288 {
289         /* start with default case */
290         adapter->rx_ring[0]->reg_idx = 0;
291         adapter->tx_ring[0]->reg_idx = 0;
292
293 #ifdef CONFIG_IXGBE_DCB
294         if (ixgbe_cache_ring_dcb_sriov(adapter))
295                 return;
296
297         if (ixgbe_cache_ring_dcb(adapter))
298                 return;
299
300 #endif
301         if (ixgbe_cache_ring_sriov(adapter))
302                 return;
303
304         ixgbe_cache_ring_rss(adapter);
305 }
306
307 #define IXGBE_RSS_16Q_MASK      0xF
308 #define IXGBE_RSS_8Q_MASK       0x7
309 #define IXGBE_RSS_4Q_MASK       0x3
310 #define IXGBE_RSS_2Q_MASK       0x1
311 #define IXGBE_RSS_DISABLED_MASK 0x0
312
313 #ifdef CONFIG_IXGBE_DCB
314 /**
315  * ixgbe_set_dcb_sriov_queues: Allocate queues for SR-IOV devices w/ DCB
316  * @adapter: board private structure to initialize
317  *
318  * When SR-IOV (Single Root IO Virtualiztion) is enabled, allocate queues
319  * and VM pools where appropriate.  Also assign queues based on DCB
320  * priorities and map accordingly..
321  *
322  **/
323 static bool ixgbe_set_dcb_sriov_queues(struct ixgbe_adapter *adapter)
324 {
325         int i;
326         u16 vmdq_i = adapter->ring_feature[RING_F_VMDQ].limit;
327         u16 vmdq_m = 0;
328 #ifdef IXGBE_FCOE
329         u16 fcoe_i = 0;
330 #endif
331         u8 tcs = netdev_get_num_tc(adapter->netdev);
332
333         /* verify we have DCB queueing enabled before proceeding */
334         if (tcs <= 1)
335                 return false;
336
337         /* verify we have VMDq enabled before proceeding */
338         if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
339                 return false;
340
341         /* Add starting offset to total pool count */
342         vmdq_i += adapter->ring_feature[RING_F_VMDQ].offset;
343
344         /* 16 pools w/ 8 TC per pool */
345         if (tcs > 4) {
346                 vmdq_i = min_t(u16, vmdq_i, 16);
347                 vmdq_m = IXGBE_82599_VMDQ_8Q_MASK;
348         /* 32 pools w/ 4 TC per pool */
349         } else {
350                 vmdq_i = min_t(u16, vmdq_i, 32);
351                 vmdq_m = IXGBE_82599_VMDQ_4Q_MASK;
352         }
353
354 #ifdef IXGBE_FCOE
355         /* queues in the remaining pools are available for FCoE */
356         fcoe_i = (128 / __ALIGN_MASK(1, ~vmdq_m)) - vmdq_i;
357
358 #endif
359         /* remove the starting offset from the pool count */
360         vmdq_i -= adapter->ring_feature[RING_F_VMDQ].offset;
361
362         /* save features for later use */
363         adapter->ring_feature[RING_F_VMDQ].indices = vmdq_i;
364         adapter->ring_feature[RING_F_VMDQ].mask = vmdq_m;
365
366         /*
367          * We do not support DCB, VMDq, and RSS all simultaneously
368          * so we will disable RSS since it is the lowest priority
369          */
370         adapter->ring_feature[RING_F_RSS].indices = 1;
371         adapter->ring_feature[RING_F_RSS].mask = IXGBE_RSS_DISABLED_MASK;
372
373         /* disable ATR as it is not supported when VMDq is enabled */
374         adapter->flags &= ~IXGBE_FLAG_FDIR_HASH_CAPABLE;
375
376         adapter->num_rx_pools = vmdq_i;
377         adapter->num_rx_queues_per_pool = tcs;
378
379         adapter->num_tx_queues = vmdq_i * tcs;
380         adapter->num_rx_queues = vmdq_i * tcs;
381
382 #ifdef IXGBE_FCOE
383         if (adapter->flags & IXGBE_FLAG_FCOE_ENABLED) {
384                 struct ixgbe_ring_feature *fcoe;
385
386                 fcoe = &adapter->ring_feature[RING_F_FCOE];
387
388                 /* limit ourselves based on feature limits */
389                 fcoe_i = min_t(u16, fcoe_i, num_online_cpus());
390                 fcoe_i = min_t(u16, fcoe_i, fcoe->limit);
391
392                 if (fcoe_i) {
393                         /* alloc queues for FCoE separately */
394                         fcoe->indices = fcoe_i;
395                         fcoe->offset = vmdq_i * tcs;
396
397                         /* add queues to adapter */
398                         adapter->num_tx_queues += fcoe_i;
399                         adapter->num_rx_queues += fcoe_i;
400                 } else if (tcs > 1) {
401                         /* use queue belonging to FcoE TC */
402                         fcoe->indices = 1;
403                         fcoe->offset = ixgbe_fcoe_get_tc(adapter);
404                 } else {
405                         adapter->flags &= ~IXGBE_FLAG_FCOE_ENABLED;
406
407                         fcoe->indices = 0;
408                         fcoe->offset = 0;
409                 }
410         }
411
412 #endif /* IXGBE_FCOE */
413         /* configure TC to queue mapping */
414         for (i = 0; i < tcs; i++)
415                 netdev_set_tc_queue(adapter->netdev, i, 1, i);
416
417         return true;
418 }
419
420 static bool ixgbe_set_dcb_queues(struct ixgbe_adapter *adapter)
421 {
422         struct net_device *dev = adapter->netdev;
423         struct ixgbe_ring_feature *f;
424         int rss_i, rss_m, i;
425         int tcs;
426
427         /* Map queue offset and counts onto allocated tx queues */
428         tcs = netdev_get_num_tc(dev);
429
430         /* verify we have DCB queueing enabled before proceeding */
431         if (tcs <= 1)
432                 return false;
433
434         /* determine the upper limit for our current DCB mode */
435         rss_i = dev->num_tx_queues / tcs;
436         if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
437                 /* 8 TC w/ 4 queues per TC */
438                 rss_i = min_t(u16, rss_i, 4);
439                 rss_m = IXGBE_RSS_4Q_MASK;
440         } else if (tcs > 4) {
441                 /* 8 TC w/ 8 queues per TC */
442                 rss_i = min_t(u16, rss_i, 8);
443                 rss_m = IXGBE_RSS_8Q_MASK;
444         } else {
445                 /* 4 TC w/ 16 queues per TC */
446                 rss_i = min_t(u16, rss_i, 16);
447                 rss_m = IXGBE_RSS_16Q_MASK;
448         }
449
450         /* set RSS mask and indices */
451         f = &adapter->ring_feature[RING_F_RSS];
452         rss_i = min_t(int, rss_i, f->limit);
453         f->indices = rss_i;
454         f->mask = rss_m;
455
456         /* disable ATR as it is not supported when multiple TCs are enabled */
457         adapter->flags &= ~IXGBE_FLAG_FDIR_HASH_CAPABLE;
458
459 #ifdef IXGBE_FCOE
460         /* FCoE enabled queues require special configuration indexed
461          * by feature specific indices and offset. Here we map FCoE
462          * indices onto the DCB queue pairs allowing FCoE to own
463          * configuration later.
464          */
465         if (adapter->flags & IXGBE_FLAG_FCOE_ENABLED) {
466                 u8 tc = ixgbe_fcoe_get_tc(adapter);
467
468                 f = &adapter->ring_feature[RING_F_FCOE];
469                 f->indices = min_t(u16, rss_i, f->limit);
470                 f->offset = rss_i * tc;
471         }
472
473 #endif /* IXGBE_FCOE */
474         for (i = 0; i < tcs; i++)
475                 netdev_set_tc_queue(dev, i, rss_i, rss_i * i);
476
477         adapter->num_tx_queues = rss_i * tcs;
478         adapter->num_rx_queues = rss_i * tcs;
479
480         return true;
481 }
482
483 #endif
484 /**
485  * ixgbe_set_sriov_queues - Allocate queues for SR-IOV devices
486  * @adapter: board private structure to initialize
487  *
488  * When SR-IOV (Single Root IO Virtualiztion) is enabled, allocate queues
489  * and VM pools where appropriate.  If RSS is available, then also try and
490  * enable RSS and map accordingly.
491  *
492  **/
493 static bool ixgbe_set_sriov_queues(struct ixgbe_adapter *adapter)
494 {
495         u16 vmdq_i = adapter->ring_feature[RING_F_VMDQ].limit;
496         u16 vmdq_m = 0;
497         u16 rss_i = adapter->ring_feature[RING_F_RSS].limit;
498         u16 rss_m = IXGBE_RSS_DISABLED_MASK;
499 #ifdef IXGBE_FCOE
500         u16 fcoe_i = 0;
501 #endif
502
503         /* only proceed if SR-IOV is enabled */
504         if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
505                 return false;
506
507         /* Add starting offset to total pool count */
508         vmdq_i += adapter->ring_feature[RING_F_VMDQ].offset;
509
510         /* double check we are limited to maximum pools */
511         vmdq_i = min_t(u16, IXGBE_MAX_VMDQ_INDICES, vmdq_i);
512
513         /* 64 pool mode with 2 queues per pool */
514         if ((vmdq_i > 32) || (rss_i < 4)) {
515                 vmdq_m = IXGBE_82599_VMDQ_2Q_MASK;
516                 rss_m = IXGBE_RSS_2Q_MASK;
517                 rss_i = min_t(u16, rss_i, 2);
518         /* 32 pool mode with 4 queues per pool */
519         } else {
520                 vmdq_m = IXGBE_82599_VMDQ_4Q_MASK;
521                 rss_m = IXGBE_RSS_4Q_MASK;
522                 rss_i = 4;
523         }
524
525 #ifdef IXGBE_FCOE
526         /* queues in the remaining pools are available for FCoE */
527         fcoe_i = 128 - (vmdq_i * __ALIGN_MASK(1, ~vmdq_m));
528
529 #endif
530         /* remove the starting offset from the pool count */
531         vmdq_i -= adapter->ring_feature[RING_F_VMDQ].offset;
532
533         /* save features for later use */
534         adapter->ring_feature[RING_F_VMDQ].indices = vmdq_i;
535         adapter->ring_feature[RING_F_VMDQ].mask = vmdq_m;
536
537         /* limit RSS based on user input and save for later use */
538         adapter->ring_feature[RING_F_RSS].indices = rss_i;
539         adapter->ring_feature[RING_F_RSS].mask = rss_m;
540
541         adapter->num_rx_pools = vmdq_i;
542         adapter->num_rx_queues_per_pool = rss_i;
543
544         adapter->num_rx_queues = vmdq_i * rss_i;
545         adapter->num_tx_queues = vmdq_i * rss_i;
546
547         /* disable ATR as it is not supported when VMDq is enabled */
548         adapter->flags &= ~IXGBE_FLAG_FDIR_HASH_CAPABLE;
549
550 #ifdef IXGBE_FCOE
551         /*
552          * FCoE can use rings from adjacent buffers to allow RSS
553          * like behavior.  To account for this we need to add the
554          * FCoE indices to the total ring count.
555          */
556         if (adapter->flags & IXGBE_FLAG_FCOE_ENABLED) {
557                 struct ixgbe_ring_feature *fcoe;
558
559                 fcoe = &adapter->ring_feature[RING_F_FCOE];
560
561                 /* limit ourselves based on feature limits */
562                 fcoe_i = min_t(u16, fcoe_i, fcoe->limit);
563
564                 if (vmdq_i > 1 && fcoe_i) {
565                         /* reserve no more than number of CPUs */
566                         fcoe_i = min_t(u16, fcoe_i, num_online_cpus());
567
568                         /* alloc queues for FCoE separately */
569                         fcoe->indices = fcoe_i;
570                         fcoe->offset = vmdq_i * rss_i;
571                 } else {
572                         /* merge FCoE queues with RSS queues */
573                         fcoe_i = min_t(u16, fcoe_i + rss_i, num_online_cpus());
574
575                         /* limit indices to rss_i if MSI-X is disabled */
576                         if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED))
577                                 fcoe_i = rss_i;
578
579                         /* attempt to reserve some queues for just FCoE */
580                         fcoe->indices = min_t(u16, fcoe_i, fcoe->limit);
581                         fcoe->offset = fcoe_i - fcoe->indices;
582
583                         fcoe_i -= rss_i;
584                 }
585
586                 /* add queues to adapter */
587                 adapter->num_tx_queues += fcoe_i;
588                 adapter->num_rx_queues += fcoe_i;
589         }
590
591 #endif
592         return true;
593 }
594
595 /**
596  * ixgbe_set_rss_queues - Allocate queues for RSS
597  * @adapter: board private structure to initialize
598  *
599  * This is our "base" multiqueue mode.  RSS (Receive Side Scaling) will try
600  * to allocate one Rx queue per CPU, and if available, one Tx queue per CPU.
601  *
602  **/
603 static bool ixgbe_set_rss_queues(struct ixgbe_adapter *adapter)
604 {
605         struct ixgbe_ring_feature *f;
606         u16 rss_i;
607
608         /* set mask for 16 queue limit of RSS */
609         f = &adapter->ring_feature[RING_F_RSS];
610         rss_i = f->limit;
611
612         f->indices = rss_i;
613         f->mask = IXGBE_RSS_16Q_MASK;
614
615         /* disable ATR by default, it will be configured below */
616         adapter->flags &= ~IXGBE_FLAG_FDIR_HASH_CAPABLE;
617
618         /*
619          * Use Flow Director in addition to RSS to ensure the best
620          * distribution of flows across cores, even when an FDIR flow
621          * isn't matched.
622          */
623         if (rss_i > 1 && adapter->atr_sample_rate) {
624                 f = &adapter->ring_feature[RING_F_FDIR];
625
626                 f->indices = min_t(u16, num_online_cpus(), f->limit);
627                 rss_i = max_t(u16, rss_i, f->indices);
628
629                 if (!(adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE))
630                         adapter->flags |= IXGBE_FLAG_FDIR_HASH_CAPABLE;
631         }
632
633 #ifdef IXGBE_FCOE
634         /*
635          * FCoE can exist on the same rings as standard network traffic
636          * however it is preferred to avoid that if possible.  In order
637          * to get the best performance we allocate as many FCoE queues
638          * as we can and we place them at the end of the ring array to
639          * avoid sharing queues with standard RSS on systems with 24 or
640          * more CPUs.
641          */
642         if (adapter->flags & IXGBE_FLAG_FCOE_ENABLED) {
643                 struct net_device *dev = adapter->netdev;
644                 u16 fcoe_i;
645
646                 f = &adapter->ring_feature[RING_F_FCOE];
647
648                 /* merge FCoE queues with RSS queues */
649                 fcoe_i = min_t(u16, f->limit + rss_i, num_online_cpus());
650                 fcoe_i = min_t(u16, fcoe_i, dev->num_tx_queues);
651
652                 /* limit indices to rss_i if MSI-X is disabled */
653                 if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED))
654                         fcoe_i = rss_i;
655
656                 /* attempt to reserve some queues for just FCoE */
657                 f->indices = min_t(u16, fcoe_i, f->limit);
658                 f->offset = fcoe_i - f->indices;
659                 rss_i = max_t(u16, fcoe_i, rss_i);
660         }
661
662 #endif /* IXGBE_FCOE */
663         adapter->num_rx_queues = rss_i;
664         adapter->num_tx_queues = rss_i;
665
666         return true;
667 }
668
669 /**
670  * ixgbe_set_num_queues - Allocate queues for device, feature dependent
671  * @adapter: board private structure to initialize
672  *
673  * This is the top level queue allocation routine.  The order here is very
674  * important, starting with the "most" number of features turned on at once,
675  * and ending with the smallest set of features.  This way large combinations
676  * can be allocated if they're turned on, and smaller combinations are the
677  * fallthrough conditions.
678  *
679  **/
680 static void ixgbe_set_num_queues(struct ixgbe_adapter *adapter)
681 {
682         /* Start with base case */
683         adapter->num_rx_queues = 1;
684         adapter->num_tx_queues = 1;
685         adapter->num_rx_pools = adapter->num_rx_queues;
686         adapter->num_rx_queues_per_pool = 1;
687
688 #ifdef CONFIG_IXGBE_DCB
689         if (ixgbe_set_dcb_sriov_queues(adapter))
690                 return;
691
692         if (ixgbe_set_dcb_queues(adapter))
693                 return;
694
695 #endif
696         if (ixgbe_set_sriov_queues(adapter))
697                 return;
698
699         ixgbe_set_rss_queues(adapter);
700 }
701
702 static void ixgbe_acquire_msix_vectors(struct ixgbe_adapter *adapter,
703                                        int vectors)
704 {
705         int err, vector_threshold;
706
707         /* We'll want at least 2 (vector_threshold):
708          * 1) TxQ[0] + RxQ[0] handler
709          * 2) Other (Link Status Change, etc.)
710          */
711         vector_threshold = MIN_MSIX_COUNT;
712
713         /*
714          * The more we get, the more we will assign to Tx/Rx Cleanup
715          * for the separate queues...where Rx Cleanup >= Tx Cleanup.
716          * Right now, we simply care about how many we'll get; we'll
717          * set them up later while requesting irq's.
718          */
719         while (vectors >= vector_threshold) {
720                 err = pci_enable_msix(adapter->pdev, adapter->msix_entries,
721                                       vectors);
722                 if (!err) /* Success in acquiring all requested vectors. */
723                         break;
724                 else if (err < 0)
725                         vectors = 0; /* Nasty failure, quit now */
726                 else /* err == number of vectors we should try again with */
727                         vectors = err;
728         }
729
730         if (vectors < vector_threshold) {
731                 /* Can't allocate enough MSI-X interrupts?  Oh well.
732                  * This just means we'll go with either a single MSI
733                  * vector or fall back to legacy interrupts.
734                  */
735                 netif_printk(adapter, hw, KERN_DEBUG, adapter->netdev,
736                              "Unable to allocate MSI-X interrupts\n");
737                 adapter->flags &= ~IXGBE_FLAG_MSIX_ENABLED;
738                 kfree(adapter->msix_entries);
739                 adapter->msix_entries = NULL;
740         } else {
741                 adapter->flags |= IXGBE_FLAG_MSIX_ENABLED; /* Woot! */
742                 /*
743                  * Adjust for only the vectors we'll use, which is minimum
744                  * of max_msix_q_vectors + NON_Q_VECTORS, or the number of
745                  * vectors we were allocated.
746                  */
747                 vectors -= NON_Q_VECTORS;
748                 adapter->num_q_vectors = min(vectors, adapter->max_q_vectors);
749         }
750 }
751
752 static void ixgbe_add_ring(struct ixgbe_ring *ring,
753                            struct ixgbe_ring_container *head)
754 {
755         ring->next = head->ring;
756         head->ring = ring;
757         head->count++;
758 }
759
760 /**
761  * ixgbe_alloc_q_vector - Allocate memory for a single interrupt vector
762  * @adapter: board private structure to initialize
763  * @v_count: q_vectors allocated on adapter, used for ring interleaving
764  * @v_idx: index of vector in adapter struct
765  * @txr_count: total number of Tx rings to allocate
766  * @txr_idx: index of first Tx ring to allocate
767  * @rxr_count: total number of Rx rings to allocate
768  * @rxr_idx: index of first Rx ring to allocate
769  *
770  * We allocate one q_vector.  If allocation fails we return -ENOMEM.
771  **/
772 static int ixgbe_alloc_q_vector(struct ixgbe_adapter *adapter,
773                                 int v_count, int v_idx,
774                                 int txr_count, int txr_idx,
775                                 int rxr_count, int rxr_idx)
776 {
777         struct ixgbe_q_vector *q_vector;
778         struct ixgbe_ring *ring;
779         int node = -1;
780         int cpu = -1;
781         int ring_count, size;
782
783         ring_count = txr_count + rxr_count;
784         size = sizeof(struct ixgbe_q_vector) +
785                (sizeof(struct ixgbe_ring) * ring_count);
786
787         /* customize cpu for Flow Director mapping */
788         if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
789                 if (cpu_online(v_idx)) {
790                         cpu = v_idx;
791                         node = cpu_to_node(cpu);
792                 }
793         }
794
795         /* allocate q_vector and rings */
796         q_vector = kzalloc_node(size, GFP_KERNEL, node);
797         if (!q_vector)
798                 q_vector = kzalloc(size, GFP_KERNEL);
799         if (!q_vector)
800                 return -ENOMEM;
801
802         /* setup affinity mask and node */
803         if (cpu != -1)
804                 cpumask_set_cpu(cpu, &q_vector->affinity_mask);
805         q_vector->numa_node = node;
806
807 #ifdef CONFIG_IXGBE_DCA
808         /* initialize CPU for DCA */
809         q_vector->cpu = -1;
810
811 #endif
812         /* initialize NAPI */
813         netif_napi_add(adapter->netdev, &q_vector->napi,
814                        ixgbe_poll, 64);
815
816         /* tie q_vector and adapter together */
817         adapter->q_vector[v_idx] = q_vector;
818         q_vector->adapter = adapter;
819         q_vector->v_idx = v_idx;
820
821         /* initialize work limits */
822         q_vector->tx.work_limit = adapter->tx_work_limit;
823
824         /* initialize pointer to rings */
825         ring = q_vector->ring;
826
827         /* intialize ITR */
828         if (txr_count && !rxr_count) {
829                 /* tx only vector */
830                 if (adapter->tx_itr_setting == 1)
831                         q_vector->itr = IXGBE_10K_ITR;
832                 else
833                         q_vector->itr = adapter->tx_itr_setting;
834         } else {
835                 /* rx or rx/tx vector */
836                 if (adapter->rx_itr_setting == 1)
837                         q_vector->itr = IXGBE_20K_ITR;
838                 else
839                         q_vector->itr = adapter->rx_itr_setting;
840         }
841
842         while (txr_count) {
843                 /* assign generic ring traits */
844                 ring->dev = &adapter->pdev->dev;
845                 ring->netdev = adapter->netdev;
846
847                 /* configure backlink on ring */
848                 ring->q_vector = q_vector;
849
850                 /* update q_vector Tx values */
851                 ixgbe_add_ring(ring, &q_vector->tx);
852
853                 /* apply Tx specific ring traits */
854                 ring->count = adapter->tx_ring_count;
855                 ring->queue_index = txr_idx;
856
857                 /* assign ring to adapter */
858                 adapter->tx_ring[txr_idx] = ring;
859
860                 /* update count and index */
861                 txr_count--;
862                 txr_idx += v_count;
863
864                 /* push pointer to next ring */
865                 ring++;
866         }
867
868         while (rxr_count) {
869                 /* assign generic ring traits */
870                 ring->dev = &adapter->pdev->dev;
871                 ring->netdev = adapter->netdev;
872
873                 /* configure backlink on ring */
874                 ring->q_vector = q_vector;
875
876                 /* update q_vector Rx values */
877                 ixgbe_add_ring(ring, &q_vector->rx);
878
879                 /*
880                  * 82599 errata, UDP frames with a 0 checksum
881                  * can be marked as checksum errors.
882                  */
883                 if (adapter->hw.mac.type == ixgbe_mac_82599EB)
884                         set_bit(__IXGBE_RX_CSUM_UDP_ZERO_ERR, &ring->state);
885
886 #ifdef IXGBE_FCOE
887                 if (adapter->netdev->features & NETIF_F_FCOE_MTU) {
888                         struct ixgbe_ring_feature *f;
889                         f = &adapter->ring_feature[RING_F_FCOE];
890                         if ((rxr_idx >= f->offset) &&
891                             (rxr_idx < f->offset + f->indices))
892                                 set_bit(__IXGBE_RX_FCOE, &ring->state);
893                 }
894
895 #endif /* IXGBE_FCOE */
896                 /* apply Rx specific ring traits */
897                 ring->count = adapter->rx_ring_count;
898                 ring->queue_index = rxr_idx;
899
900                 /* assign ring to adapter */
901                 adapter->rx_ring[rxr_idx] = ring;
902
903                 /* update count and index */
904                 rxr_count--;
905                 rxr_idx += v_count;
906
907                 /* push pointer to next ring */
908                 ring++;
909         }
910
911         return 0;
912 }
913
914 /**
915  * ixgbe_free_q_vector - Free memory allocated for specific interrupt vector
916  * @adapter: board private structure to initialize
917  * @v_idx: Index of vector to be freed
918  *
919  * This function frees the memory allocated to the q_vector.  In addition if
920  * NAPI is enabled it will delete any references to the NAPI struct prior
921  * to freeing the q_vector.
922  **/
923 static void ixgbe_free_q_vector(struct ixgbe_adapter *adapter, int v_idx)
924 {
925         struct ixgbe_q_vector *q_vector = adapter->q_vector[v_idx];
926         struct ixgbe_ring *ring;
927
928         ixgbe_for_each_ring(ring, q_vector->tx)
929                 adapter->tx_ring[ring->queue_index] = NULL;
930
931         ixgbe_for_each_ring(ring, q_vector->rx)
932                 adapter->rx_ring[ring->queue_index] = NULL;
933
934         adapter->q_vector[v_idx] = NULL;
935         netif_napi_del(&q_vector->napi);
936
937         /*
938          * ixgbe_get_stats64() might access the rings on this vector,
939          * we must wait a grace period before freeing it.
940          */
941         kfree_rcu(q_vector, rcu);
942 }
943
944 /**
945  * ixgbe_alloc_q_vectors - Allocate memory for interrupt vectors
946  * @adapter: board private structure to initialize
947  *
948  * We allocate one q_vector per queue interrupt.  If allocation fails we
949  * return -ENOMEM.
950  **/
951 static int ixgbe_alloc_q_vectors(struct ixgbe_adapter *adapter)
952 {
953         int q_vectors = adapter->num_q_vectors;
954         int rxr_remaining = adapter->num_rx_queues;
955         int txr_remaining = adapter->num_tx_queues;
956         int rxr_idx = 0, txr_idx = 0, v_idx = 0;
957         int err;
958
959         /* only one q_vector if MSI-X is disabled. */
960         if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED))
961                 q_vectors = 1;
962
963         if (q_vectors >= (rxr_remaining + txr_remaining)) {
964                 for (; rxr_remaining; v_idx++) {
965                         err = ixgbe_alloc_q_vector(adapter, q_vectors, v_idx,
966                                                    0, 0, 1, rxr_idx);
967
968                         if (err)
969                                 goto err_out;
970
971                         /* update counts and index */
972                         rxr_remaining--;
973                         rxr_idx++;
974                 }
975         }
976
977         for (; v_idx < q_vectors; v_idx++) {
978                 int rqpv = DIV_ROUND_UP(rxr_remaining, q_vectors - v_idx);
979                 int tqpv = DIV_ROUND_UP(txr_remaining, q_vectors - v_idx);
980                 err = ixgbe_alloc_q_vector(adapter, q_vectors, v_idx,
981                                            tqpv, txr_idx,
982                                            rqpv, rxr_idx);
983
984                 if (err)
985                         goto err_out;
986
987                 /* update counts and index */
988                 rxr_remaining -= rqpv;
989                 txr_remaining -= tqpv;
990                 rxr_idx++;
991                 txr_idx++;
992         }
993
994         return 0;
995
996 err_out:
997         adapter->num_tx_queues = 0;
998         adapter->num_rx_queues = 0;
999         adapter->num_q_vectors = 0;
1000
1001         while (v_idx--)
1002                 ixgbe_free_q_vector(adapter, v_idx);
1003
1004         return -ENOMEM;
1005 }
1006
1007 /**
1008  * ixgbe_free_q_vectors - Free memory allocated for interrupt vectors
1009  * @adapter: board private structure to initialize
1010  *
1011  * This function frees the memory allocated to the q_vectors.  In addition if
1012  * NAPI is enabled it will delete any references to the NAPI struct prior
1013  * to freeing the q_vector.
1014  **/
1015 static void ixgbe_free_q_vectors(struct ixgbe_adapter *adapter)
1016 {
1017         int v_idx = adapter->num_q_vectors;
1018
1019         adapter->num_tx_queues = 0;
1020         adapter->num_rx_queues = 0;
1021         adapter->num_q_vectors = 0;
1022
1023         while (v_idx--)
1024                 ixgbe_free_q_vector(adapter, v_idx);
1025 }
1026
1027 static void ixgbe_reset_interrupt_capability(struct ixgbe_adapter *adapter)
1028 {
1029         if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
1030                 adapter->flags &= ~IXGBE_FLAG_MSIX_ENABLED;
1031                 pci_disable_msix(adapter->pdev);
1032                 kfree(adapter->msix_entries);
1033                 adapter->msix_entries = NULL;
1034         } else if (adapter->flags & IXGBE_FLAG_MSI_ENABLED) {
1035                 adapter->flags &= ~IXGBE_FLAG_MSI_ENABLED;
1036                 pci_disable_msi(adapter->pdev);
1037         }
1038 }
1039
1040 /**
1041  * ixgbe_set_interrupt_capability - set MSI-X or MSI if supported
1042  * @adapter: board private structure to initialize
1043  *
1044  * Attempt to configure the interrupts using the best available
1045  * capabilities of the hardware and the kernel.
1046  **/
1047 static void ixgbe_set_interrupt_capability(struct ixgbe_adapter *adapter)
1048 {
1049         struct ixgbe_hw *hw = &adapter->hw;
1050         int vector, v_budget, err;
1051
1052         /*
1053          * It's easy to be greedy for MSI-X vectors, but it really
1054          * doesn't do us much good if we have a lot more vectors
1055          * than CPU's.  So let's be conservative and only ask for
1056          * (roughly) the same number of vectors as there are CPU's.
1057          * The default is to use pairs of vectors.
1058          */
1059         v_budget = max(adapter->num_rx_queues, adapter->num_tx_queues);
1060         v_budget = min_t(int, v_budget, num_online_cpus());
1061         v_budget += NON_Q_VECTORS;
1062
1063         /*
1064          * At the same time, hardware can only support a maximum of
1065          * hw.mac->max_msix_vectors vectors.  With features
1066          * such as RSS and VMDq, we can easily surpass the number of Rx and Tx
1067          * descriptor queues supported by our device.  Thus, we cap it off in
1068          * those rare cases where the cpu count also exceeds our vector limit.
1069          */
1070         v_budget = min_t(int, v_budget, hw->mac.max_msix_vectors);
1071
1072         /* A failure in MSI-X entry allocation isn't fatal, but it does
1073          * mean we disable MSI-X capabilities of the adapter. */
1074         adapter->msix_entries = kcalloc(v_budget,
1075                                         sizeof(struct msix_entry), GFP_KERNEL);
1076         if (adapter->msix_entries) {
1077                 for (vector = 0; vector < v_budget; vector++)
1078                         adapter->msix_entries[vector].entry = vector;
1079
1080                 ixgbe_acquire_msix_vectors(adapter, v_budget);
1081
1082                 if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
1083                         return;
1084         }
1085
1086         /* disable DCB if number of TCs exceeds 1 */
1087         if (netdev_get_num_tc(adapter->netdev) > 1) {
1088                 e_err(probe, "num TCs exceeds number of queues - disabling DCB\n");
1089                 netdev_reset_tc(adapter->netdev);
1090
1091                 if (adapter->hw.mac.type == ixgbe_mac_82598EB)
1092                         adapter->hw.fc.requested_mode = adapter->last_lfc_mode;
1093
1094                 adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;
1095                 adapter->temp_dcb_cfg.pfc_mode_enable = false;
1096                 adapter->dcb_cfg.pfc_mode_enable = false;
1097         }
1098         adapter->dcb_cfg.num_tcs.pg_tcs = 1;
1099         adapter->dcb_cfg.num_tcs.pfc_tcs = 1;
1100
1101         /* disable SR-IOV */
1102         ixgbe_disable_sriov(adapter);
1103
1104         /* disable RSS */
1105         adapter->ring_feature[RING_F_RSS].limit = 1;
1106
1107         ixgbe_set_num_queues(adapter);
1108         adapter->num_q_vectors = 1;
1109
1110         err = pci_enable_msi(adapter->pdev);
1111         if (err) {
1112                 netif_printk(adapter, hw, KERN_DEBUG, adapter->netdev,
1113                              "Unable to allocate MSI interrupt, "
1114                              "falling back to legacy.  Error: %d\n", err);
1115                 return;
1116         }
1117         adapter->flags |= IXGBE_FLAG_MSI_ENABLED;
1118 }
1119
1120 /**
1121  * ixgbe_init_interrupt_scheme - Determine proper interrupt scheme
1122  * @adapter: board private structure to initialize
1123  *
1124  * We determine which interrupt scheme to use based on...
1125  * - Kernel support (MSI, MSI-X)
1126  *   - which can be user-defined (via MODULE_PARAM)
1127  * - Hardware queue count (num_*_queues)
1128  *   - defined by miscellaneous hardware support/features (RSS, etc.)
1129  **/
1130 int ixgbe_init_interrupt_scheme(struct ixgbe_adapter *adapter)
1131 {
1132         int err;
1133
1134         /* Number of supported queues */
1135         ixgbe_set_num_queues(adapter);
1136
1137         /* Set interrupt mode */
1138         ixgbe_set_interrupt_capability(adapter);
1139
1140         err = ixgbe_alloc_q_vectors(adapter);
1141         if (err) {
1142                 e_dev_err("Unable to allocate memory for queue vectors\n");
1143                 goto err_alloc_q_vectors;
1144         }
1145
1146         ixgbe_cache_ring_register(adapter);
1147
1148         e_dev_info("Multiqueue %s: Rx Queue count = %u, Tx Queue count = %u\n",
1149                    (adapter->num_rx_queues > 1) ? "Enabled" : "Disabled",
1150                    adapter->num_rx_queues, adapter->num_tx_queues);
1151
1152         set_bit(__IXGBE_DOWN, &adapter->state);
1153
1154         return 0;
1155
1156 err_alloc_q_vectors:
1157         ixgbe_reset_interrupt_capability(adapter);
1158         return err;
1159 }
1160
1161 /**
1162  * ixgbe_clear_interrupt_scheme - Clear the current interrupt scheme settings
1163  * @adapter: board private structure to clear interrupt scheme on
1164  *
1165  * We go through and clear interrupt specific resources and reset the structure
1166  * to pre-load conditions
1167  **/
1168 void ixgbe_clear_interrupt_scheme(struct ixgbe_adapter *adapter)
1169 {
1170         adapter->num_tx_queues = 0;
1171         adapter->num_rx_queues = 0;
1172
1173         ixgbe_free_q_vectors(adapter);
1174         ixgbe_reset_interrupt_capability(adapter);
1175 }
1176
1177 void ixgbe_tx_ctxtdesc(struct ixgbe_ring *tx_ring, u32 vlan_macip_lens,
1178                        u32 fcoe_sof_eof, u32 type_tucmd, u32 mss_l4len_idx)
1179 {
1180         struct ixgbe_adv_tx_context_desc *context_desc;
1181         u16 i = tx_ring->next_to_use;
1182
1183         context_desc = IXGBE_TX_CTXTDESC(tx_ring, i);
1184
1185         i++;
1186         tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
1187
1188         /* set bits to identify this as an advanced context descriptor */
1189         type_tucmd |= IXGBE_TXD_CMD_DEXT | IXGBE_ADVTXD_DTYP_CTXT;
1190
1191         context_desc->vlan_macip_lens   = cpu_to_le32(vlan_macip_lens);
1192         context_desc->seqnum_seed       = cpu_to_le32(fcoe_sof_eof);
1193         context_desc->type_tucmd_mlhl   = cpu_to_le32(type_tucmd);
1194         context_desc->mss_l4len_idx     = cpu_to_le32(mss_l4len_idx);
1195 }
1196