netxen_nic_main.c 59.3 KB
Newer Older
A
Amit S. Kale 已提交
1
/*
D
Dhananjay Phadke 已提交
2
 * Copyright (C) 2003 - 2009 NetXen, Inc.
D
Dhananjay Phadke 已提交
3
 * Copyright (C) 2009 - QLogic Corporation.
A
Amit S. Kale 已提交
4
 * All rights reserved.
5
 *
A
Amit S. Kale 已提交
6 7 8 9
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
10
 *
A
Amit S. Kale 已提交
11 12 13 14
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
15
 *
A
Amit S. Kale 已提交
16 17 18 19
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place - Suite 330, Boston,
 * MA  02111-1307, USA.
20
 *
A
Amit S. Kale 已提交
21 22
 * The full GNU General Public License is included in this distribution
 * in the file called LICENSE.
23
 *
A
Amit S. Kale 已提交
24 25
 */

26
#include <linux/vmalloc.h>
D
Dhananjay Phadke 已提交
27
#include <linux/interrupt.h>
A
Amit S. Kale 已提交
28 29 30 31
#include "netxen_nic_hw.h"

#include "netxen_nic.h"

J
Jeff Garzik 已提交
32
#include <linux/dma-mapping.h>
33
#include <linux/if_vlan.h>
34
#include <net/ip.h>
35
#include <linux/ipv6.h>
36
#include <linux/inetdevice.h>
J
Jeff Garzik 已提交
37

A
Amit S. Kale 已提交
38 39 40 41
MODULE_DESCRIPTION("NetXen Multi port (1/10) Gigabit Network Driver");
MODULE_LICENSE("GPL");
MODULE_VERSION(NETXEN_NIC_LINUX_VERSIONID);

42
char netxen_nic_driver_name[] = "netxen_nic";
A
Amit S. Kale 已提交
43
static char netxen_nic_driver_string[] = "NetXen Network Driver version "
44
    NETXEN_NIC_LINUX_VERSIONID;
A
Amit S. Kale 已提交
45

46 47 48 49 50 51 52 53 54
static int port_mode = NETXEN_PORT_MODE_AUTO_NEG;

/* Default to restricted 1G auto-neg mode */
static int wol_port_mode = 5;

static int use_msi = 1;

static int use_msi_x = 1;

A
Amit S. Kale 已提交
55 56
/* Local functions to NetXen NIC driver */
static int __devinit netxen_nic_probe(struct pci_dev *pdev,
57
		const struct pci_device_id *ent);
A
Amit S. Kale 已提交
58 59 60
static void __devexit netxen_nic_remove(struct pci_dev *pdev);
static int netxen_nic_open(struct net_device *netdev);
static int netxen_nic_close(struct net_device *netdev);
61 62
static netdev_tx_t netxen_nic_xmit_frame(struct sk_buff *,
					       struct net_device *);
A
Amit S. Kale 已提交
63
static void netxen_tx_timeout(struct net_device *netdev);
64
static void netxen_tx_timeout_task(struct work_struct *work);
65 66 67 68
static void netxen_fw_poll_work(struct work_struct *work);
static void netxen_schedule_work(struct netxen_adapter *adapter,
		work_func_t func, int delay);
static void netxen_cancel_fw_work(struct netxen_adapter *adapter);
69
static int netxen_nic_poll(struct napi_struct *napi, int budget);
A
Amit S. Kale 已提交
70 71 72
#ifdef CONFIG_NET_POLL_CONTROLLER
static void netxen_nic_poll_controller(struct net_device *netdev);
#endif
73 74 75 76

static void netxen_create_sysfs_entries(struct netxen_adapter *adapter);
static void netxen_remove_sysfs_entries(struct netxen_adapter *adapter);

77 78 79
static int nx_decr_dev_ref_cnt(struct netxen_adapter *adapter);
static int netxen_can_start_firmware(struct netxen_adapter *adapter);

J
Jeff Garzik 已提交
80
static irqreturn_t netxen_intr(int irq, void *data);
D
Dhananjay Phadke 已提交
81
static irqreturn_t netxen_msi_intr(int irq, void *data);
82
static irqreturn_t netxen_msix_intr(int irq, void *data);
A
Amit S. Kale 已提交
83

84 85
static void netxen_config_indev_addr(struct net_device *dev, unsigned long);

A
Amit S. Kale 已提交
86
/*  PCI Device ID Table  */
87
#define ENTRY(device) \
D
Dhananjay Phadke 已提交
88
	{PCI_DEVICE(PCI_VENDOR_ID_NETXEN, (device)), \
89 90
	.class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0}

A
Amit S. Kale 已提交
91
static struct pci_device_id netxen_pci_tbl[] __devinitdata = {
D
Dhananjay Phadke 已提交
92 93 94 95 96 97 98 99
	ENTRY(PCI_DEVICE_ID_NX2031_10GXSR),
	ENTRY(PCI_DEVICE_ID_NX2031_10GCX4),
	ENTRY(PCI_DEVICE_ID_NX2031_4GCU),
	ENTRY(PCI_DEVICE_ID_NX2031_IMEZ),
	ENTRY(PCI_DEVICE_ID_NX2031_HMEZ),
	ENTRY(PCI_DEVICE_ID_NX2031_XG_MGMT),
	ENTRY(PCI_DEVICE_ID_NX2031_XG_MGMT2),
	ENTRY(PCI_DEVICE_ID_NX3031),
A
Amit S. Kale 已提交
100 101 102 103 104
	{0,}
};

MODULE_DEVICE_TABLE(pci, netxen_pci_tbl);

105 106 107 108 109
static uint32_t crb_cmd_producer[4] = {
	CRB_CMD_PRODUCER_OFFSET, CRB_CMD_PRODUCER_OFFSET_1,
	CRB_CMD_PRODUCER_OFFSET_2, CRB_CMD_PRODUCER_OFFSET_3
};

110
void
111
netxen_nic_update_cmd_producer(struct netxen_adapter *adapter,
112
		struct nx_host_tx_ring *tx_ring)
113
{
114
	NXWRIO(adapter, tx_ring->crb_cmd_producer, tx_ring->producer);
115 116 117 118 119

	if (netxen_tx_avail(tx_ring) <= TX_STOP_THRESH) {
		netif_stop_queue(adapter->netdev);
		smp_mb();
	}
120 121
}

122 123 124 125 126
static uint32_t crb_cmd_consumer[4] = {
	CRB_CMD_CONSUMER_OFFSET, CRB_CMD_CONSUMER_OFFSET_1,
	CRB_CMD_CONSUMER_OFFSET_2, CRB_CMD_CONSUMER_OFFSET_3
};

127 128
static inline void
netxen_nic_update_cmd_consumer(struct netxen_adapter *adapter,
129
		struct nx_host_tx_ring *tx_ring)
130
{
131
	NXWRIO(adapter, tx_ring->crb_cmd_consumer, tx_ring->sw_consumer);
132 133
}

134
static uint32_t msi_tgt_status[8] = {
D
Dhananjay Phadke 已提交
135
	ISR_INT_TARGET_STATUS, ISR_INT_TARGET_STATUS_F1,
136 137 138
	ISR_INT_TARGET_STATUS_F2, ISR_INT_TARGET_STATUS_F3,
	ISR_INT_TARGET_STATUS_F4, ISR_INT_TARGET_STATUS_F5,
	ISR_INT_TARGET_STATUS_F6, ISR_INT_TARGET_STATUS_F7
D
Dhananjay Phadke 已提交
139 140
};

141 142
static struct netxen_legacy_intr_set legacy_intr[] = NX_LEGACY_INTR_CONFIG;

143
static inline void netxen_nic_disable_int(struct nx_host_sds_ring *sds_ring)
144
{
145 146
	struct netxen_adapter *adapter = sds_ring->adapter;

147
	NXWRIO(adapter, sds_ring->crb_intr_mask, 0);
148 149
}

150
static inline void netxen_nic_enable_int(struct nx_host_sds_ring *sds_ring)
151
{
152 153
	struct netxen_adapter *adapter = sds_ring->adapter;

154
	NXWRIO(adapter, sds_ring->crb_intr_mask, 0x1);
155

156
	if (!NETXEN_IS_MSI_FAMILY(adapter))
157
		NXWRIO(adapter, adapter->tgt_mask_reg, 0xfbff);
158 159
}

160 161 162 163 164 165 166 167 168 169
static int
netxen_alloc_sds_rings(struct netxen_recv_context *recv_ctx, int count)
{
	int size = sizeof(struct nx_host_sds_ring) * count;

	recv_ctx->sds_rings = kzalloc(size, GFP_KERNEL);

	return (recv_ctx->sds_rings == NULL);
}

170
static void
171 172 173 174
netxen_free_sds_rings(struct netxen_recv_context *recv_ctx)
{
	if (recv_ctx->sds_rings != NULL)
		kfree(recv_ctx->sds_rings);
175 176

	recv_ctx->sds_rings = NULL;
177 178 179
}

static int
180 181 182 183 184 185
netxen_napi_add(struct netxen_adapter *adapter, struct net_device *netdev)
{
	int ring;
	struct nx_host_sds_ring *sds_ring;
	struct netxen_recv_context *recv_ctx = &adapter->recv_ctx;

186
	if (netxen_alloc_sds_rings(recv_ctx, adapter->max_sds_rings))
187
		return -ENOMEM;
188

189 190 191 192 193
	for (ring = 0; ring < adapter->max_sds_rings; ring++) {
		sds_ring = &recv_ctx->sds_rings[ring];
		netif_napi_add(netdev, &sds_ring->napi,
				netxen_nic_poll, NETXEN_NETDEV_WEIGHT);
	}
194 195

	return 0;
196 197
}

198 199 200 201 202 203 204 205 206 207 208 209 210 211 212
static void
netxen_napi_del(struct netxen_adapter *adapter)
{
	int ring;
	struct nx_host_sds_ring *sds_ring;
	struct netxen_recv_context *recv_ctx = &adapter->recv_ctx;

	for (ring = 0; ring < adapter->max_sds_rings; ring++) {
		sds_ring = &recv_ctx->sds_rings[ring];
		netif_napi_del(&sds_ring->napi);
	}

	netxen_free_sds_rings(&adapter->recv_ctx);
}

213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235
static void
netxen_napi_enable(struct netxen_adapter *adapter)
{
	int ring;
	struct nx_host_sds_ring *sds_ring;
	struct netxen_recv_context *recv_ctx = &adapter->recv_ctx;

	for (ring = 0; ring < adapter->max_sds_rings; ring++) {
		sds_ring = &recv_ctx->sds_rings[ring];
		napi_enable(&sds_ring->napi);
		netxen_nic_enable_int(sds_ring);
	}
}

static void
netxen_napi_disable(struct netxen_adapter *adapter)
{
	int ring;
	struct nx_host_sds_ring *sds_ring;
	struct netxen_recv_context *recv_ctx = &adapter->recv_ctx;

	for (ring = 0; ring < adapter->max_sds_rings; ring++) {
		sds_ring = &recv_ctx->sds_rings[ring];
236
		netxen_nic_disable_int(sds_ring);
237 238
		napi_synchronize(&sds_ring->napi);
		napi_disable(&sds_ring->napi);
239 240 241
	}
}

242
static int nx_set_dma_mask(struct netxen_adapter *adapter)
243 244
{
	struct pci_dev *pdev = adapter->pdev;
245 246 247
	uint64_t mask, cmask;

	adapter->pci_using_dac = 0;
248

249 250
	mask = DMA_BIT_MASK(32);
	cmask = DMA_BIT_MASK(32);
251

252
	if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) {
253
#ifndef CONFIG_IA64
254
		mask = DMA_BIT_MASK(35);
255
#endif
256 257 258 259 260
	} else {
		mask = DMA_BIT_MASK(39);
		cmask = mask;
	}

261
	if (pci_set_dma_mask(pdev, mask) == 0 &&
262
		pci_set_consistent_dma_mask(pdev, cmask) == 0) {
263 264 265 266
		adapter->pci_using_dac = 1;
		return 0;
	}

