netxen_nic_main.c 47.8 KB
Newer Older
A
Amit S. Kale 已提交
1
/*
D
Dhananjay Phadke 已提交
2
 * Copyright (C) 2003 - 2009 NetXen, Inc.
A
Amit S. Kale 已提交
3
 * All rights reserved.
4
 *
A
Amit S. Kale 已提交
5 6 7 8
 * 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.
9
 *
A
Amit S. Kale 已提交
10 11 12 13
 * 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.
14
 *
A
Amit S. Kale 已提交
15 16 17 18
 * 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.
19
 *
A
Amit S. Kale 已提交
20 21
 * The full GNU General Public License is included in this distribution
 * in the file called LICENSE.
22
 *
A
Amit S. Kale 已提交
23 24
 * Contact Information:
 *    info@netxen.com
D
Dhananjay Phadke 已提交
25 26 27
 * NetXen Inc,
 * 18922 Forge Drive
 * Cupertino, CA 95014-0701
A
Amit S. Kale 已提交
28 29 30
 *
 */

31
#include <linux/vmalloc.h>
D
Dhananjay Phadke 已提交
32
#include <linux/interrupt.h>
A
Amit S. Kale 已提交
33 34 35 36 37
#include "netxen_nic_hw.h"

#include "netxen_nic.h"
#include "netxen_nic_phan_reg.h"

J
Jeff Garzik 已提交
38
#include <linux/dma-mapping.h>
39
#include <linux/if_vlan.h>
40
#include <net/ip.h>
41
#include <linux/ipv6.h>
42
#include <linux/inetdevice.h>
J
Jeff Garzik 已提交
43

A
Amit S. Kale 已提交
44 45 46 47
MODULE_DESCRIPTION("NetXen Multi port (1/10) Gigabit Network Driver");
MODULE_LICENSE("GPL");
MODULE_VERSION(NETXEN_NIC_LINUX_VERSIONID);

48
char netxen_nic_driver_name[] = "netxen_nic";
A
Amit S. Kale 已提交
49
static char netxen_nic_driver_string[] = "NetXen Network Driver version "
50
    NETXEN_NIC_LINUX_VERSIONID;
A
Amit S. Kale 已提交
51

52 53 54 55 56 57 58 59 60
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 已提交
61 62
/* Local functions to NetXen NIC driver */
static int __devinit netxen_nic_probe(struct pci_dev *pdev,
63
		const struct pci_device_id *ent);
A
Amit S. Kale 已提交
64 65 66 67 68
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);
static int netxen_nic_xmit_frame(struct sk_buff *, struct net_device *);
static void netxen_tx_timeout(struct net_device *netdev);
69
static void netxen_tx_timeout_task(struct work_struct *work);
A
Amit S. Kale 已提交
70
static void netxen_watchdog(unsigned long);
71
static int netxen_nic_poll(struct napi_struct *napi, int budget);
A
Amit S. Kale 已提交
72 73 74
#ifdef CONFIG_NET_POLL_CONTROLLER
static void netxen_nic_poll_controller(struct net_device *netdev);
#endif
J
Jeff Garzik 已提交
75
static irqreturn_t netxen_intr(int irq, void *data);
D
Dhananjay Phadke 已提交
76
static irqreturn_t netxen_msi_intr(int irq, void *data);
77
static irqreturn_t netxen_msix_intr(int irq, void *data);
A
Amit S. Kale 已提交
78 79

/*  PCI Device ID Table  */
80
#define ENTRY(device) \
D
Dhananjay Phadke 已提交
81
	{PCI_DEVICE(PCI_VENDOR_ID_NETXEN, (device)), \
82 83
	.class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0}

A
Amit S. Kale 已提交
84
static struct pci_device_id netxen_pci_tbl[] __devinitdata = {
D
Dhananjay Phadke 已提交
85 86 87 88 89 90 91 92
	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 已提交
93 94 95 96 97
	{0,}
};

MODULE_DEVICE_TABLE(pci, netxen_pci_tbl);

A
Adrian Bunk 已提交
98 99 100 101
static struct workqueue_struct *netxen_workq;
#define SCHEDULE_WORK(tp)	queue_work(netxen_workq, tp)
#define FLUSH_SCHEDULED_WORK()	flush_workqueue(netxen_workq)

102 103
static void netxen_watchdog(unsigned long);

104 105 106 107 108
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
};

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

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

121 122 123 124 125
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
};

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

133
static uint32_t msi_tgt_status[8] = {
D
Dhananjay Phadke 已提交
134
	ISR_INT_TARGET_STATUS, ISR_INT_TARGET_STATUS_F1,
135 136 137
	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 已提交
138 139
};

140 141
static struct netxen_legacy_intr_set legacy_intr[] = NX_LEGACY_INTR_CONFIG;

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

146
	NXWR32(adapter, sds_ring->crb_intr_mask, 0);
147 148
}

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

153
	NXWR32(adapter, sds_ring->crb_intr_mask, 0x1);
154

155 156 157
	if (!NETXEN_IS_MSI_FAMILY(adapter))
		adapter->pci_write_immediate(adapter,
				adapter->legacy_intr.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 175 176 177
netxen_free_sds_rings(struct netxen_recv_context *recv_ctx)
{
	if (recv_ctx->sds_rings != NULL)
		kfree(recv_ctx->sds_rings);
}

static int
178 179 180 181 182 183
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;

184 185 186
	if (netxen_alloc_sds_rings(recv_ctx, adapter->max_sds_rings))
		return 1;

187 188 189 190 191
	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);
	}
192 193

	return 0;
194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218
}

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];
219
		netxen_nic_disable_int(sds_ring);
220 221
		napi_synchronize(&sds_ring->napi);
		napi_disable(&sds_ring->napi);
222 223 224
	}
}

225 226 227
static int nx_set_dma_mask(struct netxen_adapter *adapter, uint8_t revision_id)
{
	struct pci_dev *pdev = adapter->pdev;
228 229 230
	uint64_t mask, cmask;

	adapter->pci_using_dac = 0;
231

232
	mask = DMA_BIT_MASK(32);
233 234 235 236 237
	/*
	 * Consistent DMA mask is set to 32 bit because it cannot be set to
	 * 35 bits. For P3 also leave it at 32 bits for now. Only the rings
	 * come off this pool.
	 */
238
	cmask = DMA_BIT_MASK(32);
239 240 241

#ifndef CONFIG_IA64
	if (revision_id >= NX_P3_B0)
242
		mask = DMA_BIT_MASK(39);
243
	else if (revision_id == NX_P2_C1)
244
		mask = DMA_BIT_MASK(35);
245
#endif
246
	if (pci_set_dma_mask(pdev, mask) == 0 &&
247
		pci_set_consistent_dma_mask(pdev, cmask) == 0) {
248 249 250 251
		adapter->pci_using_dac = 1;
		return 0;
	}

252 253 254 255 256 257 258 259 260 261 262 263 264
	return -EIO;
}

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

	change = 0;

