xref: /openbmc/linux/drivers/net/ethernet/wangxun/ngbe/ngbe_main.c (revision 72ed5d5624af384eaf74d84915810d54486a75e2)
1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (c) 2019 - 2022 Beijing WangXun Technology Co., Ltd. */
3 
4 #include <linux/types.h>
5 #include <linux/module.h>
6 #include <linux/pci.h>
7 #include <linux/netdevice.h>
8 #include <linux/string.h>
9 #include <linux/aer.h>
10 #include <linux/etherdevice.h>
11 #include <net/ip.h>
12 #include <linux/phy.h>
13 
14 #include "../libwx/wx_type.h"
15 #include "../libwx/wx_hw.h"
16 #include "../libwx/wx_lib.h"
17 #include "ngbe_type.h"
18 #include "ngbe_mdio.h"
19 #include "ngbe_hw.h"
20 
21 char ngbe_driver_name[] = "ngbe";
22 
23 /* ngbe_pci_tbl - PCI Device ID Table
24  *
25  * { Vendor ID, Device ID, SubVendor ID, SubDevice ID,
26  *   Class, Class Mask, private data (not used) }
27  */
28 static const struct pci_device_id ngbe_pci_tbl[] = {
29 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860AL_W), 0},
30 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860A2), 0},
31 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860A2S), 0},
32 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860A4), 0},
33 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860A4S), 0},
34 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860AL2), 0},
35 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860AL2S), 0},
36 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860AL4), 0},
37 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860AL4S), 0},
38 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860LC), 0},
39 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860A1), 0},
40 	{ PCI_VDEVICE(WANGXUN, NGBE_DEV_ID_EM_WX1860A1L), 0},
41 	/* required last entry */
42 	{ .device = 0 }
43 };
44 
45 /**
46  *  ngbe_init_type_code - Initialize the shared code
47  *  @wx: pointer to hardware structure
48  **/
49 static void ngbe_init_type_code(struct wx *wx)
50 {
51 	int wol_mask = 0, ncsi_mask = 0;
52 	u16 type_mask = 0, val;
53 
54 	wx->mac.type = wx_mac_em;
55 	type_mask = (u16)(wx->subsystem_device_id & NGBE_OEM_MASK);
56 	ncsi_mask = wx->subsystem_device_id & NGBE_NCSI_MASK;
57 	wol_mask = wx->subsystem_device_id & NGBE_WOL_MASK;
58 
59 	val = rd32(wx, WX_CFG_PORT_ST);
60 	wx->mac_type = (val & BIT(7)) >> 7 ?
61 		       em_mac_type_rgmii :
62 		       em_mac_type_mdi;
63 
64 	wx->wol_enabled = (wol_mask == NGBE_WOL_SUP) ? 1 : 0;
65 	wx->ncsi_enabled = (ncsi_mask == NGBE_NCSI_MASK ||
66 			   type_mask == NGBE_SUBID_OCP_CARD) ? 1 : 0;
67 
68 	switch (type_mask) {
69 	case NGBE_SUBID_LY_YT8521S_SFP:
70 	case NGBE_SUBID_LY_M88E1512_SFP:
71 	case NGBE_SUBID_YT8521S_SFP_GPIO:
72 	case NGBE_SUBID_INTERNAL_YT8521S_SFP_GPIO:
73 		wx->gpio_ctrl = 1;
74 		break;
75 	default:
76 		wx->gpio_ctrl = 0;
77 		break;
78 	}
79 }
80 
81 /**
82  * ngbe_init_rss_key - Initialize wx RSS key
83  * @wx: device handle
84  *
85  * Allocates and initializes the RSS key if it is not allocated.
86  **/
87 static inline int ngbe_init_rss_key(struct wx *wx)
88 {
89 	u32 *rss_key;
90 
91 	if (!wx->rss_key) {
92 		rss_key = kzalloc(WX_RSS_KEY_SIZE, GFP_KERNEL);
93 		if (unlikely(!rss_key))
94 			return -ENOMEM;
95 
96 		netdev_rss_key_fill(rss_key, WX_RSS_KEY_SIZE);
97 		wx->rss_key = rss_key;
98 	}
99 
100 	return 0;
101 }
102 
103 /**
104  * ngbe_sw_init - Initialize general software structures
105  * @wx: board private structure to initialize
106  **/
107 static int ngbe_sw_init(struct wx *wx)
108 {
109 	struct pci_dev *pdev = wx->pdev;
110 	u16 msix_count = 0;
111 	int err = 0;
112 
113 	wx->mac.num_rar_entries = NGBE_RAR_ENTRIES;
114 	wx->mac.max_rx_queues = NGBE_MAX_RX_QUEUES;
115 	wx->mac.max_tx_queues = NGBE_MAX_TX_QUEUES;
116 	wx->mac.mcft_size = NGBE_MC_TBL_SIZE;
117 	wx->mac.rx_pb_size = NGBE_RX_PB_SIZE;
118 	wx->mac.tx_pb_size = NGBE_TDB_PB_SZ;
119 
120 	/* PCI config space info */
121 	err = wx_sw_init(wx);
122 	if (err < 0) {
123 		wx_err(wx, "read of internal subsystem device id failed\n");
124 		return err;
125 	}
126 
127 	/* mac type, phy type , oem type */
128 	ngbe_init_type_code(wx);
129 
130 	/* Set common capability flags and settings */
131 	wx->max_q_vectors = NGBE_MAX_MSIX_VECTORS;
132 	err = wx_get_pcie_msix_counts(wx, &msix_count, NGBE_MAX_MSIX_VECTORS);
133 	if (err)
134 		dev_err(&pdev->dev, "Do not support MSI-X\n");
135 	wx->mac.max_msix_vectors = msix_count;
136 
137 	if (ngbe_init_rss_key(wx))
138 		return -ENOMEM;
139 
140 	/* enable itr by default in dynamic mode */
141 	wx->rx_itr_setting = 1;
142 	wx->tx_itr_setting = 1;
143 
144 	/* set default ring sizes */
145 	wx->tx_ring_count = NGBE_DEFAULT_TXD;
146 	wx->rx_ring_count = NGBE_DEFAULT_RXD;
147 
148 	/* set default work limits */
149 	wx->tx_work_limit = NGBE_DEFAULT_TX_WORK;
150 	wx->rx_work_limit = NGBE_DEFAULT_RX_WORK;
151 
152 	return 0;
153 }
154 
155 /**
156  * ngbe_irq_enable - Enable default interrupt generation settings
157  * @wx: board private structure
158  * @queues: enable all queues interrupts
159  **/
160 static void ngbe_irq_enable(struct wx *wx, bool queues)
161 {
162 	u32 mask;
163 
164 	/* enable misc interrupt */
165 	mask = NGBE_PX_MISC_IEN_MASK;
166 
167 	wr32(wx, WX_GPIO_DDR, WX_GPIO_DDR_0);
168 	wr32(wx, WX_GPIO_INTEN, WX_GPIO_INTEN_0 | WX_GPIO_INTEN_1);
169 	wr32(wx, WX_GPIO_INTTYPE_LEVEL, 0x0);
170 	wr32(wx, WX_GPIO_POLARITY, wx->gpio_ctrl ? 0 : 0x3);
171 
172 	wr32(wx, WX_PX_MISC_IEN, mask);
173 
174 	/* mask interrupt */
175 	if (queues)
176 		wx_intr_enable(wx, NGBE_INTR_ALL);
177 	else
178 		wx_intr_enable(wx, NGBE_INTR_MISC(wx));
179 }
180 
181 /**
182  * ngbe_intr - msi/legacy mode Interrupt Handler
183  * @irq: interrupt number
184  * @data: pointer to a network interface device structure
185  **/
186 static irqreturn_t ngbe_intr(int __always_unused irq, void *data)
187 {
188 	struct wx_q_vector *q_vector;
189 	struct wx *wx  = data;
190 	struct pci_dev *pdev;
191 	u32 eicr;
192 
193 	q_vector = wx->q_vector[0];
194 	pdev = wx->pdev;
195 
196 	eicr = wx_misc_isb(wx, WX_ISB_VEC0);
197 	if (!eicr) {
198 		/* shared interrupt alert!
199 		 * the interrupt that we masked before the EICR read.
200 		 */
201 		if (netif_running(wx->netdev))
202 			ngbe_irq_enable(wx, true);
203 		return IRQ_NONE;        /* Not our interrupt */
204 	}
205 	wx->isb_mem[WX_ISB_VEC0] = 0;
206 	if (!(pdev->msi_enabled))
207 		wr32(wx, WX_PX_INTA, 1);
208 
209 	wx->isb_mem[WX_ISB_MISC] = 0;
210 	/* would disable interrupts here but it is auto disabled */
211 	napi_schedule_irqoff(&q_vector->napi);
212 
213 	if (netif_running(wx->netdev))
214 		ngbe_irq_enable(wx, false);
215 
216 	return IRQ_HANDLED;
217 }
218 
219 static irqreturn_t ngbe_msix_other(int __always_unused irq, void *data)
220 {
221 	struct wx *wx = data;
222 
223 	/* re-enable the original interrupt state, no lsc, no queues */
224 	if (netif_running(wx->netdev))
225 		ngbe_irq_enable(wx, false);
226 
227 	return IRQ_HANDLED;
228 }
229 
230 /**
231  * ngbe_request_msix_irqs - Initialize MSI-X interrupts
232  * @wx: board private structure
233  *
234  * ngbe_request_msix_irqs allocates MSI-X vectors and requests
235  * interrupts from the kernel.
236  **/
237 static int ngbe_request_msix_irqs(struct wx *wx)
238 {
239 	struct net_device *netdev = wx->netdev;
240 	int vector, err;
241 
242 	for (vector = 0; vector < wx->num_q_vectors; vector++) {
243 		struct wx_q_vector *q_vector = wx->q_vector[vector];
244 		struct msix_entry *entry = &wx->msix_entries[vector];
245 
246 		if (q_vector->tx.ring && q_vector->rx.ring)
247 			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
248 				 "%s-TxRx-%d", netdev->name, entry->entry);
249 		else
250 			/* skip this unused q_vector */
251 			continue;
252 
253 		err = request_irq(entry->vector, wx_msix_clean_rings, 0,
254 				  q_vector->name, q_vector);
255 		if (err) {
256 			wx_err(wx, "request_irq failed for MSIX interrupt %s Error: %d\n",
257 			       q_vector->name, err);
258 			goto free_queue_irqs;
259 		}
260 	}
261 
262 	err = request_irq(wx->msix_entries[vector].vector,
263 			  ngbe_msix_other, 0, netdev->name, wx);
264 
265 	if (err) {
266 		wx_err(wx, "request_irq for msix_other failed: %d\n", err);
267 		goto free_queue_irqs;
268 	}
269 
270 	return 0;
271 
272 free_queue_irqs:
273 	while (vector) {
274 		vector--;
275 		free_irq(wx->msix_entries[vector].vector,
276 			 wx->q_vector[vector]);
277 	}
278 	wx_reset_interrupt_capability(wx);
279 	return err;
280 }
281 
282 /**
283  * ngbe_request_irq - initialize interrupts
284  * @wx: board private structure
285  *
286  * Attempts to configure interrupts using the best available
287  * capabilities of the hardware and kernel.
288  **/
289 static int ngbe_request_irq(struct wx *wx)
290 {
291 	struct net_device *netdev = wx->netdev;
292 	struct pci_dev *pdev = wx->pdev;
293 	int err;
294 
295 	if (pdev->msix_enabled)
296 		err = ngbe_request_msix_irqs(wx);
297 	else if (pdev->msi_enabled)
298 		err = request_irq(pdev->irq, ngbe_intr, 0,
299 				  netdev->name, wx);
300 	else
301 		err = request_irq(pdev->irq, ngbe_intr, IRQF_SHARED,
302 				  netdev->name, wx);
303 
304 	if (err)
305 		wx_err(wx, "request_irq failed, Error %d\n", err);
306 
307 	return err;
308 }
309 
310 static void ngbe_disable_device(struct wx *wx)
311 {
312 	struct net_device *netdev = wx->netdev;
313 	u32 i;
314 
315 	/* disable all enabled rx queues */
316 	for (i = 0; i < wx->num_rx_queues; i++)
317 		/* this call also flushes the previous write */
318 		wx_disable_rx_queue(wx, wx->rx_ring[i]);
319 	/* disable receives */
320 	wx_disable_rx(wx);
321 	wx_napi_disable_all(wx);
322 	netif_tx_stop_all_queues(netdev);
323 	netif_tx_disable(netdev);
324 	if (wx->gpio_ctrl)
325 		ngbe_sfp_modules_txrx_powerctl(wx, false);
326 	wx_irq_disable(wx);
327 	/* disable transmits in the hardware now that interrupts are off */
328 	for (i = 0; i < wx->num_tx_queues; i++) {
329 		u8 reg_idx = wx->tx_ring[i]->reg_idx;
330 
331 		wr32(wx, WX_PX_TR_CFG(reg_idx), WX_PX_TR_CFG_SWFLSH);
332 	}
333 }
334 
335 static void ngbe_down(struct wx *wx)
336 {
337 	phy_stop(wx->phydev);
338 	ngbe_disable_device(wx);
339 	wx_clean_all_tx_rings(wx);
340 	wx_clean_all_rx_rings(wx);
341 }
342 
343 static void ngbe_up(struct wx *wx)
344 {
345 	wx_configure_vectors(wx);
346 
347 	/* make sure to complete pre-operations */
348 	smp_mb__before_atomic();
349 	wx_napi_enable_all(wx);
350 	/* enable transmits */
351 	netif_tx_start_all_queues(wx->netdev);
352 
353 	/* clear any pending interrupts, may auto mask */
354 	rd32(wx, WX_PX_IC);
355 	rd32(wx, WX_PX_MISC_IC);
356 	ngbe_irq_enable(wx, true);
357 	if (wx->gpio_ctrl)
358 		ngbe_sfp_modules_txrx_powerctl(wx, true);
359 
360 	phy_start(wx->phydev);
361 }
362 
363 /**
364  * ngbe_open - Called when a network interface is made active
365  * @netdev: network interface device structure
366  *
367  * Returns 0 on success, negative value on failure
368  *
369  * The open entry point is called when a network interface is made
370  * active by the system (IFF_UP).
371  **/
372 static int ngbe_open(struct net_device *netdev)
373 {
374 	struct wx *wx = netdev_priv(netdev);
375 	int err;
376 
377 	wx_control_hw(wx, true);
378 
379 	err = wx_setup_resources(wx);
380 	if (err)
381 		return err;
382 
383 	wx_configure(wx);
384 
385 	err = ngbe_request_irq(wx);
386 	if (err)
387 		goto err_free_resources;
388 
389 	err = ngbe_phy_connect(wx);
390 	if (err)
391 		goto err_free_irq;
392 
393 	err = netif_set_real_num_tx_queues(netdev, wx->num_tx_queues);
394 	if (err)
395 		goto err_dis_phy;
396 
397 	err = netif_set_real_num_rx_queues(netdev, wx->num_rx_queues);
398 	if (err)
399 		goto err_dis_phy;
400 
401 	ngbe_up(wx);
402 
403 	return 0;
404 err_dis_phy:
405 	phy_disconnect(wx->phydev);
406 err_free_irq:
407 	wx_free_irq(wx);
408 err_free_resources:
409 	wx_free_resources(wx);
410 	return err;
411 }
412 
413 /**
414  * ngbe_close - Disables a network interface
415  * @netdev: network interface device structure
416  *
417  * Returns 0, this is not allowed to fail
418  *
419  * The close entry point is called when an interface is de-activated
420  * by the OS.  The hardware is still under the drivers control, but
421  * needs to be disabled.  A global MAC reset is issued to stop the
422  * hardware, and all transmit and receive resources are freed.
423  **/
424 static int ngbe_close(struct net_device *netdev)
425 {
426 	struct wx *wx = netdev_priv(netdev);
427 
428 	ngbe_down(wx);
429 	wx_free_irq(wx);
430 	wx_free_resources(wx);
431 	phy_disconnect(wx->phydev);
432 	wx_control_hw(wx, false);
433 
434 	return 0;
435 }
436 
437 static void ngbe_dev_shutdown(struct pci_dev *pdev, bool *enable_wake)
438 {
439 	struct wx *wx = pci_get_drvdata(pdev);
440 	struct net_device *netdev;
441 
442 	netdev = wx->netdev;
443 	netif_device_detach(netdev);
444 
445 	rtnl_lock();
446 	if (netif_running(netdev))
447 		ngbe_down(wx);
448 	rtnl_unlock();
449 	wx_control_hw(wx, false);
450 
451 	pci_disable_device(pdev);
452 }
453 
454 static void ngbe_shutdown(struct pci_dev *pdev)
455 {
456 	struct wx *wx = pci_get_drvdata(pdev);
457 	bool wake;
458 
459 	wake = !!wx->wol;
460 
461 	ngbe_dev_shutdown(pdev, &wake);
462 
463 	if (system_state == SYSTEM_POWER_OFF) {
464 		pci_wake_from_d3(pdev, wake);
465 		pci_set_power_state(pdev, PCI_D3hot);
466 	}
467 }
468 
469 static const struct net_device_ops ngbe_netdev_ops = {
470 	.ndo_open               = ngbe_open,
471 	.ndo_stop               = ngbe_close,
472 	.ndo_start_xmit         = wx_xmit_frame,
473 	.ndo_set_rx_mode        = wx_set_rx_mode,
474 	.ndo_validate_addr      = eth_validate_addr,
475 	.ndo_set_mac_address    = wx_set_mac,
476 	.ndo_get_stats64        = wx_get_stats64,
477 };
478 
479 /**
480  * ngbe_probe - Device Initialization Routine
481  * @pdev: PCI device information struct
482  * @ent: entry in ngbe_pci_tbl
483  *
484  * Returns 0 on success, negative on failure
485  *
486  * ngbe_probe initializes an wx identified by a pci_dev structure.
487  * The OS initialization, configuring of the wx private structure,
488  * and a hardware reset occur.
489  **/
490 static int ngbe_probe(struct pci_dev *pdev,
491 		      const struct pci_device_id __always_unused *ent)
492 {
493 	struct net_device *netdev;
494 	u32 e2rom_cksum_cap = 0;
495 	struct wx *wx = NULL;
496 	static int func_nums;
497 	u16 e2rom_ver = 0;
498 	u32 etrack_id = 0;
499 	u32 saved_ver = 0;
500 	int err;
501 
502 	err = pci_enable_device_mem(pdev);
503 	if (err)
504 		return err;
505 
506 	err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
507 	if (err) {
508 		dev_err(&pdev->dev,
509 			"No usable DMA configuration, aborting\n");
510 		goto err_pci_disable_dev;
511 	}
512 
513 	err = pci_request_selected_regions(pdev,
514 					   pci_select_bars(pdev, IORESOURCE_MEM),
515 					   ngbe_driver_name);
516 	if (err) {
517 		dev_err(&pdev->dev,
518 			"pci_request_selected_regions failed %d\n", err);
519 		goto err_pci_disable_dev;
520 	}
521 
522 	pci_enable_pcie_error_reporting(pdev);
523 	pci_set_master(pdev);
524 
525 	netdev = devm_alloc_etherdev_mqs(&pdev->dev,
526 					 sizeof(struct wx),
527 					 NGBE_MAX_TX_QUEUES,
528 					 NGBE_MAX_RX_QUEUES);
529 	if (!netdev) {
530 		err = -ENOMEM;
531 		goto err_pci_release_regions;
532 	}
533 
534 	SET_NETDEV_DEV(netdev, &pdev->dev);
535 
536 	wx = netdev_priv(netdev);
537 	wx->netdev = netdev;
538 	wx->pdev = pdev;
539 	wx->msg_enable = BIT(3) - 1;
540 
541 	wx->hw_addr = devm_ioremap(&pdev->dev,
542 				   pci_resource_start(pdev, 0),
543 				   pci_resource_len(pdev, 0));
544 	if (!wx->hw_addr) {
545 		err = -EIO;
546 		goto err_pci_release_regions;
547 	}
548 
549 	netdev->netdev_ops = &ngbe_netdev_ops;
550 
551 	netdev->features |= NETIF_F_HIGHDMA;
552 	netdev->features = NETIF_F_SG;
553 
554 	/* copy netdev features into list of user selectable features */
555 	netdev->hw_features |= netdev->features |
556 			       NETIF_F_RXALL;
557 
558 	netdev->priv_flags |= IFF_UNICAST_FLT;
559 	netdev->priv_flags |= IFF_SUPP_NOFCS;
560 
561 	netdev->min_mtu = ETH_MIN_MTU;
562 	netdev->max_mtu = NGBE_MAX_JUMBO_FRAME_SIZE - (ETH_HLEN + ETH_FCS_LEN);
563 
564 	wx->bd_number = func_nums;
565 	/* setup the private structure */
566 	err = ngbe_sw_init(wx);
567 	if (err)
568 		goto err_free_mac_table;
569 
570 	/* check if flash load is done after hw power up */
571 	err = wx_check_flash_load(wx, NGBE_SPI_ILDR_STATUS_PERST);
572 	if (err)
573 		goto err_free_mac_table;
574 	err = wx_check_flash_load(wx, NGBE_SPI_ILDR_STATUS_PWRRST);
575 	if (err)
576 		goto err_free_mac_table;
577 
578 	err = wx_mng_present(wx);
579 	if (err) {
580 		dev_err(&pdev->dev, "Management capability is not present\n");
581 		goto err_free_mac_table;
582 	}
583 
584 	err = ngbe_reset_hw(wx);
585 	if (err) {
586 		dev_err(&pdev->dev, "HW Init failed: %d\n", err);
587 		goto err_free_mac_table;
588 	}
589 
590 	if (wx->bus.func == 0) {
591 		wr32(wx, NGBE_CALSUM_CAP_STATUS, 0x0);
592 		wr32(wx, NGBE_EEPROM_VERSION_STORE_REG, 0x0);
593 	} else {
594 		e2rom_cksum_cap = rd32(wx, NGBE_CALSUM_CAP_STATUS);
595 		saved_ver = rd32(wx, NGBE_EEPROM_VERSION_STORE_REG);
596 	}
597 
598 	wx_init_eeprom_params(wx);
599 	if (wx->bus.func == 0 || e2rom_cksum_cap == 0) {
600 		/* make sure the EEPROM is ready */
601 		err = ngbe_eeprom_chksum_hostif(wx);
602 		if (err) {
603 			dev_err(&pdev->dev, "The EEPROM Checksum Is Not Valid\n");
604 			err = -EIO;
605 			goto err_free_mac_table;
606 		}
607 	}
608 
609 	wx->wol = 0;
610 	if (wx->wol_enabled)
611 		wx->wol = NGBE_PSR_WKUP_CTL_MAG;
612 
613 	wx->wol_enabled = !!(wx->wol);
614 	wr32(wx, NGBE_PSR_WKUP_CTL, wx->wol);
615 
616 	device_set_wakeup_enable(&pdev->dev, wx->wol);
617 
618 	/* Save off EEPROM version number and Option Rom version which
619 	 * together make a unique identify for the eeprom
620 	 */
621 	if (saved_ver) {
622 		etrack_id = saved_ver;
623 	} else {
624 		wx_read_ee_hostif(wx,
625 				  wx->eeprom.sw_region_offset + NGBE_EEPROM_VERSION_H,
626 				  &e2rom_ver);
627 		etrack_id = e2rom_ver << 16;
628 		wx_read_ee_hostif(wx,
629 				  wx->eeprom.sw_region_offset + NGBE_EEPROM_VERSION_L,
630 				  &e2rom_ver);
631 		etrack_id |= e2rom_ver;
632 		wr32(wx, NGBE_EEPROM_VERSION_STORE_REG, etrack_id);
633 	}
634 
635 	eth_hw_addr_set(netdev, wx->mac.perm_addr);
636 	wx_mac_set_default_filter(wx, wx->mac.perm_addr);
637 
638 	err = wx_init_interrupt_scheme(wx);
639 	if (err)
640 		goto err_free_mac_table;
641 
642 	/* phy Interface Configuration */
643 	err = ngbe_mdio_init(wx);
644 	if (err)
645 		goto err_clear_interrupt_scheme;
646 
647 	err = register_netdev(netdev);
648 	if (err)
649 		goto err_register;
650 
651 	pci_set_drvdata(pdev, wx);
652 
653 	netif_info(wx, probe, netdev,
654 		   "PHY: %s, PBA No: Wang Xun GbE Family Controller\n",
655 		   wx->mac_type == em_mac_type_mdi ? "Internal" : "External");
656 	netif_info(wx, probe, netdev, "%pM\n", netdev->dev_addr);
657 
658 	return 0;
659 
660 err_register:
661 	wx_control_hw(wx, false);
662 err_clear_interrupt_scheme:
663 	wx_clear_interrupt_scheme(wx);
664 err_free_mac_table:
665 	kfree(wx->mac_table);
666 err_pci_release_regions:
667 	pci_disable_pcie_error_reporting(pdev);
668 	pci_release_selected_regions(pdev,
669 				     pci_select_bars(pdev, IORESOURCE_MEM));
670 err_pci_disable_dev:
671 	pci_disable_device(pdev);
672 	return err;
673 }
674 
675 /**
676  * ngbe_remove - Device Removal Routine
677  * @pdev: PCI device information struct
678  *
679  * ngbe_remove is called by the PCI subsystem to alert the driver
680  * that it should release a PCI device.  The could be caused by a
681  * Hot-Plug event, or because the driver is going to be removed from
682  * memory.
683  **/
684 static void ngbe_remove(struct pci_dev *pdev)
685 {
686 	struct wx *wx = pci_get_drvdata(pdev);
687 	struct net_device *netdev;
688 
689 	netdev = wx->netdev;
690 	unregister_netdev(netdev);
691 	pci_release_selected_regions(pdev,
692 				     pci_select_bars(pdev, IORESOURCE_MEM));
693 
694 	kfree(wx->mac_table);
695 	wx_clear_interrupt_scheme(wx);
696 	pci_disable_pcie_error_reporting(pdev);
697 
698 	pci_disable_device(pdev);
699 }
700 
701 static struct pci_driver ngbe_driver = {
702 	.name     = ngbe_driver_name,
703 	.id_table = ngbe_pci_tbl,
704 	.probe    = ngbe_probe,
705 	.remove   = ngbe_remove,
706 	.shutdown = ngbe_shutdown,
707 };
708 
709 module_pci_driver(ngbe_driver);
710 
711 MODULE_DEVICE_TABLE(pci, ngbe_pci_tbl);
712 MODULE_AUTHOR("Beijing WangXun Technology Co., Ltd, <software@net-swift.com>");
713 MODULE_DESCRIPTION("WangXun(R) Gigabit PCI Express Network Driver");
714 MODULE_LICENSE("GPL");
715