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