qlcnic_main.c 82.5 KB
Newer Older
1
/*
S
Sritej Velaga 已提交
2 3
 * QLogic qlcnic NIC Driver
 * Copyright (c)  2009-2010 QLogic Corporation
4
 *
S
Sritej Velaga 已提交
5
 * See LICENSE.qlcnic for copyright and licensing details.
6 7 8 9 10 11
 */

#include <linux/vmalloc.h>
#include <linux/interrupt.h>

#include "qlcnic.h"
12
#include "qlcnic_hw.h"
13

14
#include <linux/swab.h>
15
#include <linux/dma-mapping.h>
S
Sony Chacko 已提交
16
#include <linux/if_vlan.h>
17 18 19
#include <net/ip.h>
#include <linux/ipv6.h>
#include <linux/inetdevice.h>
S
Sucheta Chakraborty 已提交
20
#include <linux/aer.h>
21
#include <linux/log2.h>
22
#include <linux/pci.h>
23

24
MODULE_DESCRIPTION("QLogic 1/10 GbE Converged/Intelligent Ethernet Driver");
25 26 27 28 29
MODULE_LICENSE("GPL");
MODULE_VERSION(QLCNIC_LINUX_VERSIONID);
MODULE_FIRMWARE(QLCNIC_UNIFIED_ROMIMAGE_NAME);

char qlcnic_driver_name[] = "qlcnic";
30 31
static const char qlcnic_driver_string[] = "QLogic 1/10 GbE "
	"Converged/Intelligent Ethernet Driver v" QLCNIC_LINUX_VERSIONID;
32

33
static int qlcnic_mac_learn;
34
module_param(qlcnic_mac_learn, int, 0444);
35 36
MODULE_PARM_DESC(qlcnic_mac_learn, "Mac Filter (0=disabled, 1=enabled)");

37
int qlcnic_use_msi = 1;
38
MODULE_PARM_DESC(use_msi, "MSI interrupt (0=disabled, 1=enabled");
39
module_param_named(use_msi, qlcnic_use_msi, int, 0444);
40

41
int qlcnic_use_msi_x = 1;
42
MODULE_PARM_DESC(use_msi_x, "MSI-X interrupt (0=disabled, 1=enabled");
43
module_param_named(use_msi_x, qlcnic_use_msi_x, int, 0444);
44

45
int qlcnic_auto_fw_reset = 1;
46
MODULE_PARM_DESC(auto_fw_reset, "Auto firmware reset (0=disabled, 1=enabled");
47
module_param_named(auto_fw_reset, qlcnic_auto_fw_reset, int, 0644);
48

49
int qlcnic_load_fw_file;
50
MODULE_PARM_DESC(load_fw_file, "Load firmware from (0=flash, 1=file");
51
module_param_named(load_fw_file, qlcnic_load_fw_file, int, 0444);
52

53
int qlcnic_config_npars;
54
module_param(qlcnic_config_npars, int, 0444);
55 56
MODULE_PARM_DESC(qlcnic_config_npars, "Configure NPARs (0=disabled, 1=enabled");

57
static int qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent);
B
Bill Pemberton 已提交
58
static void qlcnic_remove(struct pci_dev *pdev);
59 60 61 62 63 64 65 66 67 68
static int qlcnic_open(struct net_device *netdev);
static int qlcnic_close(struct net_device *netdev);
static void qlcnic_tx_timeout(struct net_device *netdev);
static void qlcnic_attach_work(struct work_struct *work);
static void qlcnic_fwinit_work(struct work_struct *work);
static void qlcnic_fw_poll_work(struct work_struct *work);
#ifdef CONFIG_NET_POLL_CONTROLLER
static void qlcnic_poll_controller(struct net_device *netdev);
#endif

69
static void qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding);
70
static void qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8);
71 72
static int qlcnic_can_start_firmware(struct qlcnic_adapter *adapter);

73
static irqreturn_t qlcnic_tmp_intr(int irq, void *data);
74 75 76
static irqreturn_t qlcnic_intr(int irq, void *data);
static irqreturn_t qlcnic_msi_intr(int irq, void *data);
static irqreturn_t qlcnic_msix_intr(int irq, void *data);
S
Sony Chacko 已提交
77
static irqreturn_t qlcnic_msix_tx_intr(int irq, void *data);
78 79

static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev);
80 81
static int qlcnic_start_firmware(struct qlcnic_adapter *);

82
static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter);
83 84
static void qlcnic_dev_set_npar_ready(struct qlcnic_adapter *);
static int qlcnicvf_start_firmware(struct qlcnic_adapter *);
85 86
static void qlcnic_set_netdev_features(struct qlcnic_adapter *,
				struct qlcnic_esw_func_cfg *);
87 88
static int qlcnic_vlan_rx_add(struct net_device *, u16);
static int qlcnic_vlan_rx_del(struct net_device *, u16);
89

90 91 92
#define QLCNIC_IS_TSO_CAPABLE(adapter)	\
	((adapter)->ahw->capabilities & QLCNIC_FW_CAPABILITY_TSO)

S
Sony Chacko 已提交
93 94 95 96 97 98 99 100 101 102
static u32 qlcnic_vlan_tx_check(struct qlcnic_adapter *adapter)
{
	struct qlcnic_hardware_context *ahw = adapter->ahw;

	if (adapter->pdev->device == PCI_DEVICE_ID_QLOGIC_QLE824X)
		return ahw->capabilities & QLCNIC_FW_CAPABILITY_FVLANTX;
	else
		return 1;
}

103 104 105 106 107
/*  PCI Device ID Table  */
#define ENTRY(device) \
	{PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, (device)), \
	.class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0}

108
static DEFINE_PCI_DEVICE_TABLE(qlcnic_pci_tbl) = {
109
	ENTRY(PCI_DEVICE_ID_QLOGIC_QLE824X),
S
Sony Chacko 已提交
110
	ENTRY(PCI_DEVICE_ID_QLOGIC_QLE834X),
111 112 113 114 115 116
	{0,}
};

MODULE_DEVICE_TABLE(pci, qlcnic_pci_tbl);


S
Sony Chacko 已提交
117
inline void qlcnic_update_cmd_producer(struct qlcnic_host_tx_ring *tx_ring)
118 119 120 121 122 123 124 125 126 127 128
{
	writel(tx_ring->producer, tx_ring->crb_cmd_producer);
}

static const u32 msi_tgt_status[8] = {
	ISR_INT_TARGET_STATUS, ISR_INT_TARGET_STATUS_F1,
	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
};

129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154
static const u32 qlcnic_reg_tbl[] = {
	0x1B20A8,	/* PEG_HALT_STAT1 */
	0x1B20AC,	/* PEG_HALT_STAT2 */
	0x1B20B0,	/* FW_HEARTBEAT */
	0x1B2100,	/* LOCK ID */
	0x1B2128,	/* FW_CAPABILITIES */
	0x1B2138,	/* drv active */
	0x1B2140,	/* dev state */
	0x1B2144,	/* drv state */
	0x1B2148,	/* drv scratch */
	0x1B214C,	/* dev partition info */
	0x1B2174,	/* drv idc ver */
	0x1B2150,	/* fw version major */
	0x1B2154,	/* fw version minor */
	0x1B2158,	/* fw version sub */
	0x1B219C,	/* npar state */
	0x1B21FC,	/* FW_IMG_VALID */
	0x1B2250,	/* CMD_PEG_STATE */
	0x1B233C,	/* RCV_PEG_STATE */
	0x1B23B4,	/* ASIC TEMP */
	0x1B216C,	/* FW api */
	0x1B2170,	/* drv op mode */
	0x13C010,	/* flash lock */
	0x13C014,	/* flash unlock */
};

S
Sony Chacko 已提交
155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177
static const struct qlcnic_board_info qlcnic_boards[] = {
	{0x1077, 0x8020, 0x1077, 0x203,
	 "8200 Series Single Port 10GbE Converged Network Adapter"
	 "(TCP/IP Networking)"},
	{0x1077, 0x8020, 0x1077, 0x207,
	 "8200 Series Dual Port 10GbE Converged Network Adapter"
	 "(TCP/IP Networking)"},
	{0x1077, 0x8020, 0x1077, 0x20b,
	 "3200 Series Dual Port 10Gb Intelligent Ethernet Adapter"},
	{0x1077, 0x8020, 0x1077, 0x20c,
	 "3200 Series Quad Port 1Gb Intelligent Ethernet Adapter"},
	{0x1077, 0x8020, 0x1077, 0x20f,
	 "3200 Series Single Port 10Gb Intelligent Ethernet Adapter"},
	{0x1077, 0x8020, 0x103c, 0x3733,
	 "NC523SFP 10Gb 2-port Server Adapter"},
	{0x1077, 0x8020, 0x103c, 0x3346,
	 "CN1000Q Dual Port Converged Network Adapter"},
	{0x1077, 0x8020, 0x1077, 0x210,
	 "QME8242-k 10GbE Dual Port Mezzanine Card"},
	{0x1077, 0x8020, 0x0, 0x0, "cLOM8214 1/10GbE Controller"},
};

#define NUM_SUPPORTED_BOARDS ARRAY_SIZE(qlcnic_boards)
S
Sony Chacko 已提交
178
#define QLC_MAX_SDS_RINGS	8
S
Sony Chacko 已提交
179

180 181 182
static const
struct qlcnic_legacy_intr_set legacy_intr[] = QLCNIC_LEGACY_INTR_CONFIG;

183
int qlcnic_alloc_sds_rings(struct qlcnic_recv_context *recv_ctx, int count)
184 185 186 187 188
{
	int size = sizeof(struct qlcnic_host_sds_ring) * count;

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

189
	return recv_ctx->sds_rings == NULL;
190 191
}

192
void qlcnic_free_sds_rings(struct qlcnic_recv_context *recv_ctx)
193 194 195 196 197 198 199 200 201 202
{
	if (recv_ctx->sds_rings != NULL)
		kfree(recv_ctx->sds_rings);

	recv_ctx->sds_rings = NULL;
}

static int
qlcnic_read_mac_addr(struct qlcnic_adapter *adapter)
{
203
	u8 mac_addr[ETH_ALEN];
204 205 206
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;

R
Rajesh Borundia 已提交
207
	if (qlcnic_get_mac_address(adapter, mac_addr) != 0)
208 209
		return -EIO;

210
	memcpy(netdev->dev_addr, mac_addr, ETH_ALEN);
211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227
	memcpy(netdev->perm_addr, netdev->dev_addr, netdev->addr_len);
	memcpy(adapter->mac_addr, netdev->dev_addr, netdev->addr_len);

	/* set station address */

	if (!is_valid_ether_addr(netdev->perm_addr))
		dev_warn(&pdev->dev, "Bad MAC address %pM.\n",
					netdev->dev_addr);

	return 0;
}

static int qlcnic_set_mac(struct net_device *netdev, void *p)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	struct sockaddr *addr = p;

228 229 230
	if ((adapter->flags & QLCNIC_MAC_OVERRIDE_DISABLED))
		return -EOPNOTSUPP;

231
	if (!is_valid_ether_addr(addr->sa_data))
S
Sony Chacko 已提交
232
		return -EINVAL;
233

234
	if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
235 236 237 238 239 240 241 242
		netif_device_detach(netdev);
		qlcnic_napi_disable(adapter);
	}

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

243
	if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
244 245 246 247 248 249
		netif_device_attach(netdev);
		qlcnic_napi_enable(adapter);
	}
	return 0;
}

250 251 252 253 254 255 256 257
static void qlcnic_82xx_cancel_idc_work(struct qlcnic_adapter *adapter)
{
	while (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
		usleep_range(10000, 11000);

	cancel_delayed_work_sync(&adapter->fw_work);
}

258 259 260 261 262 263
static const struct net_device_ops qlcnic_netdev_ops = {
	.ndo_open	   = qlcnic_open,
	.ndo_stop	   = qlcnic_close,
	.ndo_start_xmit    = qlcnic_xmit_frame,
	.ndo_get_stats	   = qlcnic_get_stats,
	.ndo_validate_addr = eth_validate_addr,
264
	.ndo_set_rx_mode   = qlcnic_set_multi,
265 266
	.ndo_set_mac_address    = qlcnic_set_mac,
	.ndo_change_mtu	   = qlcnic_change_mtu,
267 268
	.ndo_fix_features  = qlcnic_fix_features,
	.ndo_set_features  = qlcnic_set_features,
269
	.ndo_tx_timeout	   = qlcnic_tx_timeout,
270 271
	.ndo_vlan_rx_add_vid	= qlcnic_vlan_rx_add,
	.ndo_vlan_rx_kill_vid	= qlcnic_vlan_rx_del,
272 273 274 275 276
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller = qlcnic_poll_controller,
#endif
};

277 278 279 280
static const struct net_device_ops qlcnic_netdev_failed_ops = {
	.ndo_open	   = qlcnic_open,
};

281
static struct qlcnic_nic_template qlcnic_ops = {
282 283 284 285 286 287
	.config_bridged_mode	= qlcnic_config_bridged_mode,
	.config_led		= qlcnic_82xx_config_led,
	.start_firmware		= qlcnic_82xx_start_firmware,
	.request_reset		= qlcnic_82xx_dev_request_reset,
	.cancel_idc_work	= qlcnic_82xx_cancel_idc_work,
	.napi_add		= qlcnic_82xx_napi_add,
S
Sony Chacko 已提交
288
	.napi_del		= qlcnic_82xx_napi_del,
289 290 291 292 293 294 295 296
	.config_ipaddr		= qlcnic_82xx_config_ipaddr,
	.clear_legacy_intr	= qlcnic_82xx_clear_legacy_intr,
};

struct qlcnic_nic_template qlcnic_vf_ops = {
	.config_bridged_mode	= qlcnicvf_config_bridged_mode,
	.config_led		= qlcnicvf_config_led,
	.start_firmware		= qlcnicvf_start_firmware
297 298
};

299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330
static struct qlcnic_hardware_ops qlcnic_hw_ops = {
	.read_crb			= qlcnic_82xx_read_crb,
	.write_crb			= qlcnic_82xx_write_crb,
	.read_reg			= qlcnic_82xx_hw_read_wx_2M,
	.write_reg			= qlcnic_82xx_hw_write_wx_2M,
	.get_mac_address		= qlcnic_82xx_get_mac_address,
	.setup_intr			= qlcnic_82xx_setup_intr,
	.alloc_mbx_args			= qlcnic_82xx_alloc_mbx_args,
	.mbx_cmd			= qlcnic_82xx_issue_cmd,
	.get_func_no			= qlcnic_82xx_get_func_no,
	.api_lock			= qlcnic_82xx_api_lock,
	.api_unlock			= qlcnic_82xx_api_unlock,
	.add_sysfs			= qlcnic_82xx_add_sysfs,
	.remove_sysfs			= qlcnic_82xx_remove_sysfs,
	.process_lb_rcv_ring_diag	= qlcnic_82xx_process_rcv_ring_diag,
	.create_rx_ctx			= qlcnic_82xx_fw_cmd_create_rx_ctx,
	.create_tx_ctx			= qlcnic_82xx_fw_cmd_create_tx_ctx,
	.setup_link_event		= qlcnic_82xx_linkevent_request,
	.get_nic_info			= qlcnic_82xx_get_nic_info,
	.get_pci_info			= qlcnic_82xx_get_pci_info,
	.set_nic_info			= qlcnic_82xx_set_nic_info,
	.change_macvlan			= qlcnic_82xx_sre_macaddr_change,
	.napi_enable			= qlcnic_82xx_napi_enable,
	.napi_disable			= qlcnic_82xx_napi_disable,
	.config_intr_coal		= qlcnic_82xx_config_intr_coalesce,
	.config_rss			= qlcnic_82xx_config_rss,
	.config_hw_lro			= qlcnic_82xx_config_hw_lro,
	.config_loopback		= qlcnic_82xx_set_lb_mode,
	.clear_loopback			= qlcnic_82xx_clear_lb_mode,
	.config_promisc_mode		= qlcnic_82xx_nic_set_promisc,
	.change_l2_filter		= qlcnic_82xx_change_filter,
	.get_board_info			= qlcnic_82xx_get_board_info,
331 332
};

333
int qlcnic_enable_msix(struct qlcnic_adapter *adapter, u32 num_msix)
334 335
{
	struct pci_dev *pdev = adapter->pdev;
S
Sony Chacko 已提交
336 337 338 339 340 341 342 343 344 345 346 347
	int err = -1, i;
	int max_tx_rings;

	if (!adapter->msix_entries) {
		adapter->msix_entries = kcalloc(num_msix,
						sizeof(struct msix_entry),
						GFP_KERNEL);
		if (!adapter->msix_entries) {
			dev_err(&pdev->dev, "failed allocating msix_entries\n");
			return -ENOMEM;
		}
	}
348 349 350 351

	adapter->max_sds_rings = 1;
	adapter->flags &= ~(QLCNIC_MSI_ENABLED | QLCNIC_MSIX_ENABLED);

352
	if (adapter->ahw->msix_supported) {
353
 enable_msix:
S
Sony Chacko 已提交
354 355
		for (i = 0; i < num_msix; i++)
			adapter->msix_entries[i].entry = i;
356 357 358
		err = pci_enable_msix(pdev, adapter->msix_entries, num_msix);
		if (err == 0) {
			adapter->flags |= QLCNIC_MSIX_ENABLED;
S
Sony Chacko 已提交
359 360 361 362 363 364 365 366 367
			if (qlcnic_83xx_check(adapter)) {
				adapter->ahw->num_msix = num_msix;
				/* subtract mail box and tx ring vectors */
				max_tx_rings = adapter->max_drv_tx_rings;
				adapter->max_sds_rings = num_msix -
							 max_tx_rings - 1;
			} else {
				adapter->max_sds_rings = num_msix;
			}
368
			dev_info(&pdev->dev, "using msi-x interrupts\n");
369
			return err;
S
Sony Chacko 已提交
370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387
		} else if (err > 0) {
			dev_info(&pdev->dev,
				 "Unable to allocate %d MSI-X interrupt vectors\n",
				 num_msix);
			if (qlcnic_83xx_check(adapter)) {
				if (err < QLC_83XX_MINIMUM_VECTOR)
					return err;
				err -= (adapter->max_drv_tx_rings + 1);
				num_msix = rounddown_pow_of_two(err);
				num_msix += (adapter->max_drv_tx_rings + 1);
			} else {
				num_msix = rounddown_pow_of_two(err);
			}

			if (num_msix) {
				dev_info(&pdev->dev,
					 "Trying %d MSI-X interrupt vectors\n",
					 num_msix);
388
				goto enable_msix;
S
Sony Chacko 已提交
389 390 391 392
			}
		} else {
			dev_info(&pdev->dev, "Failed to get %d vectors\n",
				 num_msix);
393 394
		}
	}
S
Sony Chacko 已提交
395

396 397
	return err;
}
398

399 400
static void qlcnic_enable_msi_legacy(struct qlcnic_adapter *adapter)
{
401
	u32 offset, mask_reg;
402
	const struct qlcnic_legacy_intr_set *legacy_intrp;
403
	struct qlcnic_hardware_context *ahw = adapter->ahw;
404
	struct pci_dev *pdev = adapter->pdev;
405

406
	if (qlcnic_use_msi && !pci_enable_msi(pdev)) {
407
		adapter->flags |= QLCNIC_MSI_ENABLED;
408 409 410
		offset = msi_tgt_status[adapter->ahw->pci_func];
		adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter->ahw,
							    offset);
411 412 413 414 415
		dev_info(&pdev->dev, "using msi interrupts\n");
		adapter->msix_entries[0].vector = pdev->irq;
		return;
	}

416
	legacy_intrp = &legacy_intr[adapter->ahw->pci_func];
417
	adapter->ahw->int_vec_bit = legacy_intrp->int_vec_bit;
418 419 420 421 422 423
	offset = legacy_intrp->tgt_status_reg;
	adapter->tgt_status_reg = qlcnic_get_ioaddr(ahw, offset);
	mask_reg = legacy_intrp->tgt_mask_reg;
	adapter->tgt_mask_reg = qlcnic_get_ioaddr(ahw, mask_reg);
	adapter->isr_int_vec = qlcnic_get_ioaddr(ahw, ISR_INT_VECTOR);
	adapter->crb_int_state_reg = qlcnic_get_ioaddr(ahw, ISR_INT_STATE_REG);
424 425 426 427
	dev_info(&pdev->dev, "using legacy interrupts\n");
	adapter->msix_entries[0].vector = pdev->irq;
}