267 268 269 270 271 272 273 274
	return -EIO;
}

/* Update addressable range if firmware supports it */
static int
nx_update_dma_mask(struct netxen_adapter *adapter)
{
	int change, shift, err;
275
	uint64_t mask, old_mask, old_cmask;
276 277 278 279
	struct pci_dev *pdev = adapter->pdev;

	change = 0;

280
	shift = NXRD32(adapter, CRB_DMA_SHIFT);
281
	if (shift > 32)
282 283 284 285 286 287 288 289 290
		return 0;

	if (NX_IS_REVISION_P3(adapter->ahw.revision_id) && (shift > 9))
		change = 1;
	else if ((adapter->ahw.revision_id == NX_P2_C1) && (shift <= 4))
		change = 1;

	if (change) {
		old_mask = pdev->dma_mask;
291 292
		old_cmask = pdev->dev.coherent_dma_mask;

293
		mask = DMA_BIT_MASK(32+shift);
294 295 296

		err = pci_set_dma_mask(pdev, mask);
		if (err)
297 298 299 300 301 302 303 304 305
			goto err_out;

		if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) {

			err = pci_set_consistent_dma_mask(pdev, mask);
			if (err)
				goto err_out;
		}
		dev_info(&pdev->dev, "using %d-bit dma mask\n", 32+shift);
306 307 308
	}

	return 0;
309 310 311 312 313

err_out:
	pci_set_dma_mask(pdev, old_mask);
	pci_set_consistent_dma_mask(pdev, old_cmask);
	return err;
314 315 316 317 318
}

static int
netxen_check_hw_init(struct netxen_adapter *adapter, int first_boot)
{
D
Dhananjay Phadke 已提交
319
	u32 val, timeout;
320 321 322

	if (first_boot == 0x55555555) {
		/* This is the first boot after power up */
323
		NXWR32(adapter, NETXEN_CAM_RAM(0x1fc), NETXEN_BDINFO_MAGIC);
D
Dhananjay Phadke 已提交
324 325 326

		if (!NX_IS_REVISION_P2(adapter->ahw.revision_id))
			return 0;
327 328

		/* PCI bus master workaround */
329
		first_boot = NXRD32(adapter, NETXEN_PCIE_REG(0x4));
330 331
		if (!(first_boot & 0x4)) {
			first_boot |= 0x4;
332 333
			NXWR32(adapter, NETXEN_PCIE_REG(0x4), first_boot);
			first_boot = NXRD32(adapter, NETXEN_PCIE_REG(0x4));
334 335 336
		}

		/* This is the first boot after power up */
337
		first_boot = NXRD32(adapter, NETXEN_ROMUSB_GLB_SW_RESET);
338 339
		if (first_boot != 0x80000f) {
			/* clear the register for future unloads/loads */
340
			NXWR32(adapter, NETXEN_CAM_RAM(0x1fc), 0);
D
Dhananjay Phadke 已提交
341
			return -EIO;
342 343
		}

D
Dhananjay Phadke 已提交
344
		/* Start P2 boot loader */
345 346
		val = NXRD32(adapter, NETXEN_ROMUSB_GLB_PEGTUNE_DONE);
		NXWR32(adapter, NETXEN_ROMUSB_GLB_PEGTUNE_DONE, val | 0x1);
D
Dhananjay Phadke 已提交
347 348 349
		timeout = 0;
		do {
			msleep(1);
350
			val = NXRD32(adapter, NETXEN_CAM_RAM(0x1fc));
D
Dhananjay Phadke 已提交
351 352 353 354 355

			if (++timeout > 5000)
				return -EIO;

		} while (val == NETXEN_BDINFO_MAGIC);
356
	}
D
Dhananjay Phadke 已提交
357
	return 0;
358 359 360 361 362 363
}

static void netxen_set_port_mode(struct netxen_adapter *adapter)
{
	u32 val, data;

364
	val = adapter->ahw.board_type;
365 366 367 368
	if ((val == NETXEN_BRDTYPE_P3_HMEZ) ||
		(val == NETXEN_BRDTYPE_P3_XG_LOM)) {
		if (port_mode == NETXEN_PORT_MODE_802_3_AP) {
			data = NETXEN_PORT_MODE_802_3_AP;
369
			NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data);
370 371
		} else if (port_mode == NETXEN_PORT_MODE_XG) {
			data = NETXEN_PORT_MODE_XG;
372
			NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data);
373 374
		} else if (port_mode == NETXEN_PORT_MODE_AUTO_NEG_1G) {
			data = NETXEN_PORT_MODE_AUTO_NEG_1G;
375
			NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data);
376 377
		} else if (port_mode == NETXEN_PORT_MODE_AUTO_NEG_XG) {
			data = NETXEN_PORT_MODE_AUTO_NEG_XG;
378
			NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data);
379 380
		} else {
			data = NETXEN_PORT_MODE_AUTO_NEG;
381
			NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data);
382 383 384 385 386 387 388 389
		}

		if ((wol_port_mode != NETXEN_PORT_MODE_802_3_AP) &&
			(wol_port_mode != NETXEN_PORT_MODE_XG) &&
			(wol_port_mode != NETXEN_PORT_MODE_AUTO_NEG_1G) &&
			(wol_port_mode != NETXEN_PORT_MODE_AUTO_NEG_XG)) {
			wol_port_mode = NETXEN_PORT_MODE_AUTO_NEG;
		}
390
		NXWR32(adapter, NETXEN_WOL_PORT_MODE, wol_port_mode);
391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409
	}
}

static void netxen_set_msix_bit(struct pci_dev *pdev, int enable)
{
	u32 control;
	int pos;

	pos = pci_find_capability(pdev, PCI_CAP_ID_MSIX);
	if (pos) {
		pci_read_config_dword(pdev, pos, &control);
		if (enable)
			control |= PCI_MSIX_FLAGS_ENABLE;
		else
			control = 0;
		pci_write_config_dword(pdev, pos, control);
	}
}

410
static void netxen_init_msix_entries(struct netxen_adapter *adapter, int count)
411 412 413
{
	int i;

414
	for (i = 0; i < count; i++)
415 416 417
		adapter->msix_entries[i].entry = i;
}

D
Dhananjay Phadke 已提交
418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442
static int
netxen_read_mac_addr(struct netxen_adapter *adapter)
{
	int i;
	unsigned char *p;
	__le64 mac_addr;
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;

	if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) {
		if (netxen_p3_get_mac_addr(adapter, &mac_addr) != 0)
			return -EIO;
	} else {
		if (netxen_get_flash_mac_addr(adapter, &mac_addr) != 0)
			return -EIO;
	}

	p = (unsigned char *)&mac_addr;
	for (i = 0; i < 6; i++)
		netdev->dev_addr[i] = *(p + 5 - i);

	memcpy(netdev->perm_addr, netdev->dev_addr, netdev->addr_len);

	/* set station address */

J
Johannes Berg 已提交
443 444
	if (!is_valid_ether_addr(netdev->perm_addr))
		dev_warn(&pdev->dev, "Bad MAC address %pM.\n", netdev->dev_addr);
D
Dhananjay Phadke 已提交
445 446 447 448

	return 0;
}

D
Dhananjay Phadke 已提交
449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471
int netxen_nic_set_mac(struct net_device *netdev, void *p)
{
	struct netxen_adapter *adapter = netdev_priv(netdev);
	struct sockaddr *addr = p;

	if (!is_valid_ether_addr(addr->sa_data))
		return -EINVAL;

	if (netif_running(netdev)) {
		netif_device_detach(netdev);
		netxen_napi_disable(adapter);
	}

	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
	adapter->macaddr_set(adapter, addr->sa_data);

	if (netif_running(netdev)) {
		netif_device_attach(netdev);
		netxen_napi_enable(adapter);
	}
	return 0;
}

472 473 474 475
static void netxen_set_multicast_list(struct net_device *dev)
{
	struct netxen_adapter *adapter = netdev_priv(dev);

D
Dhananjay Phadke 已提交
476
	adapter->set_multi(dev);
477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493
}

static const struct net_device_ops netxen_netdev_ops = {
	.ndo_open	   = netxen_nic_open,
	.ndo_stop	   = netxen_nic_close,
	.ndo_start_xmit    = netxen_nic_xmit_frame,
	.ndo_get_stats	   = netxen_nic_get_stats,
	.ndo_validate_addr = eth_validate_addr,
	.ndo_set_multicast_list = netxen_set_multicast_list,
	.ndo_set_mac_address    = netxen_nic_set_mac,
	.ndo_change_mtu	   = netxen_nic_change_mtu,
	.ndo_tx_timeout	   = netxen_tx_timeout,
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller = netxen_nic_poll_controller,
#endif
};

D
Dhananjay Phadke 已提交
494 495 496 497 498
static void
netxen_setup_intr(struct netxen_adapter *adapter)
{
	struct netxen_legacy_intr_set *legacy_intrp;
	struct pci_dev *pdev = adapter->pdev;
499 500 501 502 503 504 505 506 507
	int err, num_msix;

	if (adapter->rss_supported) {
		num_msix = (num_online_cpus() >= MSIX_ENTRIES_PER_ADAPTER) ?
			MSIX_ENTRIES_PER_ADAPTER : 2;
	} else
		num_msix = 1;

	adapter->max_sds_rings = 1;
D
Dhananjay Phadke 已提交
508 509 510 511 512 513 514

	adapter->flags &= ~(NETXEN_NIC_MSI_ENABLED | NETXEN_NIC_MSIX_ENABLED);

	if (adapter->ahw.revision_id >= NX_P3_B0)
		legacy_intrp = &legacy_intr[adapter->ahw.pci_func];
	else
		legacy_intrp = &legacy_intr[0];
515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530

	adapter->int_vec_bit = legacy_intrp->int_vec_bit;
	adapter->tgt_status_reg = netxen_get_ioaddr(adapter,
			legacy_intrp->tgt_status_reg);
	adapter->tgt_mask_reg = netxen_get_ioaddr(adapter,
			legacy_intrp->tgt_mask_reg);
	adapter->pci_int_reg = netxen_get_ioaddr(adapter,
			legacy_intrp->pci_int_reg);
	adapter->isr_int_vec = netxen_get_ioaddr(adapter, ISR_INT_VECTOR);

	if (adapter->ahw.revision_id >= NX_P3_B1)
		adapter->crb_int_state_reg = netxen_get_ioaddr(adapter,
			ISR_INT_STATE_REG);
	else
		adapter->crb_int_state_reg = netxen_get_ioaddr(adapter,
			CRB_INT_VECTOR);
D
Dhananjay Phadke 已提交
531 532 533 534 535

	netxen_set_msix_bit(pdev, 0);

	if (adapter->msix_supported) {

536 537 538 539 540
		netxen_init_msix_entries(adapter, num_msix);
		err = pci_enable_msix(pdev, adapter->msix_entries, num_msix);
		if (err == 0) {
			adapter->flags |= NETXEN_NIC_MSIX_ENABLED;
			netxen_set_msix_bit(pdev, 1);
D
Dhananjay Phadke 已提交
541

542 543
			if (adapter->rss_supported)
				adapter->max_sds_rings = num_msix;
D
Dhananjay Phadke 已提交
544

545 546 547 548 549 550 551 552
			dev_info(&pdev->dev, "using msi-x interrupts\n");
			return;
		}

		if (err > 0)
			pci_disable_msix(pdev);

		/* fall through for msi */
D
Dhananjay Phadke 已提交
553
	}
554 555 556

	if (use_msi && !pci_enable_msi(pdev)) {
		adapter->flags |= NETXEN_NIC_MSI_ENABLED;
557 558
		adapter->tgt_status_reg = netxen_get_ioaddr(adapter,
				msi_tgt_status[adapter->ahw.pci_func]);
559
		dev_info(&pdev->dev, "using msi interrupts\n");
D
Dhananjay Phadke 已提交
560
		adapter->msix_entries[0].vector = pdev->irq;
561 562 563 564 565
		return;
	}

	dev_info(&pdev->dev, "using legacy interrupts\n");
	adapter->msix_entries[0].vector = pdev->irq;
D
Dhananjay Phadke 已提交
566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609
}

