00f9698e86ae6da1c4e1d2587dcf6b28795ca4d6
[firefly-linux-kernel-4.4.55.git] / drivers / net / ethernet / intel / ixgbevf / ixgbevf_main.c
1 /*******************************************************************************
2
3   Intel 82599 Virtual Function 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
29 /******************************************************************************
30  Copyright (c)2006 - 2007 Myricom, Inc. for some LRO specific code
31 ******************************************************************************/
32
33 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
34
35 #include <linux/types.h>
36 #include <linux/bitops.h>
37 #include <linux/module.h>
38 #include <linux/pci.h>
39 #include <linux/netdevice.h>
40 #include <linux/vmalloc.h>
41 #include <linux/string.h>
42 #include <linux/in.h>
43 #include <linux/ip.h>
44 #include <linux/tcp.h>
45 #include <linux/sctp.h>
46 #include <linux/ipv6.h>
47 #include <linux/slab.h>
48 #include <net/checksum.h>
49 #include <net/ip6_checksum.h>
50 #include <linux/ethtool.h>
51 #include <linux/if.h>
52 #include <linux/if_vlan.h>
53 #include <linux/prefetch.h>
54
55 #include "ixgbevf.h"
56
57 const char ixgbevf_driver_name[] = "ixgbevf";
58 static const char ixgbevf_driver_string[] =
59         "Intel(R) 10 Gigabit PCI Express Virtual Function Network Driver";
60
61 #define DRV_VERSION "2.7.12-k"
62 const char ixgbevf_driver_version[] = DRV_VERSION;
63 static char ixgbevf_copyright[] =
64         "Copyright (c) 2009 - 2012 Intel Corporation.";
65
66 static const struct ixgbevf_info *ixgbevf_info_tbl[] = {
67         [board_82599_vf] = &ixgbevf_82599_vf_info,
68         [board_X540_vf]  = &ixgbevf_X540_vf_info,
69 };
70
71 /* ixgbevf_pci_tbl - PCI Device ID Table
72  *
73  * Wildcard entries (PCI_ANY_ID) should come last
74  * Last entry must be all 0s
75  *
76  * { Vendor ID, Device ID, SubVendor ID, SubDevice ID,
77  *   Class, Class Mask, private data (not used) }
78  */
79 static struct pci_device_id ixgbevf_pci_tbl[] = {
80         {PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_VF),
81         board_82599_vf},
82         {PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X540_VF),
83         board_X540_vf},
84
85         /* required last entry */
86         {0, }
87 };
88 MODULE_DEVICE_TABLE(pci, ixgbevf_pci_tbl);
89
90 MODULE_AUTHOR("Intel Corporation, <linux.nics@intel.com>");
91 MODULE_DESCRIPTION("Intel(R) 82599 Virtual Function Driver");
92 MODULE_LICENSE("GPL");
93 MODULE_VERSION(DRV_VERSION);
94
95 #define DEFAULT_MSG_ENABLE (NETIF_MSG_DRV|NETIF_MSG_PROBE|NETIF_MSG_LINK)
96 static int debug = -1;
97 module_param(debug, int, 0);
98 MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)");
99
100 /* forward decls */
101 static void ixgbevf_set_itr(struct ixgbevf_q_vector *q_vector);
102 static void ixgbevf_free_all_rx_resources(struct ixgbevf_adapter *adapter);
103
104 static inline void ixgbevf_release_rx_desc(struct ixgbe_hw *hw,
105                                            struct ixgbevf_ring *rx_ring,
106                                            u32 val)
107 {
108         /*
109          * Force memory writes to complete before letting h/w
110          * know there are new descriptors to fetch.  (Only
111          * applicable for weak-ordered memory model archs,
112          * such as IA-64).
113          */
114         wmb();
115         IXGBE_WRITE_REG(hw, IXGBE_VFRDT(rx_ring->reg_idx), val);
116 }
117
118 /**
119  * ixgbevf_set_ivar - set IVAR registers - maps interrupt causes to vectors
120  * @adapter: pointer to adapter struct
121  * @direction: 0 for Rx, 1 for Tx, -1 for other causes
122  * @queue: queue to map the corresponding interrupt to
123  * @msix_vector: the vector to map to the corresponding queue
124  *
125  */
126 static void ixgbevf_set_ivar(struct ixgbevf_adapter *adapter, s8 direction,
127                              u8 queue, u8 msix_vector)
128 {
129         u32 ivar, index;
130         struct ixgbe_hw *hw = &adapter->hw;
131         if (direction == -1) {
132                 /* other causes */
133                 msix_vector |= IXGBE_IVAR_ALLOC_VAL;
134                 ivar = IXGBE_READ_REG(hw, IXGBE_VTIVAR_MISC);
135                 ivar &= ~0xFF;
136                 ivar |= msix_vector;
137                 IXGBE_WRITE_REG(hw, IXGBE_VTIVAR_MISC, ivar);
138         } else {
139                 /* tx or rx causes */
140                 msix_vector |= IXGBE_IVAR_ALLOC_VAL;
141                 index = ((16 * (queue & 1)) + (8 * direction));
142                 ivar = IXGBE_READ_REG(hw, IXGBE_VTIVAR(queue >> 1));
143                 ivar &= ~(0xFF << index);
144                 ivar |= (msix_vector << index);
145                 IXGBE_WRITE_REG(hw, IXGBE_VTIVAR(queue >> 1), ivar);
146         }
147 }
148
149 static void ixgbevf_unmap_and_free_tx_resource(struct ixgbevf_ring *tx_ring,
150                                                struct ixgbevf_tx_buffer
151                                                *tx_buffer_info)
152 {
153         if (tx_buffer_info->dma) {
154                 if (tx_buffer_info->mapped_as_page)
155                         dma_unmap_page(tx_ring->dev,
156                                        tx_buffer_info->dma,
157                                        tx_buffer_info->length,
158                                        DMA_TO_DEVICE);
159                 else
160                         dma_unmap_single(tx_ring->dev,
161                                          tx_buffer_info->dma,
162                                          tx_buffer_info->length,
163                                          DMA_TO_DEVICE);
164                 tx_buffer_info->dma = 0;
165         }
166         if (tx_buffer_info->skb) {
167                 dev_kfree_skb_any(tx_buffer_info->skb);
168                 tx_buffer_info->skb = NULL;
169         }
170         tx_buffer_info->time_stamp = 0;
171         /* tx_buffer_info must be completely set up in the transmit path */
172 }
173
174 #define IXGBE_MAX_TXD_PWR       14
175 #define IXGBE_MAX_DATA_PER_TXD  (1 << IXGBE_MAX_TXD_PWR)
176
177 /* Tx Descriptors needed, worst case */
178 #define TXD_USE_COUNT(S) DIV_ROUND_UP((S), IXGBE_MAX_DATA_PER_TXD)
179 #define DESC_NEEDED (MAX_SKB_FRAGS + 4)
180
181 static void ixgbevf_tx_timeout(struct net_device *netdev);
182
183 /**
184  * ixgbevf_clean_tx_irq - Reclaim resources after transmit completes
185  * @q_vector: board private structure
186  * @tx_ring: tx ring to clean
187  **/
188 static bool ixgbevf_clean_tx_irq(struct ixgbevf_q_vector *q_vector,
189                                  struct ixgbevf_ring *tx_ring)
190 {
191         struct ixgbevf_adapter *adapter = q_vector->adapter;
192         union ixgbe_adv_tx_desc *tx_desc, *eop_desc;
193         struct ixgbevf_tx_buffer *tx_buffer_info;
194         unsigned int i, eop, count = 0;
195         unsigned int total_bytes = 0, total_packets = 0;
196
197         if (test_bit(__IXGBEVF_DOWN, &adapter->state))
198                 return true;
199
200         i = tx_ring->next_to_clean;
201         eop = tx_ring->tx_buffer_info[i].next_to_watch;
202         eop_desc = IXGBEVF_TX_DESC(tx_ring, eop);
203
204         while ((eop_desc->wb.status & cpu_to_le32(IXGBE_TXD_STAT_DD)) &&
205                (count < tx_ring->count)) {
206                 bool cleaned = false;
207                 rmb(); /* read buffer_info after eop_desc */
208                 /* eop could change between read and DD-check */
209                 if (unlikely(eop != tx_ring->tx_buffer_info[i].next_to_watch))
210                         goto cont_loop;
211                 for ( ; !cleaned; count++) {
212                         struct sk_buff *skb;
213                         tx_desc = IXGBEVF_TX_DESC(tx_ring, i);
214                         tx_buffer_info = &tx_ring->tx_buffer_info[i];
215                         cleaned = (i == eop);
216                         skb = tx_buffer_info->skb;
217
218                         if (cleaned && skb) {
219                                 unsigned int segs, bytecount;
220
221                                 /* gso_segs is currently only valid for tcp */
222                                 segs = skb_shinfo(skb)->gso_segs ?: 1;
223                                 /* multiply data chunks by size of headers */
224                                 bytecount = ((segs - 1) * skb_headlen(skb)) +
225                                             skb->len;
226                                 total_packets += segs;
227                                 total_bytes += bytecount;
228                         }
229
230                         ixgbevf_unmap_and_free_tx_resource(tx_ring,
231                                                            tx_buffer_info);
232
233                         tx_desc->wb.status = 0;
234
235                         i++;
236                         if (i == tx_ring->count)
237                                 i = 0;
238                 }
239
240 cont_loop:
241                 eop = tx_ring->tx_buffer_info[i].next_to_watch;
242                 eop_desc = IXGBEVF_TX_DESC(tx_ring, eop);
243         }
244
245         tx_ring->next_to_clean = i;
246
247 #define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
248         if (unlikely(count && netif_carrier_ok(tx_ring->netdev) &&
249                      (IXGBE_DESC_UNUSED(tx_ring) >= TX_WAKE_THRESHOLD))) {
250                 /* Make sure that anybody stopping the queue after this
251                  * sees the new next_to_clean.
252                  */
253                 smp_mb();
254                 if (__netif_subqueue_stopped(tx_ring->netdev,
255                                              tx_ring->queue_index) &&
256                     !test_bit(__IXGBEVF_DOWN, &adapter->state)) {
257                         netif_wake_subqueue(tx_ring->netdev,
258                                             tx_ring->queue_index);
259                         ++adapter->restart_queue;
260                 }
261         }
262
263         u64_stats_update_begin(&tx_ring->syncp);
264         tx_ring->total_bytes += total_bytes;
265         tx_ring->total_packets += total_packets;
266         u64_stats_update_end(&tx_ring->syncp);
267         q_vector->tx.total_bytes += total_bytes;
268         q_vector->tx.total_packets += total_packets;
269
270         return count < tx_ring->count;
271 }
272
273 /**
274  * ixgbevf_receive_skb - Send a completed packet up the stack
275  * @q_vector: structure containing interrupt and ring information
276  * @skb: packet to send up
277  * @status: hardware indication of status of receive
278  * @rx_desc: rx descriptor
279  **/
280 static void ixgbevf_receive_skb(struct ixgbevf_q_vector *q_vector,
281                                 struct sk_buff *skb, u8 status,
282                                 union ixgbe_adv_rx_desc *rx_desc)
283 {
284         struct ixgbevf_adapter *adapter = q_vector->adapter;
285         bool is_vlan = (status & IXGBE_RXD_STAT_VP);
286         u16 tag = le16_to_cpu(rx_desc->wb.upper.vlan);
287
288         if (is_vlan && test_bit(tag & VLAN_VID_MASK, adapter->active_vlans))
289                 __vlan_hwaccel_put_tag(skb, tag);
290
291         if (!(adapter->flags & IXGBE_FLAG_IN_NETPOLL))
292                 napi_gro_receive(&q_vector->napi, skb);
293         else
294                 netif_rx(skb);
295 }
296
297 /**
298  * ixgbevf_rx_checksum - indicate in skb if hw indicated a good cksum
299  * @adapter: address of board private structure
300  * @status_err: hardware indication of status of receive
301  * @skb: skb currently being received and modified
302  **/
303 static inline void ixgbevf_rx_checksum(struct ixgbevf_adapter *adapter,
304                                        struct ixgbevf_ring *ring,
305                                        u32 status_err, struct sk_buff *skb)
306 {
307         skb_checksum_none_assert(skb);
308
309         /* Rx csum disabled */
310         if (!(ring->netdev->features & NETIF_F_RXCSUM))
311                 return;
312
313         /* if IP and error */
314         if ((status_err & IXGBE_RXD_STAT_IPCS) &&
315             (status_err & IXGBE_RXDADV_ERR_IPE)) {
316                 adapter->hw_csum_rx_error++;
317                 return;
318         }
319
320         if (!(status_err & IXGBE_RXD_STAT_L4CS))
321                 return;
322
323         if (status_err & IXGBE_RXDADV_ERR_TCPE) {
324                 adapter->hw_csum_rx_error++;
325                 return;
326         }
327
328         /* It must be a TCP or UDP packet with a valid checksum */
329         skb->ip_summed = CHECKSUM_UNNECESSARY;
330         adapter->hw_csum_rx_good++;
331 }
332
333 /**
334  * ixgbevf_alloc_rx_buffers - Replace used receive buffers; packet split
335  * @adapter: address of board private structure
336  **/
337 static void ixgbevf_alloc_rx_buffers(struct ixgbevf_adapter *adapter,
338                                      struct ixgbevf_ring *rx_ring,
339                                      int cleaned_count)
340 {
341         struct pci_dev *pdev = adapter->pdev;
342         union ixgbe_adv_rx_desc *rx_desc;
343         struct ixgbevf_rx_buffer *bi;
344         struct sk_buff *skb;
345         unsigned int i = rx_ring->next_to_use;
346
347         bi = &rx_ring->rx_buffer_info[i];
348
349         while (cleaned_count--) {
350                 rx_desc = IXGBEVF_RX_DESC(rx_ring, i);
351                 skb = bi->skb;
352                 if (!skb) {
353                         skb = netdev_alloc_skb_ip_align(rx_ring->netdev,
354                                                         rx_ring->rx_buf_len);
355                         if (!skb) {
356                                 adapter->alloc_rx_buff_failed++;
357                                 goto no_buffers;
358                         }
359                         bi->skb = skb;
360                 }
361                 if (!bi->dma) {
362                         bi->dma = dma_map_single(&pdev->dev, skb->data,
363                                                  rx_ring->rx_buf_len,
364                                                  DMA_FROM_DEVICE);
365                         if (dma_mapping_error(&pdev->dev, bi->dma)) {
366                                 dev_kfree_skb(skb);
367                                 bi->skb = NULL;
368                                 dev_err(&pdev->dev, "RX DMA map failed\n");
369                                 break;
370                         }
371                 }
372                 rx_desc->read.pkt_addr = cpu_to_le64(bi->dma);
373
374                 i++;
375                 if (i == rx_ring->count)
376                         i = 0;
377                 bi = &rx_ring->rx_buffer_info[i];
378         }
379
380 no_buffers:
381         if (rx_ring->next_to_use != i) {
382                 rx_ring->next_to_use = i;
383
384                 ixgbevf_release_rx_desc(&adapter->hw, rx_ring, i);
385         }
386 }
387
388 static inline void ixgbevf_irq_enable_queues(struct ixgbevf_adapter *adapter,
389                                              u32 qmask)
390 {
391         struct ixgbe_hw *hw = &adapter->hw;
392
393         IXGBE_WRITE_REG(hw, IXGBE_VTEIMS, qmask);
394 }
395
396 static bool ixgbevf_clean_rx_irq(struct ixgbevf_q_vector *q_vector,
397                                  struct ixgbevf_ring *rx_ring,
398                                  int budget)
399 {
400         struct ixgbevf_adapter *adapter = q_vector->adapter;
401         struct pci_dev *pdev = adapter->pdev;
402         union ixgbe_adv_rx_desc *rx_desc, *next_rxd;
403         struct ixgbevf_rx_buffer *rx_buffer_info, *next_buffer;
404         struct sk_buff *skb;
405         unsigned int i;
406         u32 len, staterr;
407         int cleaned_count = 0;
408         unsigned int total_rx_bytes = 0, total_rx_packets = 0;
409
410         i = rx_ring->next_to_clean;
411         rx_desc = IXGBEVF_RX_DESC(rx_ring, i);
412         staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
413         rx_buffer_info = &rx_ring->rx_buffer_info[i];
414
415         while (staterr & IXGBE_RXD_STAT_DD) {
416                 if (!budget)
417                         break;
418                 budget--;
419
420                 rmb(); /* read descriptor and rx_buffer_info after status DD */
421                 len = le16_to_cpu(rx_desc->wb.upper.length);
422                 skb = rx_buffer_info->skb;
423                 prefetch(skb->data - NET_IP_ALIGN);
424                 rx_buffer_info->skb = NULL;
425
426                 if (rx_buffer_info->dma) {
427                         dma_unmap_single(&pdev->dev, rx_buffer_info->dma,
428                                          rx_ring->rx_buf_len,
429                                          DMA_FROM_DEVICE);
430                         rx_buffer_info->dma = 0;
431                         skb_put(skb, len);
432                 }
433
434                 i++;
435                 if (i == rx_ring->count)
436                         i = 0;
437
438                 next_rxd = IXGBEVF_RX_DESC(rx_ring, i);
439                 prefetch(next_rxd);
440                 cleaned_count++;
441
442                 next_buffer = &rx_ring->rx_buffer_info[i];
443
444                 if (!(staterr & IXGBE_RXD_STAT_EOP)) {
445                         skb->next = next_buffer->skb;
446                         IXGBE_CB(skb->next)->prev = skb;
447                         adapter->non_eop_descs++;
448                         goto next_desc;
449                 }
450
451                 /* we should not be chaining buffers, if we did drop the skb */
452                 if (IXGBE_CB(skb)->prev) {
453                         do {
454                                 struct sk_buff *this = skb;
455                                 skb = IXGBE_CB(skb)->prev;
456                                 dev_kfree_skb(this);
457                         } while (skb);
458                         goto next_desc;
459                 }
460
461                 /* ERR_MASK will only have valid bits if EOP set */
462                 if (unlikely(staterr & IXGBE_RXDADV_ERR_FRAME_ERR_MASK)) {
463                         dev_kfree_skb_irq(skb);
464                         goto next_desc;
465                 }
466
467                 ixgbevf_rx_checksum(adapter, rx_ring, staterr, skb);
468
469                 /* probably a little skewed due to removing CRC */
470                 total_rx_bytes += skb->len;
471                 total_rx_packets++;
472
473                 /*
474                  * Work around issue of some types of VM to VM loop back
475                  * packets not getting split correctly
476                  */
477                 if (staterr & IXGBE_RXD_STAT_LB) {
478                         u32 header_fixup_len = skb_headlen(skb);
479                         if (header_fixup_len < 14)
480                                 skb_push(skb, header_fixup_len);
481                 }
482                 skb->protocol = eth_type_trans(skb, rx_ring->netdev);
483
484                 /* Workaround hardware that can't do proper VEPA multicast
485                  * source pruning.
486                  */
487                 if ((skb->pkt_type & (PACKET_BROADCAST | PACKET_MULTICAST)) &&
488                     !(compare_ether_addr(adapter->netdev->dev_addr,
489                                         eth_hdr(skb)->h_source))) {
490                         dev_kfree_skb_irq(skb);
491                         goto next_desc;
492                 }
493
494                 ixgbevf_receive_skb(q_vector, skb, staterr, rx_desc);
495
496 next_desc:
497                 rx_desc->wb.upper.status_error = 0;
498
499                 /* return some buffers to hardware, one at a time is too slow */
500                 if (cleaned_count >= IXGBEVF_RX_BUFFER_WRITE) {
501                         ixgbevf_alloc_rx_buffers(adapter, rx_ring,
502                                                  cleaned_count);
503                         cleaned_count = 0;
504                 }
505
506                 /* use prefetched values */
507                 rx_desc = next_rxd;
508                 rx_buffer_info = &rx_ring->rx_buffer_info[i];
509
510                 staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
511         }
512
513         rx_ring->next_to_clean = i;
514         cleaned_count = IXGBE_DESC_UNUSED(rx_ring);
515
516         if (cleaned_count)
517                 ixgbevf_alloc_rx_buffers(adapter, rx_ring, cleaned_count);
518
519         u64_stats_update_begin(&rx_ring->syncp);
520         rx_ring->total_packets += total_rx_packets;
521         rx_ring->total_bytes += total_rx_bytes;
522         u64_stats_update_end(&rx_ring->syncp);
523         q_vector->rx.total_packets += total_rx_packets;
524         q_vector->rx.total_bytes += total_rx_bytes;
525
526         return !!budget;
527 }
528
529 /**
530  * ixgbevf_poll - NAPI polling calback
531  * @napi: napi struct with our devices info in it
532  * @budget: amount of work driver is allowed to do this pass, in packets
533  *
534  * This function will clean more than one or more rings associated with a
535  * q_vector.
536  **/
537 static int ixgbevf_poll(struct napi_struct *napi, int budget)
538 {
539         struct ixgbevf_q_vector *q_vector =
540                 container_of(napi, struct ixgbevf_q_vector, napi);
541         struct ixgbevf_adapter *adapter = q_vector->adapter;
542         struct ixgbevf_ring *ring;
543         int per_ring_budget;
544         bool clean_complete = true;
545
546         ixgbevf_for_each_ring(ring, q_vector->tx)
547                 clean_complete &= ixgbevf_clean_tx_irq(q_vector, ring);
548
549         /* attempt to distribute budget to each queue fairly, but don't allow
550          * the budget to go below 1 because we'll exit polling */
551         if (q_vector->rx.count > 1)
552                 per_ring_budget = max(budget/q_vector->rx.count, 1);
553         else
554                 per_ring_budget = budget;
555
556         adapter->flags |= IXGBE_FLAG_IN_NETPOLL;
557         ixgbevf_for_each_ring(ring, q_vector->rx)
558                 clean_complete &= ixgbevf_clean_rx_irq(q_vector, ring,
559                                                        per_ring_budget);
560         adapter->flags &= ~IXGBE_FLAG_IN_NETPOLL;
561
562         /* If all work not completed, return budget and keep polling */
563         if (!clean_complete)
564                 return budget;
565         /* all work done, exit the polling mode */
566         napi_complete(napi);
567         if (adapter->rx_itr_setting & 1)
568                 ixgbevf_set_itr(q_vector);
569         if (!test_bit(__IXGBEVF_DOWN, &adapter->state))
570                 ixgbevf_irq_enable_queues(adapter,
571                                           1 << q_vector->v_idx);
572
573         return 0;
574 }
575
576 /**
577  * ixgbevf_write_eitr - write VTEITR register in hardware specific way
578  * @q_vector: structure containing interrupt and ring information
579  */
580 static void ixgbevf_write_eitr(struct ixgbevf_q_vector *q_vector)
581 {
582         struct ixgbevf_adapter *adapter = q_vector->adapter;
583         struct ixgbe_hw *hw = &adapter->hw;
584         int v_idx = q_vector->v_idx;
585         u32 itr_reg = q_vector->itr & IXGBE_MAX_EITR;
586
587         /*
588          * set the WDIS bit to not clear the timer bits and cause an
589          * immediate assertion of the interrupt
590          */
591         itr_reg |= IXGBE_EITR_CNT_WDIS;
592
593         IXGBE_WRITE_REG(hw, IXGBE_VTEITR(v_idx), itr_reg);
594 }
595
596 /**
597  * ixgbevf_configure_msix - Configure MSI-X hardware
598  * @adapter: board private structure
599  *
600  * ixgbevf_configure_msix sets up the hardware to properly generate MSI-X
601  * interrupts.
602  **/
603 static void ixgbevf_configure_msix(struct ixgbevf_adapter *adapter)
604 {
605         struct ixgbevf_q_vector *q_vector;
606         int q_vectors, v_idx;
607
608         q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
609         adapter->eims_enable_mask = 0;
610
611         /*
612          * Populate the IVAR table and set the ITR values to the
613          * corresponding register.
614          */
615         for (v_idx = 0; v_idx < q_vectors; v_idx++) {
616                 struct ixgbevf_ring *ring;
617                 q_vector = adapter->q_vector[v_idx];
618
619                 ixgbevf_for_each_ring(ring, q_vector->rx)
620                         ixgbevf_set_ivar(adapter, 0, ring->reg_idx, v_idx);
621
622                 ixgbevf_for_each_ring(ring, q_vector->tx)
623                         ixgbevf_set_ivar(adapter, 1, ring->reg_idx, v_idx);
624
625                 if (q_vector->tx.ring && !q_vector->rx.ring) {
626                         /* tx only vector */
627                         if (adapter->tx_itr_setting == 1)
628                                 q_vector->itr = IXGBE_10K_ITR;
629                         else
630                                 q_vector->itr = adapter->tx_itr_setting;
631                 } else {
632                         /* rx or rx/tx vector */
633                         if (adapter->rx_itr_setting == 1)
634                                 q_vector->itr = IXGBE_20K_ITR;
635                         else
636                                 q_vector->itr = adapter->rx_itr_setting;
637                 }
638
639                 /* add q_vector eims value to global eims_enable_mask */
640                 adapter->eims_enable_mask |= 1 << v_idx;
641
642                 ixgbevf_write_eitr(q_vector);
643         }
644
645         ixgbevf_set_ivar(adapter, -1, 1, v_idx);
646         /* setup eims_other and add value to global eims_enable_mask */
647         adapter->eims_other = 1 << v_idx;
648         adapter->eims_enable_mask |= adapter->eims_other;
649 }
650
651 enum latency_range {
652         lowest_latency = 0,
653         low_latency = 1,
654         bulk_latency = 2,
655         latency_invalid = 255
656 };
657
658 /**
659  * ixgbevf_update_itr - update the dynamic ITR value based on statistics
660  * @q_vector: structure containing interrupt and ring information
661  * @ring_container: structure containing ring performance data
662  *
663  *      Stores a new ITR value based on packets and byte
664  *      counts during the last interrupt.  The advantage of per interrupt
665  *      computation is faster updates and more accurate ITR for the current
666  *      traffic pattern.  Constants in this function were computed
667  *      based on theoretical maximum wire speed and thresholds were set based
668  *      on testing data as well as attempting to minimize response time
669  *      while increasing bulk throughput.
670  **/
671 static void ixgbevf_update_itr(struct ixgbevf_q_vector *q_vector,
672                                struct ixgbevf_ring_container *ring_container)
673 {
674         int bytes = ring_container->total_bytes;
675         int packets = ring_container->total_packets;
676         u32 timepassed_us;
677         u64 bytes_perint;
678         u8 itr_setting = ring_container->itr;
679
680         if (packets == 0)
681                 return;
682
683         /* simple throttlerate management
684          *    0-20MB/s lowest (100000 ints/s)
685          *   20-100MB/s low   (20000 ints/s)
686          *  100-1249MB/s bulk (8000 ints/s)
687          */
688         /* what was last interrupt timeslice? */
689         timepassed_us = q_vector->itr >> 2;
690         bytes_perint = bytes / timepassed_us; /* bytes/usec */
691
692         switch (itr_setting) {
693         case lowest_latency:
694                 if (bytes_perint > 10)
695                         itr_setting = low_latency;
696                 break;
697         case low_latency:
698                 if (bytes_perint > 20)
699                         itr_setting = bulk_latency;
700                 else if (bytes_perint <= 10)
701                         itr_setting = lowest_latency;
702                 break;
703         case bulk_latency:
704                 if (bytes_perint <= 20)
705                         itr_setting = low_latency;
706                 break;
707         }
708
709         /* clear work counters since we have the values we need */
710         ring_container->total_bytes = 0;
711         ring_container->total_packets = 0;
712
713         /* write updated itr to ring container */
714         ring_container->itr = itr_setting;
715 }
716
717 static void ixgbevf_set_itr(struct ixgbevf_q_vector *q_vector)
718 {
719         u32 new_itr = q_vector->itr;
720         u8 current_itr;
721
722         ixgbevf_update_itr(q_vector, &q_vector->tx);
723         ixgbevf_update_itr(q_vector, &q_vector->rx);
724
725         current_itr = max(q_vector->rx.itr, q_vector->tx.itr);
726
727         switch (current_itr) {
728         /* counts and packets in update_itr are dependent on these numbers */
729         case lowest_latency:
730                 new_itr = IXGBE_100K_ITR;
731                 break;
732         case low_latency:
733                 new_itr = IXGBE_20K_ITR;
734                 break;
735         case bulk_latency:
736         default:
737                 new_itr = IXGBE_8K_ITR;
738                 break;
739         }
740
741         if (new_itr != q_vector->itr) {
742                 /* do an exponential smoothing */
743                 new_itr = (10 * new_itr * q_vector->itr) /
744                           ((9 * new_itr) + q_vector->itr);
745
746                 /* save the algorithm value here */
747                 q_vector->itr = new_itr;
748
749                 ixgbevf_write_eitr(q_vector);
750         }
751 }
752
753 static irqreturn_t ixgbevf_msix_other(int irq, void *data)
754 {
755         struct ixgbevf_adapter *adapter = data;
756         struct ixgbe_hw *hw = &adapter->hw;
757
758         hw->mac.get_link_status = 1;
759
760         if (!test_bit(__IXGBEVF_DOWN, &adapter->state))
761                 mod_timer(&adapter->watchdog_timer, jiffies);
762
763         IXGBE_WRITE_REG(hw, IXGBE_VTEIMS, adapter->eims_other);
764
765         return IRQ_HANDLED;
766 }
767
768
769 /**
770  * ixgbevf_msix_clean_rings - single unshared vector rx clean (all queues)
771  * @irq: unused
772  * @data: pointer to our q_vector struct for this interrupt vector
773  **/
774 static irqreturn_t ixgbevf_msix_clean_rings(int irq, void *data)
775 {
776         struct ixgbevf_q_vector *q_vector = data;
777
778         /* EIAM disabled interrupts (on this vector) for us */
779         if (q_vector->rx.ring || q_vector->tx.ring)
780                 napi_schedule(&q_vector->napi);
781
782         return IRQ_HANDLED;
783 }
784
785 static inline void map_vector_to_rxq(struct ixgbevf_adapter *a, int v_idx,
786                                      int r_idx)
787 {
788         struct ixgbevf_q_vector *q_vector = a->q_vector[v_idx];
789
790         a->rx_ring[r_idx].next = q_vector->rx.ring;
791         q_vector->rx.ring = &a->rx_ring[r_idx];
792         q_vector->rx.count++;
793 }
794
795 static inline void map_vector_to_txq(struct ixgbevf_adapter *a, int v_idx,
796                                      int t_idx)
797 {
798         struct ixgbevf_q_vector *q_vector = a->q_vector[v_idx];
799
800         a->tx_ring[t_idx].next = q_vector->tx.ring;
801         q_vector->tx.ring = &a->tx_ring[t_idx];
802         q_vector->tx.count++;
803 }
804
805 /**
806  * ixgbevf_map_rings_to_vectors - Maps descriptor rings to vectors
807  * @adapter: board private structure to initialize
808  *
809  * This function maps descriptor rings to the queue-specific vectors
810  * we were allotted through the MSI-X enabling code.  Ideally, we'd have
811  * one vector per ring/queue, but on a constrained vector budget, we
812  * group the rings as "efficiently" as possible.  You would add new
813  * mapping configurations in here.
814  **/
815 static int ixgbevf_map_rings_to_vectors(struct ixgbevf_adapter *adapter)
816 {
817         int q_vectors;
818         int v_start = 0;
819         int rxr_idx = 0, txr_idx = 0;
820         int rxr_remaining = adapter->num_rx_queues;
821         int txr_remaining = adapter->num_tx_queues;
822         int i, j;
823         int rqpv, tqpv;
824         int err = 0;
825
826         q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
827
828         /*
829          * The ideal configuration...
830          * We have enough vectors to map one per queue.
831          */
832         if (q_vectors == adapter->num_rx_queues + adapter->num_tx_queues) {
833                 for (; rxr_idx < rxr_remaining; v_start++, rxr_idx++)
834                         map_vector_to_rxq(adapter, v_start, rxr_idx);
835
836                 for (; txr_idx < txr_remaining; v_start++, txr_idx++)
837                         map_vector_to_txq(adapter, v_start, txr_idx);
838                 goto out;
839         }
840
841         /*
842          * If we don't have enough vectors for a 1-to-1
843          * mapping, we'll have to group them so there are
844          * multiple queues per vector.
845          */
846         /* Re-adjusting *qpv takes care of the remainder. */
847         for (i = v_start; i < q_vectors; i++) {
848                 rqpv = DIV_ROUND_UP(rxr_remaining, q_vectors - i);
849                 for (j = 0; j < rqpv; j++) {
850                         map_vector_to_rxq(adapter, i, rxr_idx);
851                         rxr_idx++;
852                         rxr_remaining--;
853                 }
854         }
855         for (i = v_start; i < q_vectors; i++) {
856                 tqpv = DIV_ROUND_UP(txr_remaining, q_vectors - i);
857                 for (j = 0; j < tqpv; j++) {
858                         map_vector_to_txq(adapter, i, txr_idx);
859                         txr_idx++;
860                         txr_remaining--;
861                 }
862         }
863
864 out:
865         return err;
866 }
867
868 /**
869  * ixgbevf_request_msix_irqs - Initialize MSI-X interrupts
870  * @adapter: board private structure
871  *
872  * ixgbevf_request_msix_irqs allocates MSI-X vectors and requests
873  * interrupts from the kernel.
874  **/
875 static int ixgbevf_request_msix_irqs(struct ixgbevf_adapter *adapter)
876 {
877         struct net_device *netdev = adapter->netdev;
878         int q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
879         int vector, err;
880         int ri = 0, ti = 0;
881
882         for (vector = 0; vector < q_vectors; vector++) {
883                 struct ixgbevf_q_vector *q_vector = adapter->q_vector[vector];
884                 struct msix_entry *entry = &adapter->msix_entries[vector];
885
886                 if (q_vector->tx.ring && q_vector->rx.ring) {
887                         snprintf(q_vector->name, sizeof(q_vector->name) - 1,
888                                  "%s-%s-%d", netdev->name, "TxRx", ri++);
889                         ti++;
890                 } else if (q_vector->rx.ring) {
891                         snprintf(q_vector->name, sizeof(q_vector->name) - 1,
892                                  "%s-%s-%d", netdev->name, "rx", ri++);
893                 } else if (q_vector->tx.ring) {
894                         snprintf(q_vector->name, sizeof(q_vector->name) - 1,
895                                  "%s-%s-%d", netdev->name, "tx", ti++);
896                 } else {
897                         /* skip this unused q_vector */
898                         continue;
899                 }
900                 err = request_irq(entry->vector, &ixgbevf_msix_clean_rings, 0,
901                                   q_vector->name, q_vector);
902                 if (err) {
903                         hw_dbg(&adapter->hw,
904                                "request_irq failed for MSIX interrupt "
905                                "Error: %d\n", err);
906                         goto free_queue_irqs;
907                 }
908         }
909
910         err = request_irq(adapter->msix_entries[vector].vector,
911                           &ixgbevf_msix_other, 0, netdev->name, adapter);
912         if (err) {
913                 hw_dbg(&adapter->hw,
914                        "request_irq for msix_other failed: %d\n", err);
915                 goto free_queue_irqs;
916         }
917
918         return 0;
919
920 free_queue_irqs:
921         while (vector) {
922                 vector--;
923                 free_irq(adapter->msix_entries[vector].vector,
924                          adapter->q_vector[vector]);
925         }
926         pci_disable_msix(adapter->pdev);
927         kfree(adapter->msix_entries);
928         adapter->msix_entries = NULL;
929         return err;
930 }
931
932 static inline void ixgbevf_reset_q_vectors(struct ixgbevf_adapter *adapter)
933 {
934         int i, q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
935
936         for (i = 0; i < q_vectors; i++) {
937                 struct ixgbevf_q_vector *q_vector = adapter->q_vector[i];
938                 q_vector->rx.ring = NULL;
939                 q_vector->tx.ring = NULL;
940                 q_vector->rx.count = 0;
941                 q_vector->tx.count = 0;
942         }
943 }
944
945 /**
946  * ixgbevf_request_irq - initialize interrupts
947  * @adapter: board private structure
948  *
949  * Attempts to configure interrupts using the best available
950  * capabilities of the hardware and kernel.
951  **/
952 static int ixgbevf_request_irq(struct ixgbevf_adapter *adapter)
953 {
954         int err = 0;
955
956         err = ixgbevf_request_msix_irqs(adapter);
957
958         if (err)
959                 hw_dbg(&adapter->hw,
960                        "request_irq failed, Error %d\n", err);
961
962         return err;
963 }
964
965 static void ixgbevf_free_irq(struct ixgbevf_adapter *adapter)
966 {
967         int i, q_vectors;
968
969         q_vectors = adapter->num_msix_vectors;
970         i = q_vectors - 1;
971
972         free_irq(adapter->msix_entries[i].vector, adapter);
973         i--;
974
975         for (; i >= 0; i--) {
976                 /* free only the irqs that were actually requested */
977                 if (!adapter->q_vector[i]->rx.ring &&
978                     !adapter->q_vector[i]->tx.ring)
979                         continue;
980
981                 free_irq(adapter->msix_entries[i].vector,
982                          adapter->q_vector[i]);
983         }
984
985         ixgbevf_reset_q_vectors(adapter);
986 }
987
988 /**
989  * ixgbevf_irq_disable - Mask off interrupt generation on the NIC
990  * @adapter: board private structure
991  **/
992 static inline void ixgbevf_irq_disable(struct ixgbevf_adapter *adapter)
993 {
994         struct ixgbe_hw *hw = &adapter->hw;
995         int i;
996
997         IXGBE_WRITE_REG(hw, IXGBE_VTEIAM, 0);
998         IXGBE_WRITE_REG(hw, IXGBE_VTEIMC, ~0);
999         IXGBE_WRITE_REG(hw, IXGBE_VTEIAC, 0);
1000
1001         IXGBE_WRITE_FLUSH(hw);
1002
1003         for (i = 0; i < adapter->num_msix_vectors; i++)
1004                 synchronize_irq(adapter->msix_entries[i].vector);
1005 }
1006
1007 /**
1008  * ixgbevf_irq_enable - Enable default interrupt generation settings
1009  * @adapter: board private structure
1010  **/
1011 static inline void ixgbevf_irq_enable(struct ixgbevf_adapter *adapter)
1012 {
1013         struct ixgbe_hw *hw = &adapter->hw;
1014
1015         IXGBE_WRITE_REG(hw, IXGBE_VTEIAM, adapter->eims_enable_mask);
1016         IXGBE_WRITE_REG(hw, IXGBE_VTEIAC, adapter->eims_enable_mask);
1017         IXGBE_WRITE_REG(hw, IXGBE_VTEIMS, adapter->eims_enable_mask);
1018 }
1019
1020 /**
1021  * ixgbevf_configure_tx - Configure 82599 VF Transmit Unit after Reset
1022  * @adapter: board private structure
1023  *
1024  * Configure the Tx unit of the MAC after a reset.
1025  **/
1026 static void ixgbevf_configure_tx(struct ixgbevf_adapter *adapter)
1027 {
1028         u64 tdba;
1029         struct ixgbe_hw *hw = &adapter->hw;
1030         u32 i, j, tdlen, txctrl;
1031
1032         /* Setup the HW Tx Head and Tail descriptor pointers */
1033         for (i = 0; i < adapter->num_tx_queues; i++) {
1034                 struct ixgbevf_ring *ring = &adapter->tx_ring[i];
1035                 j = ring->reg_idx;
1036                 tdba = ring->dma;
1037                 tdlen = ring->count * sizeof(union ixgbe_adv_tx_desc);
1038                 IXGBE_WRITE_REG(hw, IXGBE_VFTDBAL(j),
1039                                 (tdba & DMA_BIT_MASK(32)));
1040                 IXGBE_WRITE_REG(hw, IXGBE_VFTDBAH(j), (tdba >> 32));
1041                 IXGBE_WRITE_REG(hw, IXGBE_VFTDLEN(j), tdlen);
1042                 IXGBE_WRITE_REG(hw, IXGBE_VFTDH(j), 0);
1043                 IXGBE_WRITE_REG(hw, IXGBE_VFTDT(j), 0);
1044                 adapter->tx_ring[i].head = IXGBE_VFTDH(j);
1045                 adapter->tx_ring[i].tail = IXGBE_VFTDT(j);
1046                 /* Disable Tx Head Writeback RO bit, since this hoses
1047                  * bookkeeping if things aren't delivered in order.
1048                  */
1049                 txctrl = IXGBE_READ_REG(hw, IXGBE_VFDCA_TXCTRL(j));
1050                 txctrl &= ~IXGBE_DCA_TXCTRL_TX_WB_RO_EN;
1051                 IXGBE_WRITE_REG(hw, IXGBE_VFDCA_TXCTRL(j), txctrl);
1052         }
1053 }
1054
1055 #define IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT 2
1056
1057 static void ixgbevf_configure_srrctl(struct ixgbevf_adapter *adapter, int index)
1058 {
1059         struct ixgbevf_ring *rx_ring;
1060         struct ixgbe_hw *hw = &adapter->hw;
1061         u32 srrctl;
1062
1063         rx_ring = &adapter->rx_ring[index];
1064
1065         srrctl = IXGBE_SRRCTL_DROP_EN;
1066
1067         srrctl |= IXGBE_SRRCTL_DESCTYPE_ADV_ONEBUF;
1068
1069         srrctl |= ALIGN(rx_ring->rx_buf_len, 1024) >>
1070                   IXGBE_SRRCTL_BSIZEPKT_SHIFT;
1071
1072         IXGBE_WRITE_REG(hw, IXGBE_VFSRRCTL(index), srrctl);
1073 }
1074
1075 static void ixgbevf_set_rx_buffer_len(struct ixgbevf_adapter *adapter)
1076 {
1077         struct ixgbe_hw *hw = &adapter->hw;
1078         struct net_device *netdev = adapter->netdev;
1079         int max_frame = netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
1080         int i;
1081         u16 rx_buf_len;
1082
1083         /* notify the PF of our intent to use this size of frame */
1084         ixgbevf_rlpml_set_vf(hw, max_frame);
1085
1086         /* PF will allow an extra 4 bytes past for vlan tagged frames */
1087         max_frame += VLAN_HLEN;
1088
1089         /*
1090          * Make best use of allocation by using all but 1K of a
1091          * power of 2 allocation that will be used for skb->head.
1092          */
1093         if ((hw->mac.type == ixgbe_mac_X540_vf) &&
1094             (max_frame <= MAXIMUM_ETHERNET_VLAN_SIZE))
1095                 rx_buf_len = MAXIMUM_ETHERNET_VLAN_SIZE;
1096         else if (max_frame <= IXGBEVF_RXBUFFER_3K)
1097                 rx_buf_len = IXGBEVF_RXBUFFER_3K;
1098         else if (max_frame <= IXGBEVF_RXBUFFER_7K)
1099                 rx_buf_len = IXGBEVF_RXBUFFER_7K;
1100         else if (max_frame <= IXGBEVF_RXBUFFER_15K)
1101                 rx_buf_len = IXGBEVF_RXBUFFER_15K;
1102         else
1103                 rx_buf_len = IXGBEVF_MAX_RXBUFFER;
1104
1105         for (i = 0; i < adapter->num_rx_queues; i++)
1106                 adapter->rx_ring[i].rx_buf_len = rx_buf_len;
1107 }
1108
1109 /**
1110  * ixgbevf_configure_rx - Configure 82599 VF Receive Unit after Reset
1111  * @adapter: board private structure
1112  *
1113  * Configure the Rx unit of the MAC after a reset.
1114  **/
1115 static void ixgbevf_configure_rx(struct ixgbevf_adapter *adapter)
1116 {
1117         u64 rdba;
1118         struct ixgbe_hw *hw = &adapter->hw;
1119         int i, j;
1120         u32 rdlen;
1121
1122         /* PSRTYPE must be initialized in 82599 */
1123         IXGBE_WRITE_REG(hw, IXGBE_VFPSRTYPE, 0);
1124
1125         /* set_rx_buffer_len must be called before ring initialization */
1126         ixgbevf_set_rx_buffer_len(adapter);
1127
1128         rdlen = adapter->rx_ring[0].count * sizeof(union ixgbe_adv_rx_desc);
1129         /* Setup the HW Rx Head and Tail Descriptor Pointers and
1130          * the Base and Length of the Rx Descriptor Ring */
1131         for (i = 0; i < adapter->num_rx_queues; i++) {
1132                 rdba = adapter->rx_ring[i].dma;
1133                 j = adapter->rx_ring[i].reg_idx;
1134                 IXGBE_WRITE_REG(hw, IXGBE_VFRDBAL(j),
1135                                 (rdba & DMA_BIT_MASK(32)));
1136                 IXGBE_WRITE_REG(hw, IXGBE_VFRDBAH(j), (rdba >> 32));
1137                 IXGBE_WRITE_REG(hw, IXGBE_VFRDLEN(j), rdlen);
1138                 IXGBE_WRITE_REG(hw, IXGBE_VFRDH(j), 0);
1139                 IXGBE_WRITE_REG(hw, IXGBE_VFRDT(j), 0);
1140                 adapter->rx_ring[i].head = IXGBE_VFRDH(j);
1141                 adapter->rx_ring[i].tail = IXGBE_VFRDT(j);
1142
1143                 ixgbevf_configure_srrctl(adapter, j);
1144         }
1145 }
1146
1147 static int ixgbevf_vlan_rx_add_vid(struct net_device *netdev, u16 vid)
1148 {
1149         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
1150         struct ixgbe_hw *hw = &adapter->hw;
1151         int err;
1152
1153         if (!hw->mac.ops.set_vfta)
1154                 return -EOPNOTSUPP;
1155
1156         spin_lock_bh(&adapter->mbx_lock);
1157
1158         /* add VID to filter table */
1159         err = hw->mac.ops.set_vfta(hw, vid, 0, true);
1160
1161         spin_unlock_bh(&adapter->mbx_lock);
1162
1163         /* translate error return types so error makes sense */
1164         if (err == IXGBE_ERR_MBX)
1165                 return -EIO;
1166
1167         if (err == IXGBE_ERR_INVALID_ARGUMENT)
1168                 return -EACCES;
1169
1170         set_bit(vid, adapter->active_vlans);
1171
1172         return err;
1173 }
1174
1175 static int ixgbevf_vlan_rx_kill_vid(struct net_device *netdev, u16 vid)
1176 {
1177         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
1178         struct ixgbe_hw *hw = &adapter->hw;
1179         int err = -EOPNOTSUPP;
1180
1181         spin_lock_bh(&adapter->mbx_lock);
1182
1183         /* remove VID from filter table */
1184         if (hw->mac.ops.set_vfta)
1185                 err = hw->mac.ops.set_vfta(hw, vid, 0, false);
1186
1187         spin_unlock_bh(&adapter->mbx_lock);
1188
1189         clear_bit(vid, adapter->active_vlans);
1190
1191         return err;
1192 }
1193
1194 static void ixgbevf_restore_vlan(struct ixgbevf_adapter *adapter)
1195 {
1196         u16 vid;
1197
1198         for_each_set_bit(vid, adapter->active_vlans, VLAN_N_VID)
1199                 ixgbevf_vlan_rx_add_vid(adapter->netdev, vid);
1200 }
1201
1202 static int ixgbevf_write_uc_addr_list(struct net_device *netdev)
1203 {
1204         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
1205         struct ixgbe_hw *hw = &adapter->hw;
1206         int count = 0;
1207
1208         if ((netdev_uc_count(netdev)) > 10) {
1209                 pr_err("Too many unicast filters - No Space\n");
1210                 return -ENOSPC;
1211         }
1212
1213         if (!netdev_uc_empty(netdev)) {
1214                 struct netdev_hw_addr *ha;
1215                 netdev_for_each_uc_addr(ha, netdev) {
1216                         hw->mac.ops.set_uc_addr(hw, ++count, ha->addr);
1217                         udelay(200);
1218                 }
1219         } else {
1220                 /*
1221                  * If the list is empty then send message to PF driver to
1222                  * clear all macvlans on this VF.
1223                  */
1224                 hw->mac.ops.set_uc_addr(hw, 0, NULL);
1225         }
1226
1227         return count;
1228 }
1229
1230 /**
1231  * ixgbevf_set_rx_mode - Multicast set
1232  * @netdev: network interface device structure
1233  *
1234  * The set_rx_method entry point is called whenever the multicast address
1235  * list or the network interface flags are updated.  This routine is
1236  * responsible for configuring the hardware for proper multicast mode.
1237  **/
1238 static void ixgbevf_set_rx_mode(struct net_device *netdev)
1239 {
1240         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
1241         struct ixgbe_hw *hw = &adapter->hw;
1242
1243         spin_lock_bh(&adapter->mbx_lock);
1244
1245         /* reprogram multicast list */
1246         if (hw->mac.ops.update_mc_addr_list)
1247                 hw->mac.ops.update_mc_addr_list(hw, netdev);
1248
1249         ixgbevf_write_uc_addr_list(netdev);
1250
1251         spin_unlock_bh(&adapter->mbx_lock);
1252 }
1253
1254 static void ixgbevf_napi_enable_all(struct ixgbevf_adapter *adapter)
1255 {
1256         int q_idx;
1257         struct ixgbevf_q_vector *q_vector;
1258         int q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
1259
1260         for (q_idx = 0; q_idx < q_vectors; q_idx++) {
1261                 q_vector = adapter->q_vector[q_idx];
1262                 napi_enable(&q_vector->napi);
1263         }
1264 }
1265
1266 static void ixgbevf_napi_disable_all(struct ixgbevf_adapter *adapter)
1267 {
1268         int q_idx;
1269         struct ixgbevf_q_vector *q_vector;
1270         int q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
1271
1272         for (q_idx = 0; q_idx < q_vectors; q_idx++) {
1273                 q_vector = adapter->q_vector[q_idx];
1274                 napi_disable(&q_vector->napi);
1275         }
1276 }
1277
1278 static void ixgbevf_configure(struct ixgbevf_adapter *adapter)
1279 {
1280         struct net_device *netdev = adapter->netdev;
1281         int i;
1282
1283         ixgbevf_set_rx_mode(netdev);
1284
1285         ixgbevf_restore_vlan(adapter);
1286
1287         ixgbevf_configure_tx(adapter);
1288         ixgbevf_configure_rx(adapter);
1289         for (i = 0; i < adapter->num_rx_queues; i++) {
1290                 struct ixgbevf_ring *ring = &adapter->rx_ring[i];
1291                 ixgbevf_alloc_rx_buffers(adapter, ring,
1292                                          IXGBE_DESC_UNUSED(ring));
1293         }
1294 }
1295
1296 #define IXGBE_MAX_RX_DESC_POLL 10
1297 static inline void ixgbevf_rx_desc_queue_enable(struct ixgbevf_adapter *adapter,
1298                                                 int rxr)
1299 {
1300         struct ixgbe_hw *hw = &adapter->hw;
1301         int j = adapter->rx_ring[rxr].reg_idx;
1302         int k;
1303
1304         for (k = 0; k < IXGBE_MAX_RX_DESC_POLL; k++) {
1305                 if (IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(j)) & IXGBE_RXDCTL_ENABLE)
1306                         break;
1307                 else
1308                         msleep(1);
1309         }
1310         if (k >= IXGBE_MAX_RX_DESC_POLL) {
1311                 hw_dbg(hw, "RXDCTL.ENABLE on Rx queue %d "
1312                        "not set within the polling period\n", rxr);
1313         }
1314
1315         ixgbevf_release_rx_desc(&adapter->hw, &adapter->rx_ring[rxr],
1316                                 (adapter->rx_ring[rxr].count - 1));
1317 }
1318
1319 static void ixgbevf_save_reset_stats(struct ixgbevf_adapter *adapter)
1320 {
1321         /* Only save pre-reset stats if there are some */
1322         if (adapter->stats.vfgprc || adapter->stats.vfgptc) {
1323                 adapter->stats.saved_reset_vfgprc += adapter->stats.vfgprc -
1324                         adapter->stats.base_vfgprc;
1325                 adapter->stats.saved_reset_vfgptc += adapter->stats.vfgptc -
1326                         adapter->stats.base_vfgptc;
1327                 adapter->stats.saved_reset_vfgorc += adapter->stats.vfgorc -
1328                         adapter->stats.base_vfgorc;
1329                 adapter->stats.saved_reset_vfgotc += adapter->stats.vfgotc -
1330                         adapter->stats.base_vfgotc;
1331                 adapter->stats.saved_reset_vfmprc += adapter->stats.vfmprc -
1332                         adapter->stats.base_vfmprc;
1333         }
1334 }
1335
1336 static void ixgbevf_init_last_counter_stats(struct ixgbevf_adapter *adapter)
1337 {
1338         struct ixgbe_hw *hw = &adapter->hw;
1339
1340         adapter->stats.last_vfgprc = IXGBE_READ_REG(hw, IXGBE_VFGPRC);
1341         adapter->stats.last_vfgorc = IXGBE_READ_REG(hw, IXGBE_VFGORC_LSB);
1342         adapter->stats.last_vfgorc |=
1343                 (((u64)(IXGBE_READ_REG(hw, IXGBE_VFGORC_MSB))) << 32);
1344         adapter->stats.last_vfgptc = IXGBE_READ_REG(hw, IXGBE_VFGPTC);
1345         adapter->stats.last_vfgotc = IXGBE_READ_REG(hw, IXGBE_VFGOTC_LSB);
1346         adapter->stats.last_vfgotc |=
1347                 (((u64)(IXGBE_READ_REG(hw, IXGBE_VFGOTC_MSB))) << 32);
1348         adapter->stats.last_vfmprc = IXGBE_READ_REG(hw, IXGBE_VFMPRC);
1349
1350         adapter->stats.base_vfgprc = adapter->stats.last_vfgprc;
1351         adapter->stats.base_vfgorc = adapter->stats.last_vfgorc;
1352         adapter->stats.base_vfgptc = adapter->stats.last_vfgptc;
1353         adapter->stats.base_vfgotc = adapter->stats.last_vfgotc;
1354         adapter->stats.base_vfmprc = adapter->stats.last_vfmprc;
1355 }
1356
1357 static void ixgbevf_negotiate_api(struct ixgbevf_adapter *adapter)
1358 {
1359         struct ixgbe_hw *hw = &adapter->hw;
1360         int api[] = { ixgbe_mbox_api_11,
1361                       ixgbe_mbox_api_10,
1362                       ixgbe_mbox_api_unknown };
1363         int err = 0, idx = 0;
1364
1365         spin_lock_bh(&adapter->mbx_lock);
1366
1367         while (api[idx] != ixgbe_mbox_api_unknown) {
1368                 err = ixgbevf_negotiate_api_version(hw, api[idx]);
1369                 if (!err)
1370                         break;
1371                 idx++;
1372         }
1373
1374         spin_unlock_bh(&adapter->mbx_lock);
1375 }
1376
1377 static void ixgbevf_up_complete(struct ixgbevf_adapter *adapter)
1378 {
1379         struct net_device *netdev = adapter->netdev;
1380         struct ixgbe_hw *hw = &adapter->hw;
1381         int i, j = 0;
1382         int num_rx_rings = adapter->num_rx_queues;
1383         u32 txdctl, rxdctl;
1384
1385         for (i = 0; i < adapter->num_tx_queues; i++) {
1386                 j = adapter->tx_ring[i].reg_idx;
1387                 txdctl = IXGBE_READ_REG(hw, IXGBE_VFTXDCTL(j));
1388                 /* enable WTHRESH=8 descriptors, to encourage burst writeback */
1389                 txdctl |= (8 << 16);
1390                 IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(j), txdctl);
1391         }
1392
1393         for (i = 0; i < adapter->num_tx_queues; i++) {
1394                 j = adapter->tx_ring[i].reg_idx;
1395                 txdctl = IXGBE_READ_REG(hw, IXGBE_VFTXDCTL(j));
1396                 txdctl |= IXGBE_TXDCTL_ENABLE;
1397                 IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(j), txdctl);
1398         }
1399
1400         for (i = 0; i < num_rx_rings; i++) {
1401                 j = adapter->rx_ring[i].reg_idx;
1402                 rxdctl = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(j));
1403                 rxdctl |= IXGBE_RXDCTL_ENABLE | IXGBE_RXDCTL_VME;
1404                 if (hw->mac.type == ixgbe_mac_X540_vf) {
1405                         rxdctl &= ~IXGBE_RXDCTL_RLPMLMASK;
1406                         rxdctl |= ((netdev->mtu + ETH_HLEN + ETH_FCS_LEN) |
1407                                    IXGBE_RXDCTL_RLPML_EN);
1408                 }
1409                 IXGBE_WRITE_REG(hw, IXGBE_VFRXDCTL(j), rxdctl);
1410                 ixgbevf_rx_desc_queue_enable(adapter, i);
1411         }
1412
1413         ixgbevf_configure_msix(adapter);
1414
1415         spin_lock_bh(&adapter->mbx_lock);
1416
1417         if (hw->mac.ops.set_rar) {
1418                 if (is_valid_ether_addr(hw->mac.addr))
1419                         hw->mac.ops.set_rar(hw, 0, hw->mac.addr, 0);
1420                 else
1421                         hw->mac.ops.set_rar(hw, 0, hw->mac.perm_addr, 0);
1422         }
1423
1424         spin_unlock_bh(&adapter->mbx_lock);
1425
1426         clear_bit(__IXGBEVF_DOWN, &adapter->state);
1427         ixgbevf_napi_enable_all(adapter);
1428
1429         /* enable transmits */
1430         netif_tx_start_all_queues(netdev);
1431
1432         ixgbevf_save_reset_stats(adapter);
1433         ixgbevf_init_last_counter_stats(adapter);
1434
1435         hw->mac.get_link_status = 1;
1436         mod_timer(&adapter->watchdog_timer, jiffies);
1437 }
1438
1439 static int ixgbevf_reset_queues(struct ixgbevf_adapter *adapter)
1440 {
1441         struct ixgbe_hw *hw = &adapter->hw;
1442         struct ixgbevf_ring *rx_ring;
1443         unsigned int def_q = 0;
1444         unsigned int num_tcs = 0;
1445         unsigned int num_rx_queues = 1;
1446         int err, i;
1447
1448         spin_lock_bh(&adapter->mbx_lock);
1449
1450         /* fetch queue configuration from the PF */
1451         err = ixgbevf_get_queues(hw, &num_tcs, &def_q);
1452
1453         spin_unlock_bh(&adapter->mbx_lock);
1454
1455         if (err)
1456                 return err;
1457
1458         if (num_tcs > 1) {
1459                 /* update default Tx ring register index */
1460                 adapter->tx_ring[0].reg_idx = def_q;
1461
1462                 /* we need as many queues as traffic classes */
1463                 num_rx_queues = num_tcs;
1464         }
1465
1466         /* nothing to do if we have the correct number of queues */
1467         if (adapter->num_rx_queues == num_rx_queues)
1468                 return 0;
1469
1470         /* allocate new rings */
1471         rx_ring = kcalloc(num_rx_queues,
1472                           sizeof(struct ixgbevf_ring), GFP_KERNEL);
1473         if (!rx_ring)
1474                 return -ENOMEM;
1475
1476         /* setup ring fields */
1477         for (i = 0; i < num_rx_queues; i++) {
1478                 rx_ring[i].count = adapter->rx_ring_count;
1479                 rx_ring[i].queue_index = i;
1480                 rx_ring[i].reg_idx = i;
1481                 rx_ring[i].dev = &adapter->pdev->dev;
1482                 rx_ring[i].netdev = adapter->netdev;
1483
1484                 /* allocate resources on the ring */
1485                 err = ixgbevf_setup_rx_resources(adapter, &rx_ring[i]);
1486                 if (err) {
1487                         while (i) {
1488                                 i--;
1489                                 ixgbevf_free_rx_resources(adapter, &rx_ring[i]);
1490                         }
1491                         kfree(rx_ring);
1492                         return err;
1493                 }
1494         }
1495
1496         /* free the existing rings and queues */
1497         ixgbevf_free_all_rx_resources(adapter);
1498         adapter->num_rx_queues = 0;
1499         kfree(adapter->rx_ring);
1500
1501         /* move new rings into position on the adapter struct */
1502         adapter->rx_ring = rx_ring;
1503         adapter->num_rx_queues = num_rx_queues;
1504
1505         /* reset ring to vector mapping */
1506         ixgbevf_reset_q_vectors(adapter);
1507         ixgbevf_map_rings_to_vectors(adapter);
1508
1509         return 0;
1510 }
1511
1512 void ixgbevf_up(struct ixgbevf_adapter *adapter)
1513 {
1514         struct ixgbe_hw *hw = &adapter->hw;
1515
1516         ixgbevf_negotiate_api(adapter);
1517
1518         ixgbevf_reset_queues(adapter);
1519
1520         ixgbevf_configure(adapter);
1521
1522         ixgbevf_up_complete(adapter);
1523
1524         /* clear any pending interrupts, may auto mask */
1525         IXGBE_READ_REG(hw, IXGBE_VTEICR);
1526
1527         ixgbevf_irq_enable(adapter);
1528 }
1529
1530 /**
1531  * ixgbevf_clean_rx_ring - Free Rx Buffers per Queue
1532  * @adapter: board private structure
1533  * @rx_ring: ring to free buffers from
1534  **/
1535 static void ixgbevf_clean_rx_ring(struct ixgbevf_adapter *adapter,
1536                                   struct ixgbevf_ring *rx_ring)
1537 {
1538         struct pci_dev *pdev = adapter->pdev;
1539         unsigned long size;
1540         unsigned int i;
1541
1542         if (!rx_ring->rx_buffer_info)
1543                 return;
1544
1545         /* Free all the Rx ring sk_buffs */
1546         for (i = 0; i < rx_ring->count; i++) {
1547                 struct ixgbevf_rx_buffer *rx_buffer_info;
1548
1549                 rx_buffer_info = &rx_ring->rx_buffer_info[i];
1550                 if (rx_buffer_info->dma) {
1551                         dma_unmap_single(&pdev->dev, rx_buffer_info->dma,
1552                                          rx_ring->rx_buf_len,
1553                                          DMA_FROM_DEVICE);
1554                         rx_buffer_info->dma = 0;
1555                 }
1556                 if (rx_buffer_info->skb) {
1557                         struct sk_buff *skb = rx_buffer_info->skb;
1558                         rx_buffer_info->skb = NULL;
1559                         do {
1560                                 struct sk_buff *this = skb;
1561                                 skb = IXGBE_CB(skb)->prev;
1562                                 dev_kfree_skb(this);
1563                         } while (skb);
1564                 }
1565         }
1566
1567         size = sizeof(struct ixgbevf_rx_buffer) * rx_ring->count;
1568         memset(rx_ring->rx_buffer_info, 0, size);
1569
1570         /* Zero out the descriptor ring */
1571         memset(rx_ring->desc, 0, rx_ring->size);
1572
1573         rx_ring->next_to_clean = 0;
1574         rx_ring->next_to_use = 0;
1575
1576         if (rx_ring->head)
1577                 writel(0, adapter->hw.hw_addr + rx_ring->head);
1578         if (rx_ring->tail)
1579                 writel(0, adapter->hw.hw_addr + rx_ring->tail);
1580 }
1581
1582 /**
1583  * ixgbevf_clean_tx_ring - Free Tx Buffers
1584  * @adapter: board private structure
1585  * @tx_ring: ring to be cleaned
1586  **/
1587 static void ixgbevf_clean_tx_ring(struct ixgbevf_adapter *adapter,
1588                                   struct ixgbevf_ring *tx_ring)
1589 {
1590         struct ixgbevf_tx_buffer *tx_buffer_info;
1591         unsigned long size;
1592         unsigned int i;
1593
1594         if (!tx_ring->tx_buffer_info)
1595                 return;
1596
1597         /* Free all the Tx ring sk_buffs */
1598
1599         for (i = 0; i < tx_ring->count; i++) {
1600                 tx_buffer_info = &tx_ring->tx_buffer_info[i];
1601                 ixgbevf_unmap_and_free_tx_resource(tx_ring, tx_buffer_info);
1602         }
1603
1604         size = sizeof(struct ixgbevf_tx_buffer) * tx_ring->count;
1605         memset(tx_ring->tx_buffer_info, 0, size);
1606
1607         memset(tx_ring->desc, 0, tx_ring->size);
1608
1609         tx_ring->next_to_use = 0;
1610         tx_ring->next_to_clean = 0;
1611
1612         if (tx_ring->head)
1613                 writel(0, adapter->hw.hw_addr + tx_ring->head);
1614         if (tx_ring->tail)
1615                 writel(0, adapter->hw.hw_addr + tx_ring->tail);
1616 }
1617
1618 /**
1619  * ixgbevf_clean_all_rx_rings - Free Rx Buffers for all queues
1620  * @adapter: board private structure
1621  **/
1622 static void ixgbevf_clean_all_rx_rings(struct ixgbevf_adapter *adapter)
1623 {
1624         int i;
1625
1626         for (i = 0; i < adapter->num_rx_queues; i++)
1627                 ixgbevf_clean_rx_ring(adapter, &adapter->rx_ring[i]);
1628 }
1629
1630 /**
1631  * ixgbevf_clean_all_tx_rings - Free Tx Buffers for all queues
1632  * @adapter: board private structure
1633  **/
1634 static void ixgbevf_clean_all_tx_rings(struct ixgbevf_adapter *adapter)
1635 {
1636         int i;
1637
1638         for (i = 0; i < adapter->num_tx_queues; i++)
1639                 ixgbevf_clean_tx_ring(adapter, &adapter->tx_ring[i]);
1640 }
1641
1642 void ixgbevf_down(struct ixgbevf_adapter *adapter)
1643 {
1644         struct net_device *netdev = adapter->netdev;
1645         struct ixgbe_hw *hw = &adapter->hw;
1646         u32 txdctl;
1647         int i, j;
1648
1649         /* signal that we are down to the interrupt handler */
1650         set_bit(__IXGBEVF_DOWN, &adapter->state);
1651         /* disable receives */
1652
1653         netif_tx_disable(netdev);
1654
1655         msleep(10);
1656
1657         netif_tx_stop_all_queues(netdev);
1658
1659         ixgbevf_irq_disable(adapter);
1660
1661         ixgbevf_napi_disable_all(adapter);
1662
1663         del_timer_sync(&adapter->watchdog_timer);
1664         /* can't call flush scheduled work here because it can deadlock
1665          * if linkwatch_event tries to acquire the rtnl_lock which we are
1666          * holding */
1667         while (adapter->flags & IXGBE_FLAG_IN_WATCHDOG_TASK)
1668                 msleep(1);
1669
1670         /* disable transmits in the hardware now that interrupts are off */
1671         for (i = 0; i < adapter->num_tx_queues; i++) {
1672                 j = adapter->tx_ring[i].reg_idx;
1673                 txdctl = IXGBE_READ_REG(hw, IXGBE_VFTXDCTL(j));
1674                 IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(j),
1675                                 (txdctl & ~IXGBE_TXDCTL_ENABLE));
1676         }
1677
1678         netif_carrier_off(netdev);
1679
1680         if (!pci_channel_offline(adapter->pdev))
1681                 ixgbevf_reset(adapter);
1682
1683         ixgbevf_clean_all_tx_rings(adapter);
1684         ixgbevf_clean_all_rx_rings(adapter);
1685 }
1686
1687 void ixgbevf_reinit_locked(struct ixgbevf_adapter *adapter)
1688 {
1689         WARN_ON(in_interrupt());
1690
1691         while (test_and_set_bit(__IXGBEVF_RESETTING, &adapter->state))
1692                 msleep(1);
1693
1694         /*
1695          * Check if PF is up before re-init.  If not then skip until
1696          * later when the PF is up and ready to service requests from
1697          * the VF via mailbox.  If the VF is up and running then the
1698          * watchdog task will continue to schedule reset tasks until
1699          * the PF is up and running.
1700          */
1701         ixgbevf_down(adapter);
1702         ixgbevf_up(adapter);
1703
1704         clear_bit(__IXGBEVF_RESETTING, &adapter->state);
1705 }
1706
1707 void ixgbevf_reset(struct ixgbevf_adapter *adapter)
1708 {
1709         struct ixgbe_hw *hw = &adapter->hw;
1710         struct net_device *netdev = adapter->netdev;
1711
1712         spin_lock_bh(&adapter->mbx_lock);
1713
1714         if (hw->mac.ops.reset_hw(hw))
1715                 hw_dbg(hw, "PF still resetting\n");
1716         else
1717                 hw->mac.ops.init_hw(hw);
1718
1719         spin_unlock_bh(&adapter->mbx_lock);
1720
1721         if (is_valid_ether_addr(adapter->hw.mac.addr)) {
1722                 memcpy(netdev->dev_addr, adapter->hw.mac.addr,
1723                        netdev->addr_len);
1724                 memcpy(netdev->perm_addr, adapter->hw.mac.addr,
1725                        netdev->addr_len);
1726         }
1727 }
1728
1729 static int ixgbevf_acquire_msix_vectors(struct ixgbevf_adapter *adapter,
1730                                         int vectors)
1731 {
1732         int err = 0;
1733         int vector_threshold;
1734
1735         /* We'll want at least 2 (vector_threshold):
1736          * 1) TxQ[0] + RxQ[0] handler
1737          * 2) Other (Link Status Change, etc.)
1738          */
1739         vector_threshold = MIN_MSIX_COUNT;
1740
1741         /* The more we get, the more we will assign to Tx/Rx Cleanup
1742          * for the separate queues...where Rx Cleanup >= Tx Cleanup.
1743          * Right now, we simply care about how many we'll get; we'll
1744          * set them up later while requesting irq's.
1745          */
1746         while (vectors >= vector_threshold) {
1747                 err = pci_enable_msix(adapter->pdev, adapter->msix_entries,
1748                                       vectors);
1749                 if (!err || err < 0) /* Success or a nasty failure. */
1750                         break;
1751                 else /* err == number of vectors we should try again with */
1752                         vectors = err;
1753         }
1754
1755         if (vectors < vector_threshold)
1756                 err = -ENOMEM;
1757
1758         if (err) {
1759                 dev_err(&adapter->pdev->dev,
1760                         "Unable to allocate MSI-X interrupts\n");
1761                 kfree(adapter->msix_entries);
1762                 adapter->msix_entries = NULL;
1763         } else {
1764                 /*
1765                  * Adjust for only the vectors we'll use, which is minimum
1766                  * of max_msix_q_vectors + NON_Q_VECTORS, or the number of
1767                  * vectors we were allocated.
1768                  */
1769                 adapter->num_msix_vectors = vectors;
1770         }
1771         return err;
1772 }
1773
1774 /**
1775  * ixgbevf_set_num_queues - Allocate queues for device, feature dependent
1776  * @adapter: board private structure to initialize
1777  *
1778  * This is the top level queue allocation routine.  The order here is very
1779  * important, starting with the "most" number of features turned on at once,
1780  * and ending with the smallest set of features.  This way large combinations
1781  * can be allocated if they're turned on, and smaller combinations are the
1782  * fallthrough conditions.
1783  *
1784  **/
1785 static void ixgbevf_set_num_queues(struct ixgbevf_adapter *adapter)
1786 {
1787         /* Start with base case */
1788         adapter->num_rx_queues = 1;
1789         adapter->num_tx_queues = 1;
1790 }
1791
1792 /**
1793  * ixgbevf_alloc_queues - Allocate memory for all rings
1794  * @adapter: board private structure to initialize
1795  *
1796  * We allocate one ring per queue at run-time since we don't know the
1797  * number of queues at compile-time.  The polling_netdev array is
1798  * intended for Multiqueue, but should work fine with a single queue.
1799  **/
1800 static int ixgbevf_alloc_queues(struct ixgbevf_adapter *adapter)
1801 {
1802         int i;
1803
1804         adapter->tx_ring = kcalloc(adapter->num_tx_queues,
1805                                    sizeof(struct ixgbevf_ring), GFP_KERNEL);
1806         if (!adapter->tx_ring)
1807                 goto err_tx_ring_allocation;
1808
1809         adapter->rx_ring = kcalloc(adapter->num_rx_queues,
1810                                    sizeof(struct ixgbevf_ring), GFP_KERNEL);
1811         if (!adapter->rx_ring)
1812                 goto err_rx_ring_allocation;
1813
1814         for (i = 0; i < adapter->num_tx_queues; i++) {
1815                 adapter->tx_ring[i].count = adapter->tx_ring_count;
1816                 adapter->tx_ring[i].queue_index = i;
1817                 /* reg_idx may be remapped later by DCB config */
1818                 adapter->tx_ring[i].reg_idx = i;
1819                 adapter->tx_ring[i].dev = &adapter->pdev->dev;
1820                 adapter->tx_ring[i].netdev = adapter->netdev;
1821         }
1822
1823         for (i = 0; i < adapter->num_rx_queues; i++) {
1824                 adapter->rx_ring[i].count = adapter->rx_ring_count;
1825                 adapter->rx_ring[i].queue_index = i;
1826                 adapter->rx_ring[i].reg_idx = i;
1827                 adapter->rx_ring[i].dev = &adapter->pdev->dev;
1828                 adapter->rx_ring[i].netdev = adapter->netdev;
1829         }
1830
1831         return 0;
1832
1833 err_rx_ring_allocation:
1834         kfree(adapter->tx_ring);
1835 err_tx_ring_allocation:
1836         return -ENOMEM;
1837 }
1838
1839 /**
1840  * ixgbevf_set_interrupt_capability - set MSI-X or FAIL if not supported
1841  * @adapter: board private structure to initialize
1842  *
1843  * Attempt to configure the interrupts using the best available
1844  * capabilities of the hardware and the kernel.
1845  **/
1846 static int ixgbevf_set_interrupt_capability(struct ixgbevf_adapter *adapter)
1847 {
1848         struct net_device *netdev = adapter->netdev;
1849         int err = 0;
1850         int vector, v_budget;
1851
1852         /*
1853          * It's easy to be greedy for MSI-X vectors, but it really
1854          * doesn't do us much good if we have a lot more vectors
1855          * than CPU's.  So let's be conservative and only ask for
1856          * (roughly) the same number of vectors as there are CPU's.
1857          * The default is to use pairs of vectors.
1858          */
1859         v_budget = max(adapter->num_rx_queues, adapter->num_tx_queues);
1860         v_budget = min_t(int, v_budget, num_online_cpus());
1861         v_budget += NON_Q_VECTORS;
1862
1863         /* A failure in MSI-X entry allocation isn't fatal, but it does
1864          * mean we disable MSI-X capabilities of the adapter. */
1865         adapter->msix_entries = kcalloc(v_budget,
1866                                         sizeof(struct msix_entry), GFP_KERNEL);
1867         if (!adapter->msix_entries) {
1868                 err = -ENOMEM;
1869                 goto out;
1870         }
1871
1872         for (vector = 0; vector < v_budget; vector++)
1873                 adapter->msix_entries[vector].entry = vector;
1874
1875         err = ixgbevf_acquire_msix_vectors(adapter, v_budget);
1876         if (err)
1877                 goto out;
1878
1879         err = netif_set_real_num_tx_queues(netdev, adapter->num_tx_queues);
1880         if (err)
1881                 goto out;
1882
1883         err = netif_set_real_num_rx_queues(netdev, adapter->num_rx_queues);
1884
1885 out:
1886         return err;
1887 }
1888
1889 /**
1890  * ixgbevf_alloc_q_vectors - Allocate memory for interrupt vectors
1891  * @adapter: board private structure to initialize
1892  *
1893  * We allocate one q_vector per queue interrupt.  If allocation fails we
1894  * return -ENOMEM.
1895  **/
1896 static int ixgbevf_alloc_q_vectors(struct ixgbevf_adapter *adapter)
1897 {
1898         int q_idx, num_q_vectors;
1899         struct ixgbevf_q_vector *q_vector;
1900
1901         num_q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
1902
1903         for (q_idx = 0; q_idx < num_q_vectors; q_idx++) {
1904                 q_vector = kzalloc(sizeof(struct ixgbevf_q_vector), GFP_KERNEL);
1905                 if (!q_vector)
1906                         goto err_out;
1907                 q_vector->adapter = adapter;
1908                 q_vector->v_idx = q_idx;
1909                 netif_napi_add(adapter->netdev, &q_vector->napi,
1910                                ixgbevf_poll, 64);
1911                 adapter->q_vector[q_idx] = q_vector;
1912         }
1913
1914         return 0;
1915
1916 err_out:
1917         while (q_idx) {
1918                 q_idx--;
1919                 q_vector = adapter->q_vector[q_idx];
1920                 netif_napi_del(&q_vector->napi);
1921                 kfree(q_vector);
1922                 adapter->q_vector[q_idx] = NULL;
1923         }
1924         return -ENOMEM;
1925 }
1926
1927 /**
1928  * ixgbevf_free_q_vectors - Free memory allocated for interrupt vectors
1929  * @adapter: board private structure to initialize
1930  *
1931  * This function frees the memory allocated to the q_vectors.  In addition if
1932  * NAPI is enabled it will delete any references to the NAPI struct prior
1933  * to freeing the q_vector.
1934  **/
1935 static void ixgbevf_free_q_vectors(struct ixgbevf_adapter *adapter)
1936 {
1937         int q_idx, num_q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
1938
1939         for (q_idx = 0; q_idx < num_q_vectors; q_idx++) {
1940                 struct ixgbevf_q_vector *q_vector = adapter->q_vector[q_idx];
1941
1942                 adapter->q_vector[q_idx] = NULL;
1943                 netif_napi_del(&q_vector->napi);
1944                 kfree(q_vector);
1945         }
1946 }
1947
1948 /**
1949  * ixgbevf_reset_interrupt_capability - Reset MSIX setup
1950  * @adapter: board private structure
1951  *
1952  **/
1953 static void ixgbevf_reset_interrupt_capability(struct ixgbevf_adapter *adapter)
1954 {
1955         pci_disable_msix(adapter->pdev);
1956         kfree(adapter->msix_entries);
1957         adapter->msix_entries = NULL;
1958 }
1959
1960 /**
1961  * ixgbevf_init_interrupt_scheme - Determine if MSIX is supported and init
1962  * @adapter: board private structure to initialize
1963  *
1964  **/
1965 static int ixgbevf_init_interrupt_scheme(struct ixgbevf_adapter *adapter)
1966 {
1967         int err;
1968
1969         /* Number of supported queues */
1970         ixgbevf_set_num_queues(adapter);
1971
1972         err = ixgbevf_set_interrupt_capability(adapter);
1973         if (err) {
1974                 hw_dbg(&adapter->hw,
1975                        "Unable to setup interrupt capabilities\n");
1976                 goto err_set_interrupt;
1977         }
1978
1979         err = ixgbevf_alloc_q_vectors(adapter);
1980         if (err) {
1981                 hw_dbg(&adapter->hw, "Unable to allocate memory for queue "
1982                        "vectors\n");
1983                 goto err_alloc_q_vectors;
1984         }
1985
1986         err = ixgbevf_alloc_queues(adapter);
1987         if (err) {
1988                 pr_err("Unable to allocate memory for queues\n");
1989                 goto err_alloc_queues;
1990         }
1991
1992         hw_dbg(&adapter->hw, "Multiqueue %s: Rx Queue count = %u, "
1993                "Tx Queue count = %u\n",
1994                (adapter->num_rx_queues > 1) ? "Enabled" :
1995                "Disabled", adapter->num_rx_queues, adapter->num_tx_queues);
1996
1997         set_bit(__IXGBEVF_DOWN, &adapter->state);
1998
1999         return 0;
2000 err_alloc_queues:
2001         ixgbevf_free_q_vectors(adapter);
2002 err_alloc_q_vectors:
2003         ixgbevf_reset_interrupt_capability(adapter);
2004 err_set_interrupt:
2005         return err;
2006 }
2007
2008 /**
2009  * ixgbevf_clear_interrupt_scheme - Clear the current interrupt scheme settings
2010  * @adapter: board private structure to clear interrupt scheme on
2011  *
2012  * We go through and clear interrupt specific resources and reset the structure
2013  * to pre-load conditions
2014  **/
2015 static void ixgbevf_clear_interrupt_scheme(struct ixgbevf_adapter *adapter)
2016 {
2017         adapter->num_tx_queues = 0;
2018         adapter->num_rx_queues = 0;
2019
2020         ixgbevf_free_q_vectors(adapter);
2021         ixgbevf_reset_interrupt_capability(adapter);
2022 }
2023
2024 /**
2025  * ixgbevf_sw_init - Initialize general software structures
2026  * (struct ixgbevf_adapter)
2027  * @adapter: board private structure to initialize
2028  *
2029  * ixgbevf_sw_init initializes the Adapter private data structure.
2030  * Fields are initialized based on PCI device information and
2031  * OS network device settings (MTU size).
2032  **/
2033 static int __devinit ixgbevf_sw_init(struct ixgbevf_adapter *adapter)
2034 {
2035         struct ixgbe_hw *hw = &adapter->hw;
2036         struct pci_dev *pdev = adapter->pdev;
2037         int err;
2038
2039         /* PCI config space info */
2040
2041         hw->vendor_id = pdev->vendor;
2042         hw->device_id = pdev->device;
2043         hw->revision_id = pdev->revision;
2044         hw->subsystem_vendor_id = pdev->subsystem_vendor;
2045         hw->subsystem_device_id = pdev->subsystem_device;
2046
2047         hw->mbx.ops.init_params(hw);
2048
2049         /* assume legacy case in which PF would only give VF 2 queues */
2050         hw->mac.max_tx_queues = 2;
2051         hw->mac.max_rx_queues = 2;
2052
2053         err = hw->mac.ops.reset_hw(hw);
2054         if (err) {
2055                 dev_info(&pdev->dev,
2056                          "PF still in reset state, assigning new address\n");
2057                 eth_hw_addr_random(adapter->netdev);
2058                 memcpy(adapter->hw.mac.addr, adapter->netdev->dev_addr,
2059                         adapter->netdev->addr_len);
2060         } else {
2061                 err = hw->mac.ops.init_hw(hw);
2062                 if (err) {
2063                         pr_err("init_shared_code failed: %d\n", err);
2064                         goto out;
2065                 }
2066                 memcpy(adapter->netdev->dev_addr, adapter->hw.mac.addr,
2067                         adapter->netdev->addr_len);
2068         }
2069
2070         /* lock to protect mailbox accesses */
2071         spin_lock_init(&adapter->mbx_lock);
2072
2073         /* Enable dynamic interrupt throttling rates */
2074         adapter->rx_itr_setting = 1;
2075         adapter->tx_itr_setting = 1;
2076
2077         /* set default ring sizes */
2078         adapter->tx_ring_count = IXGBEVF_DEFAULT_TXD;
2079         adapter->rx_ring_count = IXGBEVF_DEFAULT_RXD;
2080
2081         set_bit(__IXGBEVF_DOWN, &adapter->state);
2082         return 0;
2083
2084 out:
2085         return err;
2086 }
2087
2088 #define UPDATE_VF_COUNTER_32bit(reg, last_counter, counter)     \
2089         {                                                       \
2090                 u32 current_counter = IXGBE_READ_REG(hw, reg);  \
2091                 if (current_counter < last_counter)             \
2092                         counter += 0x100000000LL;               \
2093                 last_counter = current_counter;                 \
2094                 counter &= 0xFFFFFFFF00000000LL;                \
2095                 counter |= current_counter;                     \
2096         }
2097
2098 #define UPDATE_VF_COUNTER_36bit(reg_lsb, reg_msb, last_counter, counter) \
2099         {                                                                \
2100                 u64 current_counter_lsb = IXGBE_READ_REG(hw, reg_lsb);   \
2101                 u64 current_counter_msb = IXGBE_READ_REG(hw, reg_msb);   \
2102                 u64 current_counter = (current_counter_msb << 32) |      \
2103                         current_counter_lsb;                             \
2104                 if (current_counter < last_counter)                      \
2105                         counter += 0x1000000000LL;                       \
2106                 last_counter = current_counter;                          \
2107                 counter &= 0xFFFFFFF000000000LL;                         \
2108                 counter |= current_counter;                              \
2109         }
2110 /**
2111  * ixgbevf_update_stats - Update the board statistics counters.
2112  * @adapter: board private structure
2113  **/
2114 void ixgbevf_update_stats(struct ixgbevf_adapter *adapter)
2115 {
2116         struct ixgbe_hw *hw = &adapter->hw;
2117
2118         UPDATE_VF_COUNTER_32bit(IXGBE_VFGPRC, adapter->stats.last_vfgprc,
2119                                 adapter->stats.vfgprc);
2120         UPDATE_VF_COUNTER_32bit(IXGBE_VFGPTC, adapter->stats.last_vfgptc,
2121                                 adapter->stats.vfgptc);
2122         UPDATE_VF_COUNTER_36bit(IXGBE_VFGORC_LSB, IXGBE_VFGORC_MSB,
2123                                 adapter->stats.last_vfgorc,
2124                                 adapter->stats.vfgorc);
2125         UPDATE_VF_COUNTER_36bit(IXGBE_VFGOTC_LSB, IXGBE_VFGOTC_MSB,
2126                                 adapter->stats.last_vfgotc,
2127                                 adapter->stats.vfgotc);
2128         UPDATE_VF_COUNTER_32bit(IXGBE_VFMPRC, adapter->stats.last_vfmprc,
2129                                 adapter->stats.vfmprc);
2130 }
2131
2132 /**
2133  * ixgbevf_watchdog - Timer Call-back
2134  * @data: pointer to adapter cast into an unsigned long
2135  **/
2136 static void ixgbevf_watchdog(unsigned long data)
2137 {
2138         struct ixgbevf_adapter *adapter = (struct ixgbevf_adapter *)data;
2139         struct ixgbe_hw *hw = &adapter->hw;
2140         u32 eics = 0;
2141         int i;
2142
2143         /*
2144          * Do the watchdog outside of interrupt context due to the lovely
2145          * delays that some of the newer hardware requires
2146          */
2147
2148         if (test_bit(__IXGBEVF_DOWN, &adapter->state))
2149                 goto watchdog_short_circuit;
2150
2151         /* get one bit for every active tx/rx interrupt vector */
2152         for (i = 0; i < adapter->num_msix_vectors - NON_Q_VECTORS; i++) {
2153                 struct ixgbevf_q_vector *qv = adapter->q_vector[i];
2154                 if (qv->rx.ring || qv->tx.ring)
2155                         eics |= 1 << i;
2156         }
2157
2158         IXGBE_WRITE_REG(hw, IXGBE_VTEICS, eics);
2159
2160 watchdog_short_circuit:
2161         schedule_work(&adapter->watchdog_task);
2162 }
2163
2164 /**
2165  * ixgbevf_tx_timeout - Respond to a Tx Hang
2166  * @netdev: network interface device structure
2167  **/
2168 static void ixgbevf_tx_timeout(struct net_device *netdev)
2169 {
2170         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
2171
2172         /* Do the reset outside of interrupt context */
2173         schedule_work(&adapter->reset_task);
2174 }
2175
2176 static void ixgbevf_reset_task(struct work_struct *work)
2177 {
2178         struct ixgbevf_adapter *adapter;
2179         adapter = container_of(work, struct ixgbevf_adapter, reset_task);
2180
2181         /* If we're already down or resetting, just bail */
2182         if (test_bit(__IXGBEVF_DOWN, &adapter->state) ||
2183             test_bit(__IXGBEVF_RESETTING, &adapter->state))
2184                 return;
2185
2186         adapter->tx_timeout_count++;
2187
2188         ixgbevf_reinit_locked(adapter);
2189 }
2190
2191 /**
2192  * ixgbevf_watchdog_task - worker thread to bring link up
2193  * @work: pointer to work_struct containing our data
2194  **/
2195 static void ixgbevf_watchdog_task(struct work_struct *work)
2196 {
2197         struct ixgbevf_adapter *adapter = container_of(work,
2198                                                        struct ixgbevf_adapter,
2199                                                        watchdog_task);
2200         struct net_device *netdev = adapter->netdev;
2201         struct ixgbe_hw *hw = &adapter->hw;
2202         u32 link_speed = adapter->link_speed;
2203         bool link_up = adapter->link_up;
2204
2205         adapter->flags |= IXGBE_FLAG_IN_WATCHDOG_TASK;
2206
2207         /*
2208          * Always check the link on the watchdog because we have
2209          * no LSC interrupt
2210          */
2211         if (hw->mac.ops.check_link) {
2212                 s32 need_reset;
2213
2214                 spin_lock_bh(&adapter->mbx_lock);
2215
2216                 need_reset = hw->mac.ops.check_link(hw, &link_speed,
2217                                                     &link_up, false);
2218
2219                 spin_unlock_bh(&adapter->mbx_lock);
2220
2221                 if (need_reset) {
2222                         adapter->link_up = link_up;
2223                         adapter->link_speed = link_speed;
2224                         netif_carrier_off(netdev);
2225                         netif_tx_stop_all_queues(netdev);
2226                         schedule_work(&adapter->reset_task);
2227                         goto pf_has_reset;
2228                 }
2229         } else {
2230                 /* always assume link is up, if no check link
2231                  * function */
2232                 link_speed = IXGBE_LINK_SPEED_10GB_FULL;
2233                 link_up = true;
2234         }
2235         adapter->link_up = link_up;
2236         adapter->link_speed = link_speed;
2237
2238         if (link_up) {
2239                 if (!netif_carrier_ok(netdev)) {
2240                         hw_dbg(&adapter->hw, "NIC Link is Up, %u Gbps\n",
2241                                (link_speed == IXGBE_LINK_SPEED_10GB_FULL) ?
2242                                10 : 1);
2243                         netif_carrier_on(netdev);
2244                         netif_tx_wake_all_queues(netdev);
2245                 }
2246         } else {
2247                 adapter->link_up = false;
2248                 adapter->link_speed = 0;
2249                 if (netif_carrier_ok(netdev)) {
2250                         hw_dbg(&adapter->hw, "NIC Link is Down\n");
2251                         netif_carrier_off(netdev);
2252                         netif_tx_stop_all_queues(netdev);
2253                 }
2254         }
2255
2256         ixgbevf_update_stats(adapter);
2257
2258 pf_has_reset:
2259         /* Reset the timer */
2260         if (!test_bit(__IXGBEVF_DOWN, &adapter->state))
2261                 mod_timer(&adapter->watchdog_timer,
2262                           round_jiffies(jiffies + (2 * HZ)));
2263
2264         adapter->flags &= ~IXGBE_FLAG_IN_WATCHDOG_TASK;
2265 }
2266
2267 /**
2268  * ixgbevf_free_tx_resources - Free Tx Resources per Queue
2269  * @adapter: board private structure
2270  * @tx_ring: Tx descriptor ring for a specific queue
2271  *
2272  * Free all transmit software resources
2273  **/
2274 void ixgbevf_free_tx_resources(struct ixgbevf_adapter *adapter,
2275                                struct ixgbevf_ring *tx_ring)
2276 {
2277         struct pci_dev *pdev = adapter->pdev;
2278
2279         ixgbevf_clean_tx_ring(adapter, tx_ring);
2280
2281         vfree(tx_ring->tx_buffer_info);
2282         tx_ring->tx_buffer_info = NULL;
2283
2284         dma_free_coherent(&pdev->dev, tx_ring->size, tx_ring->desc,
2285                           tx_ring->dma);
2286
2287         tx_ring->desc = NULL;
2288 }
2289
2290 /**
2291  * ixgbevf_free_all_tx_resources - Free Tx Resources for All Queues
2292  * @adapter: board private structure
2293  *
2294  * Free all transmit software resources
2295  **/
2296 static void ixgbevf_free_all_tx_resources(struct ixgbevf_adapter *adapter)
2297 {
2298         int i;
2299
2300         for (i = 0; i < adapter->num_tx_queues; i++)
2301                 if (adapter->tx_ring[i].desc)
2302                         ixgbevf_free_tx_resources(adapter,
2303                                                   &adapter->tx_ring[i]);
2304
2305 }
2306
2307 /**
2308  * ixgbevf_setup_tx_resources - allocate Tx resources (Descriptors)
2309  * @adapter: board private structure
2310  * @tx_ring:    tx descriptor ring (for a specific queue) to setup
2311  *
2312  * Return 0 on success, negative on failure
2313  **/
2314 int ixgbevf_setup_tx_resources(struct ixgbevf_adapter *adapter,
2315                                struct ixgbevf_ring *tx_ring)
2316 {
2317         struct pci_dev *pdev = adapter->pdev;
2318         int size;
2319
2320         size = sizeof(struct ixgbevf_tx_buffer) * tx_ring->count;
2321         tx_ring->tx_buffer_info = vzalloc(size);
2322         if (!tx_ring->tx_buffer_info)
2323                 goto err;
2324
2325         /* round up to nearest 4K */
2326         tx_ring->size = tx_ring->count * sizeof(union ixgbe_adv_tx_desc);
2327         tx_ring->size = ALIGN(tx_ring->size, 4096);
2328
2329         tx_ring->desc = dma_alloc_coherent(&pdev->dev, tx_ring->size,
2330                                            &tx_ring->dma, GFP_KERNEL);
2331         if (!tx_ring->desc)
2332                 goto err;
2333
2334         tx_ring->next_to_use = 0;
2335         tx_ring->next_to_clean = 0;
2336         return 0;
2337
2338 err:
2339         vfree(tx_ring->tx_buffer_info);
2340         tx_ring->tx_buffer_info = NULL;
2341         hw_dbg(&adapter->hw, "Unable to allocate memory for the transmit "
2342                "descriptor ring\n");
2343         return -ENOMEM;
2344 }
2345
2346 /**
2347  * ixgbevf_setup_all_tx_resources - allocate all queues Tx resources
2348  * @adapter: board private structure
2349  *
2350  * If this function returns with an error, then it's possible one or
2351  * more of the rings is populated (while the rest are not).  It is the
2352  * callers duty to clean those orphaned rings.
2353  *
2354  * Return 0 on success, negative on failure
2355  **/
2356 static int ixgbevf_setup_all_tx_resources(struct ixgbevf_adapter *adapter)
2357 {
2358         int i, err = 0;
2359
2360         for (i = 0; i < adapter->num_tx_queues; i++) {
2361                 err = ixgbevf_setup_tx_resources(adapter, &adapter->tx_ring[i]);
2362                 if (!err)
2363                         continue;
2364                 hw_dbg(&adapter->hw,
2365                        "Allocation for Tx Queue %u failed\n", i);
2366                 break;
2367         }
2368
2369         return err;
2370 }
2371
2372 /**
2373  * ixgbevf_setup_rx_resources - allocate Rx resources (Descriptors)
2374  * @adapter: board private structure
2375  * @rx_ring:    rx descriptor ring (for a specific queue) to setup
2376  *
2377  * Returns 0 on success, negative on failure
2378  **/
2379 int ixgbevf_setup_rx_resources(struct ixgbevf_adapter *adapter,
2380                                struct ixgbevf_ring *rx_ring)
2381 {
2382         struct pci_dev *pdev = adapter->pdev;
2383         int size;
2384
2385         size = sizeof(struct ixgbevf_rx_buffer) * rx_ring->count;
2386         rx_ring->rx_buffer_info = vzalloc(size);
2387         if (!rx_ring->rx_buffer_info)
2388                 goto alloc_failed;
2389
2390         /* Round up to nearest 4K */
2391         rx_ring->size = rx_ring->count * sizeof(union ixgbe_adv_rx_desc);
2392         rx_ring->size = ALIGN(rx_ring->size, 4096);
2393
2394         rx_ring->desc = dma_alloc_coherent(&pdev->dev, rx_ring->size,
2395                                            &rx_ring->dma, GFP_KERNEL);
2396
2397         if (!rx_ring->desc) {
2398                 hw_dbg(&adapter->hw,
2399                        "Unable to allocate memory for "
2400                        "the receive descriptor ring\n");
2401                 vfree(rx_ring->rx_buffer_info);
2402                 rx_ring->rx_buffer_info = NULL;
2403                 goto alloc_failed;
2404         }
2405
2406         rx_ring->next_to_clean = 0;
2407         rx_ring->next_to_use = 0;
2408
2409         return 0;
2410 alloc_failed:
2411         return -ENOMEM;
2412 }
2413
2414 /**
2415  * ixgbevf_setup_all_rx_resources - allocate all queues Rx resources
2416  * @adapter: board private structure
2417  *
2418  * If this function returns with an error, then it's possible one or
2419  * more of the rings is populated (while the rest are not).  It is the
2420  * callers duty to clean those orphaned rings.
2421  *
2422  * Return 0 on success, negative on failure
2423  **/
2424 static int ixgbevf_setup_all_rx_resources(struct ixgbevf_adapter *adapter)
2425 {
2426         int i, err = 0;
2427
2428         for (i = 0; i < adapter->num_rx_queues; i++) {
2429                 err = ixgbevf_setup_rx_resources(adapter, &adapter->rx_ring[i]);
2430                 if (!err)
2431                         continue;
2432                 hw_dbg(&adapter->hw,
2433                        "Allocation for Rx Queue %u failed\n", i);
2434                 break;
2435         }
2436         return err;
2437 }
2438
2439 /**
2440  * ixgbevf_free_rx_resources - Free Rx Resources
2441  * @adapter: board private structure
2442  * @rx_ring: ring to clean the resources from
2443  *
2444  * Free all receive software resources
2445  **/
2446 void ixgbevf_free_rx_resources(struct ixgbevf_adapter *adapter,
2447                                struct ixgbevf_ring *rx_ring)
2448 {
2449         struct pci_dev *pdev = adapter->pdev;
2450
2451         ixgbevf_clean_rx_ring(adapter, rx_ring);
2452
2453         vfree(rx_ring->rx_buffer_info);
2454         rx_ring->rx_buffer_info = NULL;
2455
2456         dma_free_coherent(&pdev->dev, rx_ring->size, rx_ring->desc,
2457                           rx_ring->dma);
2458
2459         rx_ring->desc = NULL;
2460 }
2461
2462 /**
2463  * ixgbevf_free_all_rx_resources - Free Rx Resources for All Queues
2464  * @adapter: board private structure
2465  *
2466  * Free all receive software resources
2467  **/
2468 static void ixgbevf_free_all_rx_resources(struct ixgbevf_adapter *adapter)
2469 {
2470         int i;
2471
2472         for (i = 0; i < adapter->num_rx_queues; i++)
2473                 if (adapter->rx_ring[i].desc)
2474                         ixgbevf_free_rx_resources(adapter,
2475                                                   &adapter->rx_ring[i]);
2476 }
2477
2478 static int ixgbevf_setup_queues(struct ixgbevf_adapter *adapter)
2479 {
2480         struct ixgbe_hw *hw = &adapter->hw;
2481         struct ixgbevf_ring *rx_ring;
2482         unsigned int def_q = 0;
2483         unsigned int num_tcs = 0;
2484         unsigned int num_rx_queues = 1;
2485         int err, i;
2486
2487         spin_lock_bh(&adapter->mbx_lock);
2488
2489         /* fetch queue configuration from the PF */
2490         err = ixgbevf_get_queues(hw, &num_tcs, &def_q);
2491
2492         spin_unlock_bh(&adapter->mbx_lock);
2493
2494         if (err)
2495                 return err;
2496
2497         if (num_tcs > 1) {
2498                 /* update default Tx ring register index */
2499                 adapter->tx_ring[0].reg_idx = def_q;
2500
2501                 /* we need as many queues as traffic classes */
2502                 num_rx_queues = num_tcs;
2503         }
2504
2505         /* nothing to do if we have the correct number of queues */
2506         if (adapter->num_rx_queues == num_rx_queues)
2507                 return 0;
2508
2509         /* allocate new rings */
2510         rx_ring = kcalloc(num_rx_queues,
2511                           sizeof(struct ixgbevf_ring), GFP_KERNEL);
2512         if (!rx_ring)
2513                 return -ENOMEM;
2514
2515         /* setup ring fields */
2516         for (i = 0; i < num_rx_queues; i++) {
2517                 rx_ring[i].count = adapter->rx_ring_count;
2518                 rx_ring[i].queue_index = i;
2519                 rx_ring[i].reg_idx = i;
2520                 rx_ring[i].dev = &adapter->pdev->dev;
2521                 rx_ring[i].netdev = adapter->netdev;
2522         }
2523
2524         /* free the existing ring and queues */
2525         adapter->num_rx_queues = 0;
2526         kfree(adapter->rx_ring);
2527
2528         /* move new rings into position on the adapter struct */
2529         adapter->rx_ring = rx_ring;
2530         adapter->num_rx_queues = num_rx_queues;
2531
2532         return 0;
2533 }
2534
2535 /**
2536  * ixgbevf_open - Called when a network interface is made active
2537  * @netdev: network interface device structure
2538  *
2539  * Returns 0 on success, negative value on failure
2540  *
2541  * The open entry point is called when a network interface is made
2542  * active by the system (IFF_UP).  At this point all resources needed
2543  * for transmit and receive operations are allocated, the interrupt
2544  * handler is registered with the OS, the watchdog timer is started,
2545  * and the stack is notified that the interface is ready.
2546  **/
2547 static int ixgbevf_open(struct net_device *netdev)
2548 {
2549         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
2550         struct ixgbe_hw *hw = &adapter->hw;
2551         int err;
2552
2553         /* disallow open during test */
2554         if (test_bit(__IXGBEVF_TESTING, &adapter->state))
2555                 return -EBUSY;
2556
2557         if (hw->adapter_stopped) {
2558                 ixgbevf_reset(adapter);
2559                 /* if adapter is still stopped then PF isn't up and
2560                  * the vf can't start. */
2561                 if (hw->adapter_stopped) {
2562                         err = IXGBE_ERR_MBX;
2563                         pr_err("Unable to start - perhaps the PF Driver isn't "
2564                                "up yet\n");
2565                         goto err_setup_reset;
2566                 }
2567         }
2568
2569         ixgbevf_negotiate_api(adapter);
2570
2571         /* setup queue reg_idx and Rx queue count */
2572         err = ixgbevf_setup_queues(adapter);
2573         if (err)
2574                 goto err_setup_queues;
2575
2576         /* allocate transmit descriptors */
2577         err = ixgbevf_setup_all_tx_resources(adapter);
2578         if (err)
2579                 goto err_setup_tx;
2580
2581         /* allocate receive descriptors */
2582         err = ixgbevf_setup_all_rx_resources(adapter);
2583         if (err)
2584                 goto err_setup_rx;
2585
2586         ixgbevf_configure(adapter);
2587
2588         /*
2589          * Map the Tx/Rx rings to the vectors we were allotted.
2590          * if request_irq will be called in this function map_rings
2591          * must be called *before* up_complete
2592          */
2593         ixgbevf_map_rings_to_vectors(adapter);
2594
2595         ixgbevf_up_complete(adapter);
2596
2597         /* clear any pending interrupts, may auto mask */
2598         IXGBE_READ_REG(hw, IXGBE_VTEICR);
2599         err = ixgbevf_request_irq(adapter);
2600         if (err)
2601                 goto err_req_irq;
2602
2603         ixgbevf_irq_enable(adapter);
2604
2605         return 0;
2606
2607 err_req_irq:
2608         ixgbevf_down(adapter);
2609         ixgbevf_free_irq(adapter);
2610 err_setup_rx:
2611         ixgbevf_free_all_rx_resources(adapter);
2612 err_setup_tx:
2613         ixgbevf_free_all_tx_resources(adapter);
2614 err_setup_queues:
2615         ixgbevf_reset(adapter);
2616
2617 err_setup_reset:
2618
2619         return err;
2620 }
2621
2622 /**
2623  * ixgbevf_close - Disables a network interface
2624  * @netdev: network interface device structure
2625  *
2626  * Returns 0, this is not allowed to fail
2627  *
2628  * The close entry point is called when an interface is de-activated
2629  * by the OS.  The hardware is still under the drivers control, but
2630  * needs to be disabled.  A global MAC reset is issued to stop the
2631  * hardware, and all transmit and receive resources are freed.
2632  **/
2633 static int ixgbevf_close(struct net_device *netdev)
2634 {
2635         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
2636
2637         ixgbevf_down(adapter);
2638         ixgbevf_free_irq(adapter);
2639
2640         ixgbevf_free_all_tx_resources(adapter);
2641         ixgbevf_free_all_rx_resources(adapter);
2642
2643         return 0;
2644 }
2645
2646 static void ixgbevf_tx_ctxtdesc(struct ixgbevf_ring *tx_ring,
2647                                 u32 vlan_macip_lens, u32 type_tucmd,
2648                                 u32 mss_l4len_idx)
2649 {
2650         struct ixgbe_adv_tx_context_desc *context_desc;
2651         u16 i = tx_ring->next_to_use;
2652
2653         context_desc = IXGBEVF_TX_CTXTDESC(tx_ring, i);
2654
2655         i++;
2656         tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
2657
2658         /* set bits to identify this as an advanced context descriptor */
2659         type_tucmd |= IXGBE_TXD_CMD_DEXT | IXGBE_ADVTXD_DTYP_CTXT;
2660
2661         context_desc->vlan_macip_lens   = cpu_to_le32(vlan_macip_lens);
2662         context_desc->seqnum_seed       = 0;
2663         context_desc->type_tucmd_mlhl   = cpu_to_le32(type_tucmd);
2664         context_desc->mss_l4len_idx     = cpu_to_le32(mss_l4len_idx);
2665 }
2666
2667 static int ixgbevf_tso(struct ixgbevf_ring *tx_ring,
2668                        struct sk_buff *skb, u32 tx_flags, u8 *hdr_len)
2669 {
2670         u32 vlan_macip_lens, type_tucmd;
2671         u32 mss_l4len_idx, l4len;
2672
2673         if (!skb_is_gso(skb))
2674                 return 0;
2675
2676         if (skb_header_cloned(skb)) {
2677                 int err = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
2678                 if (err)
2679                         return err;
2680         }
2681
2682         /* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
2683         type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;
2684
2685         if (skb->protocol == htons(ETH_P_IP)) {
2686                 struct iphdr *iph = ip_hdr(skb);
2687                 iph->tot_len = 0;
2688                 iph->check = 0;
2689                 tcp_hdr(skb)->check = ~csum_tcpudp_magic(iph->saddr,
2690                                                          iph->daddr, 0,
2691                                                          IPPROTO_TCP,
2692                                                          0);
2693                 type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
2694         } else if (skb_is_gso_v6(skb)) {
2695                 ipv6_hdr(skb)->payload_len = 0;
2696                 tcp_hdr(skb)->check =
2697                     ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr,
2698                                      &ipv6_hdr(skb)->daddr,
2699                                      0, IPPROTO_TCP, 0);
2700         }
2701
2702         /* compute header lengths */
2703         l4len = tcp_hdrlen(skb);
2704         *hdr_len += l4len;
2705         *hdr_len = skb_transport_offset(skb) + l4len;
2706
2707         /* mss_l4len_id: use 1 as index for TSO */
2708         mss_l4len_idx = l4len << IXGBE_ADVTXD_L4LEN_SHIFT;
2709         mss_l4len_idx |= skb_shinfo(skb)->gso_size << IXGBE_ADVTXD_MSS_SHIFT;
2710         mss_l4len_idx |= 1 << IXGBE_ADVTXD_IDX_SHIFT;
2711
2712         /* vlan_macip_lens: HEADLEN, MACLEN, VLAN tag */
2713         vlan_macip_lens = skb_network_header_len(skb);
2714         vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
2715         vlan_macip_lens |= tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
2716
2717         ixgbevf_tx_ctxtdesc(tx_ring, vlan_macip_lens,
2718                             type_tucmd, mss_l4len_idx);
2719
2720         return 1;
2721 }
2722
2723 static bool ixgbevf_tx_csum(struct ixgbevf_ring *tx_ring,
2724                             struct sk_buff *skb, u32 tx_flags)
2725 {
2726
2727
2728
2729         u32 vlan_macip_lens = 0;
2730         u32 mss_l4len_idx = 0;
2731         u32 type_tucmd = 0;
2732
2733         if (skb->ip_summed == CHECKSUM_PARTIAL) {
2734                 u8 l4_hdr = 0;
2735                 switch (skb->protocol) {
2736                 case __constant_htons(ETH_P_IP):
2737                         vlan_macip_lens |= skb_network_header_len(skb);
2738                         type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
2739                         l4_hdr = ip_hdr(skb)->protocol;
2740                         break;
2741                 case __constant_htons(ETH_P_IPV6):
2742                         vlan_macip_lens |= skb_network_header_len(skb);
2743                         l4_hdr = ipv6_hdr(skb)->nexthdr;
2744                         break;
2745                 default:
2746                         if (unlikely(net_ratelimit())) {
2747                                 dev_warn(tx_ring->dev,
2748                                  "partial checksum but proto=%x!\n",
2749                                  skb->protocol);
2750                         }
2751                         break;
2752                 }
2753
2754                 switch (l4_hdr) {
2755                 case IPPROTO_TCP:
2756                         type_tucmd |= IXGBE_ADVTXD_TUCMD_L4T_TCP;
2757                         mss_l4len_idx = tcp_hdrlen(skb) <<
2758                                         IXGBE_ADVTXD_L4LEN_SHIFT;
2759                         break;
2760                 case IPPROTO_SCTP:
2761                         type_tucmd |= IXGBE_ADVTXD_TUCMD_L4T_SCTP;
2762                         mss_l4len_idx = sizeof(struct sctphdr) <<
2763                                         IXGBE_ADVTXD_L4LEN_SHIFT;
2764                         break;
2765                 case IPPROTO_UDP:
2766                         mss_l4len_idx = sizeof(struct udphdr) <<
2767                                         IXGBE_ADVTXD_L4LEN_SHIFT;
2768                         break;
2769                 default:
2770                         if (unlikely(net_ratelimit())) {
2771                                 dev_warn(tx_ring->dev,
2772                                  "partial checksum but l4 proto=%x!\n",
2773                                  l4_hdr);
2774                         }
2775                         break;
2776                 }
2777         }
2778
2779         /* vlan_macip_lens: MACLEN, VLAN tag */
2780         vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
2781         vlan_macip_lens |= tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
2782
2783         ixgbevf_tx_ctxtdesc(tx_ring, vlan_macip_lens,
2784                             type_tucmd, mss_l4len_idx);
2785
2786         return (skb->ip_summed == CHECKSUM_PARTIAL);
2787 }
2788
2789 static int ixgbevf_tx_map(struct ixgbevf_ring *tx_ring,
2790                           struct sk_buff *skb, u32 tx_flags,
2791                           unsigned int first)
2792 {
2793         struct ixgbevf_tx_buffer *tx_buffer_info;
2794         unsigned int len;
2795         unsigned int total = skb->len;
2796         unsigned int offset = 0, size;
2797         int count = 0;
2798         unsigned int nr_frags = skb_shinfo(skb)->nr_frags;
2799         unsigned int f;
2800         int i;
2801
2802         i = tx_ring->next_to_use;
2803
2804         len = min(skb_headlen(skb), total);
2805         while (len) {
2806                 tx_buffer_info = &tx_ring->tx_buffer_info[i];
2807                 size = min(len, (unsigned int)IXGBE_MAX_DATA_PER_TXD);
2808
2809                 tx_buffer_info->length = size;
2810                 tx_buffer_info->mapped_as_page = false;
2811                 tx_buffer_info->dma = dma_map_single(tx_ring->dev,
2812                                                      skb->data + offset,
2813                                                      size, DMA_TO_DEVICE);
2814                 if (dma_mapping_error(tx_ring->dev, tx_buffer_info->dma))
2815                         goto dma_error;
2816                 tx_buffer_info->next_to_watch = i;
2817
2818                 len -= size;
2819                 total -= size;
2820                 offset += size;
2821                 count++;
2822                 i++;
2823                 if (i == tx_ring->count)
2824                         i = 0;
2825         }
2826
2827         for (f = 0; f < nr_frags; f++) {
2828                 const struct skb_frag_struct *frag;
2829
2830                 frag = &skb_shinfo(skb)->frags[f];
2831                 len = min((unsigned int)skb_frag_size(frag), total);
2832                 offset = 0;
2833
2834                 while (len) {
2835                         tx_buffer_info = &tx_ring->tx_buffer_info[i];
2836                         size = min(len, (unsigned int)IXGBE_MAX_DATA_PER_TXD);
2837
2838                         tx_buffer_info->length = size;
2839                         tx_buffer_info->dma =
2840                                 skb_frag_dma_map(tx_ring->dev, frag,
2841                                                  offset, size, DMA_TO_DEVICE);
2842                         if (dma_mapping_error(tx_ring->dev,
2843                                               tx_buffer_info->dma))
2844                                 goto dma_error;
2845                         tx_buffer_info->mapped_as_page = true;
2846                         tx_buffer_info->next_to_watch = i;
2847
2848                         len -= size;
2849                         total -= size;
2850                         offset += size;
2851                         count++;
2852                         i++;
2853                         if (i == tx_ring->count)
2854                                 i = 0;
2855                 }
2856                 if (total == 0)
2857                         break;
2858         }
2859
2860         if (i == 0)
2861                 i = tx_ring->count - 1;
2862         else
2863                 i = i - 1;
2864         tx_ring->tx_buffer_info[i].skb = skb;
2865         tx_ring->tx_buffer_info[first].next_to_watch = i;
2866         tx_ring->tx_buffer_info[first].time_stamp = jiffies;
2867
2868         return count;
2869
2870 dma_error:
2871         dev_err(tx_ring->dev, "TX DMA map failed\n");
2872
2873         /* clear timestamp and dma mappings for failed tx_buffer_info map */
2874         tx_buffer_info->dma = 0;
2875         tx_buffer_info->next_to_watch = 0;
2876         count--;
2877
2878         /* clear timestamp and dma mappings for remaining portion of packet */
2879         while (count >= 0) {
2880                 count--;
2881                 i--;
2882                 if (i < 0)
2883                         i += tx_ring->count;
2884                 tx_buffer_info = &tx_ring->tx_buffer_info[i];
2885                 ixgbevf_unmap_and_free_tx_resource(tx_ring, tx_buffer_info);
2886         }
2887
2888         return count;
2889 }
2890
2891 static void ixgbevf_tx_queue(struct ixgbevf_ring *tx_ring, int tx_flags,
2892                              int count, u32 paylen, u8 hdr_len)
2893 {
2894         union ixgbe_adv_tx_desc *tx_desc = NULL;
2895         struct ixgbevf_tx_buffer *tx_buffer_info;
2896         u32 olinfo_status = 0, cmd_type_len = 0;
2897         unsigned int i;
2898
2899         u32 txd_cmd = IXGBE_TXD_CMD_EOP | IXGBE_TXD_CMD_RS | IXGBE_TXD_CMD_IFCS;
2900
2901         cmd_type_len |= IXGBE_ADVTXD_DTYP_DATA;
2902
2903         cmd_type_len |= IXGBE_ADVTXD_DCMD_IFCS | IXGBE_ADVTXD_DCMD_DEXT;
2904
2905         if (tx_flags & IXGBE_TX_FLAGS_VLAN)
2906                 cmd_type_len |= IXGBE_ADVTXD_DCMD_VLE;
2907
2908         if (tx_flags & IXGBE_TX_FLAGS_CSUM)
2909                 olinfo_status |= IXGBE_ADVTXD_POPTS_TXSM;
2910
2911         if (tx_flags & IXGBE_TX_FLAGS_TSO) {
2912                 cmd_type_len |= IXGBE_ADVTXD_DCMD_TSE;
2913
2914                 /* use index 1 context for tso */
2915                 olinfo_status |= (1 << IXGBE_ADVTXD_IDX_SHIFT);
2916                 if (tx_flags & IXGBE_TX_FLAGS_IPV4)
2917                         olinfo_status |= IXGBE_ADVTXD_POPTS_IXSM;
2918
2919         }
2920
2921         /*
2922          * Check Context must be set if Tx switch is enabled, which it
2923          * always is for case where virtual functions are running
2924          */
2925         olinfo_status |= IXGBE_ADVTXD_CC;
2926
2927         olinfo_status |= ((paylen - hdr_len) << IXGBE_ADVTXD_PAYLEN_SHIFT);
2928
2929         i = tx_ring->next_to_use;
2930         while (count--) {
2931                 tx_buffer_info = &tx_ring->tx_buffer_info[i];
2932                 tx_desc = IXGBEVF_TX_DESC(tx_ring, i);
2933                 tx_desc->read.buffer_addr = cpu_to_le64(tx_buffer_info->dma);
2934                 tx_desc->read.cmd_type_len =
2935                         cpu_to_le32(cmd_type_len | tx_buffer_info->length);
2936                 tx_desc->read.olinfo_status = cpu_to_le32(olinfo_status);
2937                 i++;
2938                 if (i == tx_ring->count)
2939                         i = 0;
2940         }
2941
2942         tx_desc->read.cmd_type_len |= cpu_to_le32(txd_cmd);
2943
2944         tx_ring->next_to_use = i;
2945 }
2946
2947 static int __ixgbevf_maybe_stop_tx(struct ixgbevf_ring *tx_ring, int size)
2948 {
2949         struct ixgbevf_adapter *adapter = netdev_priv(tx_ring->netdev);
2950
2951         netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);
2952         /* Herbert's original patch had:
2953          *  smp_mb__after_netif_stop_queue();
2954          * but since that doesn't exist yet, just open code it. */
2955         smp_mb();
2956
2957         /* We need to check again in a case another CPU has just
2958          * made room available. */
2959         if (likely(IXGBE_DESC_UNUSED(tx_ring) < size))
2960                 return -EBUSY;
2961
2962         /* A reprieve! - use start_queue because it doesn't call schedule */
2963         netif_start_subqueue(tx_ring->netdev, tx_ring->queue_index);
2964         ++adapter->restart_queue;
2965         return 0;
2966 }
2967
2968 static int ixgbevf_maybe_stop_tx(struct ixgbevf_ring *tx_ring, int size)
2969 {
2970         if (likely(IXGBE_DESC_UNUSED(tx_ring) >= size))
2971                 return 0;
2972         return __ixgbevf_maybe_stop_tx(tx_ring, size);
2973 }
2974
2975 static int ixgbevf_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
2976 {
2977         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
2978         struct ixgbevf_ring *tx_ring;
2979         unsigned int first;
2980         unsigned int tx_flags = 0;
2981         u8 hdr_len = 0;
2982         int r_idx = 0, tso;
2983         u16 count = TXD_USE_COUNT(skb_headlen(skb));
2984 #if PAGE_SIZE > IXGBE_MAX_DATA_PER_TXD
2985         unsigned short f;
2986 #endif
2987         u8 *dst_mac = skb_header_pointer(skb, 0, 0, NULL);
2988         if (!dst_mac || is_link_local_ether_addr(dst_mac)) {
2989                 dev_kfree_skb(skb);
2990                 return NETDEV_TX_OK;
2991         }
2992
2993         tx_ring = &adapter->tx_ring[r_idx];
2994
2995         /*
2996          * need: 1 descriptor per page * PAGE_SIZE/IXGBE_MAX_DATA_PER_TXD,
2997          *       + 1 desc for skb_headlen/IXGBE_MAX_DATA_PER_TXD,
2998          *       + 2 desc gap to keep tail from touching head,
2999          *       + 1 desc for context descriptor,
3000          * otherwise try next time
3001          */
3002 #if PAGE_SIZE > IXGBE_MAX_DATA_PER_TXD
3003         for (f = 0; f < skb_shinfo(skb)->nr_frags; f++)
3004                 count += TXD_USE_COUNT(skb_shinfo(skb)->frags[f].size);
3005 #else
3006         count += skb_shinfo(skb)->nr_frags;
3007 #endif
3008         if (ixgbevf_maybe_stop_tx(tx_ring, count + 3)) {
3009                 adapter->tx_busy++;
3010                 return NETDEV_TX_BUSY;
3011         }
3012
3013         if (vlan_tx_tag_present(skb)) {
3014                 tx_flags |= vlan_tx_tag_get(skb);
3015                 tx_flags <<= IXGBE_TX_FLAGS_VLAN_SHIFT;
3016                 tx_flags |= IXGBE_TX_FLAGS_VLAN;
3017         }
3018
3019         first = tx_ring->next_to_use;
3020
3021         if (skb->protocol == htons(ETH_P_IP))
3022                 tx_flags |= IXGBE_TX_FLAGS_IPV4;
3023         tso = ixgbevf_tso(tx_ring, skb, tx_flags, &hdr_len);
3024         if (tso < 0) {
3025                 dev_kfree_skb_any(skb);
3026                 return NETDEV_TX_OK;
3027         }
3028
3029         if (tso)
3030                 tx_flags |= IXGBE_TX_FLAGS_TSO | IXGBE_TX_FLAGS_CSUM;
3031         else if (ixgbevf_tx_csum(tx_ring, skb, tx_flags))
3032                 tx_flags |= IXGBE_TX_FLAGS_CSUM;
3033
3034         ixgbevf_tx_queue(tx_ring, tx_flags,
3035                          ixgbevf_tx_map(tx_ring, skb, tx_flags, first),
3036                          skb->len, hdr_len);
3037         /*
3038          * Force memory writes to complete before letting h/w
3039          * know there are new descriptors to fetch.  (Only
3040          * applicable for weak-ordered memory model archs,
3041          * such as IA-64).
3042          */
3043         wmb();
3044
3045         writel(tx_ring->next_to_use, adapter->hw.hw_addr + tx_ring->tail);
3046
3047         ixgbevf_maybe_stop_tx(tx_ring, DESC_NEEDED);
3048
3049         return NETDEV_TX_OK;
3050 }
3051
3052 /**
3053  * ixgbevf_set_mac - Change the Ethernet Address of the NIC
3054  * @netdev: network interface device structure
3055  * @p: pointer to an address structure
3056  *
3057  * Returns 0 on success, negative on failure
3058  **/
3059 static int ixgbevf_set_mac(struct net_device *netdev, void *p)
3060 {
3061         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3062         struct ixgbe_hw *hw = &adapter->hw;
3063         struct sockaddr *addr = p;
3064
3065         if (!is_valid_ether_addr(addr->sa_data))
3066                 return -EADDRNOTAVAIL;
3067
3068         memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
3069         memcpy(hw->mac.addr, addr->sa_data, netdev->addr_len);
3070
3071         spin_lock_bh(&adapter->mbx_lock);
3072
3073         if (hw->mac.ops.set_rar)
3074                 hw->mac.ops.set_rar(hw, 0, hw->mac.addr, 0);
3075
3076         spin_unlock_bh(&adapter->mbx_lock);
3077
3078         return 0;
3079 }
3080
3081 /**
3082  * ixgbevf_change_mtu - Change the Maximum Transfer Unit
3083  * @netdev: network interface device structure
3084  * @new_mtu: new value for maximum frame size
3085  *
3086  * Returns 0 on success, negative on failure
3087  **/
3088 static int ixgbevf_change_mtu(struct net_device *netdev, int new_mtu)
3089 {
3090         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3091         int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN;
3092         int max_possible_frame = MAXIMUM_ETHERNET_VLAN_SIZE;
3093
3094         switch (adapter->hw.api_version) {
3095         case ixgbe_mbox_api_11:
3096                 max_possible_frame = IXGBE_MAX_JUMBO_FRAME_SIZE;
3097                 break;
3098         default:
3099                 if (adapter->hw.mac.type == ixgbe_mac_X540_vf)
3100                         max_possible_frame = IXGBE_MAX_JUMBO_FRAME_SIZE;
3101                 break;
3102         }
3103
3104         /* MTU < 68 is an error and causes problems on some kernels */
3105         if ((new_mtu < 68) || (max_frame > max_possible_frame))
3106                 return -EINVAL;
3107
3108         hw_dbg(&adapter->hw, "changing MTU from %d to %d\n",
3109                netdev->mtu, new_mtu);
3110         /* must set new MTU before calling down or up */
3111         netdev->mtu = new_mtu;
3112
3113         if (netif_running(netdev))
3114                 ixgbevf_reinit_locked(adapter);
3115
3116         return 0;
3117 }
3118
3119 static int ixgbevf_suspend(struct pci_dev *pdev, pm_message_t state)
3120 {
3121         struct net_device *netdev = pci_get_drvdata(pdev);
3122         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3123 #ifdef CONFIG_PM
3124         int retval = 0;
3125 #endif
3126
3127         netif_device_detach(netdev);
3128
3129         if (netif_running(netdev)) {
3130                 rtnl_lock();
3131                 ixgbevf_down(adapter);
3132                 ixgbevf_free_irq(adapter);
3133                 ixgbevf_free_all_tx_resources(adapter);
3134                 ixgbevf_free_all_rx_resources(adapter);
3135                 rtnl_unlock();
3136         }
3137
3138         ixgbevf_clear_interrupt_scheme(adapter);
3139
3140 #ifdef CONFIG_PM
3141         retval = pci_save_state(pdev);
3142         if (retval)
3143                 return retval;
3144
3145 #endif
3146         pci_disable_device(pdev);
3147
3148         return 0;
3149 }
3150
3151 #ifdef CONFIG_PM
3152 static int ixgbevf_resume(struct pci_dev *pdev)
3153 {
3154         struct ixgbevf_adapter *adapter = pci_get_drvdata(pdev);
3155         struct net_device *netdev = adapter->netdev;
3156         u32 err;
3157
3158         pci_set_power_state(pdev, PCI_D0);
3159         pci_restore_state(pdev);
3160         /*
3161          * pci_restore_state clears dev->state_saved so call
3162          * pci_save_state to restore it.
3163          */
3164         pci_save_state(pdev);
3165
3166         err = pci_enable_device_mem(pdev);
3167         if (err) {
3168                 dev_err(&pdev->dev, "Cannot enable PCI device from suspend\n");
3169                 return err;
3170         }
3171         pci_set_master(pdev);
3172
3173         rtnl_lock();
3174         err = ixgbevf_init_interrupt_scheme(adapter);
3175         rtnl_unlock();
3176         if (err) {
3177                 dev_err(&pdev->dev, "Cannot initialize interrupts\n");
3178                 return err;
3179         }
3180
3181         ixgbevf_reset(adapter);
3182
3183         if (netif_running(netdev)) {
3184                 err = ixgbevf_open(netdev);
3185                 if (err)
3186                         return err;
3187         }
3188
3189         netif_device_attach(netdev);
3190
3191         return err;
3192 }
3193
3194 #endif /* CONFIG_PM */
3195 static void ixgbevf_shutdown(struct pci_dev *pdev)
3196 {
3197         ixgbevf_suspend(pdev, PMSG_SUSPEND);
3198 }
3199
3200 static struct rtnl_link_stats64 *ixgbevf_get_stats(struct net_device *netdev,
3201                                                 struct rtnl_link_stats64 *stats)
3202 {
3203         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3204         unsigned int start;
3205         u64 bytes, packets;
3206         const struct ixgbevf_ring *ring;
3207         int i;
3208
3209         ixgbevf_update_stats(adapter);
3210
3211         stats->multicast = adapter->stats.vfmprc - adapter->stats.base_vfmprc;
3212
3213         for (i = 0; i < adapter->num_rx_queues; i++) {
3214                 ring = &adapter->rx_ring[i];
3215                 do {
3216                         start = u64_stats_fetch_begin_bh(&ring->syncp);
3217                         bytes = ring->total_bytes;
3218                         packets = ring->total_packets;
3219                 } while (u64_stats_fetch_retry_bh(&ring->syncp, start));
3220                 stats->rx_bytes += bytes;
3221                 stats->rx_packets += packets;
3222         }
3223
3224         for (i = 0; i < adapter->num_tx_queues; i++) {
3225                 ring = &adapter->tx_ring[i];
3226                 do {
3227                         start = u64_stats_fetch_begin_bh(&ring->syncp);
3228                         bytes = ring->total_bytes;
3229                         packets = ring->total_packets;
3230                 } while (u64_stats_fetch_retry_bh(&ring->syncp, start));
3231                 stats->tx_bytes += bytes;
3232                 stats->tx_packets += packets;
3233         }
3234
3235         return stats;
3236 }
3237
3238 static const struct net_device_ops ixgbevf_netdev_ops = {
3239         .ndo_open               = ixgbevf_open,
3240         .ndo_stop               = ixgbevf_close,
3241         .ndo_start_xmit         = ixgbevf_xmit_frame,
3242         .ndo_set_rx_mode        = ixgbevf_set_rx_mode,
3243         .ndo_get_stats64        = ixgbevf_get_stats,
3244         .ndo_validate_addr      = eth_validate_addr,
3245         .ndo_set_mac_address    = ixgbevf_set_mac,
3246         .ndo_change_mtu         = ixgbevf_change_mtu,
3247         .ndo_tx_timeout         = ixgbevf_tx_timeout,
3248         .ndo_vlan_rx_add_vid    = ixgbevf_vlan_rx_add_vid,
3249         .ndo_vlan_rx_kill_vid   = ixgbevf_vlan_rx_kill_vid,
3250 };
3251
3252 static void ixgbevf_assign_netdev_ops(struct net_device *dev)
3253 {
3254         dev->netdev_ops = &ixgbevf_netdev_ops;
3255         ixgbevf_set_ethtool_ops(dev);
3256         dev->watchdog_timeo = 5 * HZ;
3257 }
3258
3259 /**
3260  * ixgbevf_probe - Device Initialization Routine
3261  * @pdev: PCI device information struct
3262  * @ent: entry in ixgbevf_pci_tbl
3263  *
3264  * Returns 0 on success, negative on failure
3265  *
3266  * ixgbevf_probe initializes an adapter identified by a pci_dev structure.
3267  * The OS initialization, configuring of the adapter private structure,
3268  * and a hardware reset occur.
3269  **/
3270 static int __devinit ixgbevf_probe(struct pci_dev *pdev,
3271                                    const struct pci_device_id *ent)
3272 {
3273         struct net_device *netdev;
3274         struct ixgbevf_adapter *adapter = NULL;
3275         struct ixgbe_hw *hw = NULL;
3276         const struct ixgbevf_info *ii = ixgbevf_info_tbl[ent->driver_data];
3277         static int cards_found;
3278         int err, pci_using_dac;
3279
3280         err = pci_enable_device(pdev);
3281         if (err)
3282                 return err;
3283
3284         if (!dma_set_mask(&pdev->dev, DMA_BIT_MASK(64)) &&
3285             !dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(64))) {
3286                 pci_using_dac = 1;
3287         } else {
3288                 err = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32));
3289                 if (err) {
3290                         err = dma_set_coherent_mask(&pdev->dev,
3291                                                     DMA_BIT_MASK(32));
3292                         if (err) {
3293                                 dev_err(&pdev->dev, "No usable DMA "
3294                                         "configuration, aborting\n");
3295                                 goto err_dma;
3296                         }
3297                 }
3298                 pci_using_dac = 0;
3299         }
3300
3301         err = pci_request_regions(pdev, ixgbevf_driver_name);
3302         if (err) {
3303                 dev_err(&pdev->dev, "pci_request_regions failed 0x%x\n", err);
3304                 goto err_pci_reg;
3305         }
3306
3307         pci_set_master(pdev);
3308
3309         netdev = alloc_etherdev_mq(sizeof(struct ixgbevf_adapter),
3310                                    MAX_TX_QUEUES);
3311         if (!netdev) {
3312                 err = -ENOMEM;
3313                 goto err_alloc_etherdev;
3314         }
3315
3316         SET_NETDEV_DEV(netdev, &pdev->dev);
3317
3318         pci_set_drvdata(pdev, netdev);
3319         adapter = netdev_priv(netdev);
3320
3321         adapter->netdev = netdev;
3322         adapter->pdev = pdev;
3323         hw = &adapter->hw;
3324         hw->back = adapter;
3325         adapter->msg_enable = netif_msg_init(debug, DEFAULT_MSG_ENABLE);
3326
3327         /*
3328          * call save state here in standalone driver because it relies on
3329          * adapter struct to exist, and needs to call netdev_priv
3330          */
3331         pci_save_state(pdev);
3332
3333         hw->hw_addr = ioremap(pci_resource_start(pdev, 0),
3334                               pci_resource_len(pdev, 0));
3335         if (!hw->hw_addr) {
3336                 err = -EIO;
3337                 goto err_ioremap;
3338         }
3339
3340         ixgbevf_assign_netdev_ops(netdev);
3341
3342         adapter->bd_number = cards_found;
3343
3344         /* Setup hw api */
3345         memcpy(&hw->mac.ops, ii->mac_ops, sizeof(hw->mac.ops));
3346         hw->mac.type  = ii->mac;
3347
3348         memcpy(&hw->mbx.ops, &ixgbevf_mbx_ops,
3349                sizeof(struct ixgbe_mbx_operations));
3350
3351         /* setup the private structure */
3352         err = ixgbevf_sw_init(adapter);
3353         if (err)
3354                 goto err_sw_init;
3355
3356         /* The HW MAC address was set and/or determined in sw_init */
3357         memcpy(netdev->perm_addr, adapter->hw.mac.addr, netdev->addr_len);
3358
3359         if (!is_valid_ether_addr(netdev->dev_addr)) {
3360                 pr_err("invalid MAC address\n");
3361                 err = -EIO;
3362                 goto err_sw_init;
3363         }
3364
3365         netdev->hw_features = NETIF_F_SG |
3366                            NETIF_F_IP_CSUM |
3367                            NETIF_F_IPV6_CSUM |
3368                            NETIF_F_TSO |
3369                            NETIF_F_TSO6 |
3370                            NETIF_F_RXCSUM;
3371
3372         netdev->features = netdev->hw_features |
3373                            NETIF_F_HW_VLAN_TX |
3374                            NETIF_F_HW_VLAN_RX |
3375                            NETIF_F_HW_VLAN_FILTER;
3376
3377         netdev->vlan_features |= NETIF_F_TSO;
3378         netdev->vlan_features |= NETIF_F_TSO6;
3379         netdev->vlan_features |= NETIF_F_IP_CSUM;
3380         netdev->vlan_features |= NETIF_F_IPV6_CSUM;
3381         netdev->vlan_features |= NETIF_F_SG;
3382
3383         if (pci_using_dac)
3384                 netdev->features |= NETIF_F_HIGHDMA;
3385
3386         netdev->priv_flags |= IFF_UNICAST_FLT;
3387
3388         init_timer(&adapter->watchdog_timer);
3389         adapter->watchdog_timer.function = ixgbevf_watchdog;
3390         adapter->watchdog_timer.data = (unsigned long)adapter;
3391
3392         INIT_WORK(&adapter->reset_task, ixgbevf_reset_task);
3393         INIT_WORK(&adapter->watchdog_task, ixgbevf_watchdog_task);
3394
3395         err = ixgbevf_init_interrupt_scheme(adapter);
3396         if (err)
3397                 goto err_sw_init;
3398
3399         /* pick up the PCI bus settings for reporting later */
3400         if (hw->mac.ops.get_bus_info)
3401                 hw->mac.ops.get_bus_info(hw);
3402
3403         strcpy(netdev->name, "eth%d");
3404
3405         err = register_netdev(netdev);
3406         if (err)
3407                 goto err_register;
3408
3409         netif_carrier_off(netdev);
3410
3411         ixgbevf_init_last_counter_stats(adapter);
3412
3413         /* print the MAC address */
3414         hw_dbg(hw, "%pM\n", netdev->dev_addr);
3415
3416         hw_dbg(hw, "MAC: %d\n", hw->mac.type);
3417
3418         hw_dbg(hw, "Intel(R) 82599 Virtual Function\n");
3419         cards_found++;
3420         return 0;
3421
3422 err_register:
3423         ixgbevf_clear_interrupt_scheme(adapter);
3424 err_sw_init:
3425         ixgbevf_reset_interrupt_capability(adapter);
3426         iounmap(hw->hw_addr);
3427 err_ioremap:
3428         free_netdev(netdev);
3429 err_alloc_etherdev:
3430         pci_release_regions(pdev);
3431 err_pci_reg:
3432 err_dma:
3433         pci_disable_device(pdev);
3434         return err;
3435 }
3436
3437 /**
3438  * ixgbevf_remove - Device Removal Routine
3439  * @pdev: PCI device information struct
3440  *
3441  * ixgbevf_remove is called by the PCI subsystem to alert the driver
3442  * that it should release a PCI device.  The could be caused by a
3443  * Hot-Plug event, or because the driver is going to be removed from
3444  * memory.
3445  **/
3446 static void __devexit ixgbevf_remove(struct pci_dev *pdev)
3447 {
3448         struct net_device *netdev = pci_get_drvdata(pdev);
3449         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3450
3451         set_bit(__IXGBEVF_DOWN, &adapter->state);
3452
3453         del_timer_sync(&adapter->watchdog_timer);
3454
3455         cancel_work_sync(&adapter->reset_task);
3456         cancel_work_sync(&adapter->watchdog_task);
3457
3458         if (netdev->reg_state == NETREG_REGISTERED)
3459                 unregister_netdev(netdev);
3460
3461         ixgbevf_clear_interrupt_scheme(adapter);
3462         ixgbevf_reset_interrupt_capability(adapter);
3463
3464         iounmap(adapter->hw.hw_addr);
3465         pci_release_regions(pdev);
3466
3467         hw_dbg(&adapter->hw, "Remove complete\n");
3468
3469         kfree(adapter->tx_ring);
3470         kfree(adapter->rx_ring);
3471
3472         free_netdev(netdev);
3473
3474         pci_disable_device(pdev);
3475 }
3476
3477 /**
3478  * ixgbevf_io_error_detected - called when PCI error is detected
3479  * @pdev: Pointer to PCI device
3480  * @state: The current pci connection state
3481  *
3482  * This function is called after a PCI bus error affecting
3483  * this device has been detected.
3484  */
3485 static pci_ers_result_t ixgbevf_io_error_detected(struct pci_dev *pdev,
3486                                                   pci_channel_state_t state)
3487 {
3488         struct net_device *netdev = pci_get_drvdata(pdev);
3489         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3490
3491         netif_device_detach(netdev);
3492
3493         if (state == pci_channel_io_perm_failure)
3494                 return PCI_ERS_RESULT_DISCONNECT;
3495
3496         if (netif_running(netdev))
3497                 ixgbevf_down(adapter);
3498
3499         pci_disable_device(pdev);
3500
3501         /* Request a slot slot reset. */
3502         return PCI_ERS_RESULT_NEED_RESET;
3503 }
3504
3505 /**
3506  * ixgbevf_io_slot_reset - called after the pci bus has been reset.
3507  * @pdev: Pointer to PCI device
3508  *
3509  * Restart the card from scratch, as if from a cold-boot. Implementation
3510  * resembles the first-half of the ixgbevf_resume routine.
3511  */
3512 static pci_ers_result_t ixgbevf_io_slot_reset(struct pci_dev *pdev)
3513 {
3514         struct net_device *netdev = pci_get_drvdata(pdev);
3515         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3516
3517         if (pci_enable_device_mem(pdev)) {
3518                 dev_err(&pdev->dev,
3519                         "Cannot re-enable PCI device after reset.\n");
3520                 return PCI_ERS_RESULT_DISCONNECT;
3521         }
3522
3523         pci_set_master(pdev);
3524
3525         ixgbevf_reset(adapter);
3526
3527         return PCI_ERS_RESULT_RECOVERED;
3528 }
3529
3530 /**
3531  * ixgbevf_io_resume - called when traffic can start flowing again.
3532  * @pdev: Pointer to PCI device
3533  *
3534  * This callback is called when the error recovery driver tells us that
3535  * its OK to resume normal operation. Implementation resembles the
3536  * second-half of the ixgbevf_resume routine.
3537  */
3538 static void ixgbevf_io_resume(struct pci_dev *pdev)
3539 {
3540         struct net_device *netdev = pci_get_drvdata(pdev);
3541         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3542
3543         if (netif_running(netdev))
3544                 ixgbevf_up(adapter);
3545
3546         netif_device_attach(netdev);
3547 }
3548
3549 /* PCI Error Recovery (ERS) */
3550 static const struct pci_error_handlers ixgbevf_err_handler = {
3551         .error_detected = ixgbevf_io_error_detected,
3552         .slot_reset = ixgbevf_io_slot_reset,
3553         .resume = ixgbevf_io_resume,
3554 };
3555
3556 static struct pci_driver ixgbevf_driver = {
3557         .name     = ixgbevf_driver_name,
3558         .id_table = ixgbevf_pci_tbl,
3559         .probe    = ixgbevf_probe,
3560         .remove   = __devexit_p(ixgbevf_remove),
3561 #ifdef CONFIG_PM
3562         /* Power Management Hooks */
3563         .suspend  = ixgbevf_suspend,
3564         .resume   = ixgbevf_resume,
3565 #endif
3566         .shutdown = ixgbevf_shutdown,
3567         .err_handler = &ixgbevf_err_handler
3568 };
3569
3570 /**
3571  * ixgbevf_init_module - Driver Registration Routine
3572  *
3573  * ixgbevf_init_module is the first routine called when the driver is
3574  * loaded. All it does is register with the PCI subsystem.
3575  **/
3576 static int __init ixgbevf_init_module(void)
3577 {
3578         int ret;
3579         pr_info("%s - version %s\n", ixgbevf_driver_string,
3580                 ixgbevf_driver_version);
3581
3582         pr_info("%s\n", ixgbevf_copyright);
3583
3584         ret = pci_register_driver(&ixgbevf_driver);
3585         return ret;
3586 }
3587
3588 module_init(ixgbevf_init_module);
3589
3590 /**
3591  * ixgbevf_exit_module - Driver Exit Cleanup Routine
3592  *
3593  * ixgbevf_exit_module is called just before the driver is removed
3594  * from memory.
3595  **/
3596 static void __exit ixgbevf_exit_module(void)
3597 {
3598         pci_unregister_driver(&ixgbevf_driver);
3599 }
3600
3601 #ifdef DEBUG
3602 /**
3603  * ixgbevf_get_hw_dev_name - return device name string
3604  * used by hardware layer to print debugging information
3605  **/
3606 char *ixgbevf_get_hw_dev_name(struct ixgbe_hw *hw)
3607 {
3608         struct ixgbevf_adapter *adapter = hw->back;
3609         return adapter->netdev->name;
3610 }
3611
3612 #endif
3613 module_exit(ixgbevf_exit_module);
3614
3615 /* ixgbevf_main.c */