428
int qlcnic_82xx_setup_intr(struct qlcnic_adapter *adapter, u8 num_intr)
429
{
430
	int num_msix, err;
431

432 433 434 435
	if (!num_intr)
		num_intr = QLCNIC_DEF_NUM_STS_DESC_RINGS;

	if (adapter->ahw->msix_supported)
436
		num_msix = rounddown_pow_of_two(min_t(int, num_online_cpus(),
437 438
						num_intr));
	else
439 440
		num_msix = 1;

441 442 443
	err = qlcnic_enable_msix(adapter, num_msix);
	if (err == -ENOMEM || !err)
		return err;
444 445

	qlcnic_enable_msi_legacy(adapter);
446
	return 0;
447
}
S
Sony Chacko 已提交
448

S
Sony Chacko 已提交
449
void qlcnic_teardown_intr(struct qlcnic_adapter *adapter)
450 451 452 453 454
{
	if (adapter->flags & QLCNIC_MSIX_ENABLED)
		pci_disable_msix(adapter->pdev);
	if (adapter->flags & QLCNIC_MSI_ENABLED)
		pci_disable_msi(adapter->pdev);
S
Sony Chacko 已提交
455 456 457 458 459 460 461 462

	kfree(adapter->msix_entries);
	adapter->msix_entries = NULL;

	if (adapter->ahw->intr_tbl) {
		vfree(adapter->ahw->intr_tbl);
		adapter->ahw->intr_tbl = NULL;
	}
463 464 465 466 467
}

static void
qlcnic_cleanup_pci_map(struct qlcnic_adapter *adapter)
{
A
Anirban Chakraborty 已提交
468 469
	if (adapter->ahw->pci_base0 != NULL)
		iounmap(adapter->ahw->pci_base0);
470 471
}

472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499
static int qlcnic_get_act_pci_func(struct qlcnic_adapter *adapter)
{
	struct qlcnic_pci_info *pci_info;
	int ret;

	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED)) {
		switch (adapter->ahw->port_type) {
		case QLCNIC_GBE:
			adapter->ahw->act_pci_func = QLCNIC_NIU_MAX_GBE_PORTS;
			break;
		case QLCNIC_XGBE:
			adapter->ahw->act_pci_func = QLCNIC_NIU_MAX_XG_PORTS;
			break;
		}
		return 0;
	}

	if (adapter->ahw->op_mode == QLCNIC_MGMT_FUNC)
		return 0;

	pci_info = kcalloc(QLCNIC_MAX_PCI_FUNC, sizeof(*pci_info), GFP_KERNEL);
	if (!pci_info)
		return -ENOMEM;

	ret = qlcnic_get_pci_info(adapter, pci_info);
	kfree(pci_info);
	return ret;
}
500 501

int qlcnic_init_pci_info(struct qlcnic_adapter *adapter)
502
{
D
Dan Carpenter 已提交
503
	struct qlcnic_pci_info *pci_info;
504 505
	int i, ret = 0, j = 0;
	u16 act_pci_func;
506 507
	u8 pfn;

D
Dan Carpenter 已提交
508 509 510 511
	pci_info = kcalloc(QLCNIC_MAX_PCI_FUNC, sizeof(*pci_info), GFP_KERNEL);
	if (!pci_info)
		return -ENOMEM;

512 513 514 515 516 517
	ret = qlcnic_get_pci_info(adapter, pci_info);
	if (ret)
		goto err_pci_info;

	act_pci_func = adapter->ahw->act_pci_func;

518
	adapter->npars = kzalloc(sizeof(struct qlcnic_npar_info) *
519
				 act_pci_func, GFP_KERNEL);
D
Dan Carpenter 已提交
520
	if (!adapter->npars) {
521
		ret = -ENOMEM;
D
Dan Carpenter 已提交
522 523
		goto err_pci_info;
	}
524

525
	adapter->eswitch = kzalloc(sizeof(struct qlcnic_eswitch) *
526 527
				QLCNIC_NIU_MAX_XG_PORTS, GFP_KERNEL);
	if (!adapter->eswitch) {
528
		ret = -ENOMEM;
529
		goto err_npars;
530 531
	}

532 533
	for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
		pfn = pci_info[i].id;
534

535
		if (pfn >= QLCNIC_MAX_PCI_FUNC) {
S
Sony Chacko 已提交
536 537 538
			ret = QL_STATUS_INVALID_PARAM;
			goto err_eswitch;
		}
539 540 541 542 543 544 545 546 547 548 549 550

		if (!pci_info[i].active ||
		    (pci_info[i].type != QLCNIC_TYPE_NIC))
			continue;

		adapter->npars[j].pci_func = pfn;
		adapter->npars[j].active = (u8)pci_info[i].active;
		adapter->npars[j].type = (u8)pci_info[i].type;
		adapter->npars[j].phy_port = (u8)pci_info[i].default_port;
		adapter->npars[j].min_bw = pci_info[i].tx_min_bw;
		adapter->npars[j].max_bw = pci_info[i].tx_max_bw;
		j++;
551 552
	}

S
Sony Chacko 已提交
553
	for (i = 0; i < QLCNIC_NIU_MAX_XG_PORTS; i++) {
554
		adapter->eswitch[i].flags |= QLCNIC_SWITCH_ENABLE;
S
Sony Chacko 已提交
555 556 557
		if (qlcnic_83xx_check(adapter))
			qlcnic_enable_eswitch(adapter, i, 1);
	}
558

D
Dan Carpenter 已提交
559
	kfree(pci_info);
560 561 562
	return 0;

err_eswitch:
563 564
	kfree(adapter->eswitch);
	adapter->eswitch = NULL;
565
err_npars:
566
	kfree(adapter->npars);
567
	adapter->npars = NULL;
D
Dan Carpenter 已提交
568 569
err_pci_info:
	kfree(pci_info);
570 571 572 573

	return ret;
}

574 575 576 577 578 579
static int
qlcnic_set_function_modes(struct qlcnic_adapter *adapter)
{
	u8 id;
	int i, ret = 1;
	u32 data = QLCNIC_MGMT_FUNC;
580
	struct qlcnic_hardware_context *ahw = adapter->ahw;
581 582 583 584 585

	ret = qlcnic_api_lock(adapter);
	if (ret)
		goto err_lock;

586
	if (qlcnic_config_npars) {
587 588 589
		for (i = 0; i < ahw->act_pci_func; i++) {
			id = adapter->npars[i].pci_func;
			if (id == ahw->pci_func)
590 591 592 593 594
				continue;
			data |= (qlcnic_config_npars &
					QLC_DEV_SET_DRV(0xf, id));
		}
	} else {
595
		data = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
596
		data = (data & ~QLC_DEV_SET_DRV(0xf, ahw->pci_func)) |
597
			(QLC_DEV_SET_DRV(QLCNIC_MGMT_FUNC,
598
					 ahw->pci_func));
599
	}
600
	QLC_SHARED_REG_WR32(adapter, QLCNIC_DRV_OP_MODE, data);
601 602 603 604 605
	qlcnic_api_unlock(adapter);
err_lock:
	return ret;
}

S
Sony Chacko 已提交
606 607
static void qlcnic_check_vf(struct qlcnic_adapter *adapter,
			    const struct pci_device_id *ent)
608 609 610 611
{
	u32 op_mode, priv_level;

	/* Determine FW API version */
S
Sony Chacko 已提交
612 613
	adapter->ahw->fw_hal_version = QLC_SHARED_REG_RD32(adapter,
							   QLCNIC_FW_API);
614 615

	/* Find PCI function number */
S
Sony Chacko 已提交
616
	qlcnic_get_func_no(adapter);
617 618

	/* Determine function privilege level */
S
Sony Chacko 已提交
619
	op_mode = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
620
	if (op_mode == QLC_DEV_DRV_DEFAULT)
621
		priv_level = QLCNIC_MGMT_FUNC;
622
	else
A
Anirban Chakraborty 已提交
623
		priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
624

625
	if (priv_level == QLCNIC_NON_PRIV_FUNC) {
626
		adapter->ahw->op_mode = QLCNIC_NON_PRIV_FUNC;
627 628
		dev_info(&adapter->pdev->dev,
			"HAL Version: %d Non Privileged function\n",
629
			 adapter->ahw->fw_hal_version);
630
		adapter->nic_ops = &qlcnic_vf_ops;
631 632
	} else
		adapter->nic_ops = &qlcnic_ops;
633 634
}

635
#define QLCNIC_82XX_BAR0_LENGTH 0x00200000UL
S
Sony Chacko 已提交
636
#define QLCNIC_83XX_BAR0_LENGTH 0x4000
637 638 639 640 641 642
static void qlcnic_get_bar_length(u32 dev_id, ulong *bar)
{
	switch (dev_id) {
	case PCI_DEVICE_ID_QLOGIC_QLE824X:
		*bar = QLCNIC_82XX_BAR0_LENGTH;
		break;
S
Sony Chacko 已提交
643 644 645
	case PCI_DEVICE_ID_QLOGIC_QLE834X:
		*bar = QLCNIC_83XX_BAR0_LENGTH;
		break;
646 647 648 649 650 651 652
	default:
		*bar = 0;
	}
}

static int qlcnic_setup_pci_map(struct pci_dev *pdev,
				struct qlcnic_hardware_context *ahw)
653
{
654
	u32 offset;
655
	void __iomem *mem_ptr0 = NULL;
656
	unsigned long mem_len, pci_len0 = 0, bar0_len;
657 658 659 660

	/* remap phys address */
	mem_len = pci_resource_len(pdev, 0);

661 662
	qlcnic_get_bar_length(pdev->device, &bar0_len);
	if (mem_len >= bar0_len) {
663 664 665 666 667 668 669 670 671 672 673 674

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

	dev_info(&pdev->dev, "%dMB memory map\n", (int)(mem_len>>20));
675

676 677 678 679
	ahw->pci_base0 = mem_ptr0;
	ahw->pci_len0 = pci_len0;
	offset = QLCNIC_PCIX_PS_REG(PCIX_OCM_WINDOW_REG(ahw->pci_func));
	qlcnic_get_ioaddr(ahw, offset);
680 681 682 683

	return 0;
}

S
Sony Chacko 已提交
684
static void qlcnic_get_board_name(struct qlcnic_adapter *adapter, char *name)
685 686 687 688 689 690 691 692 693
{
	struct pci_dev *pdev = adapter->pdev;
	int i, found = 0;

	for (i = 0; i < NUM_SUPPORTED_BOARDS; ++i) {
		if (qlcnic_boards[i].vendor == pdev->vendor &&
			qlcnic_boards[i].device == pdev->device &&
			qlcnic_boards[i].sub_vendor == pdev->subsystem_vendor &&
			qlcnic_boards[i].sub_device == pdev->subsystem_device) {
694 695 696
				sprintf(name, "%pM: %s" ,
					adapter->mac_addr,
					qlcnic_boards[i].short_name);
697 698 699 700 701 702 703
				found = 1;
				break;
		}

	}

	if (!found)
704
		sprintf(name, "%pM Gigabit Ethernet", adapter->mac_addr);
705 706 707 708 709
}

static void
qlcnic_check_options(struct qlcnic_adapter *adapter)
{
710
	int err;
711
	u32 fw_major, fw_minor, fw_build, prev_fw_version;
712
	struct pci_dev *pdev = adapter->pdev;
713 714
	struct qlcnic_hardware_context *ahw = adapter->ahw;
	struct qlcnic_fw_dump *fw_dump = &ahw->fw_dump;
715 716

	prev_fw_version = adapter->fw_version;
717

718 719 720
	fw_major = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MAJOR);
	fw_minor = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MINOR);
	fw_build = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_SUB);
721 722 723

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