static void
netxen_teardown_intr(struct netxen_adapter *adapter)
{
	if (adapter->flags & NETXEN_NIC_MSIX_ENABLED)
		pci_disable_msix(adapter->pdev);
	if (adapter->flags & NETXEN_NIC_MSI_ENABLED)
		pci_disable_msi(adapter->pdev);
}

static void
netxen_cleanup_pci_map(struct netxen_adapter *adapter)
{
	if (adapter->ahw.db_base != NULL)
		iounmap(adapter->ahw.db_base);
	if (adapter->ahw.pci_base0 != NULL)
		iounmap(adapter->ahw.pci_base0);
	if (adapter->ahw.pci_base1 != NULL)
		iounmap(adapter->ahw.pci_base1);
	if (adapter->ahw.pci_base2 != NULL)
		iounmap(adapter->ahw.pci_base2);
}

static int
netxen_setup_pci_map(struct netxen_adapter *adapter)
{
	void __iomem *mem_ptr0 = NULL;
	void __iomem *mem_ptr1 = NULL;
	void __iomem *mem_ptr2 = NULL;
	void __iomem *db_ptr = NULL;

	unsigned long mem_base, mem_len, db_base, db_len = 0, pci_len0 = 0;

	struct pci_dev *pdev = adapter->pdev;
	int pci_func = adapter->ahw.pci_func;

	int err = 0;

	/*
	 * Set the CRB window to invalid. If any register in window 0 is
	 * accessed it should set the window to 0 and then reset it to 1.
	 */
	adapter->curr_window = 255;
610
	adapter->ahw.ocm_win = -1;
D
Dhananjay Phadke 已提交
611 612 613 614 615 616 617 618 619 620 621 622

	/* remap phys address */
	mem_base = pci_resource_start(pdev, 0);	/* 0 is for BAR 0 */
	mem_len = pci_resource_len(pdev, 0);

	/* 128 Meg of memory */
	if (mem_len == NETXEN_PCI_128MB_SIZE) {
		mem_ptr0 = ioremap(mem_base, FIRST_PAGE_GROUP_SIZE);
		mem_ptr1 = ioremap(mem_base + SECOND_PAGE_GROUP_START,
				SECOND_PAGE_GROUP_SIZE);
		mem_ptr2 = ioremap(mem_base + THIRD_PAGE_GROUP_START,
				THIRD_PAGE_GROUP_SIZE);
623
		pci_len0 = FIRST_PAGE_GROUP_SIZE;
D
Dhananjay Phadke 已提交
624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639
	} else if (mem_len == NETXEN_PCI_32MB_SIZE) {
		mem_ptr1 = ioremap(mem_base, SECOND_PAGE_GROUP_SIZE);
		mem_ptr2 = ioremap(mem_base + THIRD_PAGE_GROUP_START -
			SECOND_PAGE_GROUP_START, THIRD_PAGE_GROUP_SIZE);
	} else if (mem_len == NETXEN_PCI_2MB_SIZE) {

		mem_ptr0 = pci_ioremap_bar(pdev, 0);
		if (mem_ptr0 == NULL) {
			dev_err(&pdev->dev, "failed to map PCI bar 0\n");
			return -EIO;
		}
		pci_len0 = mem_len;
	} else {
		return -EIO;
	}

640 641
	netxen_setup_hwops(adapter);

D
Dhananjay Phadke 已提交
642 643 644 645 646 647 648
	dev_info(&pdev->dev, "%dMB memory map\n", (int)(mem_len>>20));

	adapter->ahw.pci_base0 = mem_ptr0;
	adapter->ahw.pci_len0 = pci_len0;
	adapter->ahw.pci_base1 = mem_ptr1;
	adapter->ahw.pci_base2 = mem_ptr2;

649 650 651 652 653
	if (!NX_IS_REVISION_P2(adapter->ahw.revision_id)) {
		adapter->ahw.ocm_win_crb = netxen_get_ioaddr(adapter,
			NETXEN_PCIX_PS_REG(PCIE_MN_WINDOW_REG(pci_func)));
	}

D
Dhananjay Phadke 已提交
654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id))
		goto skip_doorbell;

	db_base = pci_resource_start(pdev, 4);	/* doorbell is on bar 4 */
	db_len = pci_resource_len(pdev, 4);

	if (db_len == 0) {
		printk(KERN_ERR "%s: doorbell is disabled\n",
				netxen_nic_driver_name);
		err = -EIO;
		goto err_out;
	}

	db_ptr = ioremap(db_base, NETXEN_DB_MAPSIZE_BYTES);
	if (!db_ptr) {
		printk(KERN_ERR "%s: Failed to allocate doorbell map.",
				netxen_nic_driver_name);
		err = -EIO;
		goto err_out;
	}

skip_doorbell:
	adapter->ahw.db_base = db_ptr;
	adapter->ahw.db_len = db_len;
	return 0;

err_out:
	netxen_cleanup_pci_map(adapter);
	return err;
}

685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777
static void
netxen_check_options(struct netxen_adapter *adapter)
{
	u32 fw_major, fw_minor, fw_build;
	char brd_name[NETXEN_MAX_SHORT_NAME];
	char serial_num[32];
	int i, offset, val;
	int *ptr32;
	struct pci_dev *pdev = adapter->pdev;

	adapter->driver_mismatch = 0;

	ptr32 = (int *)&serial_num;
	offset = NX_FW_SERIAL_NUM_OFFSET;
	for (i = 0; i < 8; i++) {
		if (netxen_rom_fast_read(adapter, offset, &val) == -1) {
			dev_err(&pdev->dev, "error reading board info\n");
			adapter->driver_mismatch = 1;
			return;
		}
		ptr32[i] = cpu_to_le32(val);
		offset += sizeof(u32);
	}

	fw_major = NXRD32(adapter, NETXEN_FW_VERSION_MAJOR);
	fw_minor = NXRD32(adapter, NETXEN_FW_VERSION_MINOR);
	fw_build = NXRD32(adapter, NETXEN_FW_VERSION_SUB);

	adapter->fw_version = NETXEN_VERSION_CODE(fw_major, fw_minor, fw_build);

	if (adapter->portnum == 0) {
		get_brd_name_by_type(adapter->ahw.board_type, brd_name);

		printk(KERN_INFO "NetXen %s Board S/N %s  Chip rev 0x%x\n",
				brd_name, serial_num, adapter->ahw.revision_id);
	}

	if (adapter->fw_version < NETXEN_VERSION_CODE(3, 4, 216)) {
		adapter->driver_mismatch = 1;
		dev_warn(&pdev->dev, "firmware version %d.%d.%d unsupported\n",
				fw_major, fw_minor, fw_build);
		return;
	}

	if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) {
		i = NXRD32(adapter, NETXEN_SRE_MISC);
		adapter->ahw.cut_through = (i & 0x8000) ? 1 : 0;
	}

	dev_info(&pdev->dev, "firmware v%d.%d.%d [%s]\n",
			fw_major, fw_minor, fw_build,
			adapter->ahw.cut_through ? "cut-through" : "legacy");

	if (adapter->fw_version >= NETXEN_VERSION_CODE(4, 0, 222))
		adapter->capabilities = NXRD32(adapter, CRB_FW_CAPABILITIES_1);

	adapter->flags &= ~NETXEN_NIC_LRO_ENABLED;

	if (adapter->ahw.port_type == NETXEN_NIC_XGBE) {
		adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_10G;
		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
	} else if (adapter->ahw.port_type == NETXEN_NIC_GBE) {
		adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G;
		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
	}

	adapter->msix_supported = 0;
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) {
		adapter->msix_supported = !!use_msi_x;
		adapter->rss_supported = !!use_msi_x;
	} else if (adapter->fw_version >= NETXEN_VERSION_CODE(3, 4, 336)) {
		switch (adapter->ahw.board_type) {
		case NETXEN_BRDTYPE_P2_SB31_10G:
		case NETXEN_BRDTYPE_P2_SB31_10G_CX4:
			adapter->msix_supported = !!use_msi_x;
			adapter->rss_supported = !!use_msi_x;
			break;
		default:
			break;
		}
	}

	adapter->num_txd = MAX_CMD_DESCRIPTORS;

	if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) {
		adapter->num_lro_rxd = MAX_LRO_RCV_DESCRIPTORS;
		adapter->max_rds_rings = 3;
	} else {
		adapter->num_lro_rxd = 0;
		adapter->max_rds_rings = 2;
	}
}

778
static int
779
netxen_start_firmware(struct netxen_adapter *adapter)
780 781 782 783
{
	int val, err, first_boot;
	struct pci_dev *pdev = adapter->pdev;

784 785 786 787 788
	/* required for NX2031 dummy dma */
	err = nx_set_dma_mask(adapter);
	if (err)
		return err;

789
	if (!netxen_can_start_firmware(adapter))
790
		goto wait_init;
791

792
	first_boot = NXRD32(adapter, NETXEN_CAM_RAM(0x1fc));
793 794 795 796 797 798 799

	err = netxen_check_hw_init(adapter, first_boot);
	if (err) {
		dev_err(&pdev->dev, "error in init HW init sequence\n");
		return err;
	}

800
	netxen_request_firmware(adapter);
D
Dhananjay Phadke 已提交
801

802
	err = netxen_need_fw_reset(adapter);
803
	if (err < 0)
804
		goto err_out;
805
	if (err == 0)
806
		goto ready;
807

808
	if (first_boot != 0x55555555) {
809
		NXWR32(adapter, CRB_CMDPEG_STATE, 0);
810 811 812
		netxen_pinit_from_rom(adapter, 0);
		msleep(1);
	}
813

814
	NXWR32(adapter, CRB_DMA_SHIFT, 0x55555555);
815 816 817
	NXWR32(adapter, NETXEN_PEG_HALT_STATUS1, 0);
	NXWR32(adapter, NETXEN_PEG_HALT_STATUS2, 0);

818 819 820
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id))
		netxen_set_port_mode(adapter);

821 822 823
	err = netxen_load_firmware(adapter);
	if (err)
		goto err_out;
824

825 826
	netxen_release_firmware(adapter);

827 828 829 830
	if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) {

		/* Initialize multicast addr pool owners */
		val = 0x7654;
831
		if (adapter->ahw.port_type == NETXEN_NIC_XGBE)
832
			val |= 0x0f000000;
833
		NXWR32(adapter, NETXEN_MAC_ADDR_CNTL_REG, val);
834 835 836

	}

837
	err = netxen_init_dummy_dma(adapter);
838
	if (err)
839
		goto err_out;
840 841 842 843 844 845 846

	/*
	 * Tell the hardware our version number.
	 */
	val = (_NETXEN_NIC_LINUX_MAJOR << 16)
		| ((_NETXEN_NIC_LINUX_MINOR << 8))
		| (_NETXEN_NIC_LINUX_SUBVERSION);
847
	NXWR32(adapter, CRB_DRIVER_VERSION, val);
848

849
ready:
850 851
	NXWR32(adapter, NX_CRB_DEV_STATE, NX_DEV_READY);

852
wait_init:
853 854 855
	/* Handshake with the card before we register the devices. */
	err = netxen_phantom_init(adapter, NETXEN_NIC_PEG_TUNE);
	if (err) {
856
		netxen_free_dummy_dma(adapter);
857
		goto err_out;
858 859
	}

860 861
	nx_update_dma_mask(adapter);

862
	netxen_check_options(adapter);
863

864 865
	adapter->need_fw_reset = 0;

866
	/* fall through and release firmware */
867 868 869 870

err_out:
	netxen_release_firmware(adapter);
	return err;
871 872
}