265
	shift = NXRD32(adapter, CRB_DMA_SHIFT);
266 267 268 269 270 271 272 273 274 275 276 277 278 279 280
	if (shift >= 32)
		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;
		mask = (1ULL<<(32+shift)) - 1;

		err = pci_set_dma_mask(pdev, mask);
		if (err)
			return pci_set_dma_mask(pdev, old_mask);
281 282 283 284 285
	}

	return 0;
}

286 287
static void
netxen_check_options(struct netxen_adapter *adapter)
288
{
289 290 291 292 293 294 295
	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;
	}
296

D
Dhananjay Phadke 已提交
297 298
	adapter->msix_supported = 0;
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) {
299
		adapter->msix_supported = !!use_msi_x;
D
Dhananjay Phadke 已提交
300 301 302 303 304 305 306 307 308 309 310 311
		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;
		}
	}
312

313
	adapter->num_txd = MAX_CMD_DESCRIPTORS;
314

315 316 317 318 319 320 321
	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;
	}
322 323 324 325 326
}

static int
netxen_check_hw_init(struct netxen_adapter *adapter, int first_boot)
{
D
Dhananjay Phadke 已提交
327
	u32 val, timeout;
328 329 330

	if (first_boot == 0x55555555) {
		/* This is the first boot after power up */
331
		NXWR32(adapter, NETXEN_CAM_RAM(0x1fc), NETXEN_BDINFO_MAGIC);
D
Dhananjay Phadke 已提交
332 333 334

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

		/* PCI bus master workaround */
337
		first_boot = NXRD32(adapter, NETXEN_PCIE_REG(0x4));
338 339
		if (!(first_boot & 0x4)) {
			first_boot |= 0x4;
340 341
			NXWR32(adapter, NETXEN_PCIE_REG(0x4), first_boot);
			first_boot = NXRD32(adapter, NETXEN_PCIE_REG(0x4));
342 343 344
		}

		/* This is the first boot after power up */
345
		first_boot = NXRD32(adapter, NETXEN_ROMUSB_GLB_SW_RESET);
346 347
		if (first_boot != 0x80000f) {
			/* clear the register for future unloads/loads */
348
			NXWR32(adapter, NETXEN_CAM_RAM(0x1fc), 0);
D
Dhananjay Phadke 已提交
349
			return -EIO;
350 351
		}

D
Dhananjay Phadke 已提交
352
		/* Start P2 boot loader */
353 354
		val = NXRD32(adapter, NETXEN_ROMUSB_GLB_PEGTUNE_DONE);
		NXWR32(adapter, NETXEN_ROMUSB_GLB_PEGTUNE_DONE, val | 0x1);
D
Dhananjay Phadke 已提交
355 356 357
		timeout = 0;
		do {
			msleep(1);
358
			val = NXRD32(adapter, NETXEN_CAM_RAM(0x1fc));
D
Dhananjay Phadke 已提交
359 360 361 362 363

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

		} while (val == NETXEN_BDINFO_MAGIC);
364
	}
D
Dhananjay Phadke 已提交
365
	return 0;
366 367 368 369 370 371
}

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

372
	val = adapter->ahw.board_type;
373 374 375 376
	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;
377
			NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data);
378 379
		} else if (port_mode == NETXEN_PORT_MODE_XG) {
			data = NETXEN_PORT_MODE_XG;
380
			NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data);
381 382
		} else if (port_mode == NETXEN_PORT_MODE_AUTO_NEG_1G) {
			data = NETXEN_PORT_MODE_AUTO_NEG_1G;
383
			NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data);
384 385
		} else if (port_mode == NETXEN_PORT_MODE_AUTO_NEG_XG) {
			data = NETXEN_PORT_MODE_AUTO_NEG_XG;
386
			NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data);
387 388
		} else {
			data = NETXEN_PORT_MODE_AUTO_NEG;
389
			NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data);
390 391 392 393 394 395 396 397
		}

		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;
		}
398
		NXWR32(adapter, NETXEN_WOL_PORT_MODE, wol_port_mode);
399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417
	}
}

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);
	}
}

418
static void netxen_init_msix_entries(struct netxen_adapter *adapter, int count)
419 420 421
{
	int i;

422
	for (i = 0; i < count; i++)
423 424 425
		adapter->msix_entries[i].entry = i;
}

D
Dhananjay Phadke 已提交
426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450
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 已提交
451 452
	if (!is_valid_ether_addr(netdev->perm_addr))
		dev_warn(&pdev->dev, "Bad MAC address %pM.\n", netdev->dev_addr);
D
Dhananjay Phadke 已提交
453 454 455 456

	return 0;
}

D
Dhananjay Phadke 已提交
457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479
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;
}

480 481 482 483
static void netxen_set_multicast_list(struct net_device *dev)
{
	struct netxen_adapter *adapter = netdev_priv(dev);

D
Dhananjay Phadke 已提交
484
	adapter->set_multi(dev);
485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501
}

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 已提交
502 503 504 505 506
static void
netxen_setup_intr(struct netxen_adapter *adapter)
{
	struct netxen_legacy_intr_set *legacy_intrp;
	struct pci_dev *pdev = adapter->pdev;
507 508 509 510 511 512 513 514 515
	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 已提交
516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531

	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];
	adapter->legacy_intr.int_vec_bit = legacy_intrp->int_vec_bit;
	adapter->legacy_intr.tgt_status_reg = legacy_intrp->tgt_status_reg;
	adapter->legacy_intr.tgt_mask_reg = legacy_intrp->tgt_mask_reg;
	adapter->legacy_intr.pci_int_reg = legacy_intrp->pci_int_reg;

	netxen_set_msix_bit(pdev, 0);

	if (adapter->msix_supported) {

532 533 534 535 536
		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 已提交
537

538 539
			if (adapter->rss_supported)
				adapter->max_sds_rings = num_msix;
D
Dhananjay Phadke 已提交
540

541 542 543 544 545 546 547 548
			dev_info(&pdev->dev, "using msi-x interrupts\n");
			return;
		}

		if (err > 0)
			pci_disable_msix(pdev);

		/* fall through for msi */