724 725 726 727 728 729
	err = qlcnic_get_board_info(adapter);
	if (err) {
		dev_err(&pdev->dev, "Error getting board config info.\n");
		return;
	}
	if (ahw->op_mode != QLCNIC_NON_PRIV_FUNC) {
730 731 732 733 734 735 736 737 738 739
		if (fw_dump->tmpl_hdr == NULL ||
				adapter->fw_version > prev_fw_version) {
			if (fw_dump->tmpl_hdr)
				vfree(fw_dump->tmpl_hdr);
			if (!qlcnic_fw_cmd_get_minidump_temp(adapter))
				dev_info(&pdev->dev,
					"Supports FW dump capability\n");
		}
	}

S
Sony Chacko 已提交
740 741 742
	dev_info(&pdev->dev, "Driver v%s, firmware v%d.%d.%d\n",
		 QLCNIC_LINUX_VERSIONID, fw_major, fw_minor, fw_build);

A
Anirban Chakraborty 已提交
743
	if (adapter->ahw->port_type == QLCNIC_XGBE) {
S
Sony Chacko 已提交
744 745 746 747 748 749 750 751
		if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
			adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_VF;
			adapter->max_rxd = MAX_RCV_DESCRIPTORS_VF;
		} else {
			adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_10G;
			adapter->max_rxd = MAX_RCV_DESCRIPTORS_10G;
		}

752
		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
S
Sony Chacko 已提交
753 754
		adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;

A
Anirban Chakraborty 已提交
755
	} else if (adapter->ahw->port_type == QLCNIC_GBE) {
756 757
		adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G;
		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
S
Sony Chacko 已提交
758 759
		adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
		adapter->max_rxd = MAX_RCV_DESCRIPTORS_1G;
760 761
	}

762
	adapter->ahw->msix_supported = !!qlcnic_use_msi_x;
763 764 765

	adapter->num_txd = MAX_CMD_DESCRIPTORS;

766
	adapter->max_rds_rings = MAX_RDS_RINGS;
767 768
}

769 770 771 772 773 774
static int
qlcnic_initialize_nic(struct qlcnic_adapter *adapter)
{
	int err;
	struct qlcnic_info nic_info;

775
	memset(&nic_info, 0, sizeof(struct qlcnic_info));
A
Anirban Chakraborty 已提交
776
	err = qlcnic_get_nic_info(adapter, &nic_info, adapter->ahw->pci_func);
777 778 779
	if (err)
		return err;

780 781 782 783 784 785 786
	adapter->ahw->physical_port = (u8)nic_info.phys_port;
	adapter->ahw->switch_mode = nic_info.switch_mode;
	adapter->ahw->max_tx_ques = nic_info.max_tx_ques;
	adapter->ahw->max_rx_ques = nic_info.max_rx_ques;
	adapter->ahw->capabilities = nic_info.capabilities;
	adapter->ahw->max_mac_filters = nic_info.max_mac_filters;
	adapter->ahw->max_mtu = nic_info.max_mtu;
787

S
Sony Chacko 已提交
788 789 790 791
	/* Disable NPAR for 83XX */
	if (qlcnic_83xx_check(adapter))
		return err;

792
	if (adapter->ahw->capabilities & BIT_6)
793 794 795 796 797 798 799
		adapter->flags |= QLCNIC_ESWITCH_ENABLED;
	else
		adapter->flags &= ~QLCNIC_ESWITCH_ENABLED;

	return err;
}

800 801
void qlcnic_set_vlan_config(struct qlcnic_adapter *adapter,
			    struct qlcnic_esw_func_cfg *esw_cfg)
802 803 804 805 806 807 808 809 810 811 812 813
{
	if (esw_cfg->discard_tagged)
		adapter->flags &= ~QLCNIC_TAGGING_ENABLED;
	else
		adapter->flags |= QLCNIC_TAGGING_ENABLED;

	if (esw_cfg->vlan_id)
		adapter->pvid = esw_cfg->vlan_id;
	else
		adapter->pvid = 0;
}

814
static int
815 816 817 818
qlcnic_vlan_rx_add(struct net_device *netdev, u16 vid)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	set_bit(vid, adapter->vlans);
819
	return 0;
820 821
}

822
static int
823 824 825 826 827 828
qlcnic_vlan_rx_del(struct net_device *netdev, u16 vid)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);

	qlcnic_restore_indev_addr(netdev, NETDEV_DOWN);
	clear_bit(vid, adapter->vlans);
829
	return 0;
830 831
}

832 833
void qlcnic_set_eswitch_port_features(struct qlcnic_adapter *adapter,
				      struct qlcnic_esw_func_cfg *esw_cfg)
834
{
835 836
	adapter->flags &= ~(QLCNIC_MACSPOOF | QLCNIC_MAC_OVERRIDE_DISABLED |
				QLCNIC_PROMISC_DISABLED);
837 838 839

	if (esw_cfg->mac_anti_spoof)
		adapter->flags |= QLCNIC_MACSPOOF;
S
Sony Chacko 已提交
840

841 842 843
	if (!esw_cfg->mac_override)
		adapter->flags |= QLCNIC_MAC_OVERRIDE_DISABLED;

844 845 846
	if (!esw_cfg->promisc_mode)
		adapter->flags |= QLCNIC_PROMISC_DISABLED;

847 848 849
	qlcnic_set_netdev_features(adapter, esw_cfg);
}

850
int qlcnic_set_eswitch_port_config(struct qlcnic_adapter *adapter)
851 852 853 854 855 856
{
	struct qlcnic_esw_func_cfg esw_cfg;

	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED))
		return 0;

A
Anirban Chakraborty 已提交
857
	esw_cfg.pci_func = adapter->ahw->pci_func;
858 859
	if (qlcnic_get_eswitch_port_config(adapter, &esw_cfg))
			return -EIO;
860
	qlcnic_set_vlan_config(adapter, &esw_cfg);
861 862 863 864 865 866 867 868 869 870
	qlcnic_set_eswitch_port_features(adapter, &esw_cfg);

	return 0;
}

static void
qlcnic_set_netdev_features(struct qlcnic_adapter *adapter,
		struct qlcnic_esw_func_cfg *esw_cfg)
{
	struct net_device *netdev = adapter->netdev;
S
Sony Chacko 已提交
871 872 873 874
	unsigned long features, vlan_features;

	if (qlcnic_83xx_check(adapter))
		return;
875

876 877
	features = (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |
		    NETIF_F_IPV6_CSUM | NETIF_F_GRO);
878
	vlan_features = (NETIF_F_SG | NETIF_F_IP_CSUM |
S
Sony Chacko 已提交
879
			NETIF_F_IPV6_CSUM);
880

S
Sony Chacko 已提交
881
	if (QLCNIC_IS_TSO_CAPABLE(adapter)) {
882 883 884
		features |= (NETIF_F_TSO | NETIF_F_TSO6);
		vlan_features |= (NETIF_F_TSO | NETIF_F_TSO6);
	}
R
Rajesh Borundia 已提交
885 886

	if (netdev->features & NETIF_F_LRO)
887 888 889 890
		features |= NETIF_F_LRO;

	if (esw_cfg->offload_flags & BIT_0) {
		netdev->features |= features;
S
Sony Chacko 已提交
891
		adapter->rx_csum = 1;
892
		if (!(esw_cfg->offload_flags & BIT_1)) {
893
			netdev->features &= ~NETIF_F_TSO;
894 895 896
			features &= ~NETIF_F_TSO;
		}
		if (!(esw_cfg->offload_flags & BIT_2)) {
897
			netdev->features &= ~NETIF_F_TSO6;
898 899
			features &= ~NETIF_F_TSO6;
		}
900 901
	} else {
		netdev->features &= ~features;
902
		features &= ~features;
S
Sony Chacko 已提交
903
		adapter->rx_csum = 0;
904 905 906 907 908
	}

	netdev->vlan_features = (features & vlan_features);
}

909 910 911 912 913 914
static int
qlcnic_check_eswitch_mode(struct qlcnic_adapter *adapter)
{
	u32 op_mode, priv_level;
	int err = 0;

915 916 917 918
	err = qlcnic_initialize_nic(adapter);
	if (err)
		return err;

919 920 921
	if (adapter->flags & QLCNIC_ADAPTER_INITIALIZED)
		return 0;

S
Sony Chacko 已提交
922
	op_mode = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
A
Anirban Chakraborty 已提交
923
	priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
924 925 926 927

	if (op_mode == QLC_DEV_DRV_DEFAULT)
		priv_level = QLCNIC_MGMT_FUNC;
	else
A
Anirban Chakraborty 已提交
928
		priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
929

930
	if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
931
		if (priv_level == QLCNIC_MGMT_FUNC) {
932
			adapter->ahw->op_mode = QLCNIC_MGMT_FUNC;
933 934 935 936 937 938 939
			err = qlcnic_init_pci_info(adapter);
			if (err)
				return err;
			/* Set privilege level for other functions */
			qlcnic_set_function_modes(adapter);
			dev_info(&adapter->pdev->dev,
				"HAL Version: %d, Management function\n",
940
				 adapter->ahw->fw_hal_version);
941
		} else if (priv_level == QLCNIC_PRIV_FUNC) {
942
			adapter->ahw->op_mode = QLCNIC_PRIV_FUNC;
943 944
			dev_info(&adapter->pdev->dev,
				"HAL Version: %d, Privileged function\n",
945
				 adapter->ahw->fw_hal_version);
946
		}
947
	}
948 949 950 951 952 953

	adapter->flags |= QLCNIC_ADAPTER_INITIALIZED;

	return err;
}

954
int qlcnic_set_default_offload_settings(struct qlcnic_adapter *adapter)
955 956 957 958 959
{
	struct qlcnic_esw_func_cfg esw_cfg;
	struct qlcnic_npar_info *npar;
	u8 i;

960
	if (adapter->need_fw_reset)
961 962
		return 0;

963
	for (i = 0; i < adapter->ahw->act_pci_func; i++) {
964
		memset(&esw_cfg, 0, sizeof(struct qlcnic_esw_func_cfg));
965
		esw_cfg.pci_func = adapter->npars[i].pci_func;
966
		esw_cfg.mac_override = BIT_0;
967
		esw_cfg.promisc_mode = BIT_0;
968 969 970 971 972
		if (qlcnic_82xx_check(adapter)) {
			esw_cfg.offload_flags = BIT_0;
			if (QLCNIC_IS_TSO_CAPABLE(adapter))
				esw_cfg.offload_flags |= (BIT_1 | BIT_2);
		}
973 974 975 976
		if (qlcnic_config_switch_port(adapter, &esw_cfg))
			return -EIO;
		npar = &adapter->npars[i];
		npar->pvid = esw_cfg.vlan_id;
977
		npar->mac_override = esw_cfg.mac_override;
978 979 980 981 982 983 984 985 986
		npar->mac_anti_spoof = esw_cfg.mac_anti_spoof;
		npar->discard_tagged = esw_cfg.discard_tagged;
		npar->promisc_mode = esw_cfg.promisc_mode;
		npar->offload_flags = esw_cfg.offload_flags;
	}

	return 0;
}

S
Sony Chacko 已提交
987

988 989 990 991 992 993 994 995
static int
qlcnic_reset_eswitch_config(struct qlcnic_adapter *adapter,
			struct qlcnic_npar_info *npar, int pci_func)
{
	struct qlcnic_esw_func_cfg esw_cfg;
	esw_cfg.op_mode = QLCNIC_PORT_DEFAULTS;
	esw_cfg.pci_func = pci_func;
	esw_cfg.vlan_id = npar->pvid;
996
	esw_cfg.mac_override = npar->mac_override;
997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010
	esw_cfg.discard_tagged = npar->discard_tagged;
	esw_cfg.mac_anti_spoof = npar->mac_anti_spoof;
	esw_cfg.offload_flags = npar->offload_flags;
	esw_cfg.promisc_mode = npar->promisc_mode;
	if (qlcnic_config_switch_port(adapter, &esw_cfg))
		return -EIO;

	esw_cfg.op_mode = QLCNIC_ADD_VLAN;
	if (qlcnic_config_switch_port(adapter, &esw_cfg))
		return -EIO;

	return 0;
}

1011
int qlcnic_reset_npar_config(struct qlcnic_adapter *adapter)
1012
{
1013
	int i, err;
1014 1015
	struct qlcnic_npar_info *npar;
	struct qlcnic_info nic_info;
1016
	u8 pci_func;
1017

1018 1019 1020
	if (qlcnic_82xx_check(adapter))
		if (!adapter->need_fw_reset)
			return 0;
1021

1022
	/* Set the NPAR config data after FW reset */
1023
	for (i = 0; i < adapter->ahw->act_pci_func; i++) {
1024
		npar = &adapter->npars[i];
1025 1026
		pci_func = npar->pci_func;
		memset(&nic_info, 0, sizeof(struct qlcnic_info));
S
Sony Chacko 已提交
1027
		err = qlcnic_get_nic_info(adapter, &nic_info, pci_func);
1028 1029 1030 1031 1032 1033 1034
		if (err)
			return err;
		nic_info.min_tx_bw = npar->min_bw;
		nic_info.max_tx_bw = npar->max_bw;
		err = qlcnic_set_nic_info(adapter, &nic_info);
		if (err)
			return err;
1035

1036 1037
		if (npar->enable_pm) {
			err = qlcnic_config_port_mirroring(adapter,
1038 1039
							   npar->dest_npar, 1,
							   pci_func);
1040 1041
			if (err)
				return err;
1042
		}
1043
		err = qlcnic_reset_eswitch_config(adapter, npar, pci_func);
1044 1045
		if (err)
			return err;
1046
	}
1047
	return 0;
1048 1049
}

A
Amit Kumar Salecha 已提交
1050 1051 1052 1053 1054
static int qlcnic_check_npar_opertional(struct qlcnic_adapter *adapter)
{
	u8 npar_opt_timeo = QLCNIC_DEV_NPAR_OPER_TIMEO;
	u32 npar_state;

1055
	if (adapter->ahw->op_mode == QLCNIC_MGMT_FUNC)
A
Amit Kumar Salecha 已提交
1056 1057
		return 0;

1058 1059
	npar_state = QLC_SHARED_REG_RD32(adapter,
					 QLCNIC_CRB_DEV_NPAR_STATE);
A
Amit Kumar Salecha 已提交
1060 1061
	while (npar_state != QLCNIC_DEV_NPAR_OPER && --npar_opt_timeo) {
		msleep(1000);
1062 1063
		npar_state = QLC_SHARED_REG_RD32(adapter,
						 QLCNIC_CRB_DEV_NPAR_STATE);
A
Amit Kumar Salecha 已提交
1064 1065 1066 1067 1068 1069 1070 1071 1072
	}
	if (!npar_opt_timeo) {
		dev_err(&adapter->pdev->dev,
			"Waiting for NPAR state to opertional timeout\n");
		return -EIO;
	}
	return 0;
}

1073 1074 1075 1076 1077 1078
static int
qlcnic_set_mgmt_operations(struct qlcnic_adapter *adapter)
{
	int err;

	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
1079
	    adapter->ahw->op_mode != QLCNIC_MGMT_FUNC)
1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091
		return 0;

	err = qlcnic_set_default_offload_settings(adapter);
	if (err)
		return err;

	err = qlcnic_reset_npar_config(adapter);
	if (err)
		return err;

	qlcnic_dev_set_npar_ready(adapter);

S
Sony Chacko 已提交
1092 1093
	if (qlcnic_83xx_check(adapter))
		qlcnic_83xx_register_nic_idc_func(adapter, 1);
1094 1095 1096
	return err;
}

1097
int qlcnic_82xx_start_firmware(struct qlcnic_adapter *adapter)
1098
{
1099
	int err;
1100

1101 1102 1103 1104
	err = qlcnic_can_start_firmware(adapter);
	if (err < 0)
		return err;
	else if (!err)
1105
		goto check_fw_status;
1106

1107
	if (qlcnic_load_fw_file)
1108
		qlcnic_request_firmware(adapter);
S
schacko 已提交
1109
	else {
S
Sony Chacko 已提交
1110 1111
		err = qlcnic_check_flash_fw_ver(adapter);
		if (err)
S
schacko 已提交
1112 1113
			goto err_out;

1114
		adapter->ahw->fw_type = QLCNIC_FLASH_ROMIMAGE;
S
schacko 已提交
1115
	}
1116 1117 1118

	err = qlcnic_need_fw_reset(adapter);
	if (err == 0)
1119
		goto check_fw_status;
1120

1121 1122 1123
	err = qlcnic_pinit_from_rom(adapter);
	if (err)
		goto err_out;
1124 1125 1126 1127 1128 1129

	err = qlcnic_load_firmware(adapter);
	if (err)
		goto err_out;

	qlcnic_release_firmware(adapter);
1130
	QLCWR32(adapter, CRB_DRIVER_VERSION, QLCNIC_DRIVER_VERSION);
1131

1132 1133
check_fw_status:
	err = qlcnic_check_fw_status(adapter);
1134 1135 1136
	if (err)
		goto err_out;

1137
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_READY);
1138
	qlcnic_idc_debug_info(adapter, 1);