873 874 875 876
static int
netxen_nic_request_irq(struct netxen_adapter *adapter)
{
	irq_handler_t handler;
877 878 879
	struct nx_host_sds_ring *sds_ring;
	int err, ring;

880 881
	unsigned long flags = IRQF_SAMPLE_RANDOM;
	struct net_device *netdev = adapter->netdev;
882
	struct netxen_recv_context *recv_ctx = &adapter->recv_ctx;
883 884 885 886 887 888 889 890 891 892 893

	if (adapter->flags & NETXEN_NIC_MSIX_ENABLED)
		handler = netxen_msix_intr;
	else if (adapter->flags & NETXEN_NIC_MSI_ENABLED)
		handler = netxen_msi_intr;
	else {
		flags |= IRQF_SHARED;
		handler = netxen_intr;
	}
	adapter->irq = netdev->irq;

894 895
	for (ring = 0; ring < adapter->max_sds_rings; ring++) {
		sds_ring = &recv_ctx->sds_rings[ring];
896
		sprintf(sds_ring->name, "%s[%d]", netdev->name, ring);
897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917
		err = request_irq(sds_ring->irq, handler,
				  flags, sds_ring->name, sds_ring);
		if (err)
			return err;
	}

	return 0;
}

static void
netxen_nic_free_irq(struct netxen_adapter *adapter)
{
	int ring;
	struct nx_host_sds_ring *sds_ring;

	struct netxen_recv_context *recv_ctx = &adapter->recv_ctx;

	for (ring = 0; ring < adapter->max_sds_rings; ring++) {
		sds_ring = &recv_ctx->sds_rings[ring];
		free_irq(sds_ring->irq, sds_ring);
	}
918 919
}

920 921 922 923 924 925 926 927 928 929 930 931 932 933
static void
netxen_nic_init_coalesce_defaults(struct netxen_adapter *adapter)
{
	adapter->coal.flags = NETXEN_NIC_INTR_DEFAULT;
	adapter->coal.normal.data.rx_time_us =
		NETXEN_DEFAULT_INTR_COALESCE_RX_TIME_US;
	adapter->coal.normal.data.rx_packets =
		NETXEN_DEFAULT_INTR_COALESCE_RX_PACKETS;
	adapter->coal.normal.data.tx_time_us =
		NETXEN_DEFAULT_INTR_COALESCE_TX_TIME_US;
	adapter->coal.normal.data.tx_packets =
		NETXEN_DEFAULT_INTR_COALESCE_TX_PACKETS;
}

934 935 936 937 938
static int
netxen_nic_up(struct netxen_adapter *adapter, struct net_device *netdev)
{
	int err;

939 940 941
	if (adapter->is_up != NETXEN_ADAPTER_UP_MAGIC)
		return -EIO;

942 943 944 945 946 947
	err = adapter->init_port(adapter, adapter->physical_port);
	if (err) {
		printk(KERN_ERR "%s: Failed to initialize port %d\n",
				netxen_nic_driver_name, adapter->portnum);
		return err;
	}
D
Dhananjay Phadke 已提交
948 949
	if (NX_IS_REVISION_P2(adapter->ahw.revision_id))
		adapter->macaddr_set(adapter, netdev->dev_addr);
950

D
Dhananjay Phadke 已提交
951 952
	adapter->set_multi(netdev);
	adapter->set_mtu(adapter, netdev->mtu);
953 954 955

	adapter->ahw.linkup = 0;

956 957
	if (adapter->max_sds_rings > 1)
		netxen_config_rss(adapter, 1);
958

959 960 961
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id))
		netxen_config_intr_coalesce(adapter);

962 963 964
	if (adapter->capabilities & NX_FW_CAPABILITY_HW_LRO)
		netxen_config_hw_lro(adapter, NETXEN_NIC_LRO_ENABLED);

965 966
	netxen_napi_enable(adapter);

967
	if (adapter->capabilities & NX_FW_CAPABILITY_LINK_NOTIFICATION)
968
		netxen_linkevent_request(adapter, 1);
D
Dhananjay Phadke 已提交
969 970 971
	else
		netxen_nic_set_link_parameters(adapter);

972
	set_bit(__NX_DEV_UP, &adapter->state);
973 974 975 976 977 978
	return 0;
}

static void
netxen_nic_down(struct netxen_adapter *adapter, struct net_device *netdev)
{
979 980 981
	if (adapter->is_up != NETXEN_ADAPTER_UP_MAGIC)
		return;

982 983
	clear_bit(__NX_DEV_UP, &adapter->state);

984
	spin_lock(&adapter->tx_clean_lock);
985
	netif_carrier_off(netdev);
986
	netif_tx_disable(netdev);
987 988 989 990

	if (adapter->stop_port)
		adapter->stop_port(adapter);

991 992 993
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id))
		netxen_p3_free_mac_list(adapter);

994 995
	adapter->set_promisc(adapter, NETXEN_NIU_NON_PROMISC_MODE);

996 997
	netxen_napi_disable(adapter);

998
	netxen_release_tx_buffers(adapter);
999
	spin_unlock(&adapter->tx_clean_lock);
1000 1001 1002 1003 1004 1005 1006 1007
}


static int
netxen_nic_attach(struct netxen_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;
1008
	int err, ring;
1009
	struct nx_host_rds_ring *rds_ring;
1010
	struct nx_host_tx_ring *tx_ring;
1011

1012 1013 1014
	if (adapter->is_up == NETXEN_ADAPTER_UP_MAGIC)
		return 0;

1015
	err = netxen_init_firmware(adapter);
1016 1017 1018 1019 1020 1021
	if (err)
		return err;

	err = netxen_napi_add(adapter, netdev);
	if (err)
		return err;
1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036

	err = netxen_alloc_sw_resources(adapter);
	if (err) {
		printk(KERN_ERR "%s: Error in setting sw resources\n",
				netdev->name);
		return err;
	}

	err = netxen_alloc_hw_resources(adapter);
	if (err) {
		printk(KERN_ERR "%s: Error in setting hw resources\n",
				netdev->name);
		goto err_out_free_sw;
	}

1037
	if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) {
1038
		tx_ring = adapter->tx_ring;
1039 1040 1041 1042
		tx_ring->crb_cmd_producer = netxen_get_ioaddr(adapter,
				crb_cmd_producer[adapter->portnum]);
		tx_ring->crb_cmd_consumer = netxen_get_ioaddr(adapter,
				crb_cmd_consumer[adapter->portnum]);
1043

1044 1045 1046 1047 1048
		tx_ring->producer = 0;
		tx_ring->sw_consumer = 0;

		netxen_nic_update_cmd_producer(adapter, tx_ring);
		netxen_nic_update_cmd_consumer(adapter, tx_ring);
1049 1050
	}

1051 1052 1053 1054
	for (ring = 0; ring < adapter->max_rds_rings; ring++) {
		rds_ring = &adapter->recv_ctx.rds_rings[ring];
		netxen_post_rx_buffers(adapter, ring, rds_ring);
	}
1055 1056 1057 1058 1059 1060 1061 1062

	err = netxen_nic_request_irq(adapter);
	if (err) {
		dev_err(&pdev->dev, "%s: failed to setup interrupt\n",
				netdev->name);
		goto err_out_free_rxbuf;
	}

1063 1064 1065
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id))
		netxen_nic_init_coalesce_defaults(adapter);

1066 1067
	netxen_create_sysfs_entries(adapter);

1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081
	adapter->is_up = NETXEN_ADAPTER_UP_MAGIC;
	return 0;

err_out_free_rxbuf:
	netxen_release_rx_buffers(adapter);
	netxen_free_hw_resources(adapter);
err_out_free_sw:
	netxen_free_sw_resources(adapter);
	return err;
}

static void
netxen_nic_detach(struct netxen_adapter *adapter)
{
1082 1083 1084
	if (adapter->is_up != NETXEN_ADAPTER_UP_MAGIC)
		return;

1085 1086
	netxen_remove_sysfs_entries(adapter);

1087
	netxen_free_hw_resources(adapter);
1088
	netxen_release_rx_buffers(adapter);
1089
	netxen_nic_free_irq(adapter);
1090
	netxen_napi_del(adapter);
1091 1092 1093 1094 1095
	netxen_free_sw_resources(adapter);

	adapter->is_up = 0;
}

1096 1097 1098 1099 1100 1101
int
netxen_nic_reset_context(struct netxen_adapter *adapter)
{
	int err = 0;
	struct net_device *netdev = adapter->netdev;

1102 1103 1104
	if (test_and_set_bit(__NX_RESETTING, &adapter->state))
		return -EBUSY;

1105 1106
	if (adapter->is_up == NETXEN_ADAPTER_UP_MAGIC) {

1107 1108
		netif_device_detach(netdev);

1109 1110 1111 1112 1113
		if (netif_running(netdev))
			netxen_nic_down(adapter, netdev);

		netxen_nic_detach(adapter);

1114 1115 1116 1117
		if (netif_running(netdev)) {
			err = netxen_nic_attach(adapter);
			if (!err)
				err = netxen_nic_up(adapter, netdev);
1118

1119 1120 1121 1122 1123
			if (err)
				goto done;
		}

		netif_device_attach(netdev);
1124
	}
1125

1126
done:
1127
	clear_bit(__NX_RESETTING, &adapter->state);
1128 1129 1130
	return err;
}

1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165
static int
netxen_setup_netdev(struct netxen_adapter *adapter,
		struct net_device *netdev)
{
	int err = 0;
	struct pci_dev *pdev = adapter->pdev;

	adapter->rx_csum = 1;
	adapter->mc_enabled = 0;
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id))
		adapter->max_mc_count = 38;
	else
		adapter->max_mc_count = 16;

	netdev->netdev_ops	   = &netxen_netdev_ops;
	netdev->watchdog_timeo     = 2*HZ;

	netxen_nic_change_mtu(netdev, netdev->mtu);

	SET_ETHTOOL_OPS(netdev, &netxen_nic_ethtool_ops);

	netdev->features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO);
	netdev->features |= (NETIF_F_GRO);
	netdev->vlan_features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO);

	if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) {
		netdev->features |= (NETIF_F_IPV6_CSUM | NETIF_F_TSO6);
		netdev->vlan_features |= (NETIF_F_IPV6_CSUM | NETIF_F_TSO6);
	}

	if (adapter->pci_using_dac) {
		netdev->features |= NETIF_F_HIGHDMA;
		netdev->vlan_features |= NETIF_F_HIGHDMA;
	}

1166 1167 1168
	if (adapter->capabilities & NX_FW_CAPABILITY_FVLANTX)
		netdev->features |= (NETIF_F_HW_VLAN_TX);

1169 1170 1171
	if (adapter->capabilities & NX_FW_CAPABILITY_HW_LRO)
		netdev->features |= NETIF_F_LRO;

1172 1173
	netdev->irq = adapter->msix_entries[0].vector;

1174
	INIT_WORK(&adapter->tx_timeout_task, netxen_tx_timeout_task);
1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190

	if (netxen_read_mac_addr(adapter))
		dev_warn(&pdev->dev, "failed to read mac addr\n");

	netif_carrier_off(netdev);
	netif_stop_queue(netdev);

	err = register_netdev(netdev);
	if (err) {
		dev_err(&pdev->dev, "failed to register net device\n");
		return err;
	}

	return 0;
}

