sfc: Record hardware RX hash on each skb where possible
[pandora-kernel.git] / drivers / net / sfc / efx.c
1 /****************************************************************************
2  * Driver for Solarflare Solarstorm network controllers and boards
3  * Copyright 2005-2006 Fen Systems Ltd.
4  * Copyright 2005-2009 Solarflare Communications Inc.
5  *
6  * This program is free software; you can redistribute it and/or modify it
7  * under the terms of the GNU General Public License version 2 as published
8  * by the Free Software Foundation, incorporated herein by reference.
9  */
10
11 #include <linux/module.h>
12 #include <linux/pci.h>
13 #include <linux/netdevice.h>
14 #include <linux/etherdevice.h>
15 #include <linux/delay.h>
16 #include <linux/notifier.h>
17 #include <linux/ip.h>
18 #include <linux/tcp.h>
19 #include <linux/in.h>
20 #include <linux/crc32.h>
21 #include <linux/ethtool.h>
22 #include <linux/topology.h>
23 #include <linux/gfp.h>
24 #include "net_driver.h"
25 #include "efx.h"
26 #include "mdio_10g.h"
27 #include "nic.h"
28
29 #include "mcdi.h"
30 #include "workarounds.h"
31
32 /**************************************************************************
33  *
34  * Type name strings
35  *
36  **************************************************************************
37  */
38
39 /* Loopback mode names (see LOOPBACK_MODE()) */
40 const unsigned int efx_loopback_mode_max = LOOPBACK_MAX;
41 const char *efx_loopback_mode_names[] = {
42         [LOOPBACK_NONE]         = "NONE",
43         [LOOPBACK_DATA]         = "DATAPATH",
44         [LOOPBACK_GMAC]         = "GMAC",
45         [LOOPBACK_XGMII]        = "XGMII",
46         [LOOPBACK_XGXS]         = "XGXS",
47         [LOOPBACK_XAUI]         = "XAUI",
48         [LOOPBACK_GMII]         = "GMII",
49         [LOOPBACK_SGMII]        = "SGMII",
50         [LOOPBACK_XGBR]         = "XGBR",
51         [LOOPBACK_XFI]          = "XFI",
52         [LOOPBACK_XAUI_FAR]     = "XAUI_FAR",
53         [LOOPBACK_GMII_FAR]     = "GMII_FAR",
54         [LOOPBACK_SGMII_FAR]    = "SGMII_FAR",
55         [LOOPBACK_XFI_FAR]      = "XFI_FAR",
56         [LOOPBACK_GPHY]         = "GPHY",
57         [LOOPBACK_PHYXS]        = "PHYXS",
58         [LOOPBACK_PCS]          = "PCS",
59         [LOOPBACK_PMAPMD]       = "PMA/PMD",
60         [LOOPBACK_XPORT]        = "XPORT",
61         [LOOPBACK_XGMII_WS]     = "XGMII_WS",
62         [LOOPBACK_XAUI_WS]      = "XAUI_WS",
63         [LOOPBACK_XAUI_WS_FAR]  = "XAUI_WS_FAR",
64         [LOOPBACK_XAUI_WS_NEAR] = "XAUI_WS_NEAR",
65         [LOOPBACK_GMII_WS]      = "GMII_WS",
66         [LOOPBACK_XFI_WS]       = "XFI_WS",
67         [LOOPBACK_XFI_WS_FAR]   = "XFI_WS_FAR",
68         [LOOPBACK_PHYXS_WS]     = "PHYXS_WS",
69 };
70
71 /* Interrupt mode names (see INT_MODE())) */
72 const unsigned int efx_interrupt_mode_max = EFX_INT_MODE_MAX;
73 const char *efx_interrupt_mode_names[] = {
74         [EFX_INT_MODE_MSIX]   = "MSI-X",
75         [EFX_INT_MODE_MSI]    = "MSI",
76         [EFX_INT_MODE_LEGACY] = "legacy",
77 };
78
79 const unsigned int efx_reset_type_max = RESET_TYPE_MAX;
80 const char *efx_reset_type_names[] = {
81         [RESET_TYPE_INVISIBLE]     = "INVISIBLE",
82         [RESET_TYPE_ALL]           = "ALL",
83         [RESET_TYPE_WORLD]         = "WORLD",
84         [RESET_TYPE_DISABLE]       = "DISABLE",
85         [RESET_TYPE_TX_WATCHDOG]   = "TX_WATCHDOG",
86         [RESET_TYPE_INT_ERROR]     = "INT_ERROR",
87         [RESET_TYPE_RX_RECOVERY]   = "RX_RECOVERY",
88         [RESET_TYPE_RX_DESC_FETCH] = "RX_DESC_FETCH",
89         [RESET_TYPE_TX_DESC_FETCH] = "TX_DESC_FETCH",
90         [RESET_TYPE_TX_SKIP]       = "TX_SKIP",
91         [RESET_TYPE_MC_FAILURE]    = "MC_FAILURE",
92 };
93
94 #define EFX_MAX_MTU (9 * 1024)
95
96 /* Reset workqueue. If any NIC has a hardware failure then a reset will be
97  * queued onto this work queue. This is not a per-nic work queue, because
98  * efx_reset_work() acquires the rtnl lock, so resets are naturally serialised.
99  */
100 static struct workqueue_struct *reset_workqueue;
101
102 /**************************************************************************
103  *
104  * Configurable values
105  *
106  *************************************************************************/
107
108 /*
109  * Use separate channels for TX and RX events
110  *
111  * Set this to 1 to use separate channels for TX and RX. It allows us
112  * to control interrupt affinity separately for TX and RX.
113  *
114  * This is only used in MSI-X interrupt mode
115  */
116 static unsigned int separate_tx_channels;
117 module_param(separate_tx_channels, uint, 0644);
118 MODULE_PARM_DESC(separate_tx_channels,
119                  "Use separate channels for TX and RX");
120
121 /* This is the weight assigned to each of the (per-channel) virtual
122  * NAPI devices.
123  */
124 static int napi_weight = 64;
125
126 /* This is the time (in jiffies) between invocations of the hardware
127  * monitor, which checks for known hardware bugs and resets the
128  * hardware and driver as necessary.
129  */
130 unsigned int efx_monitor_interval = 1 * HZ;
131
132 /* This controls whether or not the driver will initialise devices
133  * with invalid MAC addresses stored in the EEPROM or flash.  If true,
134  * such devices will be initialised with a random locally-generated
135  * MAC address.  This allows for loading the sfc_mtd driver to
136  * reprogram the flash, even if the flash contents (including the MAC
137  * address) have previously been erased.
138  */
139 static unsigned int allow_bad_hwaddr;
140
141 /* Initial interrupt moderation settings.  They can be modified after
142  * module load with ethtool.
143  *
144  * The default for RX should strike a balance between increasing the
145  * round-trip latency and reducing overhead.
146  */
147 static unsigned int rx_irq_mod_usec = 60;
148
149 /* Initial interrupt moderation settings.  They can be modified after
150  * module load with ethtool.
151  *
152  * This default is chosen to ensure that a 10G link does not go idle
153  * while a TX queue is stopped after it has become full.  A queue is
154  * restarted when it drops below half full.  The time this takes (assuming
155  * worst case 3 descriptors per packet and 1024 descriptors) is
156  *   512 / 3 * 1.2 = 205 usec.
157  */
158 static unsigned int tx_irq_mod_usec = 150;
159
160 /* This is the first interrupt mode to try out of:
161  * 0 => MSI-X
162  * 1 => MSI
163  * 2 => legacy
164  */
165 static unsigned int interrupt_mode;
166
167 /* This is the requested number of CPUs to use for Receive-Side Scaling (RSS),
168  * i.e. the number of CPUs among which we may distribute simultaneous
169  * interrupt handling.
170  *
171  * Cards without MSI-X will only target one CPU via legacy or MSI interrupt.
172  * The default (0) means to assign an interrupt to each package (level II cache)
173  */
174 static unsigned int rss_cpus;
175 module_param(rss_cpus, uint, 0444);
176 MODULE_PARM_DESC(rss_cpus, "Number of CPUs to use for Receive-Side Scaling");
177
178 static int phy_flash_cfg;
179 module_param(phy_flash_cfg, int, 0644);
180 MODULE_PARM_DESC(phy_flash_cfg, "Set PHYs into reflash mode initially");
181
182 static unsigned irq_adapt_low_thresh = 10000;
183 module_param(irq_adapt_low_thresh, uint, 0644);
184 MODULE_PARM_DESC(irq_adapt_low_thresh,
185                  "Threshold score for reducing IRQ moderation");
186
187 static unsigned irq_adapt_high_thresh = 20000;
188 module_param(irq_adapt_high_thresh, uint, 0644);
189 MODULE_PARM_DESC(irq_adapt_high_thresh,
190                  "Threshold score for increasing IRQ moderation");
191
192 static unsigned debug = (NETIF_MSG_DRV | NETIF_MSG_PROBE |
193                          NETIF_MSG_LINK | NETIF_MSG_IFDOWN |
194                          NETIF_MSG_IFUP | NETIF_MSG_RX_ERR |
195                          NETIF_MSG_TX_ERR | NETIF_MSG_HW);
196 module_param(debug, uint, 0);
197 MODULE_PARM_DESC(debug, "Bitmapped debugging message enable value");
198
199 /**************************************************************************
200  *
201  * Utility functions and prototypes
202  *
203  *************************************************************************/
204 static void efx_remove_channel(struct efx_channel *channel);
205 static void efx_remove_port(struct efx_nic *efx);
206 static void efx_fini_napi(struct efx_nic *efx);
207 static void efx_fini_channels(struct efx_nic *efx);
208
209 #define EFX_ASSERT_RESET_SERIALISED(efx)                \
210         do {                                            \
211                 if ((efx->state == STATE_RUNNING) ||    \
212                     (efx->state == STATE_DISABLED))     \
213                         ASSERT_RTNL();                  \
214         } while (0)
215
216 /**************************************************************************
217  *
218  * Event queue processing
219  *
220  *************************************************************************/
221
222 /* Process channel's event queue
223  *
224  * This function is responsible for processing the event queue of a
225  * single channel.  The caller must guarantee that this function will
226  * never be concurrently called more than once on the same channel,
227  * though different channels may be being processed concurrently.
228  */
229 static int efx_process_channel(struct efx_channel *channel, int budget)
230 {
231         struct efx_nic *efx = channel->efx;
232         int spent;
233
234         if (unlikely(efx->reset_pending != RESET_TYPE_NONE ||
235                      !channel->enabled))
236                 return 0;
237
238         spent = efx_nic_process_eventq(channel, budget);
239         if (spent == 0)
240                 return 0;
241
242         /* Deliver last RX packet. */
243         if (channel->rx_pkt) {
244                 __efx_rx_packet(channel, channel->rx_pkt,
245                                 channel->rx_pkt_csummed);
246                 channel->rx_pkt = NULL;
247         }
248
249         efx_rx_strategy(channel);
250
251         efx_fast_push_rx_descriptors(&efx->rx_queue[channel->channel]);
252
253         return spent;
254 }
255
256 /* Mark channel as finished processing
257  *
258  * Note that since we will not receive further interrupts for this
259  * channel before we finish processing and call the eventq_read_ack()
260  * method, there is no need to use the interrupt hold-off timers.
261  */
262 static inline void efx_channel_processed(struct efx_channel *channel)
263 {
264         /* The interrupt handler for this channel may set work_pending
265          * as soon as we acknowledge the events we've seen.  Make sure
266          * it's cleared before then. */
267         channel->work_pending = false;
268         smp_wmb();
269
270         efx_nic_eventq_read_ack(channel);
271 }
272
273 /* NAPI poll handler
274  *
275  * NAPI guarantees serialisation of polls of the same device, which
276  * provides the guarantee required by efx_process_channel().
277  */
278 static int efx_poll(struct napi_struct *napi, int budget)
279 {
280         struct efx_channel *channel =
281                 container_of(napi, struct efx_channel, napi_str);
282         struct efx_nic *efx = channel->efx;
283         int spent;
284
285         netif_vdbg(efx, intr, efx->net_dev,
286                    "channel %d NAPI poll executing on CPU %d\n",
287                    channel->channel, raw_smp_processor_id());
288
289         spent = efx_process_channel(channel, budget);
290
291         if (spent < budget) {
292                 if (channel->channel < efx->n_rx_channels &&
293                     efx->irq_rx_adaptive &&
294                     unlikely(++channel->irq_count == 1000)) {
295                         if (unlikely(channel->irq_mod_score <
296                                      irq_adapt_low_thresh)) {
297                                 if (channel->irq_moderation > 1) {
298                                         channel->irq_moderation -= 1;
299                                         efx->type->push_irq_moderation(channel);
300                                 }
301                         } else if (unlikely(channel->irq_mod_score >
302                                             irq_adapt_high_thresh)) {
303                                 if (channel->irq_moderation <
304                                     efx->irq_rx_moderation) {
305                                         channel->irq_moderation += 1;
306                                         efx->type->push_irq_moderation(channel);
307                                 }
308                         }
309                         channel->irq_count = 0;
310                         channel->irq_mod_score = 0;
311                 }
312
313                 /* There is no race here; although napi_disable() will
314                  * only wait for napi_complete(), this isn't a problem
315                  * since efx_channel_processed() will have no effect if
316                  * interrupts have already been disabled.
317                  */
318                 napi_complete(napi);
319                 efx_channel_processed(channel);
320         }
321
322         return spent;
323 }
324
325 /* Process the eventq of the specified channel immediately on this CPU
326  *
327  * Disable hardware generated interrupts, wait for any existing
328  * processing to finish, then directly poll (and ack ) the eventq.
329  * Finally reenable NAPI and interrupts.
330  *
331  * Since we are touching interrupts the caller should hold the suspend lock
332  */
333 void efx_process_channel_now(struct efx_channel *channel)
334 {
335         struct efx_nic *efx = channel->efx;
336
337         BUG_ON(!channel->enabled);
338
339         /* Disable interrupts and wait for ISRs to complete */
340         efx_nic_disable_interrupts(efx);
341         if (efx->legacy_irq)
342                 synchronize_irq(efx->legacy_irq);
343         if (channel->irq)
344                 synchronize_irq(channel->irq);
345
346         /* Wait for any NAPI processing to complete */
347         napi_disable(&channel->napi_str);
348
349         /* Poll the channel */
350         efx_process_channel(channel, EFX_EVQ_SIZE);
351
352         /* Ack the eventq. This may cause an interrupt to be generated
353          * when they are reenabled */
354         efx_channel_processed(channel);
355
356         napi_enable(&channel->napi_str);
357         efx_nic_enable_interrupts(efx);
358 }
359
360 /* Create event queue
361  * Event queue memory allocations are done only once.  If the channel
362  * is reset, the memory buffer will be reused; this guards against
363  * errors during channel reset and also simplifies interrupt handling.
364  */
365 static int efx_probe_eventq(struct efx_channel *channel)
366 {
367         netif_dbg(channel->efx, probe, channel->efx->net_dev,
368                   "chan %d create event queue\n", channel->channel);
369
370         return efx_nic_probe_eventq(channel);
371 }
372
373 /* Prepare channel's event queue */
374 static void efx_init_eventq(struct efx_channel *channel)
375 {
376         netif_dbg(channel->efx, drv, channel->efx->net_dev,
377                   "chan %d init event queue\n", channel->channel);
378
379         channel->eventq_read_ptr = 0;
380
381         efx_nic_init_eventq(channel);
382 }
383
384 static void efx_fini_eventq(struct efx_channel *channel)
385 {
386         netif_dbg(channel->efx, drv, channel->efx->net_dev,
387                   "chan %d fini event queue\n", channel->channel);
388
389         efx_nic_fini_eventq(channel);
390 }
391
392 static void efx_remove_eventq(struct efx_channel *channel)
393 {
394         netif_dbg(channel->efx, drv, channel->efx->net_dev,
395                   "chan %d remove event queue\n", channel->channel);
396
397         efx_nic_remove_eventq(channel);
398 }
399
400 /**************************************************************************
401  *
402  * Channel handling
403  *
404  *************************************************************************/
405
406 static int efx_probe_channel(struct efx_channel *channel)
407 {
408         struct efx_tx_queue *tx_queue;
409         struct efx_rx_queue *rx_queue;
410         int rc;
411
412         netif_dbg(channel->efx, probe, channel->efx->net_dev,
413                   "creating channel %d\n", channel->channel);
414
415         rc = efx_probe_eventq(channel);
416         if (rc)
417                 goto fail1;
418
419         efx_for_each_channel_tx_queue(tx_queue, channel) {
420                 rc = efx_probe_tx_queue(tx_queue);
421                 if (rc)
422                         goto fail2;
423         }
424
425         efx_for_each_channel_rx_queue(rx_queue, channel) {
426                 rc = efx_probe_rx_queue(rx_queue);
427                 if (rc)
428                         goto fail3;
429         }
430
431         channel->n_rx_frm_trunc = 0;
432
433         return 0;
434
435  fail3:
436         efx_for_each_channel_rx_queue(rx_queue, channel)
437                 efx_remove_rx_queue(rx_queue);
438  fail2:
439         efx_for_each_channel_tx_queue(tx_queue, channel)
440                 efx_remove_tx_queue(tx_queue);
441  fail1:
442         return rc;
443 }
444
445
446 static void efx_set_channel_names(struct efx_nic *efx)
447 {
448         struct efx_channel *channel;
449         const char *type = "";
450         int number;
451
452         efx_for_each_channel(channel, efx) {
453                 number = channel->channel;
454                 if (efx->n_channels > efx->n_rx_channels) {
455                         if (channel->channel < efx->n_rx_channels) {
456                                 type = "-rx";
457                         } else {
458                                 type = "-tx";
459                                 number -= efx->n_rx_channels;
460                         }
461                 }
462                 snprintf(channel->name, sizeof(channel->name),
463                          "%s%s-%d", efx->name, type, number);
464         }
465 }
466
467 /* Channels are shutdown and reinitialised whilst the NIC is running
468  * to propagate configuration changes (mtu, checksum offload), or
469  * to clear hardware error conditions
470  */
471 static void efx_init_channels(struct efx_nic *efx)
472 {
473         struct efx_tx_queue *tx_queue;
474         struct efx_rx_queue *rx_queue;
475         struct efx_channel *channel;
476
477         /* Calculate the rx buffer allocation parameters required to
478          * support the current MTU, including padding for header
479          * alignment and overruns.
480          */
481         efx->rx_buffer_len = (max(EFX_PAGE_IP_ALIGN, NET_IP_ALIGN) +
482                               EFX_MAX_FRAME_LEN(efx->net_dev->mtu) +
483                               efx->type->rx_buffer_hash_size +
484                               efx->type->rx_buffer_padding);
485         efx->rx_buffer_order = get_order(efx->rx_buffer_len +
486                                          sizeof(struct efx_rx_page_state));
487
488         /* Initialise the channels */
489         efx_for_each_channel(channel, efx) {
490                 netif_dbg(channel->efx, drv, channel->efx->net_dev,
491                           "init chan %d\n", channel->channel);
492
493                 efx_init_eventq(channel);
494
495                 efx_for_each_channel_tx_queue(tx_queue, channel)
496                         efx_init_tx_queue(tx_queue);
497
498                 /* The rx buffer allocation strategy is MTU dependent */
499                 efx_rx_strategy(channel);
500
501                 efx_for_each_channel_rx_queue(rx_queue, channel)
502                         efx_init_rx_queue(rx_queue);
503
504                 WARN_ON(channel->rx_pkt != NULL);
505                 efx_rx_strategy(channel);
506         }
507 }
508
509 /* This enables event queue processing and packet transmission.
510  *
511  * Note that this function is not allowed to fail, since that would
512  * introduce too much complexity into the suspend/resume path.
513  */
514 static void efx_start_channel(struct efx_channel *channel)
515 {
516         struct efx_rx_queue *rx_queue;
517
518         netif_dbg(channel->efx, ifup, channel->efx->net_dev,
519                   "starting chan %d\n", channel->channel);
520
521         /* The interrupt handler for this channel may set work_pending
522          * as soon as we enable it.  Make sure it's cleared before
523          * then.  Similarly, make sure it sees the enabled flag set. */
524         channel->work_pending = false;
525         channel->enabled = true;
526         smp_wmb();
527
528         /* Fill the queues before enabling NAPI */
529         efx_for_each_channel_rx_queue(rx_queue, channel)
530                 efx_fast_push_rx_descriptors(rx_queue);
531
532         napi_enable(&channel->napi_str);
533 }
534
535 /* This disables event queue processing and packet transmission.
536  * This function does not guarantee that all queue processing
537  * (e.g. RX refill) is complete.
538  */
539 static void efx_stop_channel(struct efx_channel *channel)
540 {
541         if (!channel->enabled)
542                 return;
543
544         netif_dbg(channel->efx, ifdown, channel->efx->net_dev,
545                   "stop chan %d\n", channel->channel);
546
547         channel->enabled = false;
548         napi_disable(&channel->napi_str);
549 }
550
551 static void efx_fini_channels(struct efx_nic *efx)
552 {
553         struct efx_channel *channel;
554         struct efx_tx_queue *tx_queue;
555         struct efx_rx_queue *rx_queue;
556         int rc;
557
558         EFX_ASSERT_RESET_SERIALISED(efx);
559         BUG_ON(efx->port_enabled);
560
561         rc = efx_nic_flush_queues(efx);
562         if (rc && EFX_WORKAROUND_7803(efx)) {
563                 /* Schedule a reset to recover from the flush failure. The
564                  * descriptor caches reference memory we're about to free,
565                  * but falcon_reconfigure_mac_wrapper() won't reconnect
566                  * the MACs because of the pending reset. */
567                 netif_err(efx, drv, efx->net_dev,
568                           "Resetting to recover from flush failure\n");
569                 efx_schedule_reset(efx, RESET_TYPE_ALL);
570         } else if (rc) {
571                 netif_err(efx, drv, efx->net_dev, "failed to flush queues\n");
572         } else {
573                 netif_dbg(efx, drv, efx->net_dev,
574                           "successfully flushed all queues\n");
575         }
576
577         efx_for_each_channel(channel, efx) {
578                 netif_dbg(channel->efx, drv, channel->efx->net_dev,
579                           "shut down chan %d\n", channel->channel);
580
581                 efx_for_each_channel_rx_queue(rx_queue, channel)
582                         efx_fini_rx_queue(rx_queue);
583                 efx_for_each_channel_tx_queue(tx_queue, channel)
584                         efx_fini_tx_queue(tx_queue);
585                 efx_fini_eventq(channel);
586         }
587 }
588
589 static void efx_remove_channel(struct efx_channel *channel)
590 {
591         struct efx_tx_queue *tx_queue;
592         struct efx_rx_queue *rx_queue;
593
594         netif_dbg(channel->efx, drv, channel->efx->net_dev,
595                   "destroy chan %d\n", channel->channel);
596
597         efx_for_each_channel_rx_queue(rx_queue, channel)
598                 efx_remove_rx_queue(rx_queue);
599         efx_for_each_channel_tx_queue(tx_queue, channel)
600                 efx_remove_tx_queue(tx_queue);
601         efx_remove_eventq(channel);
602 }
603
604 void efx_schedule_slow_fill(struct efx_rx_queue *rx_queue)
605 {
606         mod_timer(&rx_queue->slow_fill, jiffies + msecs_to_jiffies(100));
607 }
608
609 /**************************************************************************
610  *
611  * Port handling
612  *
613  **************************************************************************/
614
615 /* This ensures that the kernel is kept informed (via
616  * netif_carrier_on/off) of the link status, and also maintains the
617  * link status's stop on the port's TX queue.
618  */
619 void efx_link_status_changed(struct efx_nic *efx)
620 {
621         struct efx_link_state *link_state = &efx->link_state;
622
623         /* SFC Bug 5356: A net_dev notifier is registered, so we must ensure
624          * that no events are triggered between unregister_netdev() and the
625          * driver unloading. A more general condition is that NETDEV_CHANGE
626          * can only be generated between NETDEV_UP and NETDEV_DOWN */
627         if (!netif_running(efx->net_dev))
628                 return;
629
630         if (efx->port_inhibited) {
631                 netif_carrier_off(efx->net_dev);
632                 return;
633         }
634
635         if (link_state->up != netif_carrier_ok(efx->net_dev)) {
636                 efx->n_link_state_changes++;
637
638                 if (link_state->up)
639                         netif_carrier_on(efx->net_dev);
640                 else
641                         netif_carrier_off(efx->net_dev);
642         }
643
644         /* Status message for kernel log */
645         if (link_state->up) {
646                 netif_info(efx, link, efx->net_dev,
647                            "link up at %uMbps %s-duplex (MTU %d)%s\n",
648                            link_state->speed, link_state->fd ? "full" : "half",
649                            efx->net_dev->mtu,
650                            (efx->promiscuous ? " [PROMISC]" : ""));
651         } else {
652                 netif_info(efx, link, efx->net_dev, "link down\n");
653         }
654
655 }
656
657 void efx_link_set_advertising(struct efx_nic *efx, u32 advertising)
658 {
659         efx->link_advertising = advertising;
660         if (advertising) {
661                 if (advertising & ADVERTISED_Pause)
662                         efx->wanted_fc |= (EFX_FC_TX | EFX_FC_RX);
663                 else
664                         efx->wanted_fc &= ~(EFX_FC_TX | EFX_FC_RX);
665                 if (advertising & ADVERTISED_Asym_Pause)
666                         efx->wanted_fc ^= EFX_FC_TX;
667         }
668 }
669
670 void efx_link_set_wanted_fc(struct efx_nic *efx, enum efx_fc_type wanted_fc)
671 {
672         efx->wanted_fc = wanted_fc;
673         if (efx->link_advertising) {
674                 if (wanted_fc & EFX_FC_RX)
675                         efx->link_advertising |= (ADVERTISED_Pause |
676                                                   ADVERTISED_Asym_Pause);
677                 else
678                         efx->link_advertising &= ~(ADVERTISED_Pause |
679                                                    ADVERTISED_Asym_Pause);
680                 if (wanted_fc & EFX_FC_TX)
681                         efx->link_advertising ^= ADVERTISED_Asym_Pause;
682         }
683 }
684
685 static void efx_fini_port(struct efx_nic *efx);
686
687 /* Push loopback/power/transmit disable settings to the PHY, and reconfigure
688  * the MAC appropriately. All other PHY configuration changes are pushed
689  * through phy_op->set_settings(), and pushed asynchronously to the MAC
690  * through efx_monitor().
691  *
692  * Callers must hold the mac_lock
693  */
694 int __efx_reconfigure_port(struct efx_nic *efx)
695 {
696         enum efx_phy_mode phy_mode;
697         int rc;
698
699         WARN_ON(!mutex_is_locked(&efx->mac_lock));
700
701         /* Serialise the promiscuous flag with efx_set_multicast_list. */
702         if (efx_dev_registered(efx)) {
703                 netif_addr_lock_bh(efx->net_dev);
704                 netif_addr_unlock_bh(efx->net_dev);
705         }
706
707         /* Disable PHY transmit in mac level loopbacks */
708         phy_mode = efx->phy_mode;
709         if (LOOPBACK_INTERNAL(efx))
710                 efx->phy_mode |= PHY_MODE_TX_DISABLED;
711         else
712                 efx->phy_mode &= ~PHY_MODE_TX_DISABLED;
713
714         rc = efx->type->reconfigure_port(efx);
715
716         if (rc)
717                 efx->phy_mode = phy_mode;
718
719         return rc;
720 }
721
722 /* Reinitialise the MAC to pick up new PHY settings, even if the port is
723  * disabled. */
724 int efx_reconfigure_port(struct efx_nic *efx)
725 {
726         int rc;
727
728         EFX_ASSERT_RESET_SERIALISED(efx);
729
730         mutex_lock(&efx->mac_lock);
731         rc = __efx_reconfigure_port(efx);
732         mutex_unlock(&efx->mac_lock);
733
734         return rc;
735 }
736
737 /* Asynchronous work item for changing MAC promiscuity and multicast
738  * hash.  Avoid a drain/rx_ingress enable by reconfiguring the current
739  * MAC directly. */
740 static void efx_mac_work(struct work_struct *data)
741 {
742         struct efx_nic *efx = container_of(data, struct efx_nic, mac_work);
743
744         mutex_lock(&efx->mac_lock);
745         if (efx->port_enabled) {
746                 efx->type->push_multicast_hash(efx);
747                 efx->mac_op->reconfigure(efx);
748         }
749         mutex_unlock(&efx->mac_lock);
750 }
751
752 static int efx_probe_port(struct efx_nic *efx)
753 {
754         int rc;
755
756         netif_dbg(efx, probe, efx->net_dev, "create port\n");
757
758         if (phy_flash_cfg)
759                 efx->phy_mode = PHY_MODE_SPECIAL;
760
761         /* Connect up MAC/PHY operations table */
762         rc = efx->type->probe_port(efx);
763         if (rc)
764                 goto err;
765
766         /* Sanity check MAC address */
767         if (is_valid_ether_addr(efx->mac_address)) {
768                 memcpy(efx->net_dev->dev_addr, efx->mac_address, ETH_ALEN);
769         } else {
770                 netif_err(efx, probe, efx->net_dev, "invalid MAC address %pM\n",
771                           efx->mac_address);
772                 if (!allow_bad_hwaddr) {
773                         rc = -EINVAL;
774                         goto err;
775                 }
776                 random_ether_addr(efx->net_dev->dev_addr);
777                 netif_info(efx, probe, efx->net_dev,
778                            "using locally-generated MAC %pM\n",
779                            efx->net_dev->dev_addr);
780         }
781
782         return 0;
783
784  err:
785         efx_remove_port(efx);
786         return rc;
787 }
788
789 static int efx_init_port(struct efx_nic *efx)
790 {
791         int rc;
792
793         netif_dbg(efx, drv, efx->net_dev, "init port\n");
794
795         mutex_lock(&efx->mac_lock);
796
797         rc = efx->phy_op->init(efx);
798         if (rc)
799                 goto fail1;
800
801         efx->port_initialized = true;
802
803         /* Reconfigure the MAC before creating dma queues (required for
804          * Falcon/A1 where RX_INGR_EN/TX_DRAIN_EN isn't supported) */
805         efx->mac_op->reconfigure(efx);
806
807         /* Ensure the PHY advertises the correct flow control settings */
808         rc = efx->phy_op->reconfigure(efx);
809         if (rc)
810                 goto fail2;
811
812         mutex_unlock(&efx->mac_lock);
813         return 0;
814
815 fail2:
816         efx->phy_op->fini(efx);
817 fail1:
818         mutex_unlock(&efx->mac_lock);
819         return rc;
820 }
821
822 static void efx_start_port(struct efx_nic *efx)
823 {
824         netif_dbg(efx, ifup, efx->net_dev, "start port\n");
825         BUG_ON(efx->port_enabled);
826
827         mutex_lock(&efx->mac_lock);
828         efx->port_enabled = true;
829
830         /* efx_mac_work() might have been scheduled after efx_stop_port(),
831          * and then cancelled by efx_flush_all() */
832         efx->type->push_multicast_hash(efx);
833         efx->mac_op->reconfigure(efx);
834
835         mutex_unlock(&efx->mac_lock);
836 }
837
838 /* Prevent efx_mac_work() and efx_monitor() from working */
839 static void efx_stop_port(struct efx_nic *efx)
840 {
841         netif_dbg(efx, ifdown, efx->net_dev, "stop port\n");
842
843         mutex_lock(&efx->mac_lock);
844         efx->port_enabled = false;
845         mutex_unlock(&efx->mac_lock);
846
847         /* Serialise against efx_set_multicast_list() */
848         if (efx_dev_registered(efx)) {
849                 netif_addr_lock_bh(efx->net_dev);
850                 netif_addr_unlock_bh(efx->net_dev);
851         }
852 }
853
854 static void efx_fini_port(struct efx_nic *efx)
855 {
856         netif_dbg(efx, drv, efx->net_dev, "shut down port\n");
857
858         if (!efx->port_initialized)
859                 return;
860
861         efx->phy_op->fini(efx);
862         efx->port_initialized = false;
863
864         efx->link_state.up = false;
865         efx_link_status_changed(efx);
866 }
867
868 static void efx_remove_port(struct efx_nic *efx)
869 {
870         netif_dbg(efx, drv, efx->net_dev, "destroying port\n");
871
872         efx->type->remove_port(efx);
873 }
874
875 /**************************************************************************
876  *
877  * NIC handling
878  *
879  **************************************************************************/
880
881 /* This configures the PCI device to enable I/O and DMA. */
882 static int efx_init_io(struct efx_nic *efx)
883 {
884         struct pci_dev *pci_dev = efx->pci_dev;
885         dma_addr_t dma_mask = efx->type->max_dma_mask;
886         int rc;
887
888         netif_dbg(efx, probe, efx->net_dev, "initialising I/O\n");
889
890         rc = pci_enable_device(pci_dev);
891         if (rc) {
892                 netif_err(efx, probe, efx->net_dev,
893                           "failed to enable PCI device\n");
894                 goto fail1;
895         }
896
897         pci_set_master(pci_dev);
898
899         /* Set the PCI DMA mask.  Try all possibilities from our
900          * genuine mask down to 32 bits, because some architectures
901          * (e.g. x86_64 with iommu_sac_force set) will allow 40 bit
902          * masks event though they reject 46 bit masks.
903          */
904         while (dma_mask > 0x7fffffffUL) {
905                 if (pci_dma_supported(pci_dev, dma_mask) &&
906                     ((rc = pci_set_dma_mask(pci_dev, dma_mask)) == 0))
907                         break;
908                 dma_mask >>= 1;
909         }
910         if (rc) {
911                 netif_err(efx, probe, efx->net_dev,
912                           "could not find a suitable DMA mask\n");
913                 goto fail2;
914         }
915         netif_dbg(efx, probe, efx->net_dev,
916                   "using DMA mask %llx\n", (unsigned long long) dma_mask);
917         rc = pci_set_consistent_dma_mask(pci_dev, dma_mask);
918         if (rc) {
919                 /* pci_set_consistent_dma_mask() is not *allowed* to
920                  * fail with a mask that pci_set_dma_mask() accepted,
921                  * but just in case...
922                  */
923                 netif_err(efx, probe, efx->net_dev,
924                           "failed to set consistent DMA mask\n");
925                 goto fail2;
926         }
927
928         efx->membase_phys = pci_resource_start(efx->pci_dev, EFX_MEM_BAR);
929         rc = pci_request_region(pci_dev, EFX_MEM_BAR, "sfc");
930         if (rc) {
931                 netif_err(efx, probe, efx->net_dev,
932                           "request for memory BAR failed\n");
933                 rc = -EIO;
934                 goto fail3;
935         }
936         efx->membase = ioremap_nocache(efx->membase_phys,
937                                        efx->type->mem_map_size);
938         if (!efx->membase) {
939                 netif_err(efx, probe, efx->net_dev,
940                           "could not map memory BAR at %llx+%x\n",
941                           (unsigned long long)efx->membase_phys,
942                           efx->type->mem_map_size);
943                 rc = -ENOMEM;
944                 goto fail4;
945         }
946         netif_dbg(efx, probe, efx->net_dev,
947                   "memory BAR at %llx+%x (virtual %p)\n",
948                   (unsigned long long)efx->membase_phys,
949                   efx->type->mem_map_size, efx->membase);
950
951         return 0;
952
953  fail4:
954         pci_release_region(efx->pci_dev, EFX_MEM_BAR);
955  fail3:
956         efx->membase_phys = 0;
957  fail2:
958         pci_disable_device(efx->pci_dev);
959  fail1:
960         return rc;
961 }
962
963 static void efx_fini_io(struct efx_nic *efx)
964 {
965         netif_dbg(efx, drv, efx->net_dev, "shutting down I/O\n");
966
967         if (efx->membase) {
968                 iounmap(efx->membase);
969                 efx->membase = NULL;
970         }
971
972         if (efx->membase_phys) {
973                 pci_release_region(efx->pci_dev, EFX_MEM_BAR);
974                 efx->membase_phys = 0;
975         }
976
977         pci_disable_device(efx->pci_dev);
978 }
979
980 /* Get number of channels wanted.  Each channel will have its own IRQ,
981  * 1 RX queue and/or 2 TX queues. */
982 static int efx_wanted_channels(void)
983 {
984         cpumask_var_t core_mask;
985         int count;
986         int cpu;
987
988         if (unlikely(!zalloc_cpumask_var(&core_mask, GFP_KERNEL))) {
989                 printk(KERN_WARNING
990                        "sfc: RSS disabled due to allocation failure\n");
991                 return 1;
992         }
993
994         count = 0;
995         for_each_online_cpu(cpu) {
996                 if (!cpumask_test_cpu(cpu, core_mask)) {
997                         ++count;
998                         cpumask_or(core_mask, core_mask,
999                                    topology_core_cpumask(cpu));
1000                 }
1001         }
1002
1003         free_cpumask_var(core_mask);
1004         return count;
1005 }
1006
1007 /* Probe the number and type of interrupts we are able to obtain, and
1008  * the resulting numbers of channels and RX queues.
1009  */
1010 static void efx_probe_interrupts(struct efx_nic *efx)
1011 {
1012         int max_channels =
1013                 min_t(int, efx->type->phys_addr_channels, EFX_MAX_CHANNELS);
1014         int rc, i;
1015
1016         if (efx->interrupt_mode == EFX_INT_MODE_MSIX) {
1017                 struct msix_entry xentries[EFX_MAX_CHANNELS];
1018                 int n_channels;
1019
1020                 n_channels = efx_wanted_channels();
1021                 if (separate_tx_channels)
1022                         n_channels *= 2;
1023                 n_channels = min(n_channels, max_channels);
1024
1025                 for (i = 0; i < n_channels; i++)
1026                         xentries[i].entry = i;
1027                 rc = pci_enable_msix(efx->pci_dev, xentries, n_channels);
1028                 if (rc > 0) {
1029                         netif_err(efx, drv, efx->net_dev,
1030                                   "WARNING: Insufficient MSI-X vectors"
1031                                   " available (%d < %d).\n", rc, n_channels);
1032                         netif_err(efx, drv, efx->net_dev,
1033                                   "WARNING: Performance may be reduced.\n");
1034                         EFX_BUG_ON_PARANOID(rc >= n_channels);
1035                         n_channels = rc;
1036                         rc = pci_enable_msix(efx->pci_dev, xentries,
1037                                              n_channels);
1038                 }
1039
1040                 if (rc == 0) {
1041                         efx->n_channels = n_channels;
1042                         if (separate_tx_channels) {
1043                                 efx->n_tx_channels =
1044                                         max(efx->n_channels / 2, 1U);
1045                                 efx->n_rx_channels =
1046                                         max(efx->n_channels -
1047                                             efx->n_tx_channels, 1U);
1048                         } else {
1049                                 efx->n_tx_channels = efx->n_channels;
1050                                 efx->n_rx_channels = efx->n_channels;
1051                         }
1052                         for (i = 0; i < n_channels; i++)
1053                                 efx->channel[i].irq = xentries[i].vector;
1054                 } else {
1055                         /* Fall back to single channel MSI */
1056                         efx->interrupt_mode = EFX_INT_MODE_MSI;
1057                         netif_err(efx, drv, efx->net_dev,
1058                                   "could not enable MSI-X\n");
1059                 }
1060         }
1061
1062         /* Try single interrupt MSI */
1063         if (efx->interrupt_mode == EFX_INT_MODE_MSI) {
1064                 efx->n_channels = 1;
1065                 efx->n_rx_channels = 1;
1066                 efx->n_tx_channels = 1;
1067                 rc = pci_enable_msi(efx->pci_dev);
1068                 if (rc == 0) {
1069                         efx->channel[0].irq = efx->pci_dev->irq;
1070                 } else {
1071                         netif_err(efx, drv, efx->net_dev,
1072                                   "could not enable MSI\n");
1073                         efx->interrupt_mode = EFX_INT_MODE_LEGACY;
1074                 }
1075         }
1076
1077         /* Assume legacy interrupts */
1078         if (efx->interrupt_mode == EFX_INT_MODE_LEGACY) {
1079                 efx->n_channels = 1 + (separate_tx_channels ? 1 : 0);
1080                 efx->n_rx_channels = 1;
1081                 efx->n_tx_channels = 1;
1082                 efx->legacy_irq = efx->pci_dev->irq;
1083         }
1084 }
1085
1086 static void efx_remove_interrupts(struct efx_nic *efx)
1087 {
1088         struct efx_channel *channel;
1089
1090         /* Remove MSI/MSI-X interrupts */
1091         efx_for_each_channel(channel, efx)
1092                 channel->irq = 0;
1093         pci_disable_msi(efx->pci_dev);
1094         pci_disable_msix(efx->pci_dev);
1095
1096         /* Remove legacy interrupt */
1097         efx->legacy_irq = 0;
1098 }
1099
1100 static void efx_set_channels(struct efx_nic *efx)
1101 {
1102         struct efx_channel *channel;
1103         struct efx_tx_queue *tx_queue;
1104         struct efx_rx_queue *rx_queue;
1105         unsigned tx_channel_offset =
1106                 separate_tx_channels ? efx->n_channels - efx->n_tx_channels : 0;
1107
1108         efx_for_each_channel(channel, efx) {
1109                 if (channel->channel - tx_channel_offset < efx->n_tx_channels) {
1110                         channel->tx_queue = &efx->tx_queue[
1111                                 (channel->channel - tx_channel_offset) *
1112                                 EFX_TXQ_TYPES];
1113                         efx_for_each_channel_tx_queue(tx_queue, channel)
1114                                 tx_queue->channel = channel;
1115                 }
1116         }
1117
1118         efx_for_each_rx_queue(rx_queue, efx)
1119                 rx_queue->channel = &efx->channel[rx_queue->queue];
1120 }
1121
1122 static int efx_probe_nic(struct efx_nic *efx)
1123 {
1124         int rc;
1125
1126         netif_dbg(efx, probe, efx->net_dev, "creating NIC\n");
1127
1128         /* Carry out hardware-type specific initialisation */
1129         rc = efx->type->probe(efx);
1130         if (rc)
1131                 return rc;
1132
1133         /* Determine the number of channels and queues by trying to hook
1134          * in MSI-X interrupts. */
1135         efx_probe_interrupts(efx);
1136
1137         efx_set_channels(efx);
1138         efx->net_dev->real_num_tx_queues = efx->n_tx_channels;
1139
1140         /* Initialise the interrupt moderation settings */
1141         efx_init_irq_moderation(efx, tx_irq_mod_usec, rx_irq_mod_usec, true);
1142
1143         return 0;
1144 }
1145
1146 static void efx_remove_nic(struct efx_nic *efx)
1147 {
1148         netif_dbg(efx, drv, efx->net_dev, "destroying NIC\n");
1149
1150         efx_remove_interrupts(efx);
1151         efx->type->remove(efx);
1152 }
1153
1154 /**************************************************************************
1155  *
1156  * NIC startup/shutdown
1157  *
1158  *************************************************************************/
1159
1160 static int efx_probe_all(struct efx_nic *efx)
1161 {
1162         struct efx_channel *channel;
1163         int rc;
1164
1165         /* Create NIC */
1166         rc = efx_probe_nic(efx);
1167         if (rc) {
1168                 netif_err(efx, probe, efx->net_dev, "failed to create NIC\n");
1169                 goto fail1;
1170         }
1171
1172         /* Create port */
1173         rc = efx_probe_port(efx);
1174         if (rc) {
1175                 netif_err(efx, probe, efx->net_dev, "failed to create port\n");
1176                 goto fail2;
1177         }
1178
1179         /* Create channels */
1180         efx_for_each_channel(channel, efx) {
1181                 rc = efx_probe_channel(channel);
1182                 if (rc) {
1183                         netif_err(efx, probe, efx->net_dev,
1184                                   "failed to create channel %d\n",
1185                                   channel->channel);
1186                         goto fail3;
1187                 }
1188         }
1189         efx_set_channel_names(efx);
1190
1191         return 0;
1192
1193  fail3:
1194         efx_for_each_channel(channel, efx)
1195                 efx_remove_channel(channel);
1196         efx_remove_port(efx);
1197  fail2:
1198         efx_remove_nic(efx);
1199  fail1:
1200         return rc;
1201 }
1202
1203 /* Called after previous invocation(s) of efx_stop_all, restarts the
1204  * port, kernel transmit queue, NAPI processing and hardware interrupts,
1205  * and ensures that the port is scheduled to be reconfigured.
1206  * This function is safe to call multiple times when the NIC is in any
1207  * state. */
1208 static void efx_start_all(struct efx_nic *efx)
1209 {
1210         struct efx_channel *channel;
1211
1212         EFX_ASSERT_RESET_SERIALISED(efx);
1213
1214         /* Check that it is appropriate to restart the interface. All
1215          * of these flags are safe to read under just the rtnl lock */
1216         if (efx->port_enabled)
1217                 return;
1218         if ((efx->state != STATE_RUNNING) && (efx->state != STATE_INIT))
1219                 return;
1220         if (efx_dev_registered(efx) && !netif_running(efx->net_dev))
1221                 return;
1222
1223         /* Mark the port as enabled so port reconfigurations can start, then
1224          * restart the transmit interface early so the watchdog timer stops */
1225         efx_start_port(efx);
1226
1227         efx_for_each_channel(channel, efx) {
1228                 if (efx_dev_registered(efx))
1229                         efx_wake_queue(channel);
1230                 efx_start_channel(channel);
1231         }
1232
1233         efx_nic_enable_interrupts(efx);
1234
1235         /* Switch to event based MCDI completions after enabling interrupts.
1236          * If a reset has been scheduled, then we need to stay in polled mode.
1237          * Rather than serialising efx_mcdi_mode_event() [which sleeps] and
1238          * reset_pending [modified from an atomic context], we instead guarantee
1239          * that efx_mcdi_mode_poll() isn't reverted erroneously */
1240         efx_mcdi_mode_event(efx);
1241         if (efx->reset_pending != RESET_TYPE_NONE)
1242                 efx_mcdi_mode_poll(efx);
1243
1244         /* Start the hardware monitor if there is one. Otherwise (we're link
1245          * event driven), we have to poll the PHY because after an event queue
1246          * flush, we could have a missed a link state change */
1247         if (efx->type->monitor != NULL) {
1248                 queue_delayed_work(efx->workqueue, &efx->monitor_work,
1249                                    efx_monitor_interval);
1250         } else {
1251                 mutex_lock(&efx->mac_lock);
1252                 if (efx->phy_op->poll(efx))
1253                         efx_link_status_changed(efx);
1254                 mutex_unlock(&efx->mac_lock);
1255         }
1256
1257         efx->type->start_stats(efx);
1258 }
1259
1260 /* Flush all delayed work. Should only be called when no more delayed work
1261  * will be scheduled. This doesn't flush pending online resets (efx_reset),
1262  * since we're holding the rtnl_lock at this point. */
1263 static void efx_flush_all(struct efx_nic *efx)
1264 {
1265         /* Make sure the hardware monitor is stopped */
1266         cancel_delayed_work_sync(&efx->monitor_work);
1267         /* Stop scheduled port reconfigurations */
1268         cancel_work_sync(&efx->mac_work);
1269 }
1270
1271 /* Quiesce hardware and software without bringing the link down.
1272  * Safe to call multiple times, when the nic and interface is in any
1273  * state. The caller is guaranteed to subsequently be in a position
1274  * to modify any hardware and software state they see fit without
1275  * taking locks. */
1276 static void efx_stop_all(struct efx_nic *efx)
1277 {
1278         struct efx_channel *channel;
1279
1280         EFX_ASSERT_RESET_SERIALISED(efx);
1281
1282         /* port_enabled can be read safely under the rtnl lock */
1283         if (!efx->port_enabled)
1284                 return;
1285
1286         efx->type->stop_stats(efx);
1287
1288         /* Switch to MCDI polling on Siena before disabling interrupts */
1289         efx_mcdi_mode_poll(efx);
1290
1291         /* Disable interrupts and wait for ISR to complete */
1292         efx_nic_disable_interrupts(efx);
1293         if (efx->legacy_irq)
1294                 synchronize_irq(efx->legacy_irq);
1295         efx_for_each_channel(channel, efx) {
1296                 if (channel->irq)
1297                         synchronize_irq(channel->irq);
1298         }
1299
1300         /* Stop all NAPI processing and synchronous rx refills */
1301         efx_for_each_channel(channel, efx)
1302                 efx_stop_channel(channel);
1303
1304         /* Stop all asynchronous port reconfigurations. Since all
1305          * event processing has already been stopped, there is no
1306          * window to loose phy events */
1307         efx_stop_port(efx);
1308
1309         /* Flush efx_mac_work(), refill_workqueue, monitor_work */
1310         efx_flush_all(efx);
1311
1312         /* Stop the kernel transmit interface late, so the watchdog
1313          * timer isn't ticking over the flush */
1314         if (efx_dev_registered(efx)) {
1315                 struct efx_channel *channel;
1316                 efx_for_each_channel(channel, efx)
1317                         efx_stop_queue(channel);
1318                 netif_tx_lock_bh(efx->net_dev);
1319                 netif_tx_unlock_bh(efx->net_dev);
1320         }
1321 }
1322
1323 static void efx_remove_all(struct efx_nic *efx)
1324 {
1325         struct efx_channel *channel;
1326
1327         efx_for_each_channel(channel, efx)
1328                 efx_remove_channel(channel);
1329         efx_remove_port(efx);
1330         efx_remove_nic(efx);
1331 }
1332
1333 /**************************************************************************
1334  *
1335  * Interrupt moderation
1336  *
1337  **************************************************************************/
1338
1339 static unsigned irq_mod_ticks(int usecs, int resolution)
1340 {
1341         if (usecs <= 0)
1342                 return 0; /* cannot receive interrupts ahead of time :-) */
1343         if (usecs < resolution)
1344                 return 1; /* never round down to 0 */
1345         return usecs / resolution;
1346 }
1347
1348 /* Set interrupt moderation parameters */
1349 void efx_init_irq_moderation(struct efx_nic *efx, int tx_usecs, int rx_usecs,
1350                              bool rx_adaptive)
1351 {
1352         struct efx_tx_queue *tx_queue;
1353         struct efx_rx_queue *rx_queue;
1354         unsigned tx_ticks = irq_mod_ticks(tx_usecs, EFX_IRQ_MOD_RESOLUTION);
1355         unsigned rx_ticks = irq_mod_ticks(rx_usecs, EFX_IRQ_MOD_RESOLUTION);
1356
1357         EFX_ASSERT_RESET_SERIALISED(efx);
1358
1359         efx_for_each_tx_queue(tx_queue, efx)
1360                 tx_queue->channel->irq_moderation = tx_ticks;
1361
1362         efx->irq_rx_adaptive = rx_adaptive;
1363         efx->irq_rx_moderation = rx_ticks;
1364         efx_for_each_rx_queue(rx_queue, efx)
1365                 rx_queue->channel->irq_moderation = rx_ticks;
1366 }
1367
1368 /**************************************************************************
1369  *
1370  * Hardware monitor
1371  *
1372  **************************************************************************/
1373
1374 /* Run periodically off the general workqueue. Serialised against
1375  * efx_reconfigure_port via the mac_lock */
1376 static void efx_monitor(struct work_struct *data)
1377 {
1378         struct efx_nic *efx = container_of(data, struct efx_nic,
1379                                            monitor_work.work);
1380
1381         netif_vdbg(efx, timer, efx->net_dev,
1382                    "hardware monitor executing on CPU %d\n",
1383                    raw_smp_processor_id());
1384         BUG_ON(efx->type->monitor == NULL);
1385
1386         /* If the mac_lock is already held then it is likely a port
1387          * reconfiguration is already in place, which will likely do
1388          * most of the work of check_hw() anyway. */
1389         if (!mutex_trylock(&efx->mac_lock))
1390                 goto out_requeue;
1391         if (!efx->port_enabled)
1392                 goto out_unlock;
1393         efx->type->monitor(efx);
1394
1395 out_unlock:
1396         mutex_unlock(&efx->mac_lock);
1397 out_requeue:
1398         queue_delayed_work(efx->workqueue, &efx->monitor_work,
1399                            efx_monitor_interval);
1400 }
1401
1402 /**************************************************************************
1403  *
1404  * ioctls
1405  *
1406  *************************************************************************/
1407
1408 /* Net device ioctl
1409  * Context: process, rtnl_lock() held.
1410  */
1411 static int efx_ioctl(struct net_device *net_dev, struct ifreq *ifr, int cmd)
1412 {
1413         struct efx_nic *efx = netdev_priv(net_dev);
1414         struct mii_ioctl_data *data = if_mii(ifr);
1415
1416         EFX_ASSERT_RESET_SERIALISED(efx);
1417
1418         /* Convert phy_id from older PRTAD/DEVAD format */
1419         if ((cmd == SIOCGMIIREG || cmd == SIOCSMIIREG) &&
1420             (data->phy_id & 0xfc00) == 0x0400)
1421                 data->phy_id ^= MDIO_PHY_ID_C45 | 0x0400;
1422
1423         return mdio_mii_ioctl(&efx->mdio, data, cmd);
1424 }
1425
1426 /**************************************************************************
1427  *
1428  * NAPI interface
1429  *
1430  **************************************************************************/
1431
1432 static int efx_init_napi(struct efx_nic *efx)
1433 {
1434         struct efx_channel *channel;
1435
1436         efx_for_each_channel(channel, efx) {
1437                 channel->napi_dev = efx->net_dev;
1438                 netif_napi_add(channel->napi_dev, &channel->napi_str,
1439                                efx_poll, napi_weight);
1440         }
1441         return 0;
1442 }
1443
1444 static void efx_fini_napi(struct efx_nic *efx)
1445 {
1446         struct efx_channel *channel;
1447
1448         efx_for_each_channel(channel, efx) {
1449                 if (channel->napi_dev)
1450                         netif_napi_del(&channel->napi_str);
1451                 channel->napi_dev = NULL;
1452         }
1453 }
1454
1455 /**************************************************************************
1456  *
1457  * Kernel netpoll interface
1458  *
1459  *************************************************************************/
1460
1461 #ifdef CONFIG_NET_POLL_CONTROLLER
1462
1463 /* Although in the common case interrupts will be disabled, this is not
1464  * guaranteed. However, all our work happens inside the NAPI callback,
1465  * so no locking is required.
1466  */
1467 static void efx_netpoll(struct net_device *net_dev)
1468 {
1469         struct efx_nic *efx = netdev_priv(net_dev);
1470         struct efx_channel *channel;
1471
1472         efx_for_each_channel(channel, efx)
1473                 efx_schedule_channel(channel);
1474 }
1475
1476 #endif
1477
1478 /**************************************************************************
1479  *
1480  * Kernel net device interface
1481  *
1482  *************************************************************************/
1483
1484 /* Context: process, rtnl_lock() held. */
1485 static int efx_net_open(struct net_device *net_dev)
1486 {
1487         struct efx_nic *efx = netdev_priv(net_dev);
1488         EFX_ASSERT_RESET_SERIALISED(efx);
1489
1490         netif_dbg(efx, ifup, efx->net_dev, "opening device on CPU %d\n",
1491                   raw_smp_processor_id());
1492
1493         if (efx->state == STATE_DISABLED)
1494                 return -EIO;
1495         if (efx->phy_mode & PHY_MODE_SPECIAL)
1496                 return -EBUSY;
1497         if (efx_mcdi_poll_reboot(efx) && efx_reset(efx, RESET_TYPE_ALL))
1498                 return -EIO;
1499
1500         /* Notify the kernel of the link state polled during driver load,
1501          * before the monitor starts running */
1502         efx_link_status_changed(efx);
1503
1504         efx_start_all(efx);
1505         return 0;
1506 }
1507
1508 /* Context: process, rtnl_lock() held.
1509  * Note that the kernel will ignore our return code; this method
1510  * should really be a void.
1511  */
1512 static int efx_net_stop(struct net_device *net_dev)
1513 {
1514         struct efx_nic *efx = netdev_priv(net_dev);
1515
1516         netif_dbg(efx, ifdown, efx->net_dev, "closing on CPU %d\n",
1517                   raw_smp_processor_id());
1518
1519         if (efx->state != STATE_DISABLED) {
1520                 /* Stop the device and flush all the channels */
1521                 efx_stop_all(efx);
1522                 efx_fini_channels(efx);
1523                 efx_init_channels(efx);
1524         }
1525
1526         return 0;
1527 }
1528
1529 /* Context: process, dev_base_lock or RTNL held, non-blocking. */
1530 static struct rtnl_link_stats64 *efx_net_stats(struct net_device *net_dev)
1531 {
1532         struct efx_nic *efx = netdev_priv(net_dev);
1533         struct efx_mac_stats *mac_stats = &efx->mac_stats;
1534         struct rtnl_link_stats64 *stats = &net_dev->stats64;
1535
1536         spin_lock_bh(&efx->stats_lock);
1537         efx->type->update_stats(efx);
1538         spin_unlock_bh(&efx->stats_lock);
1539
1540         stats->rx_packets = mac_stats->rx_packets;
1541         stats->tx_packets = mac_stats->tx_packets;
1542         stats->rx_bytes = mac_stats->rx_bytes;
1543         stats->tx_bytes = mac_stats->tx_bytes;
1544         stats->multicast = mac_stats->rx_multicast;
1545         stats->collisions = mac_stats->tx_collision;
1546         stats->rx_length_errors = (mac_stats->rx_gtjumbo +
1547                                    mac_stats->rx_length_error);
1548         stats->rx_over_errors = efx->n_rx_nodesc_drop_cnt;
1549         stats->rx_crc_errors = mac_stats->rx_bad;
1550         stats->rx_frame_errors = mac_stats->rx_align_error;
1551         stats->rx_fifo_errors = mac_stats->rx_overflow;
1552         stats->rx_missed_errors = mac_stats->rx_missed;
1553         stats->tx_window_errors = mac_stats->tx_late_collision;
1554
1555         stats->rx_errors = (stats->rx_length_errors +
1556                             stats->rx_crc_errors +
1557                             stats->rx_frame_errors +
1558                             mac_stats->rx_symbol_error);
1559         stats->tx_errors = (stats->tx_window_errors +
1560                             mac_stats->tx_bad);
1561
1562         return stats;
1563 }
1564
1565 /* Context: netif_tx_lock held, BHs disabled. */
1566 static void efx_watchdog(struct net_device *net_dev)
1567 {
1568         struct efx_nic *efx = netdev_priv(net_dev);
1569
1570         netif_err(efx, tx_err, efx->net_dev,
1571                   "TX stuck with port_enabled=%d: resetting channels\n",
1572                   efx->port_enabled);
1573
1574         efx_schedule_reset(efx, RESET_TYPE_TX_WATCHDOG);
1575 }
1576
1577
1578 /* Context: process, rtnl_lock() held. */
1579 static int efx_change_mtu(struct net_device *net_dev, int new_mtu)
1580 {
1581         struct efx_nic *efx = netdev_priv(net_dev);
1582         int rc = 0;
1583
1584         EFX_ASSERT_RESET_SERIALISED(efx);
1585
1586         if (new_mtu > EFX_MAX_MTU)
1587                 return -EINVAL;
1588
1589         efx_stop_all(efx);
1590
1591         netif_dbg(efx, drv, efx->net_dev, "changing MTU to %d\n", new_mtu);
1592
1593         efx_fini_channels(efx);
1594
1595         mutex_lock(&efx->mac_lock);
1596         /* Reconfigure the MAC before enabling the dma queues so that
1597          * the RX buffers don't overflow */
1598         net_dev->mtu = new_mtu;
1599         efx->mac_op->reconfigure(efx);
1600         mutex_unlock(&efx->mac_lock);
1601
1602         efx_init_channels(efx);
1603
1604         efx_start_all(efx);
1605         return rc;
1606 }
1607
1608 static int efx_set_mac_address(struct net_device *net_dev, void *data)
1609 {
1610         struct efx_nic *efx = netdev_priv(net_dev);
1611         struct sockaddr *addr = data;
1612         char *new_addr = addr->sa_data;
1613
1614         EFX_ASSERT_RESET_SERIALISED(efx);
1615
1616         if (!is_valid_ether_addr(new_addr)) {
1617                 netif_err(efx, drv, efx->net_dev,
1618                           "invalid ethernet MAC address requested: %pM\n",
1619                           new_addr);
1620                 return -EINVAL;
1621         }
1622
1623         memcpy(net_dev->dev_addr, new_addr, net_dev->addr_len);
1624
1625         /* Reconfigure the MAC */
1626         mutex_lock(&efx->mac_lock);
1627         efx->mac_op->reconfigure(efx);
1628         mutex_unlock(&efx->mac_lock);
1629
1630         return 0;
1631 }
1632
1633 /* Context: netif_addr_lock held, BHs disabled. */
1634 static void efx_set_multicast_list(struct net_device *net_dev)
1635 {
1636         struct efx_nic *efx = netdev_priv(net_dev);
1637         struct netdev_hw_addr *ha;
1638         union efx_multicast_hash *mc_hash = &efx->multicast_hash;
1639         u32 crc;
1640         int bit;
1641
1642         efx->promiscuous = !!(net_dev->flags & IFF_PROMISC);
1643
1644         /* Build multicast hash table */
1645         if (efx->promiscuous || (net_dev->flags & IFF_ALLMULTI)) {
1646                 memset(mc_hash, 0xff, sizeof(*mc_hash));
1647         } else {
1648                 memset(mc_hash, 0x00, sizeof(*mc_hash));
1649                 netdev_for_each_mc_addr(ha, net_dev) {
1650                         crc = ether_crc_le(ETH_ALEN, ha->addr);
1651                         bit = crc & (EFX_MCAST_HASH_ENTRIES - 1);
1652                         set_bit_le(bit, mc_hash->byte);
1653                 }
1654
1655                 /* Broadcast packets go through the multicast hash filter.
1656                  * ether_crc_le() of the broadcast address is 0xbe2612ff
1657                  * so we always add bit 0xff to the mask.
1658                  */
1659                 set_bit_le(0xff, mc_hash->byte);
1660         }
1661
1662         if (efx->port_enabled)
1663                 queue_work(efx->workqueue, &efx->mac_work);
1664         /* Otherwise efx_start_port() will do this */
1665 }
1666
1667 static const struct net_device_ops efx_netdev_ops = {
1668         .ndo_open               = efx_net_open,
1669         .ndo_stop               = efx_net_stop,
1670         .ndo_get_stats64        = efx_net_stats,
1671         .ndo_tx_timeout         = efx_watchdog,
1672         .ndo_start_xmit         = efx_hard_start_xmit,
1673         .ndo_validate_addr      = eth_validate_addr,
1674         .ndo_do_ioctl           = efx_ioctl,
1675         .ndo_change_mtu         = efx_change_mtu,
1676         .ndo_set_mac_address    = efx_set_mac_address,
1677         .ndo_set_multicast_list = efx_set_multicast_list,
1678 #ifdef CONFIG_NET_POLL_CONTROLLER
1679         .ndo_poll_controller = efx_netpoll,
1680 #endif
1681 };
1682
1683 static void efx_update_name(struct efx_nic *efx)
1684 {
1685         strcpy(efx->name, efx->net_dev->name);
1686         efx_mtd_rename(efx);
1687         efx_set_channel_names(efx);
1688 }
1689
1690 static int efx_netdev_event(struct notifier_block *this,
1691                             unsigned long event, void *ptr)
1692 {
1693         struct net_device *net_dev = ptr;
1694
1695         if (net_dev->netdev_ops == &efx_netdev_ops &&
1696             event == NETDEV_CHANGENAME)
1697                 efx_update_name(netdev_priv(net_dev));
1698
1699         return NOTIFY_DONE;
1700 }
1701
1702 static struct notifier_block efx_netdev_notifier = {
1703         .notifier_call = efx_netdev_event,
1704 };
1705
1706 static ssize_t
1707 show_phy_type(struct device *dev, struct device_attribute *attr, char *buf)
1708 {
1709         struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev));
1710         return sprintf(buf, "%d\n", efx->phy_type);
1711 }
1712 static DEVICE_ATTR(phy_type, 0644, show_phy_type, NULL);
1713
1714 static int efx_register_netdev(struct efx_nic *efx)
1715 {
1716         struct net_device *net_dev = efx->net_dev;
1717         int rc;
1718
1719         net_dev->watchdog_timeo = 5 * HZ;
1720         net_dev->irq = efx->pci_dev->irq;
1721         net_dev->netdev_ops = &efx_netdev_ops;
1722         SET_ETHTOOL_OPS(net_dev, &efx_ethtool_ops);
1723
1724         /* Clear MAC statistics */
1725         efx->mac_op->update_stats(efx);
1726         memset(&efx->mac_stats, 0, sizeof(efx->mac_stats));
1727
1728         rtnl_lock();
1729
1730         rc = dev_alloc_name(net_dev, net_dev->name);
1731         if (rc < 0)
1732                 goto fail_locked;
1733         efx_update_name(efx);
1734
1735         rc = register_netdevice(net_dev);
1736         if (rc)
1737                 goto fail_locked;
1738
1739         /* Always start with carrier off; PHY events will detect the link */
1740         netif_carrier_off(efx->net_dev);
1741
1742         rtnl_unlock();
1743
1744         rc = device_create_file(&efx->pci_dev->dev, &dev_attr_phy_type);
1745         if (rc) {
1746                 netif_err(efx, drv, efx->net_dev,
1747                           "failed to init net dev attributes\n");
1748                 goto fail_registered;
1749         }
1750
1751         return 0;
1752
1753 fail_locked:
1754         rtnl_unlock();
1755         netif_err(efx, drv, efx->net_dev, "could not register net dev\n");
1756         return rc;
1757
1758 fail_registered:
1759         unregister_netdev(net_dev);
1760         return rc;
1761 }
1762
1763 static void efx_unregister_netdev(struct efx_nic *efx)
1764 {
1765         struct efx_tx_queue *tx_queue;
1766
1767         if (!efx->net_dev)
1768                 return;
1769
1770         BUG_ON(netdev_priv(efx->net_dev) != efx);
1771
1772         /* Free up any skbs still remaining. This has to happen before
1773          * we try to unregister the netdev as running their destructors
1774          * may be needed to get the device ref. count to 0. */
1775         efx_for_each_tx_queue(tx_queue, efx)
1776                 efx_release_tx_buffers(tx_queue);
1777
1778         if (efx_dev_registered(efx)) {
1779                 strlcpy(efx->name, pci_name(efx->pci_dev), sizeof(efx->name));
1780                 device_remove_file(&efx->pci_dev->dev, &dev_attr_phy_type);
1781                 unregister_netdev(efx->net_dev);
1782         }
1783 }
1784
1785 /**************************************************************************
1786  *
1787  * Device reset and suspend
1788  *
1789  **************************************************************************/
1790
1791 /* Tears down the entire software state and most of the hardware state
1792  * before reset.  */
1793 void efx_reset_down(struct efx_nic *efx, enum reset_type method)
1794 {
1795         EFX_ASSERT_RESET_SERIALISED(efx);
1796
1797         efx_stop_all(efx);
1798         mutex_lock(&efx->mac_lock);
1799         mutex_lock(&efx->spi_lock);
1800
1801         efx_fini_channels(efx);
1802         if (efx->port_initialized && method != RESET_TYPE_INVISIBLE)
1803                 efx->phy_op->fini(efx);
1804         efx->type->fini(efx);
1805 }
1806
1807 /* This function will always ensure that the locks acquired in
1808  * efx_reset_down() are released. A failure return code indicates
1809  * that we were unable to reinitialise the hardware, and the
1810  * driver should be disabled. If ok is false, then the rx and tx
1811  * engines are not restarted, pending a RESET_DISABLE. */
1812 int efx_reset_up(struct efx_nic *efx, enum reset_type method, bool ok)
1813 {
1814         int rc;
1815
1816         EFX_ASSERT_RESET_SERIALISED(efx);
1817
1818         rc = efx->type->init(efx);
1819         if (rc) {
1820                 netif_err(efx, drv, efx->net_dev, "failed to initialise NIC\n");
1821                 goto fail;
1822         }
1823
1824         if (!ok)
1825                 goto fail;
1826
1827         if (efx->port_initialized && method != RESET_TYPE_INVISIBLE) {
1828                 rc = efx->phy_op->init(efx);
1829                 if (rc)
1830                         goto fail;
1831                 if (efx->phy_op->reconfigure(efx))
1832                         netif_err(efx, drv, efx->net_dev,
1833                                   "could not restore PHY settings\n");
1834         }
1835
1836         efx->mac_op->reconfigure(efx);
1837
1838         efx_init_channels(efx);
1839
1840         mutex_unlock(&efx->spi_lock);
1841         mutex_unlock(&efx->mac_lock);
1842
1843         efx_start_all(efx);
1844
1845         return 0;
1846
1847 fail:
1848         efx->port_initialized = false;
1849
1850         mutex_unlock(&efx->spi_lock);
1851         mutex_unlock(&efx->mac_lock);
1852
1853         return rc;
1854 }
1855
1856 /* Reset the NIC using the specified method.  Note that the reset may
1857  * fail, in which case the card will be left in an unusable state.
1858  *
1859  * Caller must hold the rtnl_lock.
1860  */
1861 int efx_reset(struct efx_nic *efx, enum reset_type method)
1862 {
1863         int rc, rc2;
1864         bool disabled;
1865
1866         netif_info(efx, drv, efx->net_dev, "resetting (%s)\n",
1867                    RESET_TYPE(method));
1868
1869         efx_reset_down(efx, method);
1870
1871         rc = efx->type->reset(efx, method);
1872         if (rc) {
1873                 netif_err(efx, drv, efx->net_dev, "failed to reset hardware\n");
1874                 goto out;
1875         }
1876
1877         /* Allow resets to be rescheduled. */
1878         efx->reset_pending = RESET_TYPE_NONE;
1879
1880         /* Reinitialise bus-mastering, which may have been turned off before
1881          * the reset was scheduled. This is still appropriate, even in the
1882          * RESET_TYPE_DISABLE since this driver generally assumes the hardware
1883          * can respond to requests. */
1884         pci_set_master(efx->pci_dev);
1885
1886 out:
1887         /* Leave device stopped if necessary */
1888         disabled = rc || method == RESET_TYPE_DISABLE;
1889         rc2 = efx_reset_up(efx, method, !disabled);
1890         if (rc2) {
1891                 disabled = true;
1892                 if (!rc)
1893                         rc = rc2;
1894         }
1895
1896         if (disabled) {
1897                 dev_close(efx->net_dev);
1898                 netif_err(efx, drv, efx->net_dev, "has been disabled\n");
1899                 efx->state = STATE_DISABLED;
1900         } else {
1901                 netif_dbg(efx, drv, efx->net_dev, "reset complete\n");
1902         }
1903         return rc;
1904 }
1905
1906 /* The worker thread exists so that code that cannot sleep can
1907  * schedule a reset for later.
1908  */
1909 static void efx_reset_work(struct work_struct *data)
1910 {
1911         struct efx_nic *efx = container_of(data, struct efx_nic, reset_work);
1912
1913         if (efx->reset_pending == RESET_TYPE_NONE)
1914                 return;
1915
1916         /* If we're not RUNNING then don't reset. Leave the reset_pending
1917          * flag set so that efx_pci_probe_main will be retried */
1918         if (efx->state != STATE_RUNNING) {
1919                 netif_info(efx, drv, efx->net_dev,
1920                            "scheduled reset quenched. NIC not RUNNING\n");
1921                 return;
1922         }
1923
1924         rtnl_lock();
1925         (void)efx_reset(efx, efx->reset_pending);
1926         rtnl_unlock();
1927 }
1928
1929 void efx_schedule_reset(struct efx_nic *efx, enum reset_type type)
1930 {
1931         enum reset_type method;
1932
1933         if (efx->reset_pending != RESET_TYPE_NONE) {
1934                 netif_info(efx, drv, efx->net_dev,
1935                            "quenching already scheduled reset\n");
1936                 return;
1937         }
1938
1939         switch (type) {
1940         case RESET_TYPE_INVISIBLE:
1941         case RESET_TYPE_ALL:
1942         case RESET_TYPE_WORLD:
1943         case RESET_TYPE_DISABLE:
1944                 method = type;
1945                 break;
1946         case RESET_TYPE_RX_RECOVERY:
1947         case RESET_TYPE_RX_DESC_FETCH:
1948         case RESET_TYPE_TX_DESC_FETCH:
1949         case RESET_TYPE_TX_SKIP:
1950                 method = RESET_TYPE_INVISIBLE;
1951                 break;
1952         case RESET_TYPE_MC_FAILURE:
1953         default:
1954                 method = RESET_TYPE_ALL;
1955                 break;
1956         }
1957
1958         if (method != type)
1959                 netif_dbg(efx, drv, efx->net_dev,
1960                           "scheduling %s reset for %s\n",
1961                           RESET_TYPE(method), RESET_TYPE(type));
1962         else
1963                 netif_dbg(efx, drv, efx->net_dev, "scheduling %s reset\n",
1964                           RESET_TYPE(method));
1965
1966         efx->reset_pending = method;
1967
1968         /* efx_process_channel() will no longer read events once a
1969          * reset is scheduled. So switch back to poll'd MCDI completions. */
1970         efx_mcdi_mode_poll(efx);
1971
1972         queue_work(reset_workqueue, &efx->reset_work);
1973 }
1974
1975 /**************************************************************************
1976  *
1977  * List of NICs we support
1978  *
1979  **************************************************************************/
1980
1981 /* PCI device ID table */
1982 static DEFINE_PCI_DEVICE_TABLE(efx_pci_table) = {
1983         {PCI_DEVICE(EFX_VENDID_SFC, FALCON_A_P_DEVID),
1984          .driver_data = (unsigned long) &falcon_a1_nic_type},
1985         {PCI_DEVICE(EFX_VENDID_SFC, FALCON_B_P_DEVID),
1986          .driver_data = (unsigned long) &falcon_b0_nic_type},
1987         {PCI_DEVICE(EFX_VENDID_SFC, BETHPAGE_A_P_DEVID),
1988          .driver_data = (unsigned long) &siena_a0_nic_type},
1989         {PCI_DEVICE(EFX_VENDID_SFC, SIENA_A_P_DEVID),
1990          .driver_data = (unsigned long) &siena_a0_nic_type},
1991         {0}                     /* end of list */
1992 };
1993
1994 /**************************************************************************
1995  *
1996  * Dummy PHY/MAC operations
1997  *
1998  * Can be used for some unimplemented operations
1999  * Needed so all function pointers are valid and do not have to be tested
2000  * before use
2001  *
2002  **************************************************************************/
2003 int efx_port_dummy_op_int(struct efx_nic *efx)
2004 {
2005         return 0;
2006 }
2007 void efx_port_dummy_op_void(struct efx_nic *efx) {}
2008 void efx_port_dummy_op_set_id_led(struct efx_nic *efx, enum efx_led_mode mode)
2009 {
2010 }
2011 bool efx_port_dummy_op_poll(struct efx_nic *efx)
2012 {
2013         return false;
2014 }
2015
2016 static struct efx_phy_operations efx_dummy_phy_operations = {
2017         .init            = efx_port_dummy_op_int,
2018         .reconfigure     = efx_port_dummy_op_int,
2019         .poll            = efx_port_dummy_op_poll,
2020         .fini            = efx_port_dummy_op_void,
2021 };
2022
2023 /**************************************************************************
2024  *
2025  * Data housekeeping
2026  *
2027  **************************************************************************/
2028
2029 /* This zeroes out and then fills in the invariants in a struct
2030  * efx_nic (including all sub-structures).
2031  */
2032 static int efx_init_struct(struct efx_nic *efx, struct efx_nic_type *type,
2033                            struct pci_dev *pci_dev, struct net_device *net_dev)
2034 {
2035         struct efx_channel *channel;
2036         struct efx_tx_queue *tx_queue;
2037         struct efx_rx_queue *rx_queue;
2038         int i;
2039
2040         /* Initialise common structures */
2041         memset(efx, 0, sizeof(*efx));
2042         spin_lock_init(&efx->biu_lock);
2043         mutex_init(&efx->mdio_lock);
2044         mutex_init(&efx->spi_lock);
2045 #ifdef CONFIG_SFC_MTD
2046         INIT_LIST_HEAD(&efx->mtd_list);
2047 #endif
2048         INIT_WORK(&efx->reset_work, efx_reset_work);
2049         INIT_DELAYED_WORK(&efx->monitor_work, efx_monitor);
2050         efx->pci_dev = pci_dev;
2051         efx->msg_enable = debug;
2052         efx->state = STATE_INIT;
2053         efx->reset_pending = RESET_TYPE_NONE;
2054         strlcpy(efx->name, pci_name(pci_dev), sizeof(efx->name));
2055
2056         efx->net_dev = net_dev;
2057         efx->rx_checksum_enabled = true;
2058         spin_lock_init(&efx->stats_lock);
2059         mutex_init(&efx->mac_lock);
2060         efx->mac_op = type->default_mac_ops;
2061         efx->phy_op = &efx_dummy_phy_operations;
2062         efx->mdio.dev = net_dev;
2063         INIT_WORK(&efx->mac_work, efx_mac_work);
2064
2065         for (i = 0; i < EFX_MAX_CHANNELS; i++) {
2066                 channel = &efx->channel[i];
2067                 channel->efx = efx;
2068                 channel->channel = i;
2069                 channel->work_pending = false;
2070                 spin_lock_init(&channel->tx_stop_lock);
2071                 atomic_set(&channel->tx_stop_count, 1);
2072         }
2073         for (i = 0; i < EFX_MAX_TX_QUEUES; i++) {
2074                 tx_queue = &efx->tx_queue[i];
2075                 tx_queue->efx = efx;
2076                 tx_queue->queue = i;
2077                 tx_queue->buffer = NULL;
2078                 tx_queue->channel = &efx->channel[0]; /* for safety */
2079                 tx_queue->tso_headers_free = NULL;
2080         }
2081         for (i = 0; i < EFX_MAX_RX_QUEUES; i++) {
2082                 rx_queue = &efx->rx_queue[i];
2083                 rx_queue->efx = efx;
2084                 rx_queue->queue = i;
2085                 rx_queue->channel = &efx->channel[0]; /* for safety */
2086                 rx_queue->buffer = NULL;
2087                 setup_timer(&rx_queue->slow_fill, efx_rx_slow_fill,
2088                             (unsigned long)rx_queue);
2089         }
2090
2091         efx->type = type;
2092
2093         /* As close as we can get to guaranteeing that we don't overflow */
2094         BUILD_BUG_ON(EFX_EVQ_SIZE < EFX_TXQ_SIZE + EFX_RXQ_SIZE);
2095
2096         EFX_BUG_ON_PARANOID(efx->type->phys_addr_channels > EFX_MAX_CHANNELS);
2097
2098         /* Higher numbered interrupt modes are less capable! */
2099         efx->interrupt_mode = max(efx->type->max_interrupt_mode,
2100                                   interrupt_mode);
2101
2102         /* Would be good to use the net_dev name, but we're too early */
2103         snprintf(efx->workqueue_name, sizeof(efx->workqueue_name), "sfc%s",
2104                  pci_name(pci_dev));
2105         efx->workqueue = create_singlethread_workqueue(efx->workqueue_name);
2106         if (!efx->workqueue)
2107                 return -ENOMEM;
2108
2109         return 0;
2110 }
2111
2112 static void efx_fini_struct(struct efx_nic *efx)
2113 {
2114         if (efx->workqueue) {
2115                 destroy_workqueue(efx->workqueue);
2116                 efx->workqueue = NULL;
2117         }
2118 }
2119
2120 /**************************************************************************
2121  *
2122  * PCI interface
2123  *
2124  **************************************************************************/
2125
2126 /* Main body of final NIC shutdown code
2127  * This is called only at module unload (or hotplug removal).
2128  */
2129 static void efx_pci_remove_main(struct efx_nic *efx)
2130 {
2131         efx_nic_fini_interrupt(efx);
2132         efx_fini_channels(efx);
2133         efx_fini_port(efx);
2134         efx->type->fini(efx);
2135         efx_fini_napi(efx);
2136         efx_remove_all(efx);
2137 }
2138
2139 /* Final NIC shutdown
2140  * This is called only at module unload (or hotplug removal).
2141  */
2142 static void efx_pci_remove(struct pci_dev *pci_dev)
2143 {
2144         struct efx_nic *efx;
2145
2146         efx = pci_get_drvdata(pci_dev);
2147         if (!efx)
2148                 return;
2149
2150         /* Mark the NIC as fini, then stop the interface */
2151         rtnl_lock();
2152         efx->state = STATE_FINI;
2153         dev_close(efx->net_dev);
2154
2155         /* Allow any queued efx_resets() to complete */
2156         rtnl_unlock();
2157
2158         efx_unregister_netdev(efx);
2159
2160         efx_mtd_remove(efx);
2161
2162         /* Wait for any scheduled resets to complete. No more will be
2163          * scheduled from this point because efx_stop_all() has been
2164          * called, we are no longer registered with driverlink, and
2165          * the net_device's have been removed. */
2166         cancel_work_sync(&efx->reset_work);
2167
2168         efx_pci_remove_main(efx);
2169
2170         efx_fini_io(efx);
2171         netif_dbg(efx, drv, efx->net_dev, "shutdown successful\n");
2172
2173         pci_set_drvdata(pci_dev, NULL);
2174         efx_fini_struct(efx);
2175         free_netdev(efx->net_dev);
2176 };
2177
2178 /* Main body of NIC initialisation
2179  * This is called at module load (or hotplug insertion, theoretically).
2180  */
2181 static int efx_pci_probe_main(struct efx_nic *efx)
2182 {
2183         int rc;
2184
2185         /* Do start-of-day initialisation */
2186         rc = efx_probe_all(efx);
2187         if (rc)
2188                 goto fail1;
2189
2190         rc = efx_init_napi(efx);
2191         if (rc)
2192                 goto fail2;
2193
2194         rc = efx->type->init(efx);
2195         if (rc) {
2196                 netif_err(efx, probe, efx->net_dev,
2197                           "failed to initialise NIC\n");
2198                 goto fail3;
2199         }
2200
2201         rc = efx_init_port(efx);
2202         if (rc) {
2203                 netif_err(efx, probe, efx->net_dev,
2204                           "failed to initialise port\n");
2205                 goto fail4;
2206         }
2207
2208         efx_init_channels(efx);
2209
2210         rc = efx_nic_init_interrupt(efx);
2211         if (rc)
2212                 goto fail5;
2213
2214         return 0;
2215
2216  fail5:
2217         efx_fini_channels(efx);
2218         efx_fini_port(efx);
2219  fail4:
2220         efx->type->fini(efx);
2221  fail3:
2222         efx_fini_napi(efx);
2223  fail2:
2224         efx_remove_all(efx);
2225  fail1:
2226         return rc;
2227 }
2228
2229 /* NIC initialisation
2230  *
2231  * This is called at module load (or hotplug insertion,
2232  * theoretically).  It sets up PCI mappings, tests and resets the NIC,
2233  * sets up and registers the network devices with the kernel and hooks
2234  * the interrupt service routine.  It does not prepare the device for
2235  * transmission; this is left to the first time one of the network
2236  * interfaces is brought up (i.e. efx_net_open).
2237  */
2238 static int __devinit efx_pci_probe(struct pci_dev *pci_dev,
2239                                    const struct pci_device_id *entry)
2240 {
2241         struct efx_nic_type *type = (struct efx_nic_type *) entry->driver_data;
2242         struct net_device *net_dev;
2243         struct efx_nic *efx;
2244         int i, rc;
2245
2246         /* Allocate and initialise a struct net_device and struct efx_nic */
2247         net_dev = alloc_etherdev_mq(sizeof(*efx), EFX_MAX_CORE_TX_QUEUES);
2248         if (!net_dev)
2249                 return -ENOMEM;
2250         net_dev->features |= (type->offload_features | NETIF_F_SG |
2251                               NETIF_F_HIGHDMA | NETIF_F_TSO |
2252                               NETIF_F_GRO);
2253         if (type->offload_features & NETIF_F_V6_CSUM)
2254                 net_dev->features |= NETIF_F_TSO6;
2255         /* Mask for features that also apply to VLAN devices */
2256         net_dev->vlan_features |= (NETIF_F_ALL_CSUM | NETIF_F_SG |
2257                                    NETIF_F_HIGHDMA | NETIF_F_TSO);
2258         efx = netdev_priv(net_dev);
2259         pci_set_drvdata(pci_dev, efx);
2260         SET_NETDEV_DEV(net_dev, &pci_dev->dev);
2261         rc = efx_init_struct(efx, type, pci_dev, net_dev);
2262         if (rc)
2263                 goto fail1;
2264
2265         netif_info(efx, probe, efx->net_dev,
2266                    "Solarflare Communications NIC detected\n");
2267
2268         /* Set up basic I/O (BAR mappings etc) */
2269         rc = efx_init_io(efx);
2270         if (rc)
2271                 goto fail2;
2272
2273         /* No serialisation is required with the reset path because
2274          * we're in STATE_INIT. */
2275         for (i = 0; i < 5; i++) {
2276                 rc = efx_pci_probe_main(efx);
2277
2278                 /* Serialise against efx_reset(). No more resets will be
2279                  * scheduled since efx_stop_all() has been called, and we
2280                  * have not and never have been registered with either
2281                  * the rtnetlink or driverlink layers. */
2282                 cancel_work_sync(&efx->reset_work);
2283
2284                 if (rc == 0) {
2285                         if (efx->reset_pending != RESET_TYPE_NONE) {
2286                                 /* If there was a scheduled reset during
2287                                  * probe, the NIC is probably hosed anyway */
2288                                 efx_pci_remove_main(efx);
2289                                 rc = -EIO;
2290                         } else {
2291                                 break;
2292                         }
2293                 }
2294
2295                 /* Retry if a recoverably reset event has been scheduled */
2296                 if ((efx->reset_pending != RESET_TYPE_INVISIBLE) &&
2297                     (efx->reset_pending != RESET_TYPE_ALL))
2298                         goto fail3;
2299
2300                 efx->reset_pending = RESET_TYPE_NONE;
2301         }
2302
2303         if (rc) {
2304                 netif_err(efx, probe, efx->net_dev, "Could not reset NIC\n");
2305                 goto fail4;
2306         }
2307
2308         /* Switch to the running state before we expose the device to the OS,
2309          * so that dev_open()|efx_start_all() will actually start the device */
2310         efx->state = STATE_RUNNING;
2311
2312         rc = efx_register_netdev(efx);
2313         if (rc)
2314                 goto fail5;
2315
2316         netif_dbg(efx, probe, efx->net_dev, "initialisation successful\n");
2317
2318         rtnl_lock();
2319         efx_mtd_probe(efx); /* allowed to fail */
2320         rtnl_unlock();
2321         return 0;
2322
2323  fail5:
2324         efx_pci_remove_main(efx);
2325  fail4:
2326  fail3:
2327         efx_fini_io(efx);
2328  fail2:
2329         efx_fini_struct(efx);
2330  fail1:
2331         WARN_ON(rc > 0);
2332         netif_dbg(efx, drv, efx->net_dev, "initialisation failed. rc=%d\n", rc);
2333         free_netdev(net_dev);
2334         return rc;
2335 }
2336
2337 static int efx_pm_freeze(struct device *dev)
2338 {
2339         struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev));
2340
2341         efx->state = STATE_FINI;
2342
2343         netif_device_detach(efx->net_dev);
2344
2345         efx_stop_all(efx);
2346         efx_fini_channels(efx);
2347
2348         return 0;
2349 }
2350
2351 static int efx_pm_thaw(struct device *dev)
2352 {
2353         struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev));
2354
2355         efx->state = STATE_INIT;
2356
2357         efx_init_channels(efx);
2358
2359         mutex_lock(&efx->mac_lock);
2360         efx->phy_op->reconfigure(efx);
2361         mutex_unlock(&efx->mac_lock);
2362
2363         efx_start_all(efx);
2364
2365         netif_device_attach(efx->net_dev);
2366
2367         efx->state = STATE_RUNNING;
2368
2369         efx->type->resume_wol(efx);
2370
2371         /* Reschedule any quenched resets scheduled during efx_pm_freeze() */
2372         queue_work(reset_workqueue, &efx->reset_work);
2373
2374         return 0;
2375 }
2376
2377 static int efx_pm_poweroff(struct device *dev)
2378 {
2379         struct pci_dev *pci_dev = to_pci_dev(dev);
2380         struct efx_nic *efx = pci_get_drvdata(pci_dev);
2381
2382         efx->type->fini(efx);
2383
2384         efx->reset_pending = RESET_TYPE_NONE;
2385
2386         pci_save_state(pci_dev);
2387         return pci_set_power_state(pci_dev, PCI_D3hot);
2388 }
2389
2390 /* Used for both resume and restore */
2391 static int efx_pm_resume(struct device *dev)
2392 {
2393         struct pci_dev *pci_dev = to_pci_dev(dev);
2394         struct efx_nic *efx = pci_get_drvdata(pci_dev);
2395         int rc;
2396
2397         rc = pci_set_power_state(pci_dev, PCI_D0);
2398         if (rc)
2399                 return rc;
2400         pci_restore_state(pci_dev);
2401         rc = pci_enable_device(pci_dev);
2402         if (rc)
2403                 return rc;
2404         pci_set_master(efx->pci_dev);
2405         rc = efx->type->reset(efx, RESET_TYPE_ALL);
2406         if (rc)
2407                 return rc;
2408         rc = efx->type->init(efx);
2409         if (rc)
2410                 return rc;
2411         efx_pm_thaw(dev);
2412         return 0;
2413 }
2414
2415 static int efx_pm_suspend(struct device *dev)
2416 {
2417         int rc;
2418
2419         efx_pm_freeze(dev);
2420         rc = efx_pm_poweroff(dev);
2421         if (rc)
2422                 efx_pm_resume(dev);
2423         return rc;
2424 }
2425
2426 static struct dev_pm_ops efx_pm_ops = {
2427         .suspend        = efx_pm_suspend,
2428         .resume         = efx_pm_resume,
2429         .freeze         = efx_pm_freeze,
2430         .thaw           = efx_pm_thaw,
2431         .poweroff       = efx_pm_poweroff,
2432         .restore        = efx_pm_resume,
2433 };
2434
2435 static struct pci_driver efx_pci_driver = {
2436         .name           = KBUILD_MODNAME,
2437         .id_table       = efx_pci_table,
2438         .probe          = efx_pci_probe,
2439         .remove         = efx_pci_remove,
2440         .driver.pm      = &efx_pm_ops,
2441 };
2442
2443 /**************************************************************************
2444  *
2445  * Kernel module interface
2446  *
2447  *************************************************************************/
2448
2449 module_param(interrupt_mode, uint, 0444);
2450 MODULE_PARM_DESC(interrupt_mode,
2451                  "Interrupt mode (0=>MSIX 1=>MSI 2=>legacy)");
2452
2453 static int __init efx_init_module(void)
2454 {
2455         int rc;
2456
2457         printk(KERN_INFO "Solarflare NET driver v" EFX_DRIVER_VERSION "\n");
2458
2459         rc = register_netdevice_notifier(&efx_netdev_notifier);
2460         if (rc)
2461                 goto err_notifier;
2462
2463         reset_workqueue = create_singlethread_workqueue("sfc_reset");
2464         if (!reset_workqueue) {
2465                 rc = -ENOMEM;
2466                 goto err_reset;
2467         }
2468
2469         rc = pci_register_driver(&efx_pci_driver);
2470         if (rc < 0)
2471                 goto err_pci;
2472
2473         return 0;
2474
2475  err_pci:
2476         destroy_workqueue(reset_workqueue);
2477  err_reset:
2478         unregister_netdevice_notifier(&efx_netdev_notifier);
2479  err_notifier:
2480         return rc;
2481 }
2482
2483 static void __exit efx_exit_module(void)
2484 {
2485         printk(KERN_INFO "Solarflare NET driver unloading\n");
2486
2487         pci_unregister_driver(&efx_pci_driver);
2488         destroy_workqueue(reset_workqueue);
2489         unregister_netdevice_notifier(&efx_netdev_notifier);
2490
2491 }
2492
2493 module_init(efx_init_module);
2494 module_exit(efx_exit_module);
2495
2496 MODULE_AUTHOR("Solarflare Communications and "
2497               "Michael Brown <mbrown@fensystems.co.uk>");
2498 MODULE_DESCRIPTION("Solarflare Communications network driver");
2499 MODULE_LICENSE("GPL");
2500 MODULE_DEVICE_TABLE(pci, efx_pci_table);