1139 1140 1141 1142 1143 1144
	err = qlcnic_check_eswitch_mode(adapter);
	if (err) {
		dev_err(&adapter->pdev->dev,
			"Memory allocation failed for eswitch\n");
		goto err_out;
	}
1145 1146 1147 1148 1149
	err = qlcnic_set_mgmt_operations(adapter);
	if (err)
		goto err_out;

	qlcnic_check_options(adapter);
1150 1151
	adapter->need_fw_reset = 0;

1152 1153
	qlcnic_release_firmware(adapter);
	return 0;
1154 1155

err_out:
1156
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_FAILED);
1157
	dev_err(&adapter->pdev->dev, "Device state set to failed\n");
1158

1159 1160 1161 1162 1163 1164 1165 1166 1167
	qlcnic_release_firmware(adapter);
	return err;
}

static int
qlcnic_request_irq(struct qlcnic_adapter *adapter)
{
	irq_handler_t handler;
	struct qlcnic_host_sds_ring *sds_ring;
S
Sony Chacko 已提交
1168
	struct qlcnic_host_tx_ring *tx_ring;
1169 1170 1171 1172
	int err, ring;

	unsigned long flags = 0;
	struct net_device *netdev = adapter->netdev;
A
Anirban Chakraborty 已提交
1173
	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1174

1175
	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
S
Sony Chacko 已提交
1176 1177
		if (qlcnic_82xx_check(adapter))
			handler = qlcnic_tmp_intr;
1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189
		if (!QLCNIC_IS_MSI_FAMILY(adapter))
			flags |= IRQF_SHARED;

	} else {
		if (adapter->flags & QLCNIC_MSIX_ENABLED)
			handler = qlcnic_msix_intr;
		else if (adapter->flags & QLCNIC_MSI_ENABLED)
			handler = qlcnic_msi_intr;
		else {
			flags |= IRQF_SHARED;
			handler = qlcnic_intr;
		}
1190 1191 1192
	}
	adapter->irq = netdev->irq;

S
Sony Chacko 已提交
1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217
	if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST) {
		for (ring = 0; ring < adapter->max_sds_rings; ring++) {
			sds_ring = &recv_ctx->sds_rings[ring];
			snprintf(sds_ring->name, sizeof(int) + IFNAMSIZ,
				 "%s[%d]", netdev->name, ring);
			err = request_irq(sds_ring->irq, handler, flags,
					  sds_ring->name, sds_ring);
			if (err)
				return err;
		}
		if (qlcnic_83xx_check(adapter) &&
		    (adapter->flags & QLCNIC_MSIX_ENABLED)) {
			handler = qlcnic_msix_tx_intr;
			for (ring = 0; ring < adapter->max_drv_tx_rings;
			     ring++) {
				tx_ring = &adapter->tx_ring[ring];
				snprintf(tx_ring->name, sizeof(int) + IFNAMSIZ,
					 "%s[%d]", netdev->name,
				adapter->max_sds_rings + ring);
				err = request_irq(tx_ring->irq, handler, flags,
						  tx_ring->name, tx_ring);
				if (err)
					return err;
			}
		}
1218 1219 1220 1221 1222 1223 1224 1225 1226
	}
	return 0;
}

static void
qlcnic_free_irq(struct qlcnic_adapter *adapter)
{
	int ring;
	struct qlcnic_host_sds_ring *sds_ring;
S
Sony Chacko 已提交
1227
	struct qlcnic_host_tx_ring *tx_ring;
1228

A
Anirban Chakraborty 已提交
1229
	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1230

S
Sony Chacko 已提交
1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243
	if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST) {
		for (ring = 0; ring < adapter->max_sds_rings; ring++) {
			sds_ring = &recv_ctx->sds_rings[ring];
			free_irq(sds_ring->irq, sds_ring);
		}
		if (qlcnic_83xx_check(adapter)) {
			for (ring = 0; ring < adapter->max_drv_tx_rings;
			     ring++) {
				tx_ring = &adapter->tx_ring[ring];
				if (tx_ring->irq)
					free_irq(tx_ring->irq, tx_ring);
			}
		}
1244 1245 1246
	}
}

S
Sony Chacko 已提交
1247
int __qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1248
{
1249
	int ring;
1250 1251
	u32 capab2;

1252 1253
	struct qlcnic_host_rds_ring *rds_ring;

1254 1255 1256
	if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
		return -EIO;

1257 1258
	if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
		return 0;
1259 1260
	if (qlcnic_set_eswitch_port_config(adapter))
		return -EIO;
1261

1262
	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_MORE_CAPS) {
1263 1264 1265 1266 1267
		capab2 = QLCRD32(adapter, CRB_FW_CAPABILITIES_2);
		if (capab2 & QLCNIC_FW_CAPABILITY_2_LRO_MAX_TCP_SEG)
			adapter->flags |= QLCNIC_FW_LRO_MSS_CAP;
	}

1268 1269 1270 1271
	if (qlcnic_fw_create_ctx(adapter))
		return -EIO;

	for (ring = 0; ring < adapter->max_rds_rings; ring++) {
A
Anirban Chakraborty 已提交
1272
		rds_ring = &adapter->recv_ctx->rds_rings[ring];
S
Sony Chacko 已提交
1273
		qlcnic_post_rx_buffers(adapter, rds_ring, ring);
1274 1275
	}

1276 1277 1278
	qlcnic_set_multi(netdev);
	qlcnic_fw_cmd_set_mtu(adapter, netdev->mtu);

A
Anirban Chakraborty 已提交
1279
	adapter->ahw->linkup = 0;
1280 1281 1282 1283 1284 1285

	if (adapter->max_sds_rings > 1)
		qlcnic_config_rss(adapter, 1);

	qlcnic_config_intr_coalesce(adapter);

1286
	if (netdev->features & NETIF_F_LRO)
1287 1288 1289 1290 1291 1292
		qlcnic_config_hw_lro(adapter, QLCNIC_LRO_ENABLED);

	qlcnic_napi_enable(adapter);

	qlcnic_linkevent_request(adapter, 1);

1293
	adapter->ahw->reset_context = 0;
1294 1295 1296 1297
	set_bit(__QLCNIC_DEV_UP, &adapter->state);
	return 0;
}

1298
int qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309
{
	int err = 0;

	rtnl_lock();
	if (netif_running(netdev))
		err = __qlcnic_up(adapter, netdev);
	rtnl_unlock();

	return err;
}

S
Sony Chacko 已提交
1310
void __qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324
{
	if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
		return;

	if (!test_and_clear_bit(__QLCNIC_DEV_UP, &adapter->state))
		return;

	smp_mb();
	spin_lock(&adapter->tx_clean_lock);
	netif_carrier_off(netdev);
	netif_tx_disable(netdev);

	qlcnic_free_mac_list(adapter);

1325 1326 1327
	if (adapter->fhash.fnum)
		qlcnic_delete_lb_filters(adapter);

1328 1329 1330 1331
	qlcnic_nic_set_promisc(adapter, QLCNIC_NIU_NON_PROMISC_MODE);

	qlcnic_napi_disable(adapter);

1332
	qlcnic_fw_destroy_ctx(adapter);
1333
	adapter->flags &= ~QLCNIC_FW_LRO_MSS_CAP;
1334 1335

	qlcnic_reset_rx_buffers_list(adapter);
1336 1337 1338 1339 1340 1341
	qlcnic_release_tx_buffers(adapter);
	spin_unlock(&adapter->tx_clean_lock);
}

/* Usage: During suspend and firmware recovery module */

1342
void qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1343 1344 1345 1346 1347 1348 1349 1350
{
	rtnl_lock();
	if (netif_running(netdev))
		__qlcnic_down(adapter, netdev);
	rtnl_unlock();

}

S
Sony Chacko 已提交
1351
int
1352 1353 1354 1355
qlcnic_attach(struct qlcnic_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;
1356
	int err;
1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367

	if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC)
		return 0;

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

	err = qlcnic_alloc_sw_resources(adapter);
	if (err) {
		dev_err(&pdev->dev, "Error in setting sw resources\n");
1368
		goto err_out_napi_del;
1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379
	}

	err = qlcnic_alloc_hw_resources(adapter);
	if (err) {
		dev_err(&pdev->dev, "Error in setting hw resources\n");
		goto err_out_free_sw;
	}

	err = qlcnic_request_irq(adapter);
	if (err) {
		dev_err(&pdev->dev, "failed to setup interrupt\n");
1380
		goto err_out_free_hw;
1381 1382 1383 1384 1385 1386 1387
	}

	qlcnic_create_sysfs_entries(adapter);

	adapter->is_up = QLCNIC_ADAPTER_UP_MAGIC;
	return 0;

1388
err_out_free_hw:
1389 1390 1391
	qlcnic_free_hw_resources(adapter);
err_out_free_sw:
	qlcnic_free_sw_resources(adapter);
1392 1393
err_out_napi_del:
	qlcnic_napi_del(adapter);
1394 1395 1396
	return err;
}

S
Sony Chacko 已提交
1397
void qlcnic_detach(struct qlcnic_adapter *adapter)
1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412
{
	if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
		return;

	qlcnic_remove_sysfs_entries(adapter);

	qlcnic_free_hw_resources(adapter);
	qlcnic_release_rx_buffers(adapter);
	qlcnic_free_irq(adapter);
	qlcnic_napi_del(adapter);
	qlcnic_free_sw_resources(adapter);

	adapter->is_up = 0;
}

1413 1414 1415 1416 1417 1418
void qlcnic_diag_free_res(struct net_device *netdev, int max_sds_rings)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	struct qlcnic_host_sds_ring *sds_ring;
	int ring;

1419
	clear_bit(__QLCNIC_DEV_UP, &adapter->state);
1420
	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
1421
		for (ring = 0; ring < adapter->max_sds_rings; ring++) {
A
Anirban Chakraborty 已提交
1422
			sds_ring = &adapter->recv_ctx->sds_rings[ring];
S
Sony Chacko 已提交
1423 1424 1425 1426
			if (qlcnic_83xx_check(adapter))
				writel(1, sds_ring->crb_intr_mask);
			else
				qlcnic_disable_int(sds_ring);
1427
		}
1428 1429
	}

1430 1431
	qlcnic_fw_destroy_ctx(adapter);

1432 1433
	qlcnic_detach(adapter);

1434
	adapter->ahw->diag_test = 0;
1435 1436 1437
	adapter->max_sds_rings = max_sds_rings;

	if (qlcnic_attach(adapter))
1438
		goto out;
1439 1440 1441

	if (netif_running(netdev))
		__qlcnic_up(adapter, netdev);
1442
out:
1443 1444 1445
	netif_device_attach(netdev);
}

A
Anirban Chakraborty 已提交
1446 1447 1448 1449 1450 1451 1452 1453 1454
static int qlcnic_alloc_adapter_resources(struct qlcnic_adapter *adapter)
{
	int err = 0;
	adapter->recv_ctx = kzalloc(sizeof(struct qlcnic_recv_context),
				GFP_KERNEL);
	if (!adapter->recv_ctx) {
		dev_err(&adapter->pdev->dev,
			"Failed to allocate recv ctx resources for adapter\n");
		err = -ENOMEM;
A
Anirban Chakraborty 已提交
1455
		goto err_out;
A
Anirban Chakraborty 已提交
1456
	}
A
Anirban Chakraborty 已提交
1457 1458 1459 1460
	/* Initialize interrupt coalesce parameters */
	adapter->ahw->coal.flag = QLCNIC_INTR_DEFAULT;
	adapter->ahw->coal.rx_time_us = QLCNIC_DEFAULT_INTR_COALESCE_RX_TIME_US;
	adapter->ahw->coal.rx_packets = QLCNIC_DEFAULT_INTR_COALESCE_RX_PACKETS;
S
Sony Chacko 已提交
1461 1462
	/* clear stats */
	memset(&adapter->stats, 0, sizeof(adapter->stats));
A
Anirban Chakraborty 已提交
1463 1464 1465 1466 1467 1468 1469 1470 1471
err_out:
	return err;
}

static void qlcnic_free_adapter_resources(struct qlcnic_adapter *adapter)
{
	kfree(adapter->recv_ctx);
	adapter->recv_ctx = NULL;

A
Anirban Chakraborty 已提交
1472 1473 1474 1475
	if (adapter->ahw->fw_dump.tmpl_hdr) {
		vfree(adapter->ahw->fw_dump.tmpl_hdr);
		adapter->ahw->fw_dump.tmpl_hdr = NULL;
	}
S
Sony Chacko 已提交
1476

1477
	kfree(adapter->ahw->reset.buff);
S
Sony Chacko 已提交
1478
	adapter->ahw->fw_dump.tmpl_hdr = NULL;
A
Anirban Chakraborty 已提交
1479 1480
}

1481 1482 1483 1484
int qlcnic_diag_alloc_res(struct net_device *netdev, int test)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	struct qlcnic_host_sds_ring *sds_ring;
1485
	struct qlcnic_host_rds_ring *rds_ring;
1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496
	int ring;
	int ret;

	netif_device_detach(netdev);

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

	qlcnic_detach(adapter);

	adapter->max_sds_rings = 1;
1497
	adapter->ahw->diag_test = test;
S
Sony Chacko 已提交
1498
	adapter->ahw->linkup = 0;
1499 1500

	ret = qlcnic_attach(adapter);
1501 1502
	if (ret) {
		netif_device_attach(netdev);
1503
		return ret;
1504
	}
1505

1506 1507 1508
	ret = qlcnic_fw_create_ctx(adapter);
	if (ret) {
		qlcnic_detach(adapter);
1509
		netif_device_attach(netdev);
1510 1511 1512 1513
		return ret;
	}

	for (ring = 0; ring < adapter->max_rds_rings; ring++) {
A
Anirban Chakraborty 已提交
1514
		rds_ring = &adapter->recv_ctx->rds_rings[ring];
S
Sony Chacko 已提交
1515
		qlcnic_post_rx_buffers(adapter, rds_ring, ring);
1516 1517
	}

1518
	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
1519
		for (ring = 0; ring < adapter->max_sds_rings; ring++) {
A
Anirban Chakraborty 已提交
1520
			sds_ring = &adapter->recv_ctx->sds_rings[ring];
1521 1522 1523 1524
			if (qlcnic_82xx_check(adapter))
				qlcnic_enable_int(sds_ring);
			else
				qlcnic_83xx_enable_intr(adapter, sds_ring);
1525
		}
1526
	}
1527

1528
	if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {
1529 1530 1531 1532
		adapter->ahw->loopback_state = 0;
		qlcnic_linkevent_request(adapter, 1);
	}

1533
	set_bit(__QLCNIC_DEV_UP, &adapter->state);
1534 1535 1536 1537

	return 0;
}

1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555
/* Reset context in hardware only */
static int
qlcnic_reset_hw_context(struct qlcnic_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;

	if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
		return -EBUSY;

	netif_device_detach(netdev);

	qlcnic_down(adapter, netdev);

	qlcnic_up(adapter, netdev);

	netif_device_attach(netdev);

	clear_bit(__QLCNIC_RESETTING, &adapter->state);
S
Sony Chacko 已提交
1556
	dev_err(&adapter->pdev->dev, "%s:\n", __func__);
1557 1558 1559
	return 0;
}