A
Amit S. Kale 已提交
1191 1192 1193 1194 1195
static int __devinit
netxen_nic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
{
	struct net_device *netdev = NULL;
	struct netxen_adapter *adapter = NULL;
1196
	int i = 0, err;
1197
	int pci_func_id = PCI_FUNC(pdev->devfn);
1198
	uint8_t revision_id;
A
Amit S. Kale 已提交
1199

1200
	if (pdev->class != 0x020000) {
1201
		printk(KERN_DEBUG "NetXen function %d, class %x will not "
1202
				"be enabled.\n",pci_func_id, pdev->class);
1203 1204
		return -ENODEV;
	}
1205

D
Dhananjay Phadke 已提交
1206 1207 1208 1209 1210 1211 1212
	if (pdev->revision >= NX_P3_A0 && pdev->revision < NX_P3_B1) {
		printk(KERN_WARNING "NetXen chip revisions between 0x%x-0x%x"
				"will not be enabled.\n",
				NX_P3_A0, NX_P3_B1);
		return -ENODEV;
	}

A
Amit S. Kale 已提交
1213 1214
	if ((err = pci_enable_device(pdev)))
		return err;
1215

A
Amit S. Kale 已提交
1216 1217 1218 1219 1220 1221 1222 1223 1224
	if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
		err = -ENODEV;
		goto err_out_disable_pdev;
	}

	if ((err = pci_request_regions(pdev, netxen_nic_driver_name)))
		goto err_out_disable_pdev;

	pci_set_master(pdev);
1225 1226 1227

	netdev = alloc_etherdev(sizeof(struct netxen_adapter));
	if(!netdev) {
1228 1229
		dev_err(&pdev->dev, "failed to allocate net_device\n");
		err = -ENOMEM;
1230 1231 1232 1233 1234
		goto err_out_free_res;
	}

	SET_NETDEV_DEV(netdev, &pdev->dev);

1235
	adapter = netdev_priv(netdev);
1236 1237
	adapter->netdev  = netdev;
	adapter->pdev    = pdev;
1238
	adapter->ahw.pci_func  = pci_func_id;
1239 1240 1241 1242

	revision_id = pdev->revision;
	adapter->ahw.revision_id = revision_id;

1243
	rwlock_init(&adapter->adapter_lock);
1244
	spin_lock_init(&adapter->tx_clean_lock);
1245
	INIT_LIST_HEAD(&adapter->mac_list);
1246

D
Dhananjay Phadke 已提交
1247 1248
	err = netxen_setup_pci_map(adapter);
	if (err)
1249
		goto err_out_free_netdev;
A
Amit S. Kale 已提交
1250

1251
	/* This will be reset for mezz cards  */
1252 1253
	adapter->portnum = pci_func_id;

1254 1255 1256
	err = netxen_nic_get_board_info(adapter);
	if (err) {
		dev_err(&pdev->dev, "Error getting board config info.\n");
1257 1258
		goto err_out_iounmap;
	}
1259

1260
	/* Mezz cards have PCI function 0,2,3 enabled */
1261
	switch (adapter->ahw.board_type) {
1262 1263 1264
	case NETXEN_BRDTYPE_P2_SB31_10G_IMEZ:
	case NETXEN_BRDTYPE_P2_SB31_10G_HMEZ:
		if (pci_func_id >= 2)
1265
			adapter->portnum = pci_func_id - 2;
1266 1267 1268 1269
		break;
	default:
		break;
	}
1270

1271
	err = netxen_start_firmware(adapter);
1272 1273
	if (err)
		goto err_out_iounmap;
1274

A
Amit S. Kale 已提交
1275
	/*
1276
	 * See if the firmware gave us a virtual-physical port mapping.
A
Amit S. Kale 已提交
1277
	 */
1278
	adapter->physical_port = adapter->portnum;
1279
	if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) {
1280
		i = NXRD32(adapter, CRB_V2P(adapter->portnum));
1281 1282 1283
		if (i != 0x55555555)
			adapter->physical_port = i;
	}
1284

1285
	netxen_nic_clear_stats(adapter);
1286

D
Dhananjay Phadke 已提交
1287
	netxen_setup_intr(adapter);
1288

1289
	err = netxen_setup_netdev(adapter, netdev);
D
Dhananjay Phadke 已提交
1290
	if (err)
1291
		goto err_out_disable_msi;
1292 1293

	pci_set_drvdata(pdev, adapter);
A
Amit S. Kale 已提交
1294

1295 1296
	netxen_schedule_work(adapter, netxen_fw_poll_work, FW_POLL_DELAY);

1297
	switch (adapter->ahw.port_type) {
1298 1299 1300 1301 1302 1303 1304 1305
	case NETXEN_NIC_GBE:
		dev_info(&adapter->pdev->dev, "%s: GbE port initialized\n",
				adapter->netdev->name);
		break;
	case NETXEN_NIC_XGBE:
		dev_info(&adapter->pdev->dev, "%s: XGbE port initialized\n",
				adapter->netdev->name);
		break;
A
Amit S. Kale 已提交
1306 1307
	}

1308 1309 1310
	return 0;

err_out_disable_msi:
D
Dhananjay Phadke 已提交
1311
	netxen_teardown_intr(adapter);
1312

1313
	netxen_free_dummy_dma(adapter);
A
Amit S. Kale 已提交
1314

1315 1316
	nx_decr_dev_ref_cnt(adapter);

1317
err_out_iounmap:
D
Dhananjay Phadke 已提交
1318
	netxen_cleanup_pci_map(adapter);
1319

1320 1321 1322 1323
err_out_free_netdev:
	free_netdev(netdev);

err_out_free_res:
A
Amit S. Kale 已提交
1324
	pci_release_regions(pdev);
1325 1326

err_out_disable_pdev:
1327
	pci_set_drvdata(pdev, NULL);
A
Amit S. Kale 已提交
1328 1329 1330 1331 1332 1333 1334
	pci_disable_device(pdev);
	return err;
}

static void __devexit netxen_nic_remove(struct pci_dev *pdev)
{
	struct netxen_adapter *adapter;
1335
	struct net_device *netdev;
A
Amit S. Kale 已提交
1336

1337
	adapter = pci_get_drvdata(pdev);
A
Amit S. Kale 已提交
1338 1339 1340
	if (adapter == NULL)
		return;

1341 1342
	netdev = adapter->netdev;

1343 1344
	netxen_cancel_fw_work(adapter);

1345 1346
	unregister_netdev(netdev);

1347 1348
	cancel_work_sync(&adapter->tx_timeout_task);

1349
	netxen_nic_detach(adapter);
A
Amit S. Kale 已提交
1350

1351 1352
	nx_decr_dev_ref_cnt(adapter);

1353
	if (adapter->portnum == 0)
1354
		netxen_free_dummy_dma(adapter);
1355

1356 1357
	clear_bit(__NX_RESETTING, &adapter->state);

D
Dhananjay Phadke 已提交
1358
	netxen_teardown_intr(adapter);
1359

D
Dhananjay Phadke 已提交
1360
	netxen_cleanup_pci_map(adapter);
1361

D
Dhananjay Phadke 已提交
1362 1363
	netxen_release_firmware(adapter);

1364
	pci_release_regions(pdev);
1365
	pci_disable_device(pdev);
1366 1367
	pci_set_drvdata(pdev, NULL);

1368
	free_netdev(netdev);
A
Amit S. Kale 已提交
1369
}
1370
static int __netxen_nic_shutdown(struct pci_dev *pdev)
1371 1372 1373
{
	struct netxen_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
1374
	int retval;
1375 1376 1377

	netif_device_detach(netdev);

1378 1379
	netxen_cancel_fw_work(adapter);

1380 1381 1382
	if (netif_running(netdev))
		netxen_nic_down(adapter, netdev);

1383 1384
	cancel_work_sync(&adapter->tx_timeout_task);

1385
	netxen_nic_detach(adapter);
1386

1387 1388 1389
	if (adapter->portnum == 0)
		netxen_free_dummy_dma(adapter);

1390 1391 1392 1393
	nx_decr_dev_ref_cnt(adapter);

	clear_bit(__NX_RESETTING, &adapter->state);

1394 1395 1396
	retval = pci_save_state(pdev);
	if (retval)
		return retval;
1397 1398 1399 1400 1401 1402 1403 1404 1405 1406

	if (netxen_nic_wol_supported(adapter)) {
		pci_enable_wake(pdev, PCI_D3cold, 1);
		pci_enable_wake(pdev, PCI_D3hot, 1);
	}

	pci_disable_device(pdev);

	return 0;
}
1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424
static void netxen_nic_shutdown(struct pci_dev *pdev)
{
	if (__netxen_nic_shutdown(pdev))
		return;
}
#ifdef CONFIG_PM
static int
netxen_nic_suspend(struct pci_dev *pdev, pm_message_t state)
{
	int retval;

	retval = __netxen_nic_shutdown(pdev);
	if (retval)
		return retval;

	pci_set_power_state(pdev, pci_choose_state(pdev, state));
	return 0;
}
1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440

static int
netxen_nic_resume(struct pci_dev *pdev)
{
	struct netxen_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
	int err;

	pci_set_power_state(pdev, PCI_D0);
	pci_restore_state(pdev);

	err = pci_enable_device(pdev);
	if (err)
		return err;

	adapter->curr_window = 255;
1441
	adapter->ahw.ocm_win = -1;
1442

1443
	err = netxen_start_firmware(adapter);
1444 1445 1446 1447 1448 1449 1450 1451
	if (err) {
		dev_err(&pdev->dev, "failed to start firmware\n");
		return err;
	}

	if (netif_running(netdev)) {
		err = netxen_nic_attach(adapter);
		if (err)
1452
			goto err_out;
1453 1454 1455

		err = netxen_nic_up(adapter, netdev);
		if (err)
1456
			goto err_out_detach;
1457 1458

		netif_device_attach(netdev);
1459 1460

		netxen_config_indev_addr(netdev, NETDEV_UP);
1461 1462
	}

1463
	netxen_schedule_work(adapter, netxen_fw_poll_work, FW_POLL_DELAY);
1464
	return 0;
1465 1466 1467 1468 1469 1470

err_out_detach:
	netxen_nic_detach(adapter);
err_out:
	nx_decr_dev_ref_cnt(adapter);
	return err;
1471
}
1472
#endif
1473

A
Amit S. Kale 已提交
1474 1475
static int netxen_nic_open(struct net_device *netdev)
{
1476
	struct netxen_adapter *adapter = netdev_priv(netdev);
A
Amit S. Kale 已提交
1477 1478
	int err = 0;

1479 1480 1481
	if (adapter->driver_mismatch)
		return -EIO;

1482 1483 1484
	err = netxen_nic_attach(adapter);
	if (err)
		return err;
1485

1486 1487 1488
	err = netxen_nic_up(adapter, netdev);
	if (err)
		goto err_out;
D
Dhananjay Phadke 已提交
1489

1490
	netif_start_queue(netdev);
A
Amit S. Kale 已提交
1491 1492

	return 0;
1493

1494 1495
err_out:
	netxen_nic_detach(adapter);
1496
	return err;
A
Amit S. Kale 已提交
1497 1498 1499 1500 1501 1502 1503
}

/*
 * netxen_nic_close - Disables a network interface entry point
 */
static int netxen_nic_close(struct net_device *netdev)
{
1504
	struct netxen_adapter *adapter = netdev_priv(netdev);
A
Amit S. Kale 已提交
1505

1506
	netxen_nic_down(adapter, netdev);
A
Amit S. Kale 已提交
1507 1508 1509
	return 0;
}

D
Dhananjay Phadke 已提交
1510 1511 1512 1513 1514
static void
netxen_tso_check(struct net_device *netdev,
		struct nx_host_tx_ring *tx_ring,
		struct cmd_desc_type0 *first_desc,
		struct sk_buff *skb)