D
Dhananjay Phadke 已提交
549
	}
550 551 552 553 554 555

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

	dev_info(&pdev->dev, "using legacy interrupts\n");
	adapter->msix_entries[0].vector = pdev->irq;
D
Dhananjay Phadke 已提交
562 563 564 565 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 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 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 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702
}

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;
	adapter->ahw.qdr_sn_window = -1;
	adapter->ahw.ddr_mn_window = -1;

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

	adapter->hw_write_wx = netxen_nic_hw_write_wx_128M;
	adapter->hw_read_wx = netxen_nic_hw_read_wx_128M;
	adapter->pci_read_immediate = netxen_nic_pci_read_immediate_128M;
	adapter->pci_write_immediate = netxen_nic_pci_write_immediate_128M;
	adapter->pci_set_window = netxen_nic_pci_set_window_128M;
	adapter->pci_mem_read = netxen_nic_pci_mem_read_128M;
	adapter->pci_mem_write = netxen_nic_pci_mem_write_128M;

	/* 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);
	} 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) {
		adapter->hw_write_wx = netxen_nic_hw_write_wx_2M;
		adapter->hw_read_wx = netxen_nic_hw_read_wx_2M;
		adapter->pci_read_immediate = netxen_nic_pci_read_immediate_2M;
		adapter->pci_write_immediate =
			netxen_nic_pci_write_immediate_2M;
		adapter->pci_set_window = netxen_nic_pci_set_window_2M;
		adapter->pci_mem_read = netxen_nic_pci_mem_read_2M;
		adapter->pci_mem_write = netxen_nic_pci_mem_write_2M;

		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;

		adapter->ahw.ddr_mn_window = 0;
		adapter->ahw.qdr_sn_window = 0;

		adapter->ahw.mn_win_crb = 0x100000 + PCIX_MN_WINDOW +
			(pci_func * 0x20);
		adapter->ahw.ms_win_crb = 0x100000 + PCIX_SN_WINDOW;
		if (pci_func < 4)
			adapter->ahw.ms_win_crb += (pci_func * 0x20);
		else
			adapter->ahw.ms_win_crb +=
					0xA0 + ((pci_func - 4) * 0x10);
	} else {
		return -EIO;
	}

	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;

	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;
}

703
static int
D
Dhananjay Phadke 已提交
704
netxen_start_firmware(struct netxen_adapter *adapter, int request_fw)
705 706 707 708
{
	int val, err, first_boot;
	struct pci_dev *pdev = adapter->pdev;

709
	int first_driver = 0;
D
Dhananjay Phadke 已提交
710 711 712 713 714

	if (NX_IS_REVISION_P2(adapter->ahw.revision_id))
		first_driver = (adapter->portnum == 0);
	else
		first_driver = (adapter->ahw.pci_func == 0);
715 716

	if (!first_driver)
717
		goto wait_init;
718

719
	first_boot = NXRD32(adapter, NETXEN_CAM_RAM(0x1fc));
720 721 722 723 724 725 726

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

D
Dhananjay Phadke 已提交
727 728 729
	if (request_fw)
		netxen_request_firmware(adapter);

730 731 732 733
	err = netxen_need_fw_reset(adapter);
	if (err <= 0)
		return err;

734
	if (first_boot != 0x55555555) {
735
		NXWR32(adapter, CRB_CMDPEG_STATE, 0);
736 737 738
		netxen_pinit_from_rom(adapter, 0);
		msleep(1);
	}
739

740
	NXWR32(adapter, CRB_DMA_SHIFT, 0x55555555);
741 742 743
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id))
		netxen_set_port_mode(adapter);

744 745 746 747 748 749
	netxen_load_firmware(adapter);

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

		/* Initialize multicast addr pool owners */
		val = 0x7654;
750
		if (adapter->ahw.port_type == NETXEN_NIC_XGBE)
751
			val |= 0x0f000000;
752
		NXWR32(adapter, NETXEN_MAC_ADDR_CNTL_REG, val);
753 754 755

	}

756
	err = netxen_init_dummy_dma(adapter);
757 758 759 760 761 762 763 764 765
	if (err)
		return err;

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

768
wait_init:
769 770 771
	/* Handshake with the card before we register the devices. */
	err = netxen_phantom_init(adapter, NETXEN_NIC_PEG_TUNE);
	if (err) {
772
		netxen_free_dummy_dma(adapter);
773 774 775
		return err;
	}

776 777 778 779
	nx_update_dma_mask(adapter);

	netxen_nic_get_firmware_info(adapter);

780 781 782
	return 0;
}

783 784 785 786
static int
netxen_nic_request_irq(struct netxen_adapter *adapter)
{
	irq_handler_t handler;
787 788 789
	struct nx_host_sds_ring *sds_ring;
	int err, ring;

790 791
	unsigned long flags = IRQF_SAMPLE_RANDOM;
	struct net_device *netdev = adapter->netdev;
792
	struct netxen_recv_context *recv_ctx = &adapter->recv_ctx;
793 794 795 796 797 798 799 800 801 802 803

	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;

804 805
	for (ring = 0; ring < adapter->max_sds_rings; ring++) {
		sds_ring = &recv_ctx->sds_rings[ring];
806
		sprintf(sds_ring->name, "%s[%d]", netdev->name, ring);
807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827
		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);
	}
828 829
}

830 831 832 833 834 835 836 837 838 839 840 841 842 843
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;
}

844 845 846 847 848 849 850 851 852 853 854
static int
netxen_nic_up(struct netxen_adapter *adapter, struct net_device *netdev)
{
	int err;

	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 已提交
855 856
	if (NX_IS_REVISION_P2(adapter->ahw.revision_id))
		adapter->macaddr_set(adapter, netdev->dev_addr);
857

D
Dhananjay Phadke 已提交
858 859
	adapter->set_multi(netdev);
	adapter->set_mtu(adapter, netdev->mtu);
860 861 862

	adapter->ahw.linkup = 0;

863 864
	if (adapter->max_sds_rings > 1)
		netxen_config_rss(adapter, 1);
865

866 867 868
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id))
		netxen_config_intr_coalesce(adapter);

869 870
	netxen_napi_enable(adapter);

871
	if (adapter->capabilities & NX_FW_CAPABILITY_LINK_NOTIFICATION)
872
		netxen_linkevent_request(adapter, 1);
D
Dhananjay Phadke 已提交
873 874 875 876
	else
		netxen_nic_set_link_parameters(adapter);

	mod_timer(&adapter->watchdog_timer, jiffies);
877

878 879 880 881 882 883
	return 0;
}

static void
netxen_nic_down(struct netxen_adapter *adapter, struct net_device *netdev)
{
884
	spin_lock(&adapter->tx_clean_lock);
885
	netif_carrier_off(netdev);
886
	netif_tx_disable(netdev);
887 888 889 890

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

891 892 893
	if (NX_IS_REVISION_P3(adapter->ahw.revision_id))
		netxen_p3_free_mac_list(adapter);

894 895
	netxen_napi_disable(adapter);

896
	netxen_release_tx_buffers(adapter);
897
	spin_unlock(&adapter->tx_clean_lock);
898 899

	del_timer_sync(&adapter->watchdog_timer);
900
	FLUSH_SCHEDULED_WORK();
901 902 903 904 905 906 907 908
}


static int
netxen_nic_attach(struct netxen_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;
909
	int err, ring;
910
	struct nx_host_rds_ring *rds_ring;
911
	struct nx_host_tx_ring *tx_ring;
912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934

	err = netxen_init_firmware(adapter);
	if (err != 0) {
		printk(KERN_ERR "Failed to init firmware\n");
		return -EIO;
	}

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

	netxen_nic_clear_stats(adapter);

	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;
	}

935
	if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) {
936
		tx_ring = adapter->tx_ring;
937 938
		tx_ring->crb_cmd_producer = crb_cmd_producer[adapter->portnum];
		tx_ring->crb_cmd_consumer = crb_cmd_consumer[adapter->portnum];
939

940 941 942 943 944
		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);
945 946
	}

947 948 949 950
	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);
	}
951 952 953 954 955 956 957 958

	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;
	}

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

962 963 964 965 966 967 968 969 970 971 972 973 974 975 976
	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)
{
	netxen_free_hw_resources(adapter);
977
	netxen_release_rx_buffers(adapter);
978
	netxen_nic_free_irq(adapter);
979 980 981 982 983
	netxen_free_sw_resources(adapter);

	adapter->is_up = 0;
}

A
Amit S. Kale 已提交
984 985 986 987 988
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;
989
	int i = 0, err;
990
	int pci_func_id = PCI_FUNC(pdev->devfn);
991
	uint8_t revision_id;
A
Amit S. Kale 已提交
992

993
	if (pdev->class != 0x020000) {
994
		printk(KERN_DEBUG "NetXen function %d, class %x will not "
995
				"be enabled.\n",pci_func_id, pdev->class);
996 997
		return -ENODEV;
	}
998

D
Dhananjay Phadke 已提交
999 1000 1001 1002 1003 1004 1005
	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 已提交
1006 1007
	if ((err = pci_enable_device(pdev)))
		return err;
1008

A
Amit S. Kale 已提交
1009 1010 1011 1012 1013 1014 1015 1016 1017
	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);
1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028

	netdev = alloc_etherdev(sizeof(struct netxen_adapter));
	if(!netdev) {
		printk(KERN_ERR"%s: Failed to allocate memory for the "
				"device block.Check system memory resource"
				" usage.\n", netxen_nic_driver_name);
		goto err_out_free_res;
	}

	SET_NETDEV_DEV(netdev, &pdev->dev);

1029
	adapter = netdev_priv(netdev);
1030 1031
	adapter->netdev  = netdev;
	adapter->pdev    = pdev;
1032
	adapter->ahw.pci_func  = pci_func_id;
1033 1034 1035 1036 1037 1038 1039 1040

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

	err = nx_set_dma_mask(adapter, revision_id);
	if (err)
		goto err_out_free_netdev;

1041
	rwlock_init(&adapter->adapter_lock);
1042
	spin_lock_init(&adapter->tx_clean_lock);
1043
	INIT_LIST_HEAD(&adapter->mac_list);
1044

D
Dhananjay Phadke 已提交
1045 1046
	err = netxen_setup_pci_map(adapter);
	if (err)
1047
		goto err_out_free_netdev;
A
Amit S. Kale 已提交
1048

1049
	/* This will be reset for mezz cards  */
1050
	adapter->portnum = pci_func_id;
D
Dhananjay Phadke 已提交
1051
	adapter->rx_csum = 1;
1052
	adapter->mc_enabled = 0;
D
Dhananjay Phadke 已提交
1053
	if (NX_IS_REVISION_P3(revision_id))
1054
		adapter->max_mc_count = 38;
D
Dhananjay Phadke 已提交
1055
	else
1056
		adapter->max_mc_count = 16;
1057

1058
	netdev->netdev_ops	   = &netxen_netdev_ops;
D
Dhananjay Phadke 已提交
1059
	netdev->watchdog_timeo     = 2*HZ;
1060 1061 1062 1063

	netxen_nic_change_mtu(netdev, netdev->mtu);

	SET_ETHTOOL_OPS(netdev, &netxen_nic_ethtool_ops);
1064

1065
	netdev->features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO);
A
Amit Kumar Salecha 已提交
1066
	netdev->features |= (NETIF_F_GRO);
1067 1068
	netdev->vlan_features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO);

1069
	if (NX_IS_REVISION_P3(revision_id)) {
1070 1071
		netdev->features |= (NETIF_F_IPV6_CSUM | NETIF_F_TSO6);
		netdev->vlan_features |= (NETIF_F_IPV6_CSUM | NETIF_F_TSO6);
1072
	}
1073

1074
	if (adapter->pci_using_dac) {
1075
		netdev->features |= NETIF_F_HIGHDMA;
1076 1077
		netdev->vlan_features |= NETIF_F_HIGHDMA;
	}
1078

1079 1080
	if (netxen_nic_get_board_info(adapter) != 0) {
		printk("%s: Error getting board config info.\n",
1081
				netxen_nic_driver_name);
1082 1083 1084
		err = -EIO;
		goto err_out_iounmap;
	}
1085 1086 1087

	netxen_initialize_adapter_ops(adapter);

1088
	/* Mezz cards have PCI function 0,2,3 enabled */
1089
	switch (adapter->ahw.board_type) {
1090 1091 1092
	case NETXEN_BRDTYPE_P2_SB31_10G_IMEZ:
	case NETXEN_BRDTYPE_P2_SB31_10G_HMEZ:
		if (pci_func_id >= 2)
1093
			adapter->portnum = pci_func_id - 2;
1094 1095 1096 1097
		break;
	default:
		break;
	}
1098

D
Dhananjay Phadke 已提交
1099
	err = netxen_start_firmware(adapter, 1);
1100 1101
	if (err)
		goto err_out_iounmap;
A
Amit S. Kale 已提交
1102
	/*
1103
	 * See if the firmware gave us a virtual-physical port mapping.
A
Amit S. Kale 已提交
1104
	 */
1105
	adapter->physical_port = adapter->portnum;
1106
	if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) {
1107
		i = NXRD32(adapter, CRB_V2P(adapter->portnum));
1108 1109 1110
		if (i != 0x55555555)
			adapter->physical_port = i;
	}
1111

1112
	netxen_check_options(adapter);
1113

D
Dhananjay Phadke 已提交
1114
	netxen_setup_intr(adapter);
1115

1116 1117
	netdev->irq = adapter->msix_entries[0].vector;

1118 1119
	if (netxen_napi_add(adapter, netdev))
		goto err_out_disable_msi;
1120 1121 1122 1123 1124 1125 1126

	init_timer(&adapter->watchdog_timer);
	adapter->watchdog_timer.function = &netxen_watchdog;
	adapter->watchdog_timer.data = (unsigned long)adapter;
	INIT_WORK(&adapter->watchdog_task, netxen_watchdog_task);
	INIT_WORK(&adapter->tx_timeout_task, netxen_tx_timeout_task);

D
Dhananjay Phadke 已提交
1127 1128 1129
	err = netxen_read_mac_addr(adapter);
	if (err)
		dev_warn(&pdev->dev, "failed to read mac addr\n");
1130

1131 1132 1133
	netif_carrier_off(netdev);
	netif_stop_queue(netdev);

1134 1135 1136 1137 1138
	if ((err = register_netdev(netdev))) {
		printk(KERN_ERR "%s: register_netdev failed port #%d"
			       " aborting\n", netxen_nic_driver_name,
			       adapter->portnum);
		err = -EIO;
1139
		goto err_out_disable_msi;
1140 1141 1142
	}

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

1144
	switch (adapter->ahw.port_type) {
1145 1146 1147 1148 1149 1150 1151 1152
	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 已提交
1153 1154
	}

1155 1156 1157
	return 0;

err_out_disable_msi:
D
Dhananjay Phadke 已提交
1158
	netxen_teardown_intr(adapter);
1159

1160
	netxen_free_dummy_dma(adapter);
A
Amit S. Kale 已提交
1161

1162
err_out_iounmap:
D
Dhananjay Phadke 已提交
1163
	netxen_cleanup_pci_map(adapter);
1164

1165 1166 1167 1168
err_out_free_netdev:
	free_netdev(netdev);

err_out_free_res:
A
Amit S. Kale 已提交
1169
	pci_release_regions(pdev);
1170 1171

err_out_disable_pdev:
1172
	pci_set_drvdata(pdev, NULL);
A
Amit S. Kale 已提交
1173 1174 1175 1176 1177 1178 1179
	pci_disable_device(pdev);
	return err;
}

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

1182
	adapter = pci_get_drvdata(pdev);
A
Amit S. Kale 已提交
1183 1184 1185
	if (adapter == NULL)
		return;

1186 1187
	netdev = adapter->netdev;

1188 1189 1190
	unregister_netdev(netdev);

	if (adapter->is_up == NETXEN_ADAPTER_UP_MAGIC) {
1191
		netxen_nic_detach(adapter);
1192
	}
A
Amit S. Kale 已提交
1193

1194
	if (adapter->portnum == 0)
1195
		netxen_free_dummy_dma(adapter);
1196

D
Dhananjay Phadke 已提交
1197
	netxen_teardown_intr(adapter);
1198
	netxen_free_sds_rings(&adapter->recv_ctx);
1199

D
Dhananjay Phadke 已提交
1200
	netxen_cleanup_pci_map(adapter);
1201

D
Dhananjay Phadke 已提交
1202 1203
	netxen_release_firmware(adapter);

1204
	pci_release_regions(pdev);
1205
	pci_disable_device(pdev);
1206 1207
	pci_set_drvdata(pdev, NULL);

1208
	free_netdev(netdev);
A
Amit S. Kale 已提交
1209 1210
}

1211
#ifdef CONFIG_PM
1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255
static int
netxen_nic_suspend(struct pci_dev *pdev, pm_message_t state)
{

	struct netxen_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;

	netif_device_detach(netdev);

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

	if (adapter->is_up == NETXEN_ADAPTER_UP_MAGIC)
		netxen_nic_detach(adapter);

	pci_save_state(pdev);

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

	pci_disable_device(pdev);
	pci_set_power_state(pdev, pci_choose_state(pdev, state));

	return 0;
}

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;

D
Dhananjay Phadke 已提交
1256
	err = netxen_start_firmware(adapter, 0);
1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275
	if (err) {
		dev_err(&pdev->dev, "failed to start firmware\n");
		return err;
	}

	if (netif_running(netdev)) {
		err = netxen_nic_attach(adapter);
		if (err)
			return err;

		err = netxen_nic_up(adapter, netdev);
		if (err)
			return err;

		netif_device_attach(netdev);
	}

	return 0;
}
1276
#endif
1277

A
Amit S. Kale 已提交
1278 1279
static int netxen_nic_open(struct net_device *netdev)
{
1280
	struct netxen_adapter *adapter = netdev_priv(netdev);
A
Amit S. Kale 已提交
1281 1282
	int err = 0;

1283 1284 1285
	if (adapter->driver_mismatch)
		return -EIO;

A
Amit S. Kale 已提交
1286
	if (adapter->is_up != NETXEN_ADAPTER_UP_MAGIC) {
1287 1288
		err = netxen_nic_attach(adapter);
		if (err)
A
Amit S. Kale 已提交
1289
			return err;
1290
	}
1291

1292 1293 1294
	err = netxen_nic_up(adapter, netdev);
	if (err)
		goto err_out;
D
Dhananjay Phadke 已提交
1295

1296
	netif_start_queue(netdev);
A
Amit S. Kale 已提交
1297 1298

	return 0;
1299

1300 1301
err_out:
	netxen_nic_detach(adapter);
1302
	return err;
A
Amit S. Kale 已提交
1303 1304 1305 1306 1307 1308 1309
}

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

1312
	netxen_nic_down(adapter, netdev);
A
Amit S. Kale 已提交
1313 1314 1315
	return 0;
}

D
Dhananjay Phadke 已提交
1316 1317 1318 1319 1320
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)
1321
{
1322
	u8 opcode = TX_ETHER_PKT;
1323 1324
	__be16 protocol = skb->protocol;
	u16 flags = 0;
D
Dhananjay Phadke 已提交
1325 1326 1327
	u32 producer;
	int copied, offset, copy_len, hdr_len = 0, tso = 0;
	struct cmd_desc_type0 *hwdesc;
1328

1329
	if (protocol == cpu_to_be16(ETH_P_8021Q)) {
1330 1331 1332 1333
		struct vlan_ethhdr *vh = (struct vlan_ethhdr *)skb->data;
		protocol = vh->h_vlan_encapsulated_proto;
		flags = FLAGS_VLAN_TAGGED;
	}
1334

1335 1336 1337
	if ((netdev->features & (NETIF_F_TSO | NETIF_F_TSO6)) &&
			skb_shinfo(skb)->gso_size > 0) {

D
Dhananjay Phadke 已提交
1338 1339 1340 1341
		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;
1342

1343
		opcode = (protocol == cpu_to_be16(ETH_P_IPV6)) ?
1344
				TX_TCP_LSO6 : TX_TCP_LSO;
D
Dhananjay Phadke 已提交
1345
		tso = 1;
1346 1347

	} else if (skb->ip_summed == CHECKSUM_PARTIAL) {
1348 1349
		u8 l4proto;

1350
		if (protocol == cpu_to_be16(ETH_P_IP)) {
1351 1352 1353 1354 1355 1356
			l4proto = ip_hdr(skb)->protocol;

			if (l4proto == IPPROTO_TCP)
				opcode = TX_TCP_PKT;
			else if(l4proto == IPPROTO_UDP)
				opcode = TX_UDP_PKT;
1357
		} else if (protocol == cpu_to_be16(ETH_P_IPV6)) {
1358 1359 1360 1361 1362 1363 1364
			l4proto = ipv6_hdr(skb)->nexthdr;

			if (l4proto == IPPROTO_TCP)
				opcode = TX_TCPV6_PKT;
			else if(l4proto == IPPROTO_UDP)
				opcode = TX_UDPV6_PKT;
		}
1365
	}
D
Dhananjay Phadke 已提交
1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398
	first_desc->tcp_hdr_offset = skb_transport_offset(skb);
	first_desc->ip_hdr_offset = skb_network_offset(skb);
	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;

	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();
1399 1400
}

1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418
static void
netxen_clean_tx_dma_mapping(struct pci_dev *pdev,
		struct netxen_cmd_buffer *pbuf, int last)
{
	int k;
	struct netxen_skb_frag *buffrag;

	buffrag = &pbuf->frag_array[0];
	pci_unmap_single(pdev, buffrag->dma,
			buffrag->length, PCI_DMA_TODEVICE);

	for (k = 1; k < last; k++) {
		buffrag = &pbuf->frag_array[k];
		pci_unmap_page(pdev, buffrag->dma,
			buffrag->length, PCI_DMA_TODEVICE);
	}
}

1419 1420 1421
static inline void
netxen_clear_cmddesc(u64 *desc)
{
D
Dhananjay Phadke 已提交
1422 1423
	desc[0] = 0ULL;
	desc[2] = 0ULL;
1424 1425 1426 1427
}

static int
netxen_nic_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
A
Amit S. Kale 已提交
1428
{
1429
	struct netxen_adapter *adapter = netdev_priv(netdev);
1430
	struct nx_host_tx_ring *tx_ring = adapter->tx_ring;
D
Dhananjay Phadke 已提交
1431
	struct skb_frag_struct *frag;
1432
	struct netxen_cmd_buffer *pbuf;
A
Amit S. Kale 已提交
1433
	struct netxen_skb_frag *buffrag;
D
Dhananjay Phadke 已提交
1434 1435
	struct cmd_desc_type0 *hwdesc, *first_desc;
	struct pci_dev *pdev;
1436
	dma_addr_t temp_dma;
1437
	int i, k;
D
Dhananjay Phadke 已提交
1438
	unsigned long offset;
A
Amit S. Kale 已提交
1439

1440
	u32 producer;
D
Dhananjay Phadke 已提交
1441
	int len, frag_count, no_of_desc;
1442
	u32 num_txd = tx_ring->num_desc;
A
Amit S. Kale 已提交
1443 1444 1445

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

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

1449
	if (unlikely(no_of_desc + 2) > netxen_tx_avail(tx_ring)) {
1450 1451
		netif_stop_queue(netdev);
		return NETDEV_TX_BUSY;
1452
	}
A
Amit S. Kale 已提交
1453

1454 1455
	producer = tx_ring->producer;

D
Dhananjay Phadke 已提交
1456 1457
	pdev = adapter->pdev;
	len = skb->len - skb->data_len;
1458

D
Dhananjay Phadke 已提交
1459 1460 1461
	temp_dma = pci_map_single(pdev, skb->data, len, PCI_DMA_TODEVICE);
	if (pci_dma_mapping_error(pdev, temp_dma))
		goto drop_packet;
1462

D
Dhananjay Phadke 已提交
1463
	pbuf = &tx_ring->cmd_buf_arr[producer];
A
Amit S. Kale 已提交
1464 1465
	pbuf->skb = skb;
	pbuf->frag_count = frag_count;
1466

D
Dhananjay Phadke 已提交
1467
	buffrag = &pbuf->frag_array[0];
1468
	buffrag->dma = temp_dma;
D
Dhananjay Phadke 已提交
1469 1470 1471 1472
	buffrag->length = len;

	first_desc = hwdesc = &tx_ring->desc_head[producer];
	netxen_clear_cmddesc((u64 *)hwdesc);
1473 1474
	netxen_set_tx_frags_len(hwdesc, frag_count, skb->len);
	netxen_set_tx_port(hwdesc, adapter->portnum);
A
Amit S. Kale 已提交
1475

D
Dhananjay Phadke 已提交
1476 1477
	hwdesc->buffer_length[0] = cpu_to_le16(len);
	hwdesc->addr_buffer1 = cpu_to_le64(temp_dma);
A
Amit S. Kale 已提交
1478 1479 1480 1481 1482 1483

	for (i = 1, k = 1; i < frag_count; i++, k++) {

		/* move to next desc. if there is a need */
		if ((i & 0x3) == 0) {
			k = 0;
1484
			producer = get_next_index(producer, num_txd);
1485
			hwdesc = &tx_ring->desc_head[producer];
1486
			netxen_clear_cmddesc((u64 *)hwdesc);
1487
			pbuf = &tx_ring->cmd_buf_arr[producer];
1488
			pbuf->skb = NULL;
A
Amit S. Kale 已提交
1489
		}
D
Dhananjay Phadke 已提交
1490
		buffrag = &pbuf->frag_array[i];
A
Amit S. Kale 已提交
1491 1492 1493 1494
		frag = &skb_shinfo(skb)->frags[i - 1];
		len = frag->size;
		offset = frag->page_offset;

1495
		temp_dma = pci_map_page(pdev, frag->page, offset,
A
Amit S. Kale 已提交
1496
					len, PCI_DMA_TODEVICE);
1497 1498 1499 1500
		if (pci_dma_mapping_error(pdev, temp_dma)) {
			netxen_clean_tx_dma_mapping(pdev, pbuf, i);
			goto drop_packet;
		}
A
Amit S. Kale 已提交
1501 1502

		buffrag->dma = temp_dma;
D
Dhananjay Phadke 已提交
1503
		buffrag->length = len;
A
Amit S. Kale 已提交
1504

D
Dhananjay Phadke 已提交
1505
		hwdesc->buffer_length[k] = cpu_to_le16(len);
A
Amit S. Kale 已提交
1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520
		switch (k) {
		case 0:
			hwdesc->addr_buffer1 = cpu_to_le64(temp_dma);
			break;
		case 1:
			hwdesc->addr_buffer2 = cpu_to_le64(temp_dma);
			break;
		case 2:
			hwdesc->addr_buffer3 = cpu_to_le64(temp_dma);
			break;
		case 3:
			hwdesc->addr_buffer4 = cpu_to_le64(temp_dma);
			break;
		}
	}
D
Dhananjay Phadke 已提交
1521
	tx_ring->producer = get_next_index(producer, num_txd);
A
Amit S. Kale 已提交
1522

D
Dhananjay Phadke 已提交
1523
	netxen_tso_check(netdev, tx_ring, first_desc, skb);
1524

1525
	netxen_nic_update_cmd_producer(adapter, tx_ring);
A
Amit S. Kale 已提交
1526

D
Dhananjay Phadke 已提交
1527
	adapter->stats.txbytes += skb->len;
1528
	adapter->stats.xmitcalled++;
A
Amit S. Kale 已提交
1529 1530

	return NETDEV_TX_OK;
1531 1532 1533 1534 1535

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

1538 1539 1540 1541 1542 1543
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;

1544
	temp = NXRD32(adapter, CRB_TEMP_STATE);
1545 1546 1547 1548 1549 1550 1551 1552

	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",
1553 1554 1555 1556 1557
		       netdev->name, temp_val);

		netif_device_detach(netdev);
		netxen_nic_down(adapter, netdev);
		netxen_nic_detach(adapter);
1558 1559 1560 1561 1562 1563 1564 1565

		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",
1566
			       netdev->name, temp_val);
1567 1568 1569 1570 1571
		}
	} else {
		if (adapter->temp == NX_TEMP_WARN) {
			printk(KERN_INFO
			       "%s: Device temperature is now %d degrees C"
1572
			       " in normal range.\n", netdev->name,
1573 1574 1575 1576 1577 1578 1579
			       temp_val);
		}
	}
	adapter->temp = temp_state;
	return rv;
}

1580
void netxen_advert_link_change(struct netxen_adapter *adapter, int linkup)
1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591
{
	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);
		}
1592

1593 1594 1595
		if (!adapter->has_link_events)
			netxen_nic_set_link_parameters(adapter);

1596 1597 1598 1599 1600 1601 1602 1603
	} 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);
		}
1604

1605 1606
		if (!adapter->has_link_events)
			netxen_nic_set_link_parameters(adapter);
1607 1608 1609
	}
}

1610 1611 1612 1613 1614 1615 1616
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)) {
1617
		val = NXRD32(adapter, CRB_XG_STATE_P3);
1618 1619 1620
		val = XG_LINK_STATE_P3(adapter->ahw.pci_func, val);
		linkup = (val == XG_LINK_UP_P3);
	} else {
1621
		val = NXRD32(adapter, CRB_XG_STATE);
1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632
		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 已提交
1633 1634 1635
static void netxen_watchdog(unsigned long v)
{
	struct netxen_adapter *adapter = (struct netxen_adapter *)v;
1636 1637

	SCHEDULE_WORK(&adapter->watchdog_task);
A
Amit S. Kale 已提交
1638 1639
}

1640 1641 1642 1643 1644
void netxen_watchdog_task(struct work_struct *work)
{
	struct netxen_adapter *adapter =
		container_of(work, struct netxen_adapter, watchdog_task);

1645
	if (netxen_nic_check_temp(adapter))
1646 1647
		return;

1648 1649
	if (!adapter->has_link_events)
		netxen_nic_handle_phy_intr(adapter);
1650

1651 1652
	if (netif_running(adapter->netdev))
		mod_timer(&adapter->watchdog_timer, jiffies + 2 * HZ);
1653 1654
}

A
Amit S. Kale 已提交
1655 1656
static void netxen_tx_timeout(struct net_device *netdev)
{
1657 1658 1659
	struct netxen_adapter *adapter = (struct netxen_adapter *)
						netdev_priv(netdev);
	SCHEDULE_WORK(&adapter->tx_timeout_task);
A
Amit S. Kale 已提交
1660 1661
}

1662
static void netxen_tx_timeout_task(struct work_struct *work)
A
Amit S. Kale 已提交
1663
{
1664
	struct netxen_adapter *adapter =
1665
		container_of(work, struct netxen_adapter, tx_timeout_task);
A
Amit S. Kale 已提交
1666

1667 1668 1669
	if (!netif_running(adapter->netdev))
		return;

A
Amit S. Kale 已提交
1670
	printk(KERN_ERR "%s %s: transmit timeout, resetting.\n",
1671
	       netxen_nic_driver_name, adapter->netdev->name);
A
Amit S. Kale 已提交
1672

1673
	netxen_napi_disable(adapter);
1674

1675
	adapter->netdev->trans_start = jiffies;
1676

1677
	netxen_napi_enable(adapter);
1678
	netif_wake_queue(adapter->netdev);
A
Amit S. Kale 已提交
1679 1680
}

1681 1682 1683 1684 1685 1686 1687 1688
struct net_device_stats *netxen_nic_get_stats(struct net_device *netdev)
{
	struct netxen_adapter *adapter = netdev_priv(netdev);
	struct net_device_stats *stats = &adapter->net_stats;

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

	stats->rx_packets = adapter->stats.no_rcv;
D
Dhananjay Phadke 已提交
1689
	stats->tx_packets = adapter->stats.xmitfinished;
1690 1691 1692 1693 1694 1695 1696 1697
	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;
}

1698
static irqreturn_t netxen_intr(int irq, void *data)
A
Amit S. Kale 已提交
1699
{
1700 1701
	struct nx_host_sds_ring *sds_ring = data;
	struct netxen_adapter *adapter = sds_ring->adapter;
D
Dhananjay Phadke 已提交
1702 1703 1704 1705 1706
	u32 status = 0;

	status = adapter->pci_read_immediate(adapter, ISR_INT_VECTOR);

	if (!(status & adapter->legacy_intr.int_vec_bit))
D
Dhananjay Phadke 已提交
1707
		return IRQ_NONE;
1708

D
Dhananjay Phadke 已提交
1709 1710 1711 1712 1713 1714 1715
	if (adapter->ahw.revision_id >= NX_P3_B1) {
		/* check interrupt state machine, to be sure */
		status = adapter->pci_read_immediate(adapter,
				ISR_INT_STATE_REG);
		if (!ISR_LEGACY_INT_TRIGGERED(status))
			return IRQ_NONE;

1716 1717
	} else {
		unsigned long our_int = 0;
D
Dhananjay Phadke 已提交
1718

1719
		our_int = NXRD32(adapter, CRB_INT_VECTOR);
1720

D
Dhananjay Phadke 已提交
1721
		/* not our interrupt */
1722
		if (!test_and_clear_bit((7 + adapter->portnum), &our_int))
D
Dhananjay Phadke 已提交
1723 1724
			return IRQ_NONE;

1725
		/* claim interrupt */
1726
		NXWR32(adapter, CRB_INT_VECTOR, (our_int & 0xffffffff));
1727 1728
	}

1729
	/* clear interrupt */
1730
	if (NX_IS_REVISION_P2(adapter->ahw.revision_id))
1731
		netxen_nic_disable_int(sds_ring);
1732 1733 1734 1735 1736 1737 1738 1739

	adapter->pci_write_immediate(adapter,
			adapter->legacy_intr.tgt_status_reg,
			0xffffffff);
	/* read twice to ensure write is flushed */
	adapter->pci_read_immediate(adapter, ISR_INT_VECTOR);
	adapter->pci_read_immediate(adapter, ISR_INT_VECTOR);

1740
	napi_schedule(&sds_ring->napi);
A
Amit S. Kale 已提交
1741 1742 1743 1744

	return IRQ_HANDLED;
}

1745
static irqreturn_t netxen_msi_intr(int irq, void *data)
D
Dhananjay Phadke 已提交
1746
{
1747 1748
	struct nx_host_sds_ring *sds_ring = data;
	struct netxen_adapter *adapter = sds_ring->adapter;
D
Dhananjay Phadke 已提交
1749

1750 1751
	/* clear interrupt */
	adapter->pci_write_immediate(adapter,
1752
			adapter->msi_tgt_status, 0xffffffff);
1753

1754
	napi_schedule(&sds_ring->napi);
D
Dhananjay Phadke 已提交
1755 1756 1757
	return IRQ_HANDLED;
}

1758 1759
static irqreturn_t netxen_msix_intr(int irq, void *data)
{
1760
	struct nx_host_sds_ring *sds_ring = data;
1761

1762
	napi_schedule(&sds_ring->napi);
1763 1764 1765
	return IRQ_HANDLED;
}

1766
static int netxen_nic_poll(struct napi_struct *napi, int budget)
A
Amit S. Kale 已提交
1767
{
1768 1769 1770 1771 1772
	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 已提交
1773
	int tx_complete;
1774
	int work_done;
A
Amit S. Kale 已提交
1775

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

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

D
Dhananjay Phadke 已提交
1780
	if ((work_done < budget) && tx_complete) {
1781
		napi_complete(&sds_ring->napi);
1782 1783
		if (netif_running(adapter->netdev))
			netxen_nic_enable_int(sds_ring);
A
Amit S. Kale 已提交
1784 1785
	}

1786
	return work_done;
A
Amit S. Kale 已提交
1787 1788 1789 1790 1791
}

#ifdef CONFIG_NET_POLL_CONTROLLER
static void netxen_nic_poll_controller(struct net_device *netdev)
{
1792
	struct netxen_adapter *adapter = netdev_priv(netdev);
A
Amit S. Kale 已提交
1793
	disable_irq(adapter->irq);
J
Jeff Garzik 已提交
1794
	netxen_intr(adapter->irq, adapter);
A
Amit S. Kale 已提交
1795 1796 1797 1798
	enable_irq(adapter->irq);
}
#endif

1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917
#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;
}

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;
	struct in_device *indev;

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);

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

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

	indev = in_dev_get(dev);
	if (!indev)
		goto done;

	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);
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,
};