1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579
int
qlcnic_reset_context(struct qlcnic_adapter *adapter)
{
	int err = 0;
	struct net_device *netdev = adapter->netdev;

	if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
		return -EBUSY;

	if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC) {

		netif_device_detach(netdev);

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

		qlcnic_detach(adapter);

		if (netif_running(netdev)) {
			err = qlcnic_attach(adapter);
A
Anirban Chakraborty 已提交
1580
			if (!err) {
1581
				__qlcnic_up(adapter, netdev);
A
Anirban Chakraborty 已提交
1582 1583
				qlcnic_restore_indev_addr(netdev, NETDEV_UP);
			}
1584 1585 1586 1587 1588 1589 1590 1591 1592 1593
		}

		netif_device_attach(netdev);
	}

	clear_bit(__QLCNIC_RESETTING, &adapter->state);
	return err;
}

static int
S
Sony Chacko 已提交
1594 1595
qlcnic_setup_netdev(struct qlcnic_adapter *adapter, struct net_device *netdev,
		    int pci_using_dac)
1596 1597 1598 1599
{
	int err;
	struct pci_dev *pdev = adapter->pdev;

S
Sony Chacko 已提交
1600
	adapter->rx_csum = 1;
1601
	adapter->ahw->mc_enabled = 0;
S
Sony Chacko 已提交
1602
	adapter->ahw->max_mc_count = QLCNIC_MAX_MC_COUNT;
1603 1604

	netdev->netdev_ops	   = &qlcnic_netdev_ops;
S
Sony Chacko 已提交
1605
	netdev->watchdog_timeo     = QLCNIC_WATCHDOG_TIMEOUTVALUE * HZ;
1606 1607 1608 1609 1610

	qlcnic_change_mtu(netdev, netdev->mtu);

	SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_ops);

1611
	netdev->features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |
S
Sony Chacko 已提交
1612 1613 1614 1615
			     NETIF_F_IPV6_CSUM | NETIF_F_GRO |
			     NETIF_F_HW_VLAN_RX);
	netdev->vlan_features |= (NETIF_F_SG | NETIF_F_IP_CSUM |
				  NETIF_F_IPV6_CSUM);
1616

S
Sony Chacko 已提交
1617 1618 1619 1620
	if (QLCNIC_IS_TSO_CAPABLE(adapter)) {
		netdev->features |= (NETIF_F_TSO | NETIF_F_TSO6);
		netdev->vlan_features |= (NETIF_F_TSO | NETIF_F_TSO6);
	}
1621

S
Sony Chacko 已提交
1622 1623 1624 1625
	if (pci_using_dac) {
		netdev->features |= NETIF_F_HIGHDMA;
		netdev->vlan_features |= NETIF_F_HIGHDMA;
	}
1626

S
Sony Chacko 已提交
1627 1628
	if (qlcnic_vlan_tx_check(adapter))
		netdev->features |= (NETIF_F_HW_VLAN_TX);
1629

S
Sony Chacko 已提交
1630 1631
	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)
		netdev->features |= NETIF_F_LRO;
1632

1633
	netdev->hw_features = netdev->features;
1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644
	netdev->irq = adapter->msix_entries[0].vector;

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

	return 0;
}

S
Sony Chacko 已提交
1645
static int qlcnic_set_dma_mask(struct pci_dev *pdev, int *pci_using_dac)
1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660
{
	if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) &&
			!pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)))
		*pci_using_dac = 1;
	else if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) &&
			!pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)))
		*pci_using_dac = 0;
	else {
		dev_err(&pdev->dev, "Unable to set DMA mask, aborting\n");
		return -EIO;
	}

	return 0;
}

S
Sony Chacko 已提交
1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720
void qlcnic_free_tx_rings(struct qlcnic_adapter *adapter)
{
	int ring;
	struct qlcnic_host_tx_ring *tx_ring;

	for (ring = 0; ring < adapter->max_drv_tx_rings; ring++) {
		tx_ring = &adapter->tx_ring[ring];
		if (tx_ring && tx_ring->cmd_buf_arr != NULL) {
			vfree(tx_ring->cmd_buf_arr);
			tx_ring->cmd_buf_arr = NULL;
		}
	}
	if (adapter->tx_ring != NULL)
		kfree(adapter->tx_ring);
}

int qlcnic_alloc_tx_rings(struct qlcnic_adapter *adapter,
			  struct net_device *netdev)
{
	int ring, size, vector, index;
	struct qlcnic_host_tx_ring *tx_ring;
	struct qlcnic_cmd_buffer *cmd_buf_arr;

	size = adapter->max_drv_tx_rings * sizeof(struct qlcnic_host_tx_ring);
	tx_ring = kzalloc(size, GFP_KERNEL);
	if (tx_ring == NULL) {
		dev_err(&netdev->dev, "failed to allocate tx rings\n");
		return -ENOMEM;
	}
	adapter->tx_ring = tx_ring;

	for (ring = 0; ring < adapter->max_drv_tx_rings; ring++) {
		tx_ring = &adapter->tx_ring[ring];
		tx_ring->num_desc = adapter->num_txd;
		tx_ring->txq = netdev_get_tx_queue(netdev, ring);
		cmd_buf_arr = vzalloc(TX_BUFF_RINGSIZE(tx_ring));
		if (cmd_buf_arr == NULL) {
			dev_err(&netdev->dev,
				"failed to allocate cmd buffer ring\n");
			qlcnic_free_tx_rings(adapter);
			return -ENOMEM;
		}
		memset(cmd_buf_arr, 0, TX_BUFF_RINGSIZE(tx_ring));
		tx_ring->cmd_buf_arr = cmd_buf_arr;
	}

	if (qlcnic_83xx_check(adapter)) {
		for (ring = 0; ring < adapter->max_drv_tx_rings; ring++) {
			tx_ring = &adapter->tx_ring[ring];
			tx_ring->adapter = adapter;
			if (adapter->flags & QLCNIC_MSIX_ENABLED) {
				index = adapter->max_sds_rings + ring;
				vector = adapter->msix_entries[index].vector;
				tx_ring->irq = vector;
			}
		}
	}
	return 0;
}

1721
static int __devinit
1722 1723 1724 1725
qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
{
	struct net_device *netdev = NULL;
	struct qlcnic_adapter *adapter = NULL;
1726
	struct qlcnic_hardware_context *ahw;
S
Sony Chacko 已提交
1727
	int err, pci_using_dac = -1;
S
Sony Chacko 已提交
1728
	char board_name[QLCNIC_MAX_BOARD_NAME_LEN];
1729 1730 1731 1732 1733 1734 1735 1736 1737 1738

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

	if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
		err = -ENODEV;
		goto err_out_disable_pdev;
	}

1739 1740 1741 1742
	err = qlcnic_set_dma_mask(pdev, &pci_using_dac);
	if (err)
		goto err_out_disable_pdev;

1743 1744 1745 1746 1747
	err = pci_request_regions(pdev, qlcnic_driver_name);
	if (err)
		goto err_out_disable_pdev;

	pci_set_master(pdev);
S
Sucheta Chakraborty 已提交
1748
	pci_enable_pcie_error_reporting(pdev);
1749

1750 1751 1752 1753 1754 1755 1756
	ahw = kzalloc(sizeof(struct qlcnic_hardware_context), GFP_KERNEL);
	if (!ahw)
		goto err_out_free_res;

	if (ent->device == PCI_DEVICE_ID_QLOGIC_QLE824X) {
		ahw->hw_ops = &qlcnic_hw_ops;
		ahw->reg_tbl = (u32 *)qlcnic_reg_tbl;
S
Sony Chacko 已提交
1757 1758 1759 1760
	} else if (ent->device == PCI_DEVICE_ID_QLOGIC_QLE834X) {
		qlcnic_83xx_register_map(ahw);
	} else {
		goto err_out_free_hw_res;
1761 1762 1763 1764 1765 1766
	}

	err = qlcnic_setup_pci_map(pdev, ahw);
	if (err)
		goto err_out_free_hw_res;

1767 1768 1769
	netdev = alloc_etherdev(sizeof(struct qlcnic_adapter));
	if (!netdev) {
		err = -ENOMEM;
1770
		goto err_out_iounmap;
1771 1772 1773 1774 1775 1776 1777
	}

	SET_NETDEV_DEV(netdev, &pdev->dev);

	adapter = netdev_priv(netdev);
	adapter->netdev  = netdev;
	adapter->pdev    = pdev;
S
Sony Chacko 已提交
1778 1779 1780 1781 1782 1783 1784
	adapter->ahw = ahw;

	adapter->qlcnic_wq = create_singlethread_workqueue("qlcnic");
	if (adapter->qlcnic_wq == NULL) {
		dev_err(&pdev->dev, "Failed to create workqueue\n");
		goto err_out_free_netdev;
	}
1785

1786 1787
	err = qlcnic_alloc_adapter_resources(adapter);
	if (err)
A
Anirban Chakraborty 已提交
1788 1789 1790
		goto err_out_free_netdev;

	adapter->dev_rst_time = jiffies;
1791
	adapter->ahw->revision_id = pdev->revision;
1792
	adapter->mac_learn = qlcnic_mac_learn;
1793
	adapter->max_drv_tx_rings = 1;
1794

A
Anirban Chakraborty 已提交
1795 1796
	rwlock_init(&adapter->ahw->crb_lock);
	mutex_init(&adapter->ahw->mem_lock);
1797 1798 1799 1800

	spin_lock_init(&adapter->tx_clean_lock);
	INIT_LIST_HEAD(&adapter->mac_list);

1801
	if (qlcnic_82xx_check(adapter)) {
S
Sony Chacko 已提交
1802
		qlcnic_check_vf(adapter, ent);
1803 1804 1805 1806 1807 1808
		adapter->portnum = adapter->ahw->pci_func;
		err = qlcnic_start_firmware(adapter);
		if (err) {
			dev_err(&pdev->dev, "Loading fw failed.Please Reboot\n");
			goto err_out_free_hw;
		}
1809

1810 1811 1812
		err = qlcnic_setup_idc_param(adapter);
		if (err)
			goto err_out_free_hw;
1813

1814
		adapter->flags |= QLCNIC_NEED_FLR;
S
Sony Chacko 已提交
1815 1816 1817
	} else if (qlcnic_83xx_check(adapter)) {
		qlcnic_83xx_check_vf(adapter, ent);
		adapter->portnum = adapter->ahw->pci_func;
1818 1819 1820 1821 1822
		err = qlcnic_83xx_init(adapter);
		if (err) {
			dev_err(&pdev->dev, "%s: failed\n", __func__);
			goto err_out_free_hw;
		}
S
Sony Chacko 已提交
1823 1824 1825 1826
	} else {
		dev_err(&pdev->dev,
			"%s: failed. Please Reboot\n", __func__);
		goto err_out_free_hw;
1827
	}
1828

R
Rajesh Borundia 已提交
1829 1830 1831 1832
	if (qlcnic_read_mac_addr(adapter))
		dev_warn(&pdev->dev, "failed to read mac addr\n");

	if (adapter->portnum == 0) {
S
Sony Chacko 已提交
1833
		qlcnic_get_board_name(adapter, board_name);
S
Sony Chacko 已提交
1834

R
Rajesh Borundia 已提交
1835
		pr_info("%s: %s Board Chip rev 0x%x\n",
S
Sony Chacko 已提交
1836 1837
			module_name(THIS_MODULE),
			board_name, adapter->ahw->revision_id);
R
Rajesh Borundia 已提交
1838
	}
1839 1840 1841
	err = qlcnic_setup_intr(adapter, 0);
	if (err)
		goto err_out_disable_msi;
1842

S
Sony Chacko 已提交
1843 1844 1845 1846 1847
	if (qlcnic_83xx_check(adapter)) {
		err = qlcnic_83xx_setup_mbx_intr(adapter);
		if (err)
			goto err_out_disable_msi;
	}
1848

1849
	err = qlcnic_setup_netdev(adapter, netdev, pci_using_dac);
1850
	if (err)
1851
		goto err_out_disable_mbx_intr;
1852 1853 1854

	pci_set_drvdata(pdev, adapter);

1855 1856 1857
	if (qlcnic_82xx_check(adapter))
		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
				     FW_POLL_DELAY);
1858

A
Anirban Chakraborty 已提交
1859
	switch (adapter->ahw->port_type) {
1860 1861 1862 1863 1864 1865 1866 1867 1868 1869
	case QLCNIC_GBE:
		dev_info(&adapter->pdev->dev, "%s: GbE port initialized\n",
				adapter->netdev->name);
		break;
	case QLCNIC_XGBE:
		dev_info(&adapter->pdev->dev, "%s: XGbE port initialized\n",
				adapter->netdev->name);
		break;
	}

1870 1871 1872
	if (qlcnic_get_act_pci_func(adapter))
		goto err_out_disable_mbx_intr;

1873 1874 1875
	if (adapter->mac_learn)
		qlcnic_alloc_lb_filters_mem(adapter);

1876
	qlcnic_add_sysfs(adapter);
1877 1878 1879

	return 0;

1880
err_out_disable_mbx_intr:
S
Sony Chacko 已提交
1881 1882 1883 1884 1885
	if (qlcnic_83xx_check(adapter)) {
		if (adapter->flags & QLCNIC_MSIX_ENABLED)
			qlcnic_83xx_config_intrpt(adapter, 0);
		qlcnic_83xx_free_mbx_intr(adapter);
	}
1886

1887 1888
err_out_disable_msi:
	qlcnic_teardown_intr(adapter);
1889
	qlcnic_cancel_idc_work(adapter);
1890
	qlcnic_clr_all_drv_state(adapter, 0);
1891

A
Anirban Chakraborty 已提交
1892 1893 1894
err_out_free_hw:
	qlcnic_free_adapter_resources(adapter);

1895 1896 1897
err_out_free_netdev:
	free_netdev(netdev);

1898 1899 1900 1901 1902 1903
err_out_iounmap:
	qlcnic_cleanup_pci_map(adapter);

err_out_free_hw_res:
	kfree(ahw);

1904 1905 1906 1907 1908 1909 1910 1911 1912
err_out_free_res:
	pci_release_regions(pdev);

err_out_disable_pdev:
	pci_set_drvdata(pdev, NULL);
	pci_disable_device(pdev);
	return err;
}

S
Sony Chacko 已提交
1913
static void __devexit qlcnic_remove(struct pci_dev *pdev)
1914 1915 1916
{
	struct qlcnic_adapter *adapter;
	struct net_device *netdev;
S
Sony Chacko 已提交
1917
	struct qlcnic_hardware_context *ahw;
1918 1919 1920 1921 1922 1923 1924

	adapter = pci_get_drvdata(pdev);
	if (adapter == NULL)
		return;

	netdev = adapter->netdev;

S
Sony Chacko 已提交
1925 1926
	qlcnic_cancel_idc_work(adapter);
	ahw = adapter->ahw;
1927 1928 1929

	unregister_netdev(netdev);

S
Sony Chacko 已提交
1930 1931 1932 1933 1934 1935
	if (qlcnic_83xx_check(adapter)) {
		if (adapter->flags & QLCNIC_MSIX_ENABLED)
			qlcnic_83xx_config_intrpt(adapter, 0);
		qlcnic_83xx_free_mbx_intr(adapter);
	}

1936 1937
	qlcnic_detach(adapter);

1938 1939 1940 1941 1942
	if (adapter->npars != NULL)
		kfree(adapter->npars);
	if (adapter->eswitch != NULL)
		kfree(adapter->eswitch);

1943 1944
	if (qlcnic_82xx_check(adapter))
		qlcnic_clr_all_drv_state(adapter, 0);
1945 1946 1947

	clear_bit(__QLCNIC_RESETTING, &adapter->state);

1948 1949
	qlcnic_free_lb_filters_mem(adapter);

1950 1951
	qlcnic_teardown_intr(adapter);

S
Sony Chacko 已提交
1952
	qlcnic_remove_sysfs(adapter);
1953 1954 1955 1956 1957

	qlcnic_cleanup_pci_map(adapter);

	qlcnic_release_firmware(adapter);

S
Sucheta Chakraborty 已提交
1958
	pci_disable_pcie_error_reporting(pdev);
1959 1960 1961 1962
	pci_release_regions(pdev);
	pci_disable_device(pdev);
	pci_set_drvdata(pdev, NULL);

S
Sony Chacko 已提交
1963 1964 1965 1966
	if (adapter->qlcnic_wq) {
		destroy_workqueue(adapter->qlcnic_wq);
		adapter->qlcnic_wq = NULL;
	}
A
Anirban Chakraborty 已提交
1967
	qlcnic_free_adapter_resources(adapter);
S
Sony Chacko 已提交
1968
	kfree(ahw);
1969 1970 1971 1972 1973 1974 1975 1976 1977 1978
	free_netdev(netdev);
}
static int __qlcnic_shutdown(struct pci_dev *pdev)
{
	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
	int retval;

	netif_device_detach(netdev);

S
Sony Chacko 已提交
1979
	qlcnic_cancel_idc_work(adapter);
1980 1981 1982 1983

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

1984 1985
	if (qlcnic_82xx_check(adapter))
		qlcnic_clr_all_drv_state(adapter, 0);
1986 1987 1988 1989 1990 1991

	clear_bit(__QLCNIC_RESETTING, &adapter->state);

	retval = pci_save_state(pdev);
	if (retval)
		return retval;
1992 1993 1994 1995 1996
	if (qlcnic_82xx_check(adapter)) {
		if (qlcnic_wol_supported(adapter)) {
			pci_enable_wake(pdev, PCI_D3cold, 1);
			pci_enable_wake(pdev, PCI_D3hot, 1);
		}
1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038
	}

	return 0;
}