1515
{
1516
	u8 opcode = TX_ETHER_PKT;
1517
	__be16 protocol = skb->protocol;
1518
	u16 flags = 0, vid = 0;
D
Dhananjay Phadke 已提交
1519
	u32 producer;
1520
	int copied, offset, copy_len, hdr_len = 0, tso = 0, vlan_oob = 0;
D
Dhananjay Phadke 已提交
1521
	struct cmd_desc_type0 *hwdesc;
1522
	struct vlan_ethhdr *vh;
1523

1524
	if (protocol == cpu_to_be16(ETH_P_8021Q)) {
1525 1526

		vh = (struct vlan_ethhdr *)skb->data;
1527 1528
		protocol = vh->h_vlan_encapsulated_proto;
		flags = FLAGS_VLAN_TAGGED;
1529 1530 1531 1532 1533 1534 1535

	} else if (vlan_tx_tag_present(skb)) {

		flags = FLAGS_VLAN_OOB;
		vid = vlan_tx_tag_get(skb);
		netxen_set_tx_vlan_tci(first_desc, vid);
		vlan_oob = 1;
1536
	}
1537

1538 1539 1540
	if ((netdev->features & (NETIF_F_TSO | NETIF_F_TSO6)) &&
			skb_shinfo(skb)->gso_size > 0) {

D
Dhananjay Phadke 已提交
1541 1542 1543 1544
		hdr_len = skb_transport_offset(skb) + tcp_hdrlen(skb);

		first_desc->mss = cpu_to_le16(skb_shinfo(skb)->gso_size);
		first_desc->total_hdr_length = hdr_len;
1545 1546 1547 1548 1549 1550 1551
		if (vlan_oob) {
			first_desc->total_hdr_length += VLAN_HLEN;
			first_desc->tcp_hdr_offset = VLAN_HLEN;
			first_desc->ip_hdr_offset = VLAN_HLEN;
			/* Only in case of TSO on vlan device */
			flags |= FLAGS_VLAN_TAGGED;
		}
1552

1553
		opcode = (protocol == cpu_to_be16(ETH_P_IPV6)) ?
1554
				TX_TCP_LSO6 : TX_TCP_LSO;
D
Dhananjay Phadke 已提交
1555
		tso = 1;
1556 1557

	} else if (skb->ip_summed == CHECKSUM_PARTIAL) {
1558 1559
		u8 l4proto;

1560
		if (protocol == cpu_to_be16(ETH_P_IP)) {
1561 1562 1563 1564 1565 1566
			l4proto = ip_hdr(skb)->protocol;

			if (l4proto == IPPROTO_TCP)
				opcode = TX_TCP_PKT;
			else if(l4proto == IPPROTO_UDP)
				opcode = TX_UDP_PKT;
1567
		} else if (protocol == cpu_to_be16(ETH_P_IPV6)) {
1568 1569 1570 1571 1572 1573 1574
			l4proto = ipv6_hdr(skb)->nexthdr;

			if (l4proto == IPPROTO_TCP)
				opcode = TX_TCPV6_PKT;
			else if(l4proto == IPPROTO_UDP)
				opcode = TX_UDPV6_PKT;
		}
1575
	}
1576 1577 1578

	first_desc->tcp_hdr_offset += skb_transport_offset(skb);
	first_desc->ip_hdr_offset += skb_network_offset(skb);
D
Dhananjay Phadke 已提交
1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590
	netxen_set_tx_flags_opcode(first_desc, flags, opcode);

	if (!tso)
		return;

	/* For LSO, we need to copy the MAC/IP/TCP headers into
	 * the descriptor ring
	 */
	producer = tx_ring->producer;
	copied = 0;
	offset = 2;

1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606
	if (vlan_oob) {
		/* Create a TSO vlan header template for firmware */

		hwdesc = &tx_ring->desc_head[producer];
		tx_ring->cmd_buf_arr[producer].skb = NULL;

		copy_len = min((int)sizeof(struct cmd_desc_type0) - offset,
				hdr_len + VLAN_HLEN);

		vh = (struct vlan_ethhdr *)((char *)hwdesc + 2);
		skb_copy_from_linear_data(skb, vh, 12);
		vh->h_vlan_proto = htons(ETH_P_8021Q);
		vh->h_vlan_TCI = htons(vid);
		skb_copy_from_linear_data_offset(skb, 12,
				(char *)vh + 16, copy_len - 16);

D
Dhananjay Phadke 已提交
1607
		copied = copy_len - VLAN_HLEN;
1608 1609 1610 1611 1612
		offset = 0;

		producer = get_next_index(producer, tx_ring->num_desc);
	}

D
Dhananjay Phadke 已提交
1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631
	while (copied < hdr_len) {

		copy_len = min((int)sizeof(struct cmd_desc_type0) - offset,
				(hdr_len - copied));

		hwdesc = &tx_ring->desc_head[producer];
		tx_ring->cmd_buf_arr[producer].skb = NULL;

		skb_copy_from_linear_data_offset(skb, copied,
				 (char *)hwdesc + offset, copy_len);

		copied += copy_len;
		offset = 0;

		producer = get_next_index(producer, tx_ring->num_desc);
	}

	tx_ring->producer = producer;
	barrier();
1632 1633
}

1634 1635 1636
static int
netxen_map_tx_skb(struct pci_dev *pdev,
		struct sk_buff *skb, struct netxen_cmd_buffer *pbuf)
1637
{
1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649
	struct netxen_skb_frag *nf;
	struct skb_frag_struct *frag;
	int i, nr_frags;
	dma_addr_t map;

	nr_frags = skb_shinfo(skb)->nr_frags;
	nf = &pbuf->frag_array[0];

	map = pci_map_single(pdev, skb->data,
			skb_headlen(skb), PCI_DMA_TODEVICE);
	if (pci_dma_mapping_error(pdev, map))
		goto out_err;
1650

1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667
	nf->dma = map;
	nf->length = skb_headlen(skb);

	for (i = 0; i < nr_frags; i++) {
		frag = &skb_shinfo(skb)->frags[i];
		nf = &pbuf->frag_array[i+1];

		map = pci_map_page(pdev, frag->page, frag->page_offset,
				frag->size, PCI_DMA_TODEVICE);
		if (pci_dma_mapping_error(pdev, map))
			goto unwind;

		nf->dma = map;
		nf->length = frag->size;
	}

	return 0;
1668

1669
unwind:
1670 1671
	while (--i >= 0) {
		nf = &pbuf->frag_array[i+1];
1672
		pci_unmap_page(pdev, nf->dma, nf->length, PCI_DMA_TODEVICE);
1673
	}
1674 1675 1676 1677 1678 1679

	nf = &pbuf->frag_array[0];
	pci_unmap_single(pdev, nf->dma, skb_headlen(skb), PCI_DMA_TODEVICE);

out_err:
	return -ENOMEM;
1680 1681
}

1682 1683 1684
static inline void
netxen_clear_cmddesc(u64 *desc)
{
D
Dhananjay Phadke 已提交
1685 1686
	desc[0] = 0ULL;
	desc[2] = 0ULL;
1687 1688
}

1689
static netdev_tx_t
1690
netxen_nic_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
A
Amit S. Kale 已提交
1691
{
1692
	struct netxen_adapter *adapter = netdev_priv(netdev);
1693
	struct nx_host_tx_ring *tx_ring = adapter->tx_ring;
1694
	struct netxen_cmd_buffer *pbuf;
A
Amit S. Kale 已提交
1695
	struct netxen_skb_frag *buffrag;
D
Dhananjay Phadke 已提交
1696 1697
	struct cmd_desc_type0 *hwdesc, *first_desc;
	struct pci_dev *pdev;
1698
	int i, k;
A
Amit S. Kale 已提交
1699

1700
	u32 producer;
1701
	int frag_count, no_of_desc;
1702
	u32 num_txd = tx_ring->num_desc;
A
Amit S. Kale 已提交
1703 1704 1705

	frag_count = skb_shinfo(skb)->nr_frags + 1;

1706
	/* 4 fragments per cmd des */
A
Amit S. Kale 已提交
1707
	no_of_desc = (frag_count + 3) >> 2;
1708

R
Roel Kluin 已提交
1709
	if (unlikely(no_of_desc + 2 > netxen_tx_avail(tx_ring))) {
1710 1711
		netif_stop_queue(netdev);
		return NETDEV_TX_BUSY;
1712
	}
A
Amit S. Kale 已提交
1713

1714
	producer = tx_ring->producer;
1715
	pbuf = &tx_ring->cmd_buf_arr[producer];
1716

D
Dhananjay Phadke 已提交
1717
	pdev = adapter->pdev;
1718

1719
	if (netxen_map_tx_skb(pdev, skb, pbuf))
D
Dhananjay Phadke 已提交
1720
		goto drop_packet;
1721

A
Amit S. Kale 已提交
1722 1723
	pbuf->skb = skb;
	pbuf->frag_count = frag_count;
1724

D
Dhananjay Phadke 已提交
1725 1726
	first_desc = hwdesc = &tx_ring->desc_head[producer];
	netxen_clear_cmddesc((u64 *)hwdesc);
A
Amit S. Kale 已提交
1727

1728 1729
	netxen_set_tx_frags_len(first_desc, frag_count, skb->len);
	netxen_set_tx_port(first_desc, adapter->portnum);
A
Amit S. Kale 已提交
1730

1731
	for (i = 0; i < frag_count; i++) {
A
Amit S. Kale 已提交
1732

1733 1734 1735 1736
		k = i % 4;

		if ((k == 0) && (i > 0)) {
			/* move to next desc.*/
1737
			producer = get_next_index(producer, num_txd);
1738
			hwdesc = &tx_ring->desc_head[producer];
1739
			netxen_clear_cmddesc((u64 *)hwdesc);
1740
			tx_ring->cmd_buf_arr[producer].skb = NULL;
1741
		}
A
Amit S. Kale 已提交
1742

1743
		buffrag = &pbuf->frag_array[i];
A
Amit S. Kale 已提交
1744

1745
		hwdesc->buffer_length[k] = cpu_to_le16(buffrag->length);
A
Amit S. Kale 已提交
1746 1747
		switch (k) {
		case 0:
1748
			hwdesc->addr_buffer1 = cpu_to_le64(buffrag->dma);
A
Amit S. Kale 已提交
1749 1750
			break;
		case 1:
1751
			hwdesc->addr_buffer2 = cpu_to_le64(buffrag->dma);
A
Amit S. Kale 已提交
1752 1753
			break;
		case 2:
1754
			hwdesc->addr_buffer3 = cpu_to_le64(buffrag->dma);
A
Amit S. Kale 已提交
1755 1756
			break;
		case 3:
1757
			hwdesc->addr_buffer4 = cpu_to_le64(buffrag->dma);
A
Amit S. Kale 已提交
1758 1759 1760
			break;
		}
	}
1761

D
Dhananjay Phadke 已提交
1762
	tx_ring->producer = get_next_index(producer, num_txd);
A
Amit S. Kale 已提交
1763

D
Dhananjay Phadke 已提交
1764
	netxen_tso_check(netdev, tx_ring, first_desc, skb);
1765

1766
	netxen_nic_update_cmd_producer(adapter, tx_ring);
A
Amit S. Kale 已提交
1767

D
Dhananjay Phadke 已提交
1768
	adapter->stats.txbytes += skb->len;
1769
	adapter->stats.xmitcalled++;
A
Amit S. Kale 已提交
1770 1771

	return NETDEV_TX_OK;
1772 1773 1774 1775 1776

drop_packet:
	adapter->stats.txdropped++;
	dev_kfree_skb_any(skb);
	return NETDEV_TX_OK;
A
Amit S. Kale 已提交
1777 1778
}

1779 1780 1781 1782 1783 1784
static int netxen_nic_check_temp(struct netxen_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	uint32_t temp, temp_state, temp_val;
	int rv = 0;

1785
	temp = NXRD32(adapter, CRB_TEMP_STATE);
1786 1787 1788 1789 1790 1791 1792 1793

	temp_state = nx_get_temp_state(temp);
	temp_val = nx_get_temp_val(temp);

	if (temp_state == NX_TEMP_PANIC) {
		printk(KERN_ALERT
		       "%s: Device temperature %d degrees C exceeds"
		       " maximum allowed. Hardware has been shut down.\n",
1794
		       netdev->name, temp_val);
1795 1796 1797 1798 1799 1800 1801
		rv = 1;
	} else if (temp_state == NX_TEMP_WARN) {
		if (adapter->temp == NX_TEMP_NORMAL) {
			printk(KERN_ALERT
			       "%s: Device temperature %d degrees C "
			       "exceeds operating range."
			       " Immediate action needed.\n",
1802
			       netdev->name, temp_val);
1803 1804 1805 1806 1807
		}
	} else {
		if (adapter->temp == NX_TEMP_WARN) {
			printk(KERN_INFO
			       "%s: Device temperature is now %d degrees C"
1808
			       " in normal range.\n", netdev->name,
1809 1810 1811 1812 1813 1814 1815
			       temp_val);
		}
	}
	adapter->temp = temp_state;
	return rv;
}