A
Amit S. Kale 已提交
1918 1919 1920 1921
static struct pci_driver netxen_driver = {
	.name = netxen_nic_driver_name,
	.id_table = netxen_pci_tbl,
	.probe = netxen_nic_probe,
1922
	.remove = __devexit_p(netxen_nic_remove),
1923
#ifdef CONFIG_PM
1924 1925
	.suspend = netxen_nic_suspend,
	.resume = netxen_nic_resume
1926
#endif
A
Amit S. Kale 已提交
1927 1928 1929 1930
};

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

A
Al Viro 已提交
1933
	if ((netxen_workq = create_singlethread_workqueue("netxen")) == NULL)
1934 1935
		return -ENOMEM;

1936 1937 1938
	register_netdevice_notifier(&netxen_netdev_cb);
	register_inetaddr_notifier(&netxen_inetaddr_cb);

1939
	return pci_register_driver(&netxen_driver);
A
Amit S. Kale 已提交
1940 1941 1942 1943 1944 1945 1946
}

module_init(netxen_init_module);

static void __exit netxen_exit_module(void)
{
	pci_unregister_driver(&netxen_driver);
1947 1948 1949

	unregister_inetaddr_notifier(&netxen_inetaddr_cb);
	unregister_netdevice_notifier(&netxen_netdev_cb);
A
Amit S. Kale 已提交
1950
	destroy_workqueue(netxen_workq);
A
Amit S. Kale 已提交
1951 1952 1953
}

module_exit(netxen_exit_module);