static void qlcnic_shutdown(struct pci_dev *pdev)
{
	if (__qlcnic_shutdown(pdev))
		return;

	pci_disable_device(pdev);
}

#ifdef CONFIG_PM
static int
qlcnic_suspend(struct pci_dev *pdev, pm_message_t state)
{
	int retval;

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

	pci_set_power_state(pdev, pci_choose_state(pdev, state));
	return 0;
}

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

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

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

S
Sony Chacko 已提交
2039
	err = qlcnic_start_firmware(adapter);
2040 2041 2042 2043 2044 2045 2046 2047
	if (err) {
		dev_err(&pdev->dev, "failed to start firmware\n");
		return err;
	}

	if (netif_running(netdev)) {
		err = qlcnic_up(adapter, netdev);
		if (err)
2048
			goto done;
2049

A
Amit Kumar Salecha 已提交
2050
		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
2051
	}
2052
done:
2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063
	netif_device_attach(netdev);
	qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
	return 0;
}
#endif

static int qlcnic_open(struct net_device *netdev)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	int err;

2064 2065
	netif_carrier_off(netdev);

2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090
	err = qlcnic_attach(adapter);
	if (err)
		return err;

	err = __qlcnic_up(adapter, netdev);
	if (err)
		goto err_out;

	netif_start_queue(netdev);

	return 0;

err_out:
	qlcnic_detach(adapter);
	return err;
}

/*
 * qlcnic_close - Disables a network interface entry point
 */
static int qlcnic_close(struct net_device *netdev)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);

	__qlcnic_down(adapter, netdev);
S
Sony Chacko 已提交
2091 2092 2093 2094 2095
	if (qlcnic_83xx_check(adapter)) {
		qlcnic_83xx_register_nic_idc_func(adapter, 0);
		cancel_delayed_work_sync(&adapter->idc_aen_work);
	}

2096 2097 2098
	return 0;
}

2099
void qlcnic_alloc_lb_filters_mem(struct qlcnic_adapter *adapter)
2100 2101 2102
{
	void *head;
	int i;
S
Sony Chacko 已提交
2103 2104 2105
	struct net_device *netdev = adapter->netdev;
	u32 filter_size = 0;
	u16 act_pci_func = 0;
2106

2107
	if (adapter->fhash.fmax && adapter->fhash.fhead)
2108 2109
		return;

S
Sony Chacko 已提交
2110
	act_pci_func = adapter->ahw->act_pci_func;
2111 2112
	spin_lock_init(&adapter->mac_learn_lock);

S
Sony Chacko 已提交
2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123
	if (qlcnic_82xx_check(adapter)) {
		filter_size = QLCNIC_LB_MAX_FILTERS;
		adapter->fhash.fbucket_size = QLCNIC_LB_BUCKET_SIZE;
	} else {
		filter_size = QLC_83XX_LB_MAX_FILTERS;
		adapter->fhash.fbucket_size = QLC_83XX_LB_BUCKET_SIZE;
	}

	head = kcalloc(adapter->fhash.fbucket_size,
		       sizeof(struct hlist_head), GFP_KERNEL);

2124 2125 2126
	if (!head)
		return;

S
Sony Chacko 已提交
2127
	adapter->fhash.fmax = (filter_size / act_pci_func);
2128
	adapter->fhash.fhead = head;
2129

S
Sony Chacko 已提交
2130 2131 2132 2133
	netdev_info(netdev, "active nic func = %d, mac filter size=%d\n",
		    act_pci_func, adapter->fhash.fmax);

	for (i = 0; i < adapter->fhash.fbucket_size; i++)
2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145
		INIT_HLIST_HEAD(&adapter->fhash.fhead[i]);
}

static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter)
{
	if (adapter->fhash.fmax && adapter->fhash.fhead)
		kfree(adapter->fhash.fhead);

	adapter->fhash.fhead = NULL;
	adapter->fhash.fmax = 0;
}

2146
int qlcnic_check_temp(struct qlcnic_adapter *adapter)
2147 2148
{
	struct net_device *netdev = adapter->netdev;
2149
	u32 temp_state, temp_val, temp = 0;
2150 2151
	int rv = 0;

S
Sony Chacko 已提交
2152 2153 2154
	if (qlcnic_83xx_check(adapter))
		temp = QLCRDX(adapter->ahw, QLC_83XX_ASIC_TEMP);

2155
	if (qlcnic_82xx_check(adapter))
2156
		temp = QLC_SHARED_REG_RD32(adapter, QLCNIC_ASIC_TEMP);
2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167

	temp_state = qlcnic_get_temp_state(temp);
	temp_val = qlcnic_get_temp_val(temp);

	if (temp_state == QLCNIC_TEMP_PANIC) {
		dev_err(&netdev->dev,
		       "Device temperature %d degrees C exceeds"
		       " maximum allowed. Hardware has been shut down.\n",
		       temp_val);
		rv = 1;
	} else if (temp_state == QLCNIC_TEMP_WARN) {
2168
		if (adapter->ahw->temp == QLCNIC_TEMP_NORMAL) {
2169 2170 2171 2172 2173 2174 2175
			dev_err(&netdev->dev,
			       "Device temperature %d degrees C "
			       "exceeds operating range."
			       " Immediate action needed.\n",
			       temp_val);
		}
	} else {
2176
		if (adapter->ahw->temp == QLCNIC_TEMP_WARN) {
2177 2178 2179 2180 2181
			dev_info(&netdev->dev,
			       "Device temperature is now %d degrees C"
			       " in normal range.\n", temp_val);
		}
	}
2182
	adapter->ahw->temp = temp_state;
2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195
	return rv;
}

static void qlcnic_tx_timeout(struct net_device *netdev)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);

	if (test_bit(__QLCNIC_RESETTING, &adapter->state))
		return;

	dev_err(&netdev->dev, "transmit timeout, resetting.\n");

	if (++adapter->tx_timeo_cnt >= QLCNIC_MAX_TX_TIMEOUTS)
2196 2197
		adapter->need_fw_reset = 1;
	else
2198
		adapter->ahw->reset_context = 1;
2199 2200 2201 2202 2203 2204 2205 2206 2207
}

static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	struct net_device_stats *stats = &netdev->stats;

	stats->rx_packets = adapter->stats.rx_pkts + adapter->stats.lro_pkts;
	stats->tx_packets = adapter->stats.xmitfinished;
2208
	stats->rx_bytes = adapter->stats.rxbytes + adapter->stats.lrobytes;
2209 2210 2211 2212 2213 2214 2215
	stats->tx_bytes = adapter->stats.txbytes;
	stats->rx_dropped = adapter->stats.rxdropped;
	stats->tx_dropped = adapter->stats.txdropped;

	return stats;
}

2216
irqreturn_t qlcnic_82xx_clear_legacy_intr(struct qlcnic_adapter *adapter)
2217 2218 2219 2220 2221
{
	u32 status;

	status = readl(adapter->isr_int_vec);

2222
	if (!(status & adapter->ahw->int_vec_bit))
2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234
		return IRQ_NONE;

	/* check interrupt state machine, to be sure */
	status = readl(adapter->crb_int_state_reg);
	if (!ISR_LEGACY_INT_TRIGGERED(status))
		return IRQ_NONE;

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

2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253
	return IRQ_HANDLED;
}

static irqreturn_t qlcnic_tmp_intr(int irq, void *data)
{
	struct qlcnic_host_sds_ring *sds_ring = data;
	struct qlcnic_adapter *adapter = sds_ring->adapter;

	if (adapter->flags & QLCNIC_MSIX_ENABLED)
		goto done;
	else if (adapter->flags & QLCNIC_MSI_ENABLED) {
		writel(0xffffffff, adapter->tgt_status_reg);
		goto done;
	}

	if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
		return IRQ_NONE;

done:
2254
	adapter->ahw->diag_cnt++;
2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266
	qlcnic_enable_int(sds_ring);
	return IRQ_HANDLED;
}

static irqreturn_t qlcnic_intr(int irq, void *data)
{
	struct qlcnic_host_sds_ring *sds_ring = data;
	struct qlcnic_adapter *adapter = sds_ring->adapter;

	if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
		return IRQ_NONE;

2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291
	napi_schedule(&sds_ring->napi);

	return IRQ_HANDLED;
}

static irqreturn_t qlcnic_msi_intr(int irq, void *data)
{
	struct qlcnic_host_sds_ring *sds_ring = data;
	struct qlcnic_adapter *adapter = sds_ring->adapter;

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

	napi_schedule(&sds_ring->napi);
	return IRQ_HANDLED;
}

static irqreturn_t qlcnic_msix_intr(int irq, void *data)
{
	struct qlcnic_host_sds_ring *sds_ring = data;

	napi_schedule(&sds_ring->napi);
	return IRQ_HANDLED;
}

S
Sony Chacko 已提交
2292 2293 2294 2295 2296 2297 2298 2299
static irqreturn_t qlcnic_msix_tx_intr(int irq, void *data)
{
	struct qlcnic_host_tx_ring *tx_ring = data;

	napi_schedule(&tx_ring->napi);
	return IRQ_HANDLED;
}

2300 2301 2302
#ifdef CONFIG_NET_POLL_CONTROLLER
static void qlcnic_poll_controller(struct net_device *netdev)
{
Y
Yinglin Luan 已提交
2303 2304
	int ring;
	struct qlcnic_host_sds_ring *sds_ring;
2305
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
A
Anirban Chakraborty 已提交
2306
	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
Y
Yinglin Luan 已提交
2307

2308
	disable_irq(adapter->irq);
Y
Yinglin Luan 已提交
2309 2310 2311 2312
	for (ring = 0; ring < adapter->max_sds_rings; ring++) {
		sds_ring = &recv_ctx->sds_rings[ring];
		qlcnic_intr(adapter->irq, sds_ring);
	}
2313 2314 2315 2316
	enable_irq(adapter->irq);
}
#endif

2317 2318 2319 2320 2321 2322 2323 2324 2325
static void
qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding)
{
	u32 val;

	val = adapter->portnum & 0xf;
	val |= encoding << 7;
	val |= (jiffies - adapter->dev_rst_time) << 8;

2326
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_SCRATCH, val);
2327 2328 2329
	adapter->dev_rst_time = jiffies;
}

2330 2331
static int
qlcnic_set_drv_state(struct qlcnic_adapter *adapter, u8 state)
2332 2333 2334 2335 2336 2337 2338
{
	u32  val;

	WARN_ON(state != QLCNIC_DEV_NEED_RESET &&
			state != QLCNIC_DEV_NEED_QUISCENT);

	if (qlcnic_api_lock(adapter))
2339
		return -EIO;
2340

2341
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2342 2343

	if (state == QLCNIC_DEV_NEED_RESET)
2344
		QLC_DEV_SET_RST_RDY(val, adapter->portnum);
2345
	else if (state == QLCNIC_DEV_NEED_QUISCENT)
2346
		QLC_DEV_SET_QSCNT_RDY(val, adapter->portnum);
2347

2348
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2349 2350

	qlcnic_api_unlock(adapter);
2351 2352

	return 0;
2353 2354
}

2355 2356 2357 2358 2359 2360 2361 2362
static int
qlcnic_clr_drv_state(struct qlcnic_adapter *adapter)
{
	u32  val;

	if (qlcnic_api_lock(adapter))
		return -EBUSY;

2363
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2364
	QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
2365
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2366 2367 2368 2369 2370 2371

	qlcnic_api_unlock(adapter);

	return 0;
}

2372
static void
2373
qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8 failed)
2374 2375 2376 2377 2378 2379
{
	u32  val;

	if (qlcnic_api_lock(adapter))
		goto err;

2380
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2381
	QLC_DEV_CLR_REF_CNT(val, adapter->portnum);
2382
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
2383

2384
	if (failed) {
2385 2386
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_FAILED);
2387 2388 2389
		dev_info(&adapter->pdev->dev,
				"Device state set to Failed. Please Reboot\n");
	} else if (!(val & 0x11111111))
2390 2391
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_COLD);
2392

2393
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2394
	QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
2395
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2396 2397 2398 2399

	qlcnic_api_unlock(adapter);
err:
	adapter->fw_fail_cnt = 0;
S
Sritej Velaga 已提交
2400
	adapter->flags &= ~QLCNIC_FW_HANG;
2401 2402 2403 2404
	clear_bit(__QLCNIC_START_FW, &adapter->state);
	clear_bit(__QLCNIC_RESETTING, &adapter->state);
}

2405
/* Grab api lock, before checking state */
2406 2407 2408
static int
qlcnic_check_drv_state(struct qlcnic_adapter *adapter)
{
2409
	int act, state, active_mask;
2410
	struct qlcnic_hardware_context *ahw = adapter->ahw;
2411

2412 2413
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
	act = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2414

2415
	if (adapter->flags & QLCNIC_FW_RESET_OWNER) {
2416
		active_mask = (~(1 << (ahw->pci_func * 4)));
2417 2418 2419
		act = act & active_mask;
	}

2420 2421 2422 2423 2424 2425 2426
	if (((state & 0x11111111) == (act & 0x11111111)) ||
			((act & 0x11111111) == ((state >> 1) & 0x11111111)))
		return 0;
	else
		return 1;
}

S
Sucheta Chakraborty 已提交
2427 2428
static int qlcnic_check_idc_ver(struct qlcnic_adapter *adapter)
{
2429
	u32 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_IDC_VER);
S
Sucheta Chakraborty 已提交
2430 2431 2432 2433 2434 2435 2436 2437 2438

	if (val != QLCNIC_DRV_IDC_VER) {
		dev_warn(&adapter->pdev->dev, "IDC Version mismatch, driver's"
			" idc ver = %x; reqd = %x\n", QLCNIC_DRV_IDC_VER, val);
	}

	return 0;
}

2439 2440 2441 2442
static int
qlcnic_can_start_firmware(struct qlcnic_adapter *adapter)
{
	u32 val, prev_state;
2443
	u8 dev_init_timeo = adapter->dev_init_timeo;
2444
	u8 portnum = adapter->portnum;
S
Sucheta Chakraborty 已提交
2445
	u8 ret;
2446

2447 2448 2449
	if (test_and_clear_bit(__QLCNIC_START_FW, &adapter->state))
		return 1;

2450 2451 2452
	if (qlcnic_api_lock(adapter))
		return -1;

2453
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2454 2455
	if (!(val & (1 << (portnum * 4)))) {
		QLC_DEV_SET_REF_CNT(val, portnum);
2456
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
2457 2458
	}

2459
	prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2460
	QLCDB(adapter, HW, "Device state = %u\n", prev_state);
2461 2462 2463

	switch (prev_state) {
	case QLCNIC_DEV_COLD:
2464 2465 2466 2467
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_INITIALIZING);
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_IDC_VER,
				    QLCNIC_DRV_IDC_VER);
2468
		qlcnic_idc_debug_info(adapter, 0);
2469 2470 2471 2472
		qlcnic_api_unlock(adapter);
		return 1;

	case QLCNIC_DEV_READY:
S
Sucheta Chakraborty 已提交
2473
		ret = qlcnic_check_idc_ver(adapter);
2474
		qlcnic_api_unlock(adapter);
S
Sucheta Chakraborty 已提交
2475
		return ret;
2476 2477

	case QLCNIC_DEV_NEED_RESET:
2478
		val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2479
		QLC_DEV_SET_RST_RDY(val, portnum);
2480
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2481 2482 2483
		break;

	case QLCNIC_DEV_NEED_QUISCENT:
2484
		val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2485
		QLC_DEV_SET_QSCNT_RDY(val, portnum);
2486
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2487 2488 2489
		break;

	case QLCNIC_DEV_FAILED:
2490
		dev_err(&adapter->pdev->dev, "Device in failed state.\n");
2491 2492
		qlcnic_api_unlock(adapter);
		return -1;
2493 2494 2495 2496

	case QLCNIC_DEV_INITIALIZING:
	case QLCNIC_DEV_QUISCENT:
		break;
2497 2498 2499
	}

	qlcnic_api_unlock(adapter);
2500 2501

	do {
2502
		msleep(1000);
2503
		prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2504 2505 2506 2507

		if (prev_state == QLCNIC_DEV_QUISCENT)
			continue;
	} while ((prev_state != QLCNIC_DEV_READY) && --dev_init_timeo);
2508

2509 2510 2511
	if (!dev_init_timeo) {
		dev_err(&adapter->pdev->dev,
			"Waiting for device to initialize timeout\n");
2512
		return -1;
2513
	}
2514 2515 2516 2517

	if (qlcnic_api_lock(adapter))
		return -1;

2518
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2519
	QLC_DEV_CLR_RST_QSCNT(val, portnum);
2520
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2521

S
Sucheta Chakraborty 已提交
2522
	ret = qlcnic_check_idc_ver(adapter);
2523 2524
	qlcnic_api_unlock(adapter);

S
Sucheta Chakraborty 已提交
2525
	return ret;
2526 2527 2528 2529 2530 2531 2532
}

static void
qlcnic_fwinit_work(struct work_struct *work)
{
	struct qlcnic_adapter *adapter = container_of(work,
			struct qlcnic_adapter, fw_work.work);
2533
	u32 dev_state = 0xf;
S
Sritej Velaga 已提交
2534
	u32 val;
2535

2536 2537
	if (qlcnic_api_lock(adapter))
		goto err_ret;
2538

2539
	dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2540 2541
	if (dev_state == QLCNIC_DEV_QUISCENT ||
	    dev_state == QLCNIC_DEV_NEED_QUISCENT) {
2542 2543 2544 2545 2546 2547
		qlcnic_api_unlock(adapter);
		qlcnic_schedule_work(adapter, qlcnic_fwinit_work,
						FW_POLL_DELAY * 2);
		return;
	}

2548
	if (adapter->ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
2549 2550
		qlcnic_api_unlock(adapter);
		goto wait_npar;
2551 2552
	}

2553 2554 2555 2556 2557 2558 2559
	if (dev_state == QLCNIC_DEV_INITIALIZING ||
	    dev_state == QLCNIC_DEV_READY) {
		dev_info(&adapter->pdev->dev, "Detected state change from "
				"DEV_NEED_RESET, skipping ack check\n");
		goto skip_ack_check;
	}

2560
	if (adapter->fw_wait_cnt++ > adapter->reset_ack_timeo) {
2561
		dev_info(&adapter->pdev->dev, "Reset:Failed to get ack %d sec\n",
2562 2563 2564 2565 2566 2567
					adapter->reset_ack_timeo);
		goto skip_ack_check;
	}

	if (!qlcnic_check_drv_state(adapter)) {
skip_ack_check:
2568
		dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2569

2570
		if (dev_state == QLCNIC_DEV_NEED_RESET) {
2571 2572
			QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
					    QLCNIC_DEV_INITIALIZING);
2573 2574
			set_bit(__QLCNIC_START_FW, &adapter->state);
			QLCDB(adapter, DRV, "Restarting fw\n");
2575
			qlcnic_idc_debug_info(adapter, 0);
2576 2577
			val = QLC_SHARED_REG_RD32(adapter,
						  QLCNIC_CRB_DRV_STATE);
S
Sritej Velaga 已提交
2578
			QLC_DEV_SET_RST_RDY(val, adapter->portnum);
2579 2580
			QLC_SHARED_REG_WR32(adapter,
					    QLCNIC_CRB_DRV_STATE, val);
2581 2582
		}

2583 2584
		qlcnic_api_unlock(adapter);

2585
		rtnl_lock();
S
Sritej Velaga 已提交
2586 2587
		if (adapter->ahw->fw_dump.enable &&
		    (adapter->flags & QLCNIC_FW_RESET_OWNER)) {
2588 2589
			QLCDB(adapter, DRV, "Take FW dump\n");
			qlcnic_dump_fw(adapter);
S
Sritej Velaga 已提交
2590
			adapter->flags |= QLCNIC_FW_HANG;
2591
		}
2592
		rtnl_unlock();
S
Sritej Velaga 已提交
2593 2594

		adapter->flags &= ~QLCNIC_FW_RESET_OWNER;
2595
		if (!adapter->nic_ops->start_firmware(adapter)) {
2596
			qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
2597
			adapter->fw_wait_cnt = 0;
2598 2599 2600 2601 2602
			return;
		}
		goto err_ret;
	}

2603
	qlcnic_api_unlock(adapter);
2604

2605
wait_npar:
2606
	dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2607
	QLCDB(adapter, HW, "Func waiting: Device state=%u\n", dev_state);
2608

2609
	switch (dev_state) {
2610
	case QLCNIC_DEV_READY:
2611
		if (!qlcnic_start_firmware(adapter)) {
2612
			qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
2613
			adapter->fw_wait_cnt = 0;
2614 2615
			return;
		}
2616 2617 2618 2619 2620 2621
	case QLCNIC_DEV_FAILED:
		break;
	default:
		qlcnic_schedule_work(adapter,
			qlcnic_fwinit_work, FW_POLL_DELAY);
		return;
2622 2623 2624
	}

err_ret:
2625 2626
	dev_err(&adapter->pdev->dev, "Fwinit work failed state=%u "
		"fw_wait_cnt=%u\n", dev_state, adapter->fw_wait_cnt);
2627
	netif_device_attach(adapter->netdev);
2628
	qlcnic_clr_all_drv_state(adapter, 0);
2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640
}

static void
qlcnic_detach_work(struct work_struct *work)
{
	struct qlcnic_adapter *adapter = container_of(work,
			struct qlcnic_adapter, fw_work.work);
	struct net_device *netdev = adapter->netdev;
	u32 status;

	netif_device_detach(netdev);

2641 2642 2643 2644 2645 2646
	/* Dont grab rtnl lock during Quiscent mode */
	if (adapter->dev_state == QLCNIC_DEV_NEED_QUISCENT) {
		if (netif_running(netdev))
			__qlcnic_down(adapter, netdev);
	} else
		qlcnic_down(adapter, netdev);
2647

2648
	status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
2649

S
Sony Chacko 已提交
2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660 2661 2662
	if (status & QLCNIC_RCODE_FATAL_ERROR) {
		dev_err(&adapter->pdev->dev,
			"Detaching the device: peg halt status1=0x%x\n",
					status);

		if (QLCNIC_FWERROR_CODE(status) == QLCNIC_FWERROR_FAN_FAILURE) {
			dev_err(&adapter->pdev->dev,
			"On board active cooling fan failed. "
				"Device has been halted.\n");
			dev_err(&adapter->pdev->dev,
				"Replace the adapter.\n");
		}

2663
		goto err_ret;
S
Sony Chacko 已提交
2664
	}
2665

2666
	if (adapter->ahw->temp == QLCNIC_TEMP_PANIC) {
S
Sony Chacko 已提交
2667
		dev_err(&adapter->pdev->dev, "Detaching the device: temp=%d\n",
2668
			adapter->ahw->temp);
2669
		goto err_ret;
S
Sony Chacko 已提交
2670 2671
	}

2672 2673
	/* Dont ack if this instance is the reset owner */
	if (!(adapter->flags & QLCNIC_FW_RESET_OWNER)) {
S
Sony Chacko 已提交
2674 2675 2676 2677
		if (qlcnic_set_drv_state(adapter, adapter->dev_state)) {
			dev_err(&adapter->pdev->dev,
				"Failed to set driver state,"
					"detaching the device.\n");
2678
			goto err_ret;
S
Sony Chacko 已提交
2679
		}
2680
	}
2681 2682 2683 2684 2685 2686 2687 2688

	adapter->fw_wait_cnt = 0;

	qlcnic_schedule_work(adapter, qlcnic_fwinit_work, FW_POLL_DELAY);

	return;

err_ret:
2689
	netif_device_attach(netdev);
2690
	qlcnic_clr_all_drv_state(adapter, 1);
2691 2692
}

2693 2694 2695 2696 2697 2698
/*Transit NPAR state to NON Operational */
static void
qlcnic_set_npar_non_operational(struct qlcnic_adapter *adapter)
{
	u32 state;

2699
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
2700 2701 2702 2703 2704
	if (state == QLCNIC_DEV_NPAR_NON_OPER)
		return;

	if (qlcnic_api_lock(adapter))
		return;
2705 2706
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
			    QLCNIC_DEV_NPAR_NON_OPER);
2707 2708 2709
	qlcnic_api_unlock(adapter);
}

2710
void qlcnic_82xx_dev_request_reset(struct qlcnic_adapter *adapter, u32 key)
2711
{
2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723
	u32 state, xg_val = 0, gb_val = 0;

	qlcnic_xg_set_xg0_mask(xg_val);
	qlcnic_xg_set_xg1_mask(xg_val);
	QLCWR32(adapter, QLCNIC_NIU_XG_PAUSE_CTL, xg_val);
	qlcnic_gb_set_gb0_mask(gb_val);
	qlcnic_gb_set_gb1_mask(gb_val);
	qlcnic_gb_set_gb2_mask(gb_val);
	qlcnic_gb_set_gb3_mask(gb_val);
	QLCWR32(adapter, QLCNIC_NIU_GB_PAUSE_CTL, gb_val);
	dev_info(&adapter->pdev->dev, "Pause control frames disabled"
				" on all ports\n");
2724
	adapter->need_fw_reset = 1;
S
Sony Chacko 已提交
2725

2726 2727 2728
	if (qlcnic_api_lock(adapter))
		return;

S
Sony Chacko 已提交
2729
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2730

2731
	if (state == QLCNIC_DEV_READY) {
S
Sony Chacko 已提交
2732 2733
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_NEED_RESET);
2734
		adapter->flags |= QLCNIC_FW_RESET_OWNER;
2735
		QLCDB(adapter, DRV, "NEED_RESET state set\n");
2736
		qlcnic_idc_debug_info(adapter, 0);
2737 2738
	}

S
Sony Chacko 已提交
2739 2740
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
			    QLCNIC_DEV_NPAR_NON_OPER);
2741 2742 2743
	qlcnic_api_unlock(adapter);
}

2744 2745 2746 2747 2748 2749 2750
/* Transit to NPAR READY state from NPAR NOT READY state */
static void
qlcnic_dev_set_npar_ready(struct qlcnic_adapter *adapter)
{
	if (qlcnic_api_lock(adapter))
		return;

2751 2752
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
			    QLCNIC_DEV_NPAR_OPER);
2753
	QLCDB(adapter, DRV, "NPAR operational state set\n");
2754 2755 2756 2757

	qlcnic_api_unlock(adapter);
}

S
Sony Chacko 已提交
2758 2759
void qlcnic_schedule_work(struct qlcnic_adapter *adapter,
			  work_func_t func, int delay)
2760
{
S
Sucheta Chakraborty 已提交
2761 2762 2763
	if (test_bit(__QLCNIC_AER, &adapter->state))
		return;

2764
	INIT_DELAYED_WORK(&adapter->fw_work, func);
S
Sony Chacko 已提交
2765 2766
	queue_delayed_work(adapter->qlcnic_wq, &adapter->fw_work,
			   round_jiffies_relative(delay));
2767 2768 2769 2770 2771 2772 2773 2774
}

static void
qlcnic_attach_work(struct work_struct *work)
{
	struct qlcnic_adapter *adapter = container_of(work,
				struct qlcnic_adapter, fw_work.work);
	struct net_device *netdev = adapter->netdev;
2775
	u32 npar_state;
2776

2777
	if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
2778 2779
		npar_state = QLC_SHARED_REG_RD32(adapter,
						 QLCNIC_CRB_DEV_NPAR_STATE);
2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790
		if (adapter->fw_wait_cnt++ > QLCNIC_DEV_NPAR_OPER_TIMEO)
			qlcnic_clr_all_drv_state(adapter, 0);
		else if (npar_state != QLCNIC_DEV_NPAR_OPER)
			qlcnic_schedule_work(adapter, qlcnic_attach_work,
							FW_POLL_DELAY);
		else
			goto attach;
		QLCDB(adapter, DRV, "Waiting for NPAR state to operational\n");
		return;
	}
attach:
2791
	if (netif_running(netdev)) {
2792
		if (qlcnic_up(adapter, netdev))
2793 2794
			goto done;

A
Amit Kumar Salecha 已提交
2795
		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
2796 2797 2798
	}

done:
2799
	netif_device_attach(netdev);
2800
	adapter->fw_fail_cnt = 0;
S
Sritej Velaga 已提交
2801
	adapter->flags &= ~QLCNIC_FW_HANG;
2802
	clear_bit(__QLCNIC_RESETTING, &adapter->state);
2803 2804 2805 2806

	if (!qlcnic_clr_drv_state(adapter))
		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
							FW_POLL_DELAY);
2807 2808 2809 2810 2811
}

static int
qlcnic_check_health(struct qlcnic_adapter *adapter)
{
2812
	u32 state = 0, heartbeat;
2813
	u32 peg_status;
2814 2815 2816 2817

	if (qlcnic_check_temp(adapter))
		goto detach;

A
Amit Kumar Salecha 已提交
2818
	if (adapter->need_fw_reset)
2819
		qlcnic_dev_request_reset(adapter, 0);
2820

2821
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2822
	if (state == QLCNIC_DEV_NEED_RESET) {
2823
		qlcnic_set_npar_non_operational(adapter);
2824
		adapter->need_fw_reset = 1;
2825 2826
	} else if (state == QLCNIC_DEV_NEED_QUISCENT)
		goto detach;
2827

2828
	heartbeat = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_ALIVE_COUNTER);
2829 2830
	if (heartbeat != adapter->heartbeat) {
		adapter->heartbeat = heartbeat;
2831 2832 2833
		adapter->fw_fail_cnt = 0;
		if (adapter->need_fw_reset)
			goto detach;
2834

2835
		if (adapter->ahw->reset_context && qlcnic_auto_fw_reset) {
2836 2837 2838 2839
			qlcnic_reset_hw_context(adapter);
			adapter->netdev->trans_start = jiffies;
		}

2840 2841 2842 2843 2844 2845
		return 0;
	}

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

S
Sritej Velaga 已提交
2846 2847
	adapter->flags |= QLCNIC_FW_HANG;

2848
	qlcnic_dev_request_reset(adapter, 0);
2849

2850
	if (qlcnic_auto_fw_reset)
2851
		clear_bit(__QLCNIC_FW_ATTACHED, &adapter->state);
2852

2853
	dev_err(&adapter->pdev->dev, "firmware hang detected\n");
2854
	peg_status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
2855
	dev_err(&adapter->pdev->dev, "Dumping hw/fw registers\n"
S
Sritej Velaga 已提交
2856 2857 2858 2859
			"PEG_HALT_STATUS1: 0x%x, PEG_HALT_STATUS2: 0x%x,\n"
			"PEG_NET_0_PC: 0x%x, PEG_NET_1_PC: 0x%x,\n"
			"PEG_NET_2_PC: 0x%x, PEG_NET_3_PC: 0x%x,\n"
			"PEG_NET_4_PC: 0x%x\n",
2860 2861
			peg_status,
			QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS2),
S
Sritej Velaga 已提交
2862 2863 2864 2865 2866
			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_0 + 0x3c),
			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_1 + 0x3c),
			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_2 + 0x3c),
			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_3 + 0x3c),
			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_4 + 0x3c));
2867
	if (QLCNIC_FWERROR_CODE(peg_status) == 0x67)
2868 2869 2870
		dev_err(&adapter->pdev->dev,
			"Firmware aborted with error code 0x00006700. "
				"Device is being reset.\n");
2871 2872 2873 2874
detach:
	adapter->dev_state = (state == QLCNIC_DEV_NEED_QUISCENT) ? state :
		QLCNIC_DEV_NEED_RESET;

2875 2876
	if (qlcnic_auto_fw_reset && !test_and_set_bit(__QLCNIC_RESETTING,
						      &adapter->state)) {
2877

2878
		qlcnic_schedule_work(adapter, qlcnic_detach_work, 0);
2879 2880
		QLCDB(adapter, DRV, "fw recovery scheduled.\n");
	}
2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897

	return 1;
}

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

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


	if (qlcnic_check_health(adapter))
		return;

2898 2899 2900
	if (adapter->fhash.fnum)
		qlcnic_prune_lb_filters(adapter);

2901 2902 2903 2904
reschedule:
	qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
}

S
Sucheta Chakraborty 已提交
2905 2906 2907 2908 2909 2910 2911 2912 2913
static int qlcnic_is_first_func(struct pci_dev *pdev)
{
	struct pci_dev *oth_pdev;
	int val = pdev->devfn;

	while (val-- > 0) {
		oth_pdev = pci_get_domain_bus_and_slot(pci_domain_nr
			(pdev->bus), pdev->bus->number,
			PCI_DEVFN(PCI_SLOT(pdev->devfn), val));
2914 2915
		if (!oth_pdev)
			continue;
S
Sucheta Chakraborty 已提交
2916

2917 2918
		if (oth_pdev->current_state != PCI_D3cold) {
			pci_dev_put(oth_pdev);
S
Sucheta Chakraborty 已提交
2919
			return 0;
2920 2921
		}
		pci_dev_put(oth_pdev);
S
Sucheta Chakraborty 已提交
2922 2923 2924 2925 2926 2927 2928 2929 2930 2931 2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943 2944 2945 2946
	}
	return 1;
}

static int qlcnic_attach_func(struct pci_dev *pdev)
{
	int err, first_func;
	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;

	pdev->error_state = pci_channel_io_normal;

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

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

	first_func = qlcnic_is_first_func(pdev);

	if (qlcnic_api_lock(adapter))
		return -EINVAL;

2947
	if (adapter->ahw->op_mode != QLCNIC_NON_PRIV_FUNC && first_func) {
S
Sucheta Chakraborty 已提交
2948 2949
		adapter->need_fw_reset = 1;
		set_bit(__QLCNIC_START_FW, &adapter->state);
2950 2951
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_INITIALIZING);
S
Sucheta Chakraborty 已提交
2952 2953 2954 2955
		QLCDB(adapter, DRV, "Restarting fw\n");
	}
	qlcnic_api_unlock(adapter);

S
Sony Chacko 已提交
2956
	err = qlcnic_start_firmware(adapter);
S
Sucheta Chakraborty 已提交
2957 2958 2959 2960
	if (err)
		return err;

	qlcnic_clr_drv_state(adapter);
S
Sony Chacko 已提交
2961 2962 2963 2964 2965 2966 2967 2968 2969 2970 2971 2972 2973 2974
	kfree(adapter->msix_entries);
	adapter->msix_entries = NULL;
	err = qlcnic_setup_intr(adapter, 0);

	if (qlcnic_83xx_check(adapter)) {
		err = qlcnic_83xx_setup_mbx_intr(adapter);
		if (err) {
			dev_err(&adapter->pdev->dev,
				"failed to setup mbx interrupt\n");
			qlcnic_clr_all_drv_state(adapter, 1);
			clear_bit(__QLCNIC_AER, &adapter->state);
			goto done;
		}
	}
S
Sucheta Chakraborty 已提交
2975 2976 2977 2978

	if (netif_running(netdev)) {
		err = qlcnic_attach(adapter);
		if (err) {
2979
			qlcnic_clr_all_drv_state(adapter, 1);
S
Sucheta Chakraborty 已提交
2980 2981 2982 2983 2984 2985 2986 2987 2988
			clear_bit(__QLCNIC_AER, &adapter->state);
			netif_device_attach(netdev);
			return err;
		}

		err = qlcnic_up(adapter, netdev);
		if (err)
			goto done;

A
Amit Kumar Salecha 已提交
2989
		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
S
Sucheta Chakraborty 已提交
2990 2991 2992 2993 2994 2995 2996 2997 2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015
	}
 done:
	netif_device_attach(netdev);
	return err;
}

static pci_ers_result_t qlcnic_io_error_detected(struct pci_dev *pdev,
						pci_channel_state_t state)
{
	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;

	if (state == pci_channel_io_perm_failure)
		return PCI_ERS_RESULT_DISCONNECT;

	if (state == pci_channel_io_normal)
		return PCI_ERS_RESULT_RECOVERED;

	set_bit(__QLCNIC_AER, &adapter->state);
	netif_device_detach(netdev);

	cancel_delayed_work_sync(&adapter->fw_work);

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

S
Sony Chacko 已提交
3016 3017 3018 3019 3020 3021
	if (qlcnic_83xx_check(adapter)) {
		if (adapter->flags & QLCNIC_MSIX_ENABLED)
			qlcnic_83xx_config_intrpt(adapter, 0);
		qlcnic_83xx_free_mbx_intr(adapter);
	}

S
Sucheta Chakraborty 已提交
3022 3023 3024 3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037 3038 3039 3040
	qlcnic_detach(adapter);
	qlcnic_teardown_intr(adapter);

	clear_bit(__QLCNIC_RESETTING, &adapter->state);

	pci_save_state(pdev);
	pci_disable_device(pdev);

	return PCI_ERS_RESULT_NEED_RESET;
}

static pci_ers_result_t qlcnic_io_slot_reset(struct pci_dev *pdev)
{
	return qlcnic_attach_func(pdev) ? PCI_ERS_RESULT_DISCONNECT :
				PCI_ERS_RESULT_RECOVERED;
}

static void qlcnic_io_resume(struct pci_dev *pdev)
{
3041
	u32 state;
S
Sucheta Chakraborty 已提交
3042 3043 3044
	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);

	pci_cleanup_aer_uncorrect_error_status(pdev);
3045 3046 3047
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
	if (state == QLCNIC_DEV_READY && test_and_clear_bit(__QLCNIC_AER,
							    &adapter->state))
S
Sucheta Chakraborty 已提交
3048 3049 3050 3051
		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
						FW_POLL_DELAY);
}

3052 3053 3054 3055 3056 3057 3058 3059 3060
static int
qlcnicvf_start_firmware(struct qlcnic_adapter *adapter)
{
	int err;

	err = qlcnic_can_start_firmware(adapter);
	if (err)
		return err;

A
Amit Kumar Salecha 已提交
3061 3062 3063
	err = qlcnic_check_npar_opertional(adapter);
	if (err)
		return err;
3064

3065 3066 3067 3068
	err = qlcnic_initialize_nic(adapter);
	if (err)
		return err;

3069 3070
	qlcnic_check_options(adapter);

3071 3072 3073 3074
	err = qlcnic_set_eswitch_port_config(adapter);
	if (err)
		return err;

3075 3076 3077 3078 3079
	adapter->need_fw_reset = 0;

	return err;
}

S
Sony Chacko 已提交
3080
int qlcnic_validate_max_rss(u8 max_hw, u8 val)
3081
{
S
Sony Chacko 已提交
3082 3083 3084 3085 3086
	u32 max_allowed;

	if (max_hw > QLC_MAX_SDS_RINGS) {
		max_hw = QLC_MAX_SDS_RINGS;
		pr_info("max rss reset to %d\n", QLC_MAX_SDS_RINGS);
3087 3088
	}

S
Sony Chacko 已提交
3089 3090 3091 3092 3093
	max_allowed = rounddown_pow_of_two(min_t(int, max_hw,
						 num_online_cpus()));
	if ((val > max_allowed) || (val < 2) || !is_power_of_2(val)) {
		pr_info("rss_ring valid range [2 - %x] in powers of 2\n",
			max_allowed);
3094 3095 3096 3097 3098
		return -EINVAL;
	}
	return 0;
}

S
Sony Chacko 已提交
3099
int qlcnic_set_max_rss(struct qlcnic_adapter *adapter, u8 data, size_t len)
3100
{
S
Sony Chacko 已提交
3101
	int err;
3102 3103
	struct net_device *netdev = adapter->netdev;

S
Sony Chacko 已提交
3104 3105 3106
	if (test_bit(__QLCNIC_RESETTING, &adapter->state))
		return -EBUSY;

3107 3108 3109
	netif_device_detach(netdev);
	if (netif_running(netdev))
		__qlcnic_down(adapter, netdev);
S
Sony Chacko 已提交
3110

S
Sony Chacko 已提交
3111
	if (qlcnic_82xx_check(adapter)) {
S
Sony Chacko 已提交
3112 3113 3114 3115 3116
		if (adapter->flags & QLCNIC_MSIX_ENABLED)
			qlcnic_83xx_config_intrpt(adapter, 0);
		qlcnic_83xx_free_mbx_intr(adapter);
	}

3117 3118
	qlcnic_detach(adapter);
	qlcnic_teardown_intr(adapter);
S
Sony Chacko 已提交
3119
	err = qlcnic_setup_intr(adapter, data);
S
Sony Chacko 已提交
3120 3121 3122
	if (err)
		dev_err(&adapter->pdev->dev,
			"failed setting max_rss; rss disabled\n");
3123

S
Sony Chacko 已提交
3124 3125 3126 3127 3128 3129 3130
	if (qlcnic_83xx_check(adapter)) {
		err = qlcnic_83xx_setup_mbx_intr(adapter);
		if (err) {
			dev_err(&adapter->pdev->dev,
				"failed to setup mbx interrupt\n");
			goto done;
		}
3131 3132 3133 3134 3135 3136 3137 3138 3139 3140 3141
	}

	if (netif_running(netdev)) {
		err = qlcnic_attach(adapter);
		if (err)
			goto done;
		err = __qlcnic_up(adapter, netdev);
		if (err)
			goto done;
		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
	}
S
Sony Chacko 已提交
3142
	err = len;
3143 3144 3145 3146 3147 3148
 done:
	netif_device_attach(netdev);
	clear_bit(__QLCNIC_RESETTING, &adapter->state);
	return err;
}

3149 3150 3151 3152 3153
#ifdef CONFIG_INET

#define is_qlcnic_netdev(dev) (dev->netdev_ops == &qlcnic_netdev_ops)

static void
A
Amit Kumar Salecha 已提交
3154 3155
qlcnic_config_indev_addr(struct qlcnic_adapter *adapter,
			struct net_device *dev, unsigned long event)
3156 3157 3158 3159 3160 3161 3162 3163 3164 3165 3166 3167 3168 3169 3170 3171 3172 3173 3174 3175 3176 3177 3178 3179 3180
{
	struct in_device *indev;

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

	for_ifa(indev) {
		switch (event) {
		case NETDEV_UP:
			qlcnic_config_ipaddr(adapter,
					ifa->ifa_address, QLCNIC_IP_UP);
			break;
		case NETDEV_DOWN:
			qlcnic_config_ipaddr(adapter,
					ifa->ifa_address, QLCNIC_IP_DOWN);
			break;
		default:
			break;
		}
	} endfor_ifa(indev);

	in_dev_put(indev);
}

S
Sony Chacko 已提交
3181
void qlcnic_restore_indev_addr(struct net_device *netdev, unsigned long event)
A
Amit Kumar Salecha 已提交
3182 3183 3184 3185 3186 3187 3188
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	struct net_device *dev;
	u16 vid;

	qlcnic_config_indev_addr(adapter, netdev, event);

3189
	for_each_set_bit(vid, adapter->vlans, VLAN_N_VID) {
3190
		dev = __vlan_find_dev_deep(netdev, vid);
A
Amit Kumar Salecha 已提交
3191 3192 3193 3194 3195 3196
		if (!dev)
			continue;
		qlcnic_config_indev_addr(adapter, dev, event);
	}
}

3197 3198 3199 3200 3201 3202 3203 3204 3205 3206 3207 3208 3209 3210 3211 3212 3213 3214 3215 3216 3217 3218 3219
static int qlcnic_netdev_event(struct notifier_block *this,
				 unsigned long event, void *ptr)
{
	struct qlcnic_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_qlcnic_netdev(dev))
		goto done;

	adapter = netdev_priv(dev);

	if (!adapter)
		goto done;

3220
	if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
3221 3222
		goto done;

A
Amit Kumar Salecha 已提交
3223
	qlcnic_config_indev_addr(adapter, dev, event);
3224 3225 3226 3227 3228 3229 3230 3231 3232 3233 3234 3235 3236 3237 3238 3239
done:
	return NOTIFY_DONE;
}

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

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

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

recheck:
A
Amit Kumar Salecha 已提交
3240
	if (dev == NULL)
3241 3242 3243 3244 3245 3246 3247 3248 3249 3250 3251 3252
		goto done;

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

	if (!is_qlcnic_netdev(dev))
		goto done;

	adapter = netdev_priv(dev);

A
Amit Kumar Salecha 已提交
3253
	if (!adapter)
3254 3255
		goto done;

3256
	if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
3257 3258 3259 3260 3261
		goto done;

	switch (event) {
	case NETDEV_UP:
		qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_UP);
S
Sony Chacko 已提交
3262

3263 3264 3265
		break;
	case NETDEV_DOWN:
		qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_DOWN);
S
Sony Chacko 已提交
3266

3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282 3283 3284
		break;
	default:
		break;
	}

done:
	return NOTIFY_DONE;
}

static struct notifier_block	qlcnic_netdev_cb = {
	.notifier_call = qlcnic_netdev_event,
};

static struct notifier_block qlcnic_inetaddr_cb = {
	.notifier_call = qlcnic_inetaddr_event,
};
#else
static void
A
Amit Kumar Salecha 已提交
3285
qlcnic_restore_indev_addr(struct net_device *dev, unsigned long event)
3286 3287
{ }
#endif
3288
static struct pci_error_handlers qlcnic_err_handler = {
S
Sucheta Chakraborty 已提交
3289 3290 3291 3292
	.error_detected = qlcnic_io_error_detected,
	.slot_reset = qlcnic_io_slot_reset,
	.resume = qlcnic_io_resume,
};
3293 3294 3295 3296 3297

static struct pci_driver qlcnic_driver = {
	.name = qlcnic_driver_name,
	.id_table = qlcnic_pci_tbl,
	.probe = qlcnic_probe,
B
Bill Pemberton 已提交
3298
	.remove = qlcnic_remove,
3299 3300 3301 3302
#ifdef CONFIG_PM
	.suspend = qlcnic_suspend,
	.resume = qlcnic_resume,
#endif
S
Sucheta Chakraborty 已提交
3303 3304 3305
	.shutdown = qlcnic_shutdown,
	.err_handler = &qlcnic_err_handler

3306 3307 3308 3309
};

static int __init qlcnic_init_module(void)
{
3310
	int ret;
3311 3312 3313 3314 3315 3316 3317 3318

	printk(KERN_INFO "%s\n", qlcnic_driver_string);

#ifdef CONFIG_INET
	register_netdevice_notifier(&qlcnic_netdev_cb);
	register_inetaddr_notifier(&qlcnic_inetaddr_cb);
#endif

3319 3320 3321 3322 3323 3324 3325
	ret = pci_register_driver(&qlcnic_driver);
	if (ret) {
#ifdef CONFIG_INET
		unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
		unregister_netdevice_notifier(&qlcnic_netdev_cb);
#endif
	}
3326

3327
	return ret;
3328 3329 3330 3331 3332 3333 3334 3335 3336 3337 3338 3339 3340 3341 3342
}

module_init(qlcnic_init_module);

static void __exit qlcnic_exit_module(void)
{
	pci_unregister_driver(&qlcnic_driver);

#ifdef CONFIG_INET
	unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
	unregister_netdevice_notifier(&qlcnic_netdev_cb);
#endif
}

module_exit(qlcnic_exit_module);