1816
void netxen_advert_link_change(struct netxen_adapter *adapter, int linkup)
1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827
{
	struct net_device *netdev = adapter->netdev;

	if (adapter->ahw.linkup && !linkup) {
		printk(KERN_INFO "%s: %s NIC Link is down\n",
		       netxen_nic_driver_name, netdev->name);
		adapter->ahw.linkup = 0;
		if (netif_running(netdev)) {
			netif_carrier_off(netdev);
			netif_stop_queue(netdev);
		}
1828
		adapter->link_changed = !adapter->has_link_events;
1829 1830 1831 1832 1833 1834 1835 1836
	} else if (!adapter->ahw.linkup && linkup) {
		printk(KERN_INFO "%s: %s NIC Link is up\n",
		       netxen_nic_driver_name, netdev->name);
		adapter->ahw.linkup = 1;
		if (netif_running(netdev)) {
			netif_carrier_on(netdev);
			netif_wake_queue(netdev);
		}
1837
		adapter->link_changed = !adapter->has_link_events;
1838 1839 1840
	}
}

1841 1842 1843 1844 1845 1846 1847
static void netxen_nic_handle_phy_intr(struct netxen_adapter *adapter)
{
	u32 val, port, linkup;

	port = adapter->physical_port;

	if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) {
1848
		val = NXRD32(adapter, CRB_XG_STATE_P3);
1849 1850 1851
		val = XG_LINK_STATE_P3(adapter->ahw.pci_func, val);
		linkup = (val == XG_LINK_UP_P3);
	} else {
1852
		val = NXRD32(adapter, CRB_XG_STATE);
1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863
		if (adapter->ahw.port_type == NETXEN_NIC_GBE)
			linkup = (val >> port) & 1;
		else {
			val = (val >> port*8) & 0xff;
			linkup = (val == XG_LINK_UP);
		}
	}

	netxen_advert_link_change(adapter, linkup);
}

A
Amit S. Kale 已提交
1864 1865
static void netxen_tx_timeout(struct net_device *netdev)
{
1866
	struct netxen_adapter *adapter = netdev_priv(netdev);
1867

1868 1869 1870
	if (test_bit(__NX_RESETTING, &adapter->state))
		return;

1871
	dev_err(&netdev->dev, "transmit timeout, resetting.\n");
1872
	schedule_work(&adapter->tx_timeout_task);
A
Amit S. Kale 已提交
1873 1874
}

1875
static void netxen_tx_timeout_task(struct work_struct *work)
A
Amit S. Kale 已提交
1876
{
1877
	struct netxen_adapter *adapter =
1878
		container_of(work, struct netxen_adapter, tx_timeout_task);
A
Amit S. Kale 已提交
1879

1880 1881 1882
	if (!netif_running(adapter->netdev))
		return;

1883
	if (test_and_set_bit(__NX_RESETTING, &adapter->state))
1884 1885
		return;

1886 1887 1888 1889 1890 1891
	if (++adapter->tx_timeo_cnt >= NX_MAX_TX_TIMEOUTS)
		goto request_reset;

	if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) {
		/* try to scrub interrupt */
		netxen_napi_disable(adapter);
1892

1893
		adapter->netdev->trans_start = jiffies;
1894

1895 1896 1897 1898
		netxen_napi_enable(adapter);

		netif_wake_queue(adapter->netdev);

1899
		clear_bit(__NX_RESETTING, &adapter->state);
1900 1901

	} else {
1902
		clear_bit(__NX_RESETTING, &adapter->state);
1903 1904
		if (!netxen_nic_reset_context(adapter)) {
			adapter->netdev->trans_start = jiffies;
1905
			return;
1906 1907 1908 1909 1910 1911 1912
		}

		/* context reset failed, fall through for fw reset */
	}

request_reset:
	adapter->need_fw_reset = 1;
A
Amit S. Kale 已提交
1913 1914
}

1915 1916 1917
struct net_device_stats *netxen_nic_get_stats(struct net_device *netdev)
{
	struct netxen_adapter *adapter = netdev_priv(netdev);
1918
	struct net_device_stats *stats = &netdev->stats;
1919 1920 1921

	memset(stats, 0, sizeof(*stats));

1922
	stats->rx_packets = adapter->stats.rx_pkts + adapter->stats.lro_pkts;
D
Dhananjay Phadke 已提交
1923
	stats->tx_packets = adapter->stats.xmitfinished;
1924 1925 1926 1927 1928 1929 1930 1931
	stats->rx_bytes = adapter->stats.rxbytes;
	stats->tx_bytes = adapter->stats.txbytes;
	stats->rx_dropped = adapter->stats.rxdropped;
	stats->tx_dropped = adapter->stats.txdropped;

	return stats;
}

1932
static irqreturn_t netxen_intr(int irq, void *data)
A
Amit S. Kale 已提交
1933
{
1934 1935
	struct nx_host_sds_ring *sds_ring = data;
	struct netxen_adapter *adapter = sds_ring->adapter;
D
Dhananjay Phadke 已提交
1936 1937
	u32 status = 0;

1938
	status = readl(adapter->isr_int_vec);
D
Dhananjay Phadke 已提交
1939

1940
	if (!(status & adapter->int_vec_bit))
D
Dhananjay Phadke 已提交
1941
		return IRQ_NONE;
1942

1943
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) {
D
Dhananjay Phadke 已提交
1944
		/* check interrupt state machine, to be sure */
1945
		status = readl(adapter->crb_int_state_reg);
D
Dhananjay Phadke 已提交
1946 1947 1948
		if (!ISR_LEGACY_INT_TRIGGERED(status))
			return IRQ_NONE;

1949 1950
	} else {
		unsigned long our_int = 0;
D
Dhananjay Phadke 已提交
1951

1952
		our_int = readl(adapter->crb_int_state_reg);
1953

D
Dhananjay Phadke 已提交
1954
		/* not our interrupt */
1955
		if (!test_and_clear_bit((7 + adapter->portnum), &our_int))
D
Dhananjay Phadke 已提交
1956 1957
			return IRQ_NONE;

1958
		/* claim interrupt */
1959
		writel((our_int & 0xffffffff), adapter->crb_int_state_reg);
1960

1961
		/* clear interrupt */
1962
		netxen_nic_disable_int(sds_ring);
1963
	}
1964

1965
	writel(0xffffffff, adapter->tgt_status_reg);
1966
	/* read twice to ensure write is flushed */
1967 1968
	readl(adapter->isr_int_vec);
	readl(adapter->isr_int_vec);
1969

1970
	napi_schedule(&sds_ring->napi);
A
Amit S. Kale 已提交
1971 1972 1973 1974

	return IRQ_HANDLED;
}

1975
static irqreturn_t netxen_msi_intr(int irq, void *data)
D
Dhananjay Phadke 已提交
1976
{
1977 1978
	struct nx_host_sds_ring *sds_ring = data;
	struct netxen_adapter *adapter = sds_ring->adapter;
D
Dhananjay Phadke 已提交
1979

1980
	/* clear interrupt */
1981
	writel(0xffffffff, adapter->tgt_status_reg);
1982

1983
	napi_schedule(&sds_ring->napi);
D
Dhananjay Phadke 已提交
1984 1985 1986
	return IRQ_HANDLED;
}

1987 1988
static irqreturn_t netxen_msix_intr(int irq, void *data)
{
1989
	struct nx_host_sds_ring *sds_ring = data;
1990

1991
	napi_schedule(&sds_ring->napi);
1992 1993 1994
	return IRQ_HANDLED;
}

1995
static int netxen_nic_poll(struct napi_struct *napi, int budget)
A
Amit S. Kale 已提交
1996
{
1997 1998 1999 2000 2001
	struct nx_host_sds_ring *sds_ring =
		container_of(napi, struct nx_host_sds_ring, napi);

	struct netxen_adapter *adapter = sds_ring->adapter;

D
Dhananjay Phadke 已提交
2002
	int tx_complete;
2003
	int work_done;
A
Amit S. Kale 已提交
2004

D
Dhananjay Phadke 已提交
2005
	tx_complete = netxen_process_cmd_ring(adapter);
A
Amit S. Kale 已提交
2006

2007
	work_done = netxen_process_rcv_ring(sds_ring, budget);
A
Amit S. Kale 已提交
2008

D
Dhananjay Phadke 已提交
2009
	if ((work_done < budget) && tx_complete) {
2010
		napi_complete(&sds_ring->napi);
2011 2012
		if (netif_running(adapter->netdev))
			netxen_nic_enable_int(sds_ring);
A
Amit S. Kale 已提交
2013 2014
	}

2015
	return work_done;
A
Amit S. Kale 已提交
2016 2017 2018 2019 2020
}

#ifdef CONFIG_NET_POLL_CONTROLLER
static void netxen_nic_poll_controller(struct net_device *netdev)
{
2021
	struct netxen_adapter *adapter = netdev_priv(netdev);
A
Amit S. Kale 已提交
2022
	disable_irq(adapter->irq);
J
Jeff Garzik 已提交
2023
	netxen_intr(adapter->irq, adapter);
A
Amit S. Kale 已提交
2024 2025 2026 2027
	enable_irq(adapter->irq);
}
#endif

2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061
static int
nx_incr_dev_ref_cnt(struct netxen_adapter *adapter)
{
	int count;
	if (netxen_api_lock(adapter))
		return -EIO;

	count = NXRD32(adapter, NX_CRB_DEV_REF_COUNT);

	NXWR32(adapter, NX_CRB_DEV_REF_COUNT, ++count);

	netxen_api_unlock(adapter);
	return count;
}

static int
nx_decr_dev_ref_cnt(struct netxen_adapter *adapter)
{
	int count;
	if (netxen_api_lock(adapter))
		return -EIO;

	count = NXRD32(adapter, NX_CRB_DEV_REF_COUNT);
	WARN_ON(count == 0);

	NXWR32(adapter, NX_CRB_DEV_REF_COUNT, --count);

	if (count == 0)
		NXWR32(adapter, NX_CRB_DEV_STATE, NX_DEV_COLD);

	netxen_api_unlock(adapter);
	return count;
}

2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077
static void
nx_dev_request_reset(struct netxen_adapter *adapter)
{
	u32 state;

	if (netxen_api_lock(adapter))
		return;

	state = NXRD32(adapter, NX_CRB_DEV_STATE);

	if (state != NX_DEV_INITALIZING)
		NXWR32(adapter, NX_CRB_DEV_STATE, NX_DEV_NEED_RESET);

	netxen_api_unlock(adapter);
}

2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139
static int
netxen_can_start_firmware(struct netxen_adapter *adapter)
{
	int count;
	int can_start = 0;

	if (netxen_api_lock(adapter))
		return 0;

	count = NXRD32(adapter, NX_CRB_DEV_REF_COUNT);

	if ((count < 0) || (count >= NX_MAX_PCI_FUNC))
		count = 0;

	if (count == 0) {
		can_start = 1;
		NXWR32(adapter, NX_CRB_DEV_STATE, NX_DEV_INITALIZING);
	}

	NXWR32(adapter, NX_CRB_DEV_REF_COUNT, ++count);

	netxen_api_unlock(adapter);

	return can_start;
}

static void
netxen_schedule_work(struct netxen_adapter *adapter,
		work_func_t func, int delay)
{
	INIT_DELAYED_WORK(&adapter->fw_work, func);
	schedule_delayed_work(&adapter->fw_work, delay);
}

static void
netxen_cancel_fw_work(struct netxen_adapter *adapter)
{
	while (test_and_set_bit(__NX_RESETTING, &adapter->state))
		msleep(10);

	cancel_delayed_work_sync(&adapter->fw_work);
}

static void
netxen_attach_work(struct work_struct *work)
{
	struct netxen_adapter *adapter = container_of(work,
				struct netxen_adapter, fw_work.work);
	struct net_device *netdev = adapter->netdev;
	int err = 0;

	if (netif_running(netdev)) {
		err = netxen_nic_attach(adapter);
		if (err)
			goto done;

		err = netxen_nic_up(adapter, netdev);
		if (err) {
			netxen_nic_detach(adapter);
			goto done;
		}

2140
		netxen_config_indev_addr(netdev, NETDEV_UP);
2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162
	}

	netif_device_attach(netdev);

done:
	adapter->fw_fail_cnt = 0;
	clear_bit(__NX_RESETTING, &adapter->state);
	netxen_schedule_work(adapter, netxen_fw_poll_work, FW_POLL_DELAY);
}

static void
netxen_fwinit_work(struct work_struct *work)
{
	struct netxen_adapter *adapter = container_of(work,
				struct netxen_adapter, fw_work.work);
	int dev_state;

	dev_state = NXRD32(adapter, NX_CRB_DEV_STATE);

	switch (dev_state) {
	case NX_DEV_COLD:
	case NX_DEV_READY:
2163 2164 2165 2166 2167
		if (!netxen_start_firmware(adapter)) {
			netxen_schedule_work(adapter, netxen_attach_work, 0);
			return;
		}
		break;
2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226

	case NX_DEV_INITALIZING:
		if (++adapter->fw_wait_cnt < FW_POLL_THRESH) {
			netxen_schedule_work(adapter,
					netxen_fwinit_work, 2 * FW_POLL_DELAY);
			return;
		}
		break;

	case NX_DEV_FAILED:
	default:
		break;
	}

	nx_incr_dev_ref_cnt(adapter);
	clear_bit(__NX_RESETTING, &adapter->state);
}

static void
netxen_detach_work(struct work_struct *work)
{
	struct netxen_adapter *adapter = container_of(work,
				struct netxen_adapter, fw_work.work);
	struct net_device *netdev = adapter->netdev;
	int ref_cnt, delay;
	u32 status;

	netif_device_detach(netdev);

	if (netif_running(netdev))
		netxen_nic_down(adapter, netdev);

	netxen_nic_detach(adapter);

	status = NXRD32(adapter, NETXEN_PEG_HALT_STATUS1);

	ref_cnt = nx_decr_dev_ref_cnt(adapter);

	if (status & NX_RCODE_FATAL_ERROR)
		return;

	if (adapter->temp == NX_TEMP_PANIC)
		return;

	delay = (ref_cnt == 0) ? 0 : (2 * FW_POLL_DELAY);

	adapter->fw_wait_cnt = 0;
	netxen_schedule_work(adapter, netxen_fwinit_work, delay);
}

static int
netxen_check_health(struct netxen_adapter *adapter)
{
	u32 state, heartbit;
	struct net_device *netdev = adapter->netdev;

	if (netxen_nic_check_temp(adapter))
		goto detach;

2227 2228 2229 2230 2231
	if (adapter->need_fw_reset) {
		nx_dev_request_reset(adapter);
		goto detach;
	}

2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284
	state = NXRD32(adapter, NX_CRB_DEV_STATE);
	if (state == NX_DEV_NEED_RESET)
		goto detach;

	if (NX_IS_REVISION_P2(adapter->ahw.revision_id))
		return 0;

	heartbit = NXRD32(adapter, NETXEN_PEG_ALIVE_COUNTER);
	if (heartbit != adapter->heartbit) {
		adapter->heartbit = heartbit;
		adapter->fw_fail_cnt = 0;
		return 0;
	}

	if (++adapter->fw_fail_cnt < FW_FAIL_THRESH)
		return 0;

	clear_bit(__NX_FW_ATTACHED, &adapter->state);

	dev_info(&netdev->dev, "firmware hang detected\n");

detach:
	if (!test_and_set_bit(__NX_RESETTING, &adapter->state))
		netxen_schedule_work(adapter, netxen_detach_work, 0);
	return 1;
}

static void
netxen_fw_poll_work(struct work_struct *work)
{
	struct netxen_adapter *adapter = container_of(work,
				struct netxen_adapter, fw_work.work);

	if (test_bit(__NX_RESETTING, &adapter->state))
		goto reschedule;

	if (test_bit(__NX_DEV_UP, &adapter->state)) {
		if (!adapter->has_link_events) {

			netxen_nic_handle_phy_intr(adapter);

			if (adapter->link_changed)
				netxen_nic_set_link_parameters(adapter);
		}
	}

	if (netxen_check_health(adapter))
		return;

reschedule:
	netxen_schedule_work(adapter, netxen_fw_poll_work, FW_POLL_DELAY);
}

2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356
static ssize_t
netxen_store_bridged_mode(struct device *dev,
		struct device_attribute *attr, const char *buf, size_t len)
{
	struct net_device *net = to_net_dev(dev);
	struct netxen_adapter *adapter = netdev_priv(net);
	unsigned long new;
	int ret = -EINVAL;

	if (!(adapter->capabilities & NX_FW_CAPABILITY_BDG))
		goto err_out;

	if (adapter->is_up != NETXEN_ADAPTER_UP_MAGIC)
		goto err_out;

	if (strict_strtoul(buf, 2, &new))
		goto err_out;

	if (!netxen_config_bridged_mode(adapter, !!new))
		ret = len;

err_out:
	return ret;
}

static ssize_t
netxen_show_bridged_mode(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	struct net_device *net = to_net_dev(dev);
	struct netxen_adapter *adapter;
	int bridged_mode = 0;

	adapter = netdev_priv(net);

	if (adapter->capabilities & NX_FW_CAPABILITY_BDG)
		bridged_mode = !!(adapter->flags & NETXEN_NIC_BRIDGE_ENABLED);

	return sprintf(buf, "%d\n", bridged_mode);
}

static struct device_attribute dev_attr_bridged_mode = {
       .attr = {.name = "bridged_mode", .mode = (S_IRUGO | S_IWUSR)},
       .show = netxen_show_bridged_mode,
       .store = netxen_store_bridged_mode,
};

static void
netxen_create_sysfs_entries(struct netxen_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	struct device *dev = &netdev->dev;

	if (adapter->capabilities & NX_FW_CAPABILITY_BDG) {
		/* bridged_mode control */
		if (device_create_file(dev, &dev_attr_bridged_mode)) {
			dev_warn(&netdev->dev,
				"failed to create bridged_mode sysfs entry\n");
		}
	}
}

static void
netxen_remove_sysfs_entries(struct netxen_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	struct device *dev = &netdev->dev;

	if (adapter->capabilities & NX_FW_CAPABILITY_BDG)
		device_remove_file(dev, &dev_attr_bridged_mode);
}

2357 2358
#ifdef CONFIG_INET

2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372
#define is_netxen_netdev(dev) (dev->netdev_ops == &netxen_netdev_ops)

static int
netxen_destip_supported(struct netxen_adapter *adapter)
{
	if (NX_IS_REVISION_P2(adapter->ahw.revision_id))
		return 0;

	if (adapter->ahw.cut_through)
		return 0;

	return 1;
}

2373 2374 2375 2376 2377 2378
static void
netxen_config_indev_addr(struct net_device *dev, unsigned long event)
{
	struct in_device *indev;
	struct netxen_adapter *adapter = netdev_priv(dev);

2379
	if (!netxen_destip_supported(adapter))
2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397 2398 2399 2400 2401 2402 2403 2404
		return;

	indev = in_dev_get(dev);
	if (!indev)
		return;

	for_ifa(indev) {
		switch (event) {
		case NETDEV_UP:
			netxen_config_ipaddr(adapter,
					ifa->ifa_address, NX_IP_UP);
			break;
		case NETDEV_DOWN:
			netxen_config_ipaddr(adapter,
					ifa->ifa_address, NX_IP_DOWN);
			break;
		default:
			break;
		}
	} endfor_ifa(indev);

	in_dev_put(indev);
	return;
}

2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424
static int netxen_netdev_event(struct notifier_block *this,
				 unsigned long event, void *ptr)
{
	struct netxen_adapter *adapter;
	struct net_device *dev = (struct net_device *)ptr;

recheck:
	if (dev == NULL)
		goto done;

	if (dev->priv_flags & IFF_802_1Q_VLAN) {
		dev = vlan_dev_real_dev(dev);
		goto recheck;
	}

	if (!is_netxen_netdev(dev))
		goto done;

	adapter = netdev_priv(dev);

2425
	if (!adapter)
2426 2427 2428 2429 2430
		goto done;

	if (adapter->is_up != NETXEN_ADAPTER_UP_MAGIC)
		goto done;

2431
	netxen_config_indev_addr(dev, event);
2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488
done:
	return NOTIFY_DONE;
}

static int
netxen_inetaddr_event(struct notifier_block *this,
		unsigned long event, void *ptr)
{
	struct netxen_adapter *adapter;
	struct net_device *dev;

	struct in_ifaddr *ifa = (struct in_ifaddr *)ptr;

	dev = ifa->ifa_dev ? ifa->ifa_dev->dev : NULL;

recheck:
	if (dev == NULL || !netif_running(dev))
		goto done;

	if (dev->priv_flags & IFF_802_1Q_VLAN) {
		dev = vlan_dev_real_dev(dev);
		goto recheck;
	}

	if (!is_netxen_netdev(dev))
		goto done;

	adapter = netdev_priv(dev);

	if (!adapter || !netxen_destip_supported(adapter))
		goto done;

	if (adapter->is_up != NETXEN_ADAPTER_UP_MAGIC)
		goto done;

	switch (event) {
	case NETDEV_UP:
		netxen_config_ipaddr(adapter, ifa->ifa_address, NX_IP_UP);
		break;
	case NETDEV_DOWN:
		netxen_config_ipaddr(adapter, ifa->ifa_address, NX_IP_DOWN);
		break;
	default:
		break;
	}

done:
	return NOTIFY_DONE;
}

static struct notifier_block	netxen_netdev_cb = {
	.notifier_call = netxen_netdev_event,
};

static struct notifier_block netxen_inetaddr_cb = {
	.notifier_call = netxen_inetaddr_event,
};
R
Randy Dunlap 已提交
2489 2490 2491 2492
#else
static void
netxen_config_indev_addr(struct net_device *dev, unsigned long event)
{ }
2493
#endif
2494

A
Amit S. Kale 已提交
2495 2496 2497 2498
static struct pci_driver netxen_driver = {
	.name = netxen_nic_driver_name,
	.id_table = netxen_pci_tbl,
	.probe = netxen_nic_probe,
2499
	.remove = __devexit_p(netxen_nic_remove),
2500
#ifdef CONFIG_PM
2501
	.suspend = netxen_nic_suspend,
2502
	.resume = netxen_nic_resume,
2503
#endif
2504
	.shutdown = netxen_nic_shutdown
A
Amit S. Kale 已提交
2505 2506 2507 2508
};

static int __init netxen_init_module(void)
{
2509 2510
	printk(KERN_INFO "%s\n", netxen_nic_driver_string);

2511
#ifdef CONFIG_INET
2512 2513
	register_netdevice_notifier(&netxen_netdev_cb);
	register_inetaddr_notifier(&netxen_inetaddr_cb);
2514
#endif
2515

2516
	return pci_register_driver(&netxen_driver);
A
Amit S. Kale 已提交
2517 2518 2519 2520 2521 2522 2523
}

module_init(netxen_init_module);

static void __exit netxen_exit_module(void)
{
	pci_unregister_driver(&netxen_driver);
2524

2525
#ifdef CONFIG_INET
2526 2527
	unregister_inetaddr_notifier(&netxen_inetaddr_cb);
	unregister_netdevice_notifier(&netxen_netdev_cb);
2528
#endif
A
Amit S. Kale 已提交
2529 2530 2531
}

module_exit(netxen_exit_module);