qlcnic_main.c 78.6 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
#include <linux/slab.h>
9 10 11 12
#include <linux/vmalloc.h>
#include <linux/interrupt.h>

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

15
#include <linux/swab.h>
16 17 18 19 20
#include <linux/dma-mapping.h>
#include <net/ip.h>
#include <linux/ipv6.h>
#include <linux/inetdevice.h>
#include <linux/sysfs.h>
S
Sucheta Chakraborty 已提交
21
#include <linux/aer.h>
22
#include <linux/log2.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 struct workqueue_struct *qlcnic_wq;
34
static int qlcnic_mac_learn;
35
module_param(qlcnic_mac_learn, int, 0444);
36 37
MODULE_PARM_DESC(qlcnic_mac_learn, "Mac Filter (0=disabled, 1=enabled)");

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

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

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

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

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

58
static int qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent);
B
Bill Pemberton 已提交
59
static void qlcnic_remove(struct pci_dev *pdev);
60 61 62 63 64 65 66 67 68 69 70 71 72
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);
static void qlcnic_schedule_work(struct qlcnic_adapter *adapter,
		work_func_t func, int delay);
static void qlcnic_cancel_fw_work(struct qlcnic_adapter *adapter);
#ifdef CONFIG_NET_POLL_CONTROLLER
static void qlcnic_poll_controller(struct net_device *netdev);
#endif

73
static void qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding);
74
static void qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8);
75 76
static int qlcnic_can_start_firmware(struct qlcnic_adapter *adapter);

77
static irqreturn_t qlcnic_tmp_intr(int irq, void *data);
78 79 80 81 82
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);

static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev);
A
Amit Kumar Salecha 已提交
83
static void qlcnic_restore_indev_addr(struct net_device *dev, unsigned long);
84 85
static int qlcnic_start_firmware(struct qlcnic_adapter *);

86
static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter);
87 88
static void qlcnic_dev_set_npar_ready(struct qlcnic_adapter *);
static int qlcnicvf_start_firmware(struct qlcnic_adapter *);
89 90
static void qlcnic_set_netdev_features(struct qlcnic_adapter *,
				struct qlcnic_esw_func_cfg *);
91 92
static int qlcnic_vlan_rx_add(struct net_device *, u16);
static int qlcnic_vlan_rx_del(struct net_device *, u16);
93

94 95 96
#define QLCNIC_IS_TSO_CAPABLE(adapter)	\
	((adapter)->ahw->capabilities & QLCNIC_FW_CAPABILITY_TSO)

97 98 99 100 101 102 103
/*  PCI Device ID Table  */
#define ENTRY(device) \
	{PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, (device)), \
	.class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0}

#define PCI_DEVICE_ID_QLOGIC_QLE824X  0x8020

104
static DEFINE_PCI_DEVICE_TABLE(qlcnic_pci_tbl) = {
105 106 107 108 109 110 111
	ENTRY(PCI_DEVICE_ID_QLOGIC_QLE824X),
	{0,}
};

MODULE_DEVICE_TABLE(pci, qlcnic_pci_tbl);


S
Sony Chacko 已提交
112
inline void qlcnic_update_cmd_producer(struct qlcnic_host_tx_ring *tx_ring)
113 114 115 116 117 118 119 120 121 122 123
{
	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
};

124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149
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 已提交
150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173
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)

174 175 176
static const
struct qlcnic_legacy_intr_set legacy_intr[] = QLCNIC_LEGACY_INTR_CONFIG;

177
int qlcnic_alloc_sds_rings(struct qlcnic_recv_context *recv_ctx, int count)
178 179 180 181 182
{
	int size = sizeof(struct qlcnic_host_sds_ring) * count;

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

183
	return recv_ctx->sds_rings == NULL;
184 185
}

186
void qlcnic_free_sds_rings(struct qlcnic_recv_context *recv_ctx)
187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220
{
	if (recv_ctx->sds_rings != NULL)
		kfree(recv_ctx->sds_rings);

	recv_ctx->sds_rings = NULL;
}

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

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

static void qlcnic_init_msix_entries(struct qlcnic_adapter *adapter, int count)
{
	int i;

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

static int
qlcnic_read_mac_addr(struct qlcnic_adapter *adapter)
{
221
	u8 mac_addr[ETH_ALEN];
222 223 224
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;

R
Rajesh Borundia 已提交
225
	if (qlcnic_get_mac_address(adapter, mac_addr) != 0)
226 227
		return -EIO;

228
	memcpy(netdev->dev_addr, mac_addr, ETH_ALEN);
229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245
	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;

246 247 248
	if ((adapter->flags & QLCNIC_MAC_OVERRIDE_DISABLED))
		return -EOPNOTSUPP;

249
	if (!is_valid_ether_addr(addr->sa_data))
250
		return -EADDRNOTAVAIL;
251

252
	if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
253 254 255 256 257 258 259 260
		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);

261
	if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
262 263 264 265 266 267
		netif_device_attach(netdev);
		qlcnic_napi_enable(adapter);
	}
	return 0;
}

268 269 270 271 272 273 274 275
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);
}

276 277 278 279 280 281
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,
282
	.ndo_set_rx_mode   = qlcnic_set_multi,
283 284
	.ndo_set_mac_address    = qlcnic_set_mac,
	.ndo_change_mtu	   = qlcnic_change_mtu,
285 286
	.ndo_fix_features  = qlcnic_fix_features,
	.ndo_set_features  = qlcnic_set_features,
287
	.ndo_tx_timeout	   = qlcnic_tx_timeout,
288 289
	.ndo_vlan_rx_add_vid	= qlcnic_vlan_rx_add,
	.ndo_vlan_rx_kill_vid	= qlcnic_vlan_rx_del,
290 291 292 293 294
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller = qlcnic_poll_controller,
#endif
};

295 296 297 298
static const struct net_device_ops qlcnic_netdev_failed_ops = {
	.ndo_open	   = qlcnic_open,
};

299
static struct qlcnic_nic_template qlcnic_ops = {
300 301 302 303 304 305
	.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 已提交
306
	.napi_del		= qlcnic_82xx_napi_del,
307 308 309 310 311 312 313 314
	.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
315 316
};

317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348
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,
349 350
};

351
int qlcnic_enable_msix(struct qlcnic_adapter *adapter, u32 num_msix)
352 353
{
	struct pci_dev *pdev = adapter->pdev;
354
	int err = -1;
355 356 357 358 359

	adapter->max_sds_rings = 1;
	adapter->flags &= ~(QLCNIC_MSI_ENABLED | QLCNIC_MSIX_ENABLED);
	qlcnic_set_msix_bit(pdev, 0);

360
	if (adapter->ahw->msix_supported) {
361
 enable_msix:
362 363 364 365 366 367
		qlcnic_init_msix_entries(adapter, num_msix);
		err = pci_enable_msix(pdev, adapter->msix_entries, num_msix);
		if (err == 0) {
			adapter->flags |= QLCNIC_MSIX_ENABLED;
			qlcnic_set_msix_bit(pdev, 1);

A
Anirban Chakraborty 已提交
368
			adapter->max_sds_rings = num_msix;
369 370

			dev_info(&pdev->dev, "using msi-x interrupts\n");
371
			return err;
372
		}
373 374 375 376 377 378 379 380
		if (err > 0) {
			num_msix = rounddown_pow_of_two(err);
			if (num_msix)
				goto enable_msix;
		}
	}
	return err;
}
381

382 383
static void qlcnic_enable_msi_legacy(struct qlcnic_adapter *adapter)
{
384
	u32 offset, mask_reg;
385
	const struct qlcnic_legacy_intr_set *legacy_intrp;
386
	struct qlcnic_hardware_context *ahw = adapter->ahw;
387
	struct pci_dev *pdev = adapter->pdev;
388

389
	if (qlcnic_use_msi && !pci_enable_msi(pdev)) {
390
		adapter->flags |= QLCNIC_MSI_ENABLED;
391 392 393
		offset = msi_tgt_status[adapter->ahw->pci_func];
		adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter->ahw,
							    offset);
394 395 396 397 398
		dev_info(&pdev->dev, "using msi interrupts\n");
		adapter->msix_entries[0].vector = pdev->irq;
		return;
	}

399
	legacy_intrp = &legacy_intr[adapter->ahw->pci_func];
400
	adapter->ahw->int_vec_bit = legacy_intrp->int_vec_bit;
401 402 403 404 405 406
	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);
407 408 409 410
	dev_info(&pdev->dev, "using legacy interrupts\n");
	adapter->msix_entries[0].vector = pdev->irq;
}

411
int qlcnic_82xx_setup_intr(struct qlcnic_adapter *adapter, u8 num_intr)
412
{
413
	int num_msix, err;
414

415 416 417 418
	if (!num_intr)
		num_intr = QLCNIC_DEF_NUM_STS_DESC_RINGS;

	if (adapter->ahw->msix_supported)
419
		num_msix = rounddown_pow_of_two(min_t(int, num_online_cpus(),
420 421
						num_intr));
	else
422 423
		num_msix = 1;

424 425 426
	err = qlcnic_enable_msix(adapter, num_msix);
	if (err == -ENOMEM || !err)
		return err;
427 428

	qlcnic_enable_msi_legacy(adapter);
429
	return 0;
430
}
431 432 433 434 435 436 437 438 439 440 441 442
static void
qlcnic_teardown_intr(struct qlcnic_adapter *adapter)
{
	if (adapter->flags & QLCNIC_MSIX_ENABLED)
		pci_disable_msix(adapter->pdev);
	if (adapter->flags & QLCNIC_MSI_ENABLED)
		pci_disable_msi(adapter->pdev);
}

static void
qlcnic_cleanup_pci_map(struct qlcnic_adapter *adapter)
{
A
Anirban Chakraborty 已提交
443 444
	if (adapter->ahw->pci_base0 != NULL)
		iounmap(adapter->ahw->pci_base0);
445 446
}

447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474
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;
}
475
static int qlcnic_init_pci_info(struct qlcnic_adapter *adapter)
476
{
D
Dan Carpenter 已提交
477
	struct qlcnic_pci_info *pci_info;
478 479
	int i, ret = 0, j = 0;
	u16 act_pci_func;
480 481
	u8 pfn;

D
Dan Carpenter 已提交
482 483 484 485
	pci_info = kcalloc(QLCNIC_MAX_PCI_FUNC, sizeof(*pci_info), GFP_KERNEL);
	if (!pci_info)
		return -ENOMEM;

486 487 488 489 490 491
	ret = qlcnic_get_pci_info(adapter, pci_info);
	if (ret)
		goto err_pci_info;

	act_pci_func = adapter->ahw->act_pci_func;

492
	adapter->npars = kzalloc(sizeof(struct qlcnic_npar_info) *
493
				 act_pci_func, GFP_KERNEL);
D
Dan Carpenter 已提交
494
	if (!adapter->npars) {
495
		ret = -ENOMEM;
D
Dan Carpenter 已提交
496 497
		goto err_pci_info;
	}
498

499
	adapter->eswitch = kzalloc(sizeof(struct qlcnic_eswitch) *
500 501
				QLCNIC_NIU_MAX_XG_PORTS, GFP_KERNEL);
	if (!adapter->eswitch) {
502
		ret = -ENOMEM;
503
		goto err_npars;
504 505
	}

506 507
	for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
		pfn = pci_info[i].id;
508

509
		if (pfn >= QLCNIC_MAX_PCI_FUNC) {
S
Sony Chacko 已提交
510 511 512
			ret = QL_STATUS_INVALID_PARAM;
			goto err_eswitch;
		}
513 514 515 516 517 518 519 520 521 522 523 524

		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++;
525 526
	}

527 528 529
	for (i = 0; i < QLCNIC_NIU_MAX_XG_PORTS; i++)
		adapter->eswitch[i].flags |= QLCNIC_SWITCH_ENABLE;

D
Dan Carpenter 已提交
530
	kfree(pci_info);
531 532 533
	return 0;

err_eswitch:
534 535
	kfree(adapter->eswitch);
	adapter->eswitch = NULL;
536
err_npars:
537
	kfree(adapter->npars);
538
	adapter->npars = NULL;
D
Dan Carpenter 已提交
539 540
err_pci_info:
	kfree(pci_info);
541 542 543 544

	return ret;
}

545 546 547 548 549 550
static int
qlcnic_set_function_modes(struct qlcnic_adapter *adapter)
{
	u8 id;
	int i, ret = 1;
	u32 data = QLCNIC_MGMT_FUNC;
551
	struct qlcnic_hardware_context *ahw = adapter->ahw;
552 553 554 555 556

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

557
	if (qlcnic_config_npars) {
558 559 560
		for (i = 0; i < ahw->act_pci_func; i++) {
			id = adapter->npars[i].pci_func;
			if (id == ahw->pci_func)
561 562 563 564 565
				continue;
			data |= (qlcnic_config_npars &
					QLC_DEV_SET_DRV(0xf, id));
		}
	} else {
566
		data = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
567
		data = (data & ~QLC_DEV_SET_DRV(0xf, ahw->pci_func)) |
568
			(QLC_DEV_SET_DRV(QLCNIC_MGMT_FUNC,
569
					 ahw->pci_func));
570
	}
571
	QLC_SHARED_REG_WR32(adapter, QLCNIC_DRV_OP_MODE, data);
572 573 574 575 576
	qlcnic_api_unlock(adapter);
err_lock:
	return ret;
}

577 578
static void
qlcnic_check_vf(struct qlcnic_adapter *adapter)
579 580 581 582 583 584 585 586
{
	void __iomem *msix_base_addr;
	void __iomem *priv_op;
	u32 func;
	u32 msix_base;
	u32 op_mode, priv_level;

	/* Determine FW API version */
587 588
	adapter->ahw->fw_hal_version = readl(adapter->ahw->pci_base0 +
					     QLCNIC_FW_API);
589 590 591

	/* Find PCI function number */
	pci_read_config_dword(adapter->pdev, QLCNIC_MSIX_TABLE_OFFSET, &func);
A
Anirban Chakraborty 已提交
592
	msix_base_addr = adapter->ahw->pci_base0 + QLCNIC_MSIX_BASE;
593 594
	msix_base = readl(msix_base_addr);
	func = (func - msix_base)/QLCNIC_MSIX_TBL_PGSIZE;
A
Anirban Chakraborty 已提交
595
	adapter->ahw->pci_func = func;
596 597

	/* Determine function privilege level */
A
Anirban Chakraborty 已提交
598
	priv_op = adapter->ahw->pci_base0 + QLCNIC_DRV_OP_MODE;
599
	op_mode = readl(priv_op);
600
	if (op_mode == QLC_DEV_DRV_DEFAULT)
601
		priv_level = QLCNIC_MGMT_FUNC;
602
	else
A
Anirban Chakraborty 已提交
603
		priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
604

605
	if (priv_level == QLCNIC_NON_PRIV_FUNC) {
606
		adapter->ahw->op_mode = QLCNIC_NON_PRIV_FUNC;
607 608
		dev_info(&adapter->pdev->dev,
			"HAL Version: %d Non Privileged function\n",
609
			 adapter->ahw->fw_hal_version);
610
		adapter->nic_ops = &qlcnic_vf_ops;
611 612
	} else
		adapter->nic_ops = &qlcnic_ops;
613 614
}

615 616 617 618 619 620 621 622 623 624 625 626 627 628
#define QLCNIC_82XX_BAR0_LENGTH 0x00200000UL
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;
	default:
		*bar = 0;
	}
}

static int qlcnic_setup_pci_map(struct pci_dev *pdev,
				struct qlcnic_hardware_context *ahw)
629
{
630
	u32 offset;
631
	void __iomem *mem_ptr0 = NULL;
632
	unsigned long mem_len, pci_len0 = 0, bar0_len;
633 634 635 636

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

637 638
	qlcnic_get_bar_length(pdev->device, &bar0_len);
	if (mem_len >= bar0_len) {
639 640 641 642 643 644 645 646 647 648 649 650

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

652 653 654 655
	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);
656 657 658 659

	return 0;
}

S
Sony Chacko 已提交
660
static void qlcnic_get_board_name(struct qlcnic_adapter *adapter, char *name)
661 662 663 664 665 666 667 668 669
{
	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) {
670 671 672
				sprintf(name, "%pM: %s" ,
					adapter->mac_addr,
					qlcnic_boards[i].short_name);
673 674 675 676 677 678 679
				found = 1;
				break;
		}

	}

	if (!found)
680
		sprintf(name, "%pM Gigabit Ethernet", adapter->mac_addr);
681 682 683 684 685
}

static void
qlcnic_check_options(struct qlcnic_adapter *adapter)
{
686
	int err;
687
	u32 fw_major, fw_minor, fw_build, prev_fw_version;
688
	struct pci_dev *pdev = adapter->pdev;
689 690
	struct qlcnic_hardware_context *ahw = adapter->ahw;
	struct qlcnic_fw_dump *fw_dump = &ahw->fw_dump;
691 692

	prev_fw_version = adapter->fw_version;
693

694 695 696
	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);
697 698 699

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

700 701 702 703 704 705
	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) {
706 707 708 709 710 711 712 713 714 715
		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");
		}
	}

A
Amit Kumar Salecha 已提交
716 717
	dev_info(&pdev->dev, "firmware v%d.%d.%d\n",
			fw_major, fw_minor, fw_build);
A
Anirban Chakraborty 已提交
718
	if (adapter->ahw->port_type == QLCNIC_XGBE) {
S
Sony Chacko 已提交
719 720 721 722 723 724 725 726
		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;
		}

727
		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
S
Sony Chacko 已提交
728 729
		adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;

A
Anirban Chakraborty 已提交
730
	} else if (adapter->ahw->port_type == QLCNIC_GBE) {
731 732
		adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G;
		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
S
Sony Chacko 已提交
733 734
		adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
		adapter->max_rxd = MAX_RCV_DESCRIPTORS_1G;
735 736
	}

737
	adapter->ahw->msix_supported = !!qlcnic_use_msi_x;
738 739 740

	adapter->num_txd = MAX_CMD_DESCRIPTORS;

741
	adapter->max_rds_rings = MAX_RDS_RINGS;
742 743
}

744 745 746 747 748 749
static int
qlcnic_initialize_nic(struct qlcnic_adapter *adapter)
{
	int err;
	struct qlcnic_info nic_info;

750
	memset(&nic_info, 0, sizeof(struct qlcnic_info));
A
Anirban Chakraborty 已提交
751
	err = qlcnic_get_nic_info(adapter, &nic_info, adapter->ahw->pci_func);
752 753 754
	if (err)
		return err;

755 756 757 758 759 760 761
	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;
762

763
	if (adapter->ahw->capabilities & BIT_6)
764 765 766 767 768 769 770
		adapter->flags |= QLCNIC_ESWITCH_ENABLED;
	else
		adapter->flags &= ~QLCNIC_ESWITCH_ENABLED;

	return err;
}

771 772
void qlcnic_set_vlan_config(struct qlcnic_adapter *adapter,
			    struct qlcnic_esw_func_cfg *esw_cfg)
773 774 775 776 777 778 779 780 781 782 783 784
{
	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;
}

785
static int
786 787 788 789
qlcnic_vlan_rx_add(struct net_device *netdev, u16 vid)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	set_bit(vid, adapter->vlans);
790
	return 0;
791 792
}

793
static int
794 795 796 797 798 799
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);
800
	return 0;
801 802
}

803 804
void qlcnic_set_eswitch_port_features(struct qlcnic_adapter *adapter,
				      struct qlcnic_esw_func_cfg *esw_cfg)
805
{
806 807
	adapter->flags &= ~(QLCNIC_MACSPOOF | QLCNIC_MAC_OVERRIDE_DISABLED |
				QLCNIC_PROMISC_DISABLED);
808 809 810

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

812 813 814
	if (!esw_cfg->mac_override)
		adapter->flags |= QLCNIC_MAC_OVERRIDE_DISABLED;

815 816 817
	if (!esw_cfg->promisc_mode)
		adapter->flags |= QLCNIC_PROMISC_DISABLED;

818 819 820
	qlcnic_set_netdev_features(adapter, esw_cfg);
}

821
static int qlcnic_set_eswitch_port_config(struct qlcnic_adapter *adapter)
822 823 824 825 826 827
{
	struct qlcnic_esw_func_cfg esw_cfg;

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

A
Anirban Chakraborty 已提交
828
	esw_cfg.pci_func = adapter->ahw->pci_func;
829 830
	if (qlcnic_get_eswitch_port_config(adapter, &esw_cfg))
			return -EIO;
831
	qlcnic_set_vlan_config(adapter, &esw_cfg);
832 833 834 835 836 837 838 839 840 841
	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;
842
	netdev_features_t features, vlan_features;
843

844
	features = (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |
845 846
			NETIF_F_IPV6_CSUM | NETIF_F_GRO);
	vlan_features = (NETIF_F_SG | NETIF_F_IP_CSUM |
847
			NETIF_F_IPV6_CSUM | NETIF_F_HW_VLAN_FILTER);
848

849
	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_TSO) {
850 851 852
		features |= (NETIF_F_TSO | NETIF_F_TSO6);
		vlan_features |= (NETIF_F_TSO | NETIF_F_TSO6);
	}
R
Rajesh Borundia 已提交
853 854

	if (netdev->features & NETIF_F_LRO)
855 856 857 858 859 860 861 862 863 864 865 866 867 868 869
		features |= NETIF_F_LRO;

	if (esw_cfg->offload_flags & BIT_0) {
		netdev->features |= features;
		if (!(esw_cfg->offload_flags & BIT_1))
			netdev->features &= ~NETIF_F_TSO;
		if (!(esw_cfg->offload_flags & BIT_2))
			netdev->features &= ~NETIF_F_TSO6;
	} else {
		netdev->features &= ~features;
	}

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

870 871 872 873 874 875 876
static int
qlcnic_check_eswitch_mode(struct qlcnic_adapter *adapter)
{
	void __iomem *priv_op;
	u32 op_mode, priv_level;
	int err = 0;

877 878 879 880
	err = qlcnic_initialize_nic(adapter);
	if (err)
		return err;

881 882 883
	if (adapter->flags & QLCNIC_ADAPTER_INITIALIZED)
		return 0;

A
Anirban Chakraborty 已提交
884
	priv_op = adapter->ahw->pci_base0 + QLCNIC_DRV_OP_MODE;
885
	op_mode = readl(priv_op);
A
Anirban Chakraborty 已提交
886
	priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
887 888 889 890

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

893
	if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
894
		if (priv_level == QLCNIC_MGMT_FUNC) {
895
			adapter->ahw->op_mode = QLCNIC_MGMT_FUNC;
896 897 898 899 900 901 902
			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",
903
				 adapter->ahw->fw_hal_version);
904
		} else if (priv_level == QLCNIC_PRIV_FUNC) {
905
			adapter->ahw->op_mode = QLCNIC_PRIV_FUNC;
906 907
			dev_info(&adapter->pdev->dev,
				"HAL Version: %d, Privileged function\n",
908
				 adapter->ahw->fw_hal_version);
909
		}
910
	}
911 912 913 914 915 916

	adapter->flags |= QLCNIC_ADAPTER_INITIALIZED;

	return err;
}

917
static int qlcnic_set_default_offload_settings(struct qlcnic_adapter *adapter)
918 919 920 921 922
{
	struct qlcnic_esw_func_cfg esw_cfg;
	struct qlcnic_npar_info *npar;
	u8 i;

923
	if (adapter->need_fw_reset)
924 925
		return 0;

926
	for (i = 0; i < adapter->ahw->act_pci_func; i++) {
927
		memset(&esw_cfg, 0, sizeof(struct qlcnic_esw_func_cfg));
928
		esw_cfg.pci_func = adapter->npars[i].pci_func;
929
		esw_cfg.mac_override = BIT_0;
930
		esw_cfg.promisc_mode = BIT_0;
931 932 933 934 935
		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);
		}
936 937 938 939
		if (qlcnic_config_switch_port(adapter, &esw_cfg))
			return -EIO;
		npar = &adapter->npars[i];
		npar->pvid = esw_cfg.vlan_id;
940
		npar->mac_override = esw_cfg.mac_override;
941 942 943 944 945 946 947 948 949
		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;
}

950 951 952 953 954 955 956 957
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;
958
	esw_cfg.mac_override = npar->mac_override;
959 960 961 962 963 964 965 966 967 968 969 970 971 972
	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;
}

973
static int qlcnic_reset_npar_config(struct qlcnic_adapter *adapter)
974
{
975
	int i, err;
976 977
	struct qlcnic_npar_info *npar;
	struct qlcnic_info nic_info;
978
	u8 pci_func;
979

980 981 982
	if (qlcnic_82xx_check(adapter))
		if (!adapter->need_fw_reset)
			return 0;
983

984
	/* Set the NPAR config data after FW reset */
985
	for (i = 0; i < adapter->ahw->act_pci_func; i++) {
986
		npar = &adapter->npars[i];
987 988 989 990
		pci_func = npar->pci_func;
		memset(&nic_info, 0, sizeof(struct qlcnic_info));
		err = qlcnic_get_nic_info(adapter,
					  &nic_info, pci_func);
991 992 993 994 995 996 997
		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;
998

999 1000
		if (npar->enable_pm) {
			err = qlcnic_config_port_mirroring(adapter,
1001 1002
							   npar->dest_npar, 1,
							   pci_func);
1003 1004
			if (err)
				return err;
1005
		}
1006
		err = qlcnic_reset_eswitch_config(adapter, npar, pci_func);
1007 1008
		if (err)
			return err;
1009
	}
1010
	return 0;
1011 1012
}

A
Amit Kumar Salecha 已提交
1013 1014 1015 1016 1017
static int qlcnic_check_npar_opertional(struct qlcnic_adapter *adapter)
{
	u8 npar_opt_timeo = QLCNIC_DEV_NPAR_OPER_TIMEO;
	u32 npar_state;

1018
	if (adapter->ahw->op_mode == QLCNIC_MGMT_FUNC)
A
Amit Kumar Salecha 已提交
1019 1020
		return 0;

1021 1022
	npar_state = QLC_SHARED_REG_RD32(adapter,
					 QLCNIC_CRB_DEV_NPAR_STATE);
A
Amit Kumar Salecha 已提交
1023 1024
	while (npar_state != QLCNIC_DEV_NPAR_OPER && --npar_opt_timeo) {
		msleep(1000);
1025 1026
		npar_state = QLC_SHARED_REG_RD32(adapter,
						 QLCNIC_CRB_DEV_NPAR_STATE);
A
Amit Kumar Salecha 已提交
1027 1028 1029 1030 1031 1032 1033 1034 1035
	}
	if (!npar_opt_timeo) {
		dev_err(&adapter->pdev->dev,
			"Waiting for NPAR state to opertional timeout\n");
		return -EIO;
	}
	return 0;
}

1036 1037 1038 1039 1040 1041
static int
qlcnic_set_mgmt_operations(struct qlcnic_adapter *adapter)
{
	int err;

	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
1042
	    adapter->ahw->op_mode != QLCNIC_MGMT_FUNC)
1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057
		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);

	return err;
}

1058
int qlcnic_82xx_start_firmware(struct qlcnic_adapter *adapter)
1059
{
1060
	int err;
1061

1062 1063 1064 1065
	err = qlcnic_can_start_firmware(adapter);
	if (err < 0)
		return err;
	else if (!err)
1066
		goto check_fw_status;
1067

1068
	if (qlcnic_load_fw_file)
1069
		qlcnic_request_firmware(adapter);
S
schacko 已提交
1070
	else {
S
Sony Chacko 已提交
1071 1072
		err = qlcnic_check_flash_fw_ver(adapter);
		if (err)
S
schacko 已提交
1073 1074
			goto err_out;

1075
		adapter->ahw->fw_type = QLCNIC_FLASH_ROMIMAGE;
S
schacko 已提交
1076
	}
1077 1078 1079

	err = qlcnic_need_fw_reset(adapter);
	if (err == 0)
1080
		goto check_fw_status;
1081

1082 1083 1084
	err = qlcnic_pinit_from_rom(adapter);
	if (err)
		goto err_out;
1085 1086 1087 1088 1089 1090

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

	qlcnic_release_firmware(adapter);
1091
	QLCWR32(adapter, CRB_DRIVER_VERSION, QLCNIC_DRIVER_VERSION);
1092

1093 1094
check_fw_status:
	err = qlcnic_check_fw_status(adapter);
1095 1096 1097
	if (err)
		goto err_out;

1098
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_READY);
1099
	qlcnic_idc_debug_info(adapter, 1);
1100 1101 1102 1103 1104 1105
	err = qlcnic_check_eswitch_mode(adapter);
	if (err) {
		dev_err(&adapter->pdev->dev,
			"Memory allocation failed for eswitch\n");
		goto err_out;
	}
1106 1107 1108 1109 1110
	err = qlcnic_set_mgmt_operations(adapter);
	if (err)
		goto err_out;

	qlcnic_check_options(adapter);
1111 1112
	adapter->need_fw_reset = 0;

1113 1114
	qlcnic_release_firmware(adapter);
	return 0;
1115 1116

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

1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132
	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;
	int err, ring;

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

1135
	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148
		handler = qlcnic_tmp_intr;
		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;
		}
1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169
	}
	adapter->irq = netdev->irq;

	for (ring = 0; ring < adapter->max_sds_rings; ring++) {
		sds_ring = &recv_ctx->sds_rings[ring];
		sprintf(sds_ring->name, "%s[%d]", netdev->name, ring);
		err = request_irq(sds_ring->irq, handler,
				  flags, sds_ring->name, sds_ring);
		if (err)
			return err;
	}

	return 0;
}

static void
qlcnic_free_irq(struct qlcnic_adapter *adapter)
{
	int ring;
	struct qlcnic_host_sds_ring *sds_ring;

A
Anirban Chakraborty 已提交
1170
	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1171 1172 1173 1174 1175 1176 1177 1178 1179 1180

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

static int
__qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
{
1181
	int ring;
1182 1183
	u32 capab2;

1184 1185
	struct qlcnic_host_rds_ring *rds_ring;

1186 1187 1188
	if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
		return -EIO;

1189 1190
	if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
		return 0;
1191 1192
	if (qlcnic_set_eswitch_port_config(adapter))
		return -EIO;
1193

1194
	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_MORE_CAPS) {
1195 1196 1197 1198 1199
		capab2 = QLCRD32(adapter, CRB_FW_CAPABILITIES_2);
		if (capab2 & QLCNIC_FW_CAPABILITY_2_LRO_MAX_TCP_SEG)
			adapter->flags |= QLCNIC_FW_LRO_MSS_CAP;
	}

1200 1201 1202 1203
	if (qlcnic_fw_create_ctx(adapter))
		return -EIO;

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

1208 1209 1210
	qlcnic_set_multi(netdev);
	qlcnic_fw_cmd_set_mtu(adapter, netdev->mtu);

A
Anirban Chakraborty 已提交
1211
	adapter->ahw->linkup = 0;
1212 1213 1214 1215 1216 1217

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

	qlcnic_config_intr_coalesce(adapter);

1218
	if (netdev->features & NETIF_F_LRO)
1219 1220 1221 1222 1223 1224
		qlcnic_config_hw_lro(adapter, QLCNIC_LRO_ENABLED);

	qlcnic_napi_enable(adapter);

	qlcnic_linkevent_request(adapter, 1);

1225
	adapter->ahw->reset_context = 0;
1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260
	set_bit(__QLCNIC_DEV_UP, &adapter->state);
	return 0;
}

/* Usage: During resume and firmware recovery module.*/

static int
qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
{
	int err = 0;

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

	return err;
}

static void
__qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
{
	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);

1261 1262 1263
	if (adapter->fhash.fnum)
		qlcnic_delete_lb_filters(adapter);

1264 1265 1266 1267
	qlcnic_nic_set_promisc(adapter, QLCNIC_NIU_NON_PROMISC_MODE);

	qlcnic_napi_disable(adapter);

1268
	qlcnic_fw_destroy_ctx(adapter);
1269
	adapter->flags &= ~QLCNIC_FW_LRO_MSS_CAP;
1270 1271

	qlcnic_reset_rx_buffers_list(adapter);
1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292
	qlcnic_release_tx_buffers(adapter);
	spin_unlock(&adapter->tx_clean_lock);
}

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

static void
qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
{
	rtnl_lock();
	if (netif_running(netdev))
		__qlcnic_down(adapter, netdev);
	rtnl_unlock();

}

static int
qlcnic_attach(struct qlcnic_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;
1293
	int err;
1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304

	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");
1305
		goto err_out_napi_del;
1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316
	}

	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");
1317
		goto err_out_free_hw;
1318 1319 1320 1321 1322 1323 1324
	}

	qlcnic_create_sysfs_entries(adapter);

	adapter->is_up = QLCNIC_ADAPTER_UP_MAGIC;
	return 0;

1325
err_out_free_hw:
1326 1327 1328
	qlcnic_free_hw_resources(adapter);
err_out_free_sw:
	qlcnic_free_sw_resources(adapter);
1329 1330
err_out_napi_del:
	qlcnic_napi_del(adapter);
1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350
	return err;
}

static void
qlcnic_detach(struct qlcnic_adapter *adapter)
{
	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;
}

1351 1352 1353 1354 1355 1356
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;

1357
	clear_bit(__QLCNIC_DEV_UP, &adapter->state);
1358
	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
1359
		for (ring = 0; ring < adapter->max_sds_rings; ring++) {
A
Anirban Chakraborty 已提交
1360
			sds_ring = &adapter->recv_ctx->sds_rings[ring];
1361 1362
			qlcnic_disable_int(sds_ring);
		}
1363 1364
	}

1365 1366
	qlcnic_fw_destroy_ctx(adapter);

1367 1368
	qlcnic_detach(adapter);

1369
	adapter->ahw->diag_test = 0;
1370 1371 1372
	adapter->max_sds_rings = max_sds_rings;

	if (qlcnic_attach(adapter))
1373
		goto out;
1374 1375 1376

	if (netif_running(netdev))
		__qlcnic_up(adapter, netdev);
1377
out:
1378 1379 1380
	netif_device_attach(netdev);
}

A
Anirban Chakraborty 已提交
1381 1382 1383 1384 1385 1386 1387 1388 1389
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 已提交
1390
		goto err_out;
A
Anirban Chakraborty 已提交
1391
	}
A
Anirban Chakraborty 已提交
1392 1393 1394 1395
	/* 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 已提交
1396 1397
	/* clear stats */
	memset(&adapter->stats, 0, sizeof(adapter->stats));
A
Anirban Chakraborty 已提交
1398 1399 1400 1401 1402 1403 1404 1405 1406
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 已提交
1407 1408 1409 1410
	if (adapter->ahw->fw_dump.tmpl_hdr) {
		vfree(adapter->ahw->fw_dump.tmpl_hdr);
		adapter->ahw->fw_dump.tmpl_hdr = NULL;
	}
S
Sony Chacko 已提交
1411 1412

	adapter->ahw->fw_dump.tmpl_hdr = NULL;
A
Anirban Chakraborty 已提交
1413 1414
}

1415 1416 1417 1418
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;
1419
	struct qlcnic_host_rds_ring *rds_ring;
1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430
	int ring;
	int ret;

	netif_device_detach(netdev);

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

	qlcnic_detach(adapter);

	adapter->max_sds_rings = 1;
1431
	adapter->ahw->diag_test = test;
S
Sony Chacko 已提交
1432
	adapter->ahw->linkup = 0;
1433 1434

	ret = qlcnic_attach(adapter);
1435 1436
	if (ret) {
		netif_device_attach(netdev);
1437
		return ret;
1438
	}
1439

1440 1441 1442
	ret = qlcnic_fw_create_ctx(adapter);
	if (ret) {
		qlcnic_detach(adapter);
1443
		netif_device_attach(netdev);
1444 1445 1446 1447
		return ret;
	}

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

1452
	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
1453
		for (ring = 0; ring < adapter->max_sds_rings; ring++) {
A
Anirban Chakraborty 已提交
1454
			sds_ring = &adapter->recv_ctx->sds_rings[ring];
1455 1456
			qlcnic_enable_int(sds_ring);
		}
1457
	}
1458

1459
	if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {
1460 1461 1462 1463
		adapter->ahw->loopback_state = 0;
		qlcnic_linkevent_request(adapter, 1);
	}

1464
	set_bit(__QLCNIC_DEV_UP, &adapter->state);
1465 1466 1467 1468

	return 0;
}

1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489
/* 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);
	return 0;
}

1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509
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 已提交
1510
			if (!err) {
1511
				__qlcnic_up(adapter, netdev);
A
Anirban Chakraborty 已提交
1512 1513
				qlcnic_restore_indev_addr(netdev, NETDEV_UP);
			}
1514 1515 1516 1517 1518 1519 1520 1521 1522 1523
		}

		netif_device_attach(netdev);
	}

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

static int
S
Sony Chacko 已提交
1524 1525
qlcnic_setup_netdev(struct qlcnic_adapter *adapter, struct net_device *netdev,
		    int pci_using_dac)
1526 1527 1528 1529
{
	int err;
	struct pci_dev *pdev = adapter->pdev;

1530 1531
	adapter->ahw->mc_enabled = 0;
	adapter->ahw->max_mc_count = 38;
1532 1533

	netdev->netdev_ops	   = &qlcnic_netdev_ops;
1534
	netdev->watchdog_timeo     = 5*HZ;
1535 1536 1537 1538 1539

	qlcnic_change_mtu(netdev, netdev->mtu);

	SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_ops);

1540 1541
	netdev->hw_features = NETIF_F_SG | NETIF_F_IP_CSUM |
		NETIF_F_IPV6_CSUM | NETIF_F_RXCSUM;
1542

1543
	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_TSO)
1544
		netdev->hw_features |= NETIF_F_TSO | NETIF_F_TSO6;
S
Sony Chacko 已提交
1545
	if (pci_using_dac == 1)
1546
		netdev->hw_features |= NETIF_F_HIGHDMA;
1547

1548
	netdev->vlan_features = netdev->hw_features;
1549

1550
	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_FVLANTX)
1551
		netdev->hw_features |= NETIF_F_HW_VLAN_TX;
1552
	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)
1553 1554 1555 1556 1557
		netdev->hw_features |= NETIF_F_LRO;

	netdev->features |= netdev->hw_features |
		NETIF_F_HW_VLAN_RX | NETIF_F_HW_VLAN_FILTER;

1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568
	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 已提交
1569
static int qlcnic_set_dma_mask(struct pci_dev *pdev, int *pci_using_dac)
1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584
{
	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;
}

1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597
static int
qlcnic_alloc_msix_entries(struct qlcnic_adapter *adapter, u16 count)
{
	adapter->msix_entries = kcalloc(count, sizeof(struct msix_entry),
					GFP_KERNEL);

	if (adapter->msix_entries)
		return 0;

	dev_err(&adapter->pdev->dev, "failed allocating msix_entries\n");
	return -ENOMEM;
}

S
Sony Chacko 已提交
1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657
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;
}

1658
static int __devinit
1659 1660 1661 1662
qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
{
	struct net_device *netdev = NULL;
	struct qlcnic_adapter *adapter = NULL;
1663
	struct qlcnic_hardware_context *ahw;
S
Sony Chacko 已提交
1664
	int err, pci_using_dac = -1;
S
Sony Chacko 已提交
1665
	char board_name[QLCNIC_MAX_BOARD_NAME_LEN];
1666 1667 1668 1669 1670 1671 1672 1673 1674 1675

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

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

1676 1677 1678 1679
	err = qlcnic_set_dma_mask(pdev, &pci_using_dac);
	if (err)
		goto err_out_disable_pdev;

1680 1681 1682 1683 1684
	err = pci_request_regions(pdev, qlcnic_driver_name);
	if (err)
		goto err_out_disable_pdev;

	pci_set_master(pdev);
S
Sucheta Chakraborty 已提交
1685
	pci_enable_pcie_error_reporting(pdev);
1686

1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699
	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;
	}

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

1700 1701 1702
	netdev = alloc_etherdev(sizeof(struct qlcnic_adapter));
	if (!netdev) {
		err = -ENOMEM;
1703
		goto err_out_iounmap;
1704 1705 1706 1707 1708 1709 1710 1711
	}

	SET_NETDEV_DEV(netdev, &pdev->dev);

	adapter = netdev_priv(netdev);
	adapter->netdev  = netdev;
	adapter->pdev    = pdev;

1712 1713
	err = qlcnic_alloc_adapter_resources(adapter);
	if (err)
A
Anirban Chakraborty 已提交
1714 1715 1716
		goto err_out_free_netdev;

	adapter->dev_rst_time = jiffies;
1717
	adapter->ahw->revision_id = pdev->revision;
1718
	adapter->mac_learn = qlcnic_mac_learn;
1719
	adapter->max_drv_tx_rings = 1;
1720

A
Anirban Chakraborty 已提交
1721 1722
	rwlock_init(&adapter->ahw->crb_lock);
	mutex_init(&adapter->ahw->mem_lock);
1723 1724 1725 1726

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

1727 1728 1729 1730 1731 1732 1733 1734
	if (qlcnic_82xx_check(adapter)) {
		qlcnic_check_vf(adapter);
		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;
		}
1735

1736 1737 1738
		err = qlcnic_setup_idc_param(adapter);
		if (err)
			goto err_out_free_hw;
1739

1740
		adapter->flags |= QLCNIC_NEED_FLR;
1741
	}
1742

R
Rajesh Borundia 已提交
1743 1744 1745 1746
	if (qlcnic_read_mac_addr(adapter))
		dev_warn(&pdev->dev, "failed to read mac addr\n");

	if (adapter->portnum == 0) {
S
Sony Chacko 已提交
1747
		qlcnic_get_board_name(adapter, board_name);
R
Rajesh Borundia 已提交
1748
		pr_info("%s: %s Board Chip rev 0x%x\n",
S
Sony Chacko 已提交
1749 1750
			module_name(THIS_MODULE),
			board_name, adapter->ahw->revision_id);
R
Rajesh Borundia 已提交
1751
	}
1752
	err = qlcnic_alloc_msix_entries(adapter, adapter->ahw->max_rx_ques);
1753
	if (err)
1754 1755 1756 1757 1758
		goto err_out_disable_msi;

	err = qlcnic_setup_intr(adapter, 0);
	if (err)
		goto err_out_disable_msi;
1759

1760

1761
	err = qlcnic_setup_netdev(adapter, netdev, pci_using_dac);
1762
	if (err)
1763
		goto err_out_disable_mbx_intr;
1764 1765 1766

	pci_set_drvdata(pdev, adapter);

1767 1768 1769
	if (qlcnic_82xx_check(adapter))
		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
				     FW_POLL_DELAY);
1770

A
Anirban Chakraborty 已提交
1771
	switch (adapter->ahw->port_type) {
1772 1773 1774 1775 1776 1777 1778 1779 1780 1781
	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;
	}

1782 1783 1784
	if (qlcnic_get_act_pci_func(adapter))
		goto err_out_disable_mbx_intr;

1785 1786 1787
	if (adapter->mac_learn)
		qlcnic_alloc_lb_filters_mem(adapter);

1788
	qlcnic_add_sysfs(adapter);
1789 1790 1791

	return 0;

1792 1793
err_out_disable_mbx_intr:

1794 1795
err_out_disable_msi:
	qlcnic_teardown_intr(adapter);
1796
	qlcnic_cancel_idc_work(adapter);
1797
	qlcnic_clr_all_drv_state(adapter, 0);
1798

A
Anirban Chakraborty 已提交
1799 1800 1801
err_out_free_hw:
	qlcnic_free_adapter_resources(adapter);

1802 1803 1804
err_out_free_netdev:
	free_netdev(netdev);

1805 1806 1807 1808 1809 1810
err_out_iounmap:
	qlcnic_cleanup_pci_map(adapter);

err_out_free_hw_res:
	kfree(ahw);

1811 1812 1813 1814 1815 1816 1817 1818 1819
err_out_free_res:
	pci_release_regions(pdev);

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

B
Bill Pemberton 已提交
1820
static void qlcnic_remove(struct pci_dev *pdev)
1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836
{
	struct qlcnic_adapter *adapter;
	struct net_device *netdev;

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

	netdev = adapter->netdev;

	qlcnic_cancel_fw_work(adapter);

	unregister_netdev(netdev);

	qlcnic_detach(adapter);

1837 1838 1839 1840 1841
	if (adapter->npars != NULL)
		kfree(adapter->npars);
	if (adapter->eswitch != NULL)
		kfree(adapter->eswitch);

1842 1843
	if (qlcnic_82xx_check(adapter))
		qlcnic_clr_all_drv_state(adapter, 0);
1844 1845 1846

	clear_bit(__QLCNIC_RESETTING, &adapter->state);

1847 1848
	qlcnic_free_lb_filters_mem(adapter);

1849
	qlcnic_teardown_intr(adapter);
1850
	kfree(adapter->msix_entries);
1851 1852 1853 1854 1855 1856 1857

	qlcnic_remove_diag_entries(adapter);

	qlcnic_cleanup_pci_map(adapter);

	qlcnic_release_firmware(adapter);

S
Sucheta Chakraborty 已提交
1858
	pci_disable_pcie_error_reporting(pdev);
1859 1860 1861 1862
	pci_release_regions(pdev);
	pci_disable_device(pdev);
	pci_set_drvdata(pdev, NULL);

A
Anirban Chakraborty 已提交
1863
	qlcnic_free_adapter_resources(adapter);
1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878
	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);

	qlcnic_cancel_fw_work(adapter);

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

1879 1880
	if (qlcnic_82xx_check(adapter))
		qlcnic_clr_all_drv_state(adapter, 0);
1881 1882 1883 1884 1885 1886 1887

	clear_bit(__QLCNIC_RESETTING, &adapter->state);

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

1888 1889 1890 1891 1892
	if (qlcnic_82xx_check(adapter)) {
		if (qlcnic_wol_supported(adapter)) {
			pci_enable_wake(pdev, PCI_D3cold, 1);
			pci_enable_wake(pdev, PCI_D3hot, 1);
		}
1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934
	}

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

1935
	err = adapter->nic_ops->start_firmware(adapter);
1936 1937 1938 1939 1940 1941 1942 1943
	if (err) {
		dev_err(&pdev->dev, "failed to start firmware\n");
		return err;
	}

	if (netif_running(netdev)) {
		err = qlcnic_up(adapter, netdev);
		if (err)
1944
			goto done;
1945

A
Amit Kumar Salecha 已提交
1946
		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
1947
	}
1948
done:
1949 1950 1951 1952 1953 1954 1955 1956 1957
	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);
1958
	u32 state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
1959 1960
	int err;

1961 1962 1963 1964 1965
	if (state == QLCNIC_DEV_FAILED || (state == QLCNIC_DEV_BADBAD)) {
		netdev_err(netdev, "Device in FAILED state\n");
		return -EIO;
	}

1966 1967
	netif_carrier_off(netdev);

1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995
	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);
	return 0;
}

1996
void qlcnic_alloc_lb_filters_mem(struct qlcnic_adapter *adapter)
1997 1998 1999 2000
{
	void *head;
	int i;

2001
	if (adapter->fhash.fmax && adapter->fhash.fhead)
2002 2003 2004 2005 2006 2007 2008 2009 2010 2011
		return;

	spin_lock_init(&adapter->mac_learn_lock);

	head = kcalloc(QLCNIC_LB_MAX_FILTERS, sizeof(struct hlist_head),
								GFP_KERNEL);
	if (!head)
		return;

	adapter->fhash.fmax = QLCNIC_LB_MAX_FILTERS;
2012
	adapter->fhash.fhead = head;
2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026

	for (i = 0; i < adapter->fhash.fmax; i++)
		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;
}

2027 2028 2029
static int qlcnic_check_temp(struct qlcnic_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
2030
	u32 temp_state, temp_val, temp = 0;
2031 2032
	int rv = 0;

2033
	if (qlcnic_82xx_check(adapter))
2034
		temp = QLC_SHARED_REG_RD32(adapter, QLCNIC_ASIC_TEMP);
2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045

	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) {
2046
		if (adapter->ahw->temp == QLCNIC_TEMP_NORMAL) {
2047 2048 2049 2050 2051 2052 2053
			dev_err(&netdev->dev,
			       "Device temperature %d degrees C "
			       "exceeds operating range."
			       " Immediate action needed.\n",
			       temp_val);
		}
	} else {
2054
		if (adapter->ahw->temp == QLCNIC_TEMP_WARN) {
2055 2056 2057 2058 2059
			dev_info(&netdev->dev,
			       "Device temperature is now %d degrees C"
			       " in normal range.\n", temp_val);
		}
	}
2060
	adapter->ahw->temp = temp_state;
2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073
	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)
2074 2075
		adapter->need_fw_reset = 1;
	else
2076
		adapter->ahw->reset_context = 1;
2077 2078 2079 2080 2081 2082 2083 2084 2085
}

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;
2086
	stats->rx_bytes = adapter->stats.rxbytes + adapter->stats.lrobytes;
2087 2088 2089 2090 2091 2092 2093
	stats->tx_bytes = adapter->stats.txbytes;
	stats->rx_dropped = adapter->stats.rxdropped;
	stats->tx_dropped = adapter->stats.txdropped;

	return stats;
}

2094
irqreturn_t qlcnic_82xx_clear_legacy_intr(struct qlcnic_adapter *adapter)
2095 2096 2097 2098 2099
{
	u32 status;

	status = readl(adapter->isr_int_vec);

2100
	if (!(status & adapter->ahw->int_vec_bit))
2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112
		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);

2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131
	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:
2132
	adapter->ahw->diag_cnt++;
2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144
	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;

2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172
	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;
}

#ifdef CONFIG_NET_POLL_CONTROLLER
static void qlcnic_poll_controller(struct net_device *netdev)
{
Y
Yinglin Luan 已提交
2173 2174
	int ring;
	struct qlcnic_host_sds_ring *sds_ring;
2175
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
A
Anirban Chakraborty 已提交
2176
	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
Y
Yinglin Luan 已提交
2177

2178
	disable_irq(adapter->irq);
Y
Yinglin Luan 已提交
2179 2180 2181 2182
	for (ring = 0; ring < adapter->max_sds_rings; ring++) {
		sds_ring = &recv_ctx->sds_rings[ring];
		qlcnic_intr(adapter->irq, sds_ring);
	}
2183 2184 2185 2186
	enable_irq(adapter->irq);
}
#endif

2187 2188 2189 2190 2191 2192 2193 2194 2195
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;

2196
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_SCRATCH, val);
2197 2198 2199
	adapter->dev_rst_time = jiffies;
}

2200 2201
static int
qlcnic_set_drv_state(struct qlcnic_adapter *adapter, u8 state)
2202 2203 2204 2205 2206 2207 2208
{
	u32  val;

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

	if (qlcnic_api_lock(adapter))
2209
		return -EIO;
2210

2211
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2212 2213

	if (state == QLCNIC_DEV_NEED_RESET)
2214
		QLC_DEV_SET_RST_RDY(val, adapter->portnum);
2215
	else if (state == QLCNIC_DEV_NEED_QUISCENT)
2216
		QLC_DEV_SET_QSCNT_RDY(val, adapter->portnum);
2217

2218
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2219 2220

	qlcnic_api_unlock(adapter);
2221 2222

	return 0;
2223 2224
}

2225 2226 2227 2228 2229 2230 2231 2232
static int
qlcnic_clr_drv_state(struct qlcnic_adapter *adapter)
{
	u32  val;

	if (qlcnic_api_lock(adapter))
		return -EBUSY;

2233
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2234
	QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
2235
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2236 2237 2238 2239 2240 2241

	qlcnic_api_unlock(adapter);

	return 0;
}

2242
static void
2243
qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8 failed)
2244 2245 2246 2247 2248 2249
{
	u32  val;

	if (qlcnic_api_lock(adapter))
		goto err;

2250
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2251
	QLC_DEV_CLR_REF_CNT(val, adapter->portnum);
2252
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
2253

2254
	if (failed) {
2255 2256
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_FAILED);
2257 2258 2259
		dev_info(&adapter->pdev->dev,
				"Device state set to Failed. Please Reboot\n");
	} else if (!(val & 0x11111111))
2260 2261
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_COLD);
2262

2263
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2264
	QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
2265
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2266 2267 2268 2269

	qlcnic_api_unlock(adapter);
err:
	adapter->fw_fail_cnt = 0;
S
Sritej Velaga 已提交
2270
	adapter->flags &= ~QLCNIC_FW_HANG;
2271 2272 2273 2274
	clear_bit(__QLCNIC_START_FW, &adapter->state);
	clear_bit(__QLCNIC_RESETTING, &adapter->state);
}

2275
/* Grab api lock, before checking state */
2276 2277 2278
static int
qlcnic_check_drv_state(struct qlcnic_adapter *adapter)
{
2279
	int act, state, active_mask;
2280
	struct qlcnic_hardware_context *ahw = adapter->ahw;
2281

2282 2283
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
	act = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2284

2285
	if (adapter->flags & QLCNIC_FW_RESET_OWNER) {
2286
		active_mask = (~(1 << (ahw->pci_func * 4)));
2287 2288 2289
		act = act & active_mask;
	}

2290 2291 2292 2293 2294 2295 2296
	if (((state & 0x11111111) == (act & 0x11111111)) ||
			((act & 0x11111111) == ((state >> 1) & 0x11111111)))
		return 0;
	else
		return 1;
}

S
Sucheta Chakraborty 已提交
2297 2298
static int qlcnic_check_idc_ver(struct qlcnic_adapter *adapter)
{
2299
	u32 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_IDC_VER);
S
Sucheta Chakraborty 已提交
2300 2301 2302 2303 2304 2305 2306 2307 2308

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

2309 2310 2311 2312
static int
qlcnic_can_start_firmware(struct qlcnic_adapter *adapter)
{
	u32 val, prev_state;
2313
	u8 dev_init_timeo = adapter->dev_init_timeo;
2314
	u8 portnum = adapter->portnum;
S
Sucheta Chakraborty 已提交
2315
	u8 ret;
2316

2317 2318 2319
	if (test_and_clear_bit(__QLCNIC_START_FW, &adapter->state))
		return 1;

2320 2321 2322
	if (qlcnic_api_lock(adapter))
		return -1;

2323
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2324 2325
	if (!(val & (1 << (portnum * 4)))) {
		QLC_DEV_SET_REF_CNT(val, portnum);
2326
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
2327 2328
	}

2329
	prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2330
	QLCDB(adapter, HW, "Device state = %u\n", prev_state);
2331 2332 2333

	switch (prev_state) {
	case QLCNIC_DEV_COLD:
2334 2335 2336 2337
		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);
2338
		qlcnic_idc_debug_info(adapter, 0);
2339 2340 2341 2342
		qlcnic_api_unlock(adapter);
		return 1;

	case QLCNIC_DEV_READY:
S
Sucheta Chakraborty 已提交
2343
		ret = qlcnic_check_idc_ver(adapter);
2344
		qlcnic_api_unlock(adapter);
S
Sucheta Chakraborty 已提交
2345
		return ret;
2346 2347

	case QLCNIC_DEV_NEED_RESET:
2348
		val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2349
		QLC_DEV_SET_RST_RDY(val, portnum);
2350
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2351 2352 2353
		break;

	case QLCNIC_DEV_NEED_QUISCENT:
2354
		val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2355
		QLC_DEV_SET_QSCNT_RDY(val, portnum);
2356
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2357 2358 2359
		break;

	case QLCNIC_DEV_FAILED:
2360
		dev_err(&adapter->pdev->dev, "Device in failed state.\n");
2361 2362
		qlcnic_api_unlock(adapter);
		return -1;
2363 2364 2365 2366

	case QLCNIC_DEV_INITIALIZING:
	case QLCNIC_DEV_QUISCENT:
		break;
2367 2368 2369
	}

	qlcnic_api_unlock(adapter);
2370 2371

	do {
2372
		msleep(1000);
2373
		prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2374 2375 2376 2377

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

2379 2380 2381
	if (!dev_init_timeo) {
		dev_err(&adapter->pdev->dev,
			"Waiting for device to initialize timeout\n");
2382
		return -1;
2383
	}
2384 2385 2386 2387

	if (qlcnic_api_lock(adapter))
		return -1;

2388
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2389
	QLC_DEV_CLR_RST_QSCNT(val, portnum);
2390
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2391

S
Sucheta Chakraborty 已提交
2392
	ret = qlcnic_check_idc_ver(adapter);
2393 2394
	qlcnic_api_unlock(adapter);

S
Sucheta Chakraborty 已提交
2395
	return ret;
2396 2397 2398 2399 2400 2401 2402
}

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

2406 2407
	if (qlcnic_api_lock(adapter))
		goto err_ret;
2408

2409
	dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2410 2411
	if (dev_state == QLCNIC_DEV_QUISCENT ||
	    dev_state == QLCNIC_DEV_NEED_QUISCENT) {
2412 2413 2414 2415 2416 2417
		qlcnic_api_unlock(adapter);
		qlcnic_schedule_work(adapter, qlcnic_fwinit_work,
						FW_POLL_DELAY * 2);
		return;
	}

2418
	if (adapter->ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
2419 2420
		qlcnic_api_unlock(adapter);
		goto wait_npar;
2421 2422
	}

2423 2424 2425 2426 2427 2428 2429
	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;
	}

2430
	if (adapter->fw_wait_cnt++ > adapter->reset_ack_timeo) {
2431
		dev_info(&adapter->pdev->dev, "Reset:Failed to get ack %d sec\n",
2432 2433 2434 2435 2436 2437
					adapter->reset_ack_timeo);
		goto skip_ack_check;
	}

	if (!qlcnic_check_drv_state(adapter)) {
skip_ack_check:
2438
		dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2439

2440
		if (dev_state == QLCNIC_DEV_NEED_RESET) {
2441 2442
			QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
					    QLCNIC_DEV_INITIALIZING);
2443 2444
			set_bit(__QLCNIC_START_FW, &adapter->state);
			QLCDB(adapter, DRV, "Restarting fw\n");
2445
			qlcnic_idc_debug_info(adapter, 0);
2446 2447
			val = QLC_SHARED_REG_RD32(adapter,
						  QLCNIC_CRB_DRV_STATE);
S
Sritej Velaga 已提交
2448
			QLC_DEV_SET_RST_RDY(val, adapter->portnum);
2449 2450
			QLC_SHARED_REG_WR32(adapter,
					    QLCNIC_CRB_DRV_STATE, val);
2451 2452
		}

2453 2454
		qlcnic_api_unlock(adapter);

2455
		rtnl_lock();
S
Sritej Velaga 已提交
2456 2457
		if (adapter->ahw->fw_dump.enable &&
		    (adapter->flags & QLCNIC_FW_RESET_OWNER)) {
2458 2459
			QLCDB(adapter, DRV, "Take FW dump\n");
			qlcnic_dump_fw(adapter);
S
Sritej Velaga 已提交
2460
			adapter->flags |= QLCNIC_FW_HANG;
2461
		}
2462
		rtnl_unlock();
S
Sritej Velaga 已提交
2463 2464

		adapter->flags &= ~QLCNIC_FW_RESET_OWNER;
2465
		if (!adapter->nic_ops->start_firmware(adapter)) {
2466
			qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
2467
			adapter->fw_wait_cnt = 0;
2468 2469 2470 2471 2472
			return;
		}
		goto err_ret;
	}

2473
	qlcnic_api_unlock(adapter);
2474

2475
wait_npar:
2476
	dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2477
	QLCDB(adapter, HW, "Func waiting: Device state=%u\n", dev_state);
2478

2479
	switch (dev_state) {
2480
	case QLCNIC_DEV_READY:
2481
		if (!qlcnic_start_firmware(adapter)) {
2482
			qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
2483
			adapter->fw_wait_cnt = 0;
2484 2485
			return;
		}
2486 2487 2488 2489 2490 2491
	case QLCNIC_DEV_FAILED:
		break;
	default:
		qlcnic_schedule_work(adapter,
			qlcnic_fwinit_work, FW_POLL_DELAY);
		return;
2492 2493 2494
	}

err_ret:
2495 2496
	dev_err(&adapter->pdev->dev, "Fwinit work failed state=%u "
		"fw_wait_cnt=%u\n", dev_state, adapter->fw_wait_cnt);
2497
	netif_device_attach(adapter->netdev);
2498
	qlcnic_clr_all_drv_state(adapter, 0);
2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510
}

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

2511 2512 2513 2514 2515 2516
	/* 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);
2517

2518
	status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
2519

S
Sony Chacko 已提交
2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531 2532
	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");
		}

2533
		goto err_ret;
S
Sony Chacko 已提交
2534
	}
2535

2536
	if (adapter->ahw->temp == QLCNIC_TEMP_PANIC) {
S
Sony Chacko 已提交
2537
		dev_err(&adapter->pdev->dev, "Detaching the device: temp=%d\n",
2538
			adapter->ahw->temp);
2539
		goto err_ret;
S
Sony Chacko 已提交
2540 2541
	}

2542 2543
	/* Dont ack if this instance is the reset owner */
	if (!(adapter->flags & QLCNIC_FW_RESET_OWNER)) {
S
Sony Chacko 已提交
2544 2545 2546 2547
		if (qlcnic_set_drv_state(adapter, adapter->dev_state)) {
			dev_err(&adapter->pdev->dev,
				"Failed to set driver state,"
					"detaching the device.\n");
2548
			goto err_ret;
S
Sony Chacko 已提交
2549
		}
2550
	}
2551 2552 2553 2554 2555 2556 2557 2558

	adapter->fw_wait_cnt = 0;

	qlcnic_schedule_work(adapter, qlcnic_fwinit_work, FW_POLL_DELAY);

	return;

err_ret:
2559
	netif_device_attach(netdev);
2560
	qlcnic_clr_all_drv_state(adapter, 1);
2561 2562
}

2563 2564 2565 2566 2567 2568
/*Transit NPAR state to NON Operational */
static void
qlcnic_set_npar_non_operational(struct qlcnic_adapter *adapter)
{
	u32 state;

2569
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
2570 2571 2572 2573 2574
	if (state == QLCNIC_DEV_NPAR_NON_OPER)
		return;

	if (qlcnic_api_lock(adapter))
		return;
2575 2576
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
			    QLCNIC_DEV_NPAR_NON_OPER);
2577 2578 2579
	qlcnic_api_unlock(adapter);
}

2580
void qlcnic_82xx_dev_request_reset(struct qlcnic_adapter *adapter, u32 key)
2581
{
2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593
	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");
2594
	adapter->need_fw_reset = 1;
2595 2596 2597 2598
	if (qlcnic_api_lock(adapter))
		return;

	state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
2599 2600 2601 2602 2603 2604
	if (state  == QLCNIC_DEV_FAILED || (state == QLCNIC_DEV_BADBAD)) {
		netdev_err(adapter->netdev,
				"Device is in FAILED state, Please Reboot\n");
		qlcnic_api_unlock(adapter);
		return;
	}
2605

2606
	if (state == QLCNIC_DEV_READY) {
2607
		QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_NEED_RESET);
2608
		adapter->flags |= QLCNIC_FW_RESET_OWNER;
2609
		QLCDB(adapter, DRV, "NEED_RESET state set\n");
2610
		qlcnic_idc_debug_info(adapter, 0);
2611 2612
	}

2613
	QLCWR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE, QLCNIC_DEV_NPAR_NON_OPER);
2614 2615 2616
	qlcnic_api_unlock(adapter);
}

2617 2618 2619 2620 2621 2622 2623
/* 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;

2624 2625
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
			    QLCNIC_DEV_NPAR_OPER);
2626
	QLCDB(adapter, DRV, "NPAR operational state set\n");
2627 2628 2629 2630

	qlcnic_api_unlock(adapter);
}

2631 2632 2633 2634
static void
qlcnic_schedule_work(struct qlcnic_adapter *adapter,
		work_func_t func, int delay)
{
S
Sucheta Chakraborty 已提交
2635 2636 2637
	if (test_bit(__QLCNIC_AER, &adapter->state))
		return;

2638
	INIT_DELAYED_WORK(&adapter->fw_work, func);
2639 2640
	queue_delayed_work(qlcnic_wq, &adapter->fw_work,
					round_jiffies_relative(delay));
2641 2642 2643 2644 2645 2646 2647 2648
}

static void
qlcnic_cancel_fw_work(struct qlcnic_adapter *adapter)
{
	while (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
		msleep(10);

2649 2650 2651
	if (!adapter->fw_work.work.func)
		return;

2652 2653 2654 2655 2656 2657 2658 2659 2660
	cancel_delayed_work_sync(&adapter->fw_work);
}

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;
2661
	u32 npar_state;
2662

2663
	if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
2664 2665
		npar_state = QLC_SHARED_REG_RD32(adapter,
						 QLCNIC_CRB_DEV_NPAR_STATE);
2666 2667 2668 2669 2670 2671 2672 2673 2674 2675 2676
		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:
2677
	if (netif_running(netdev)) {
2678
		if (qlcnic_up(adapter, netdev))
2679 2680
			goto done;

A
Amit Kumar Salecha 已提交
2681
		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
2682 2683 2684
	}

done:
2685
	netif_device_attach(netdev);
2686
	adapter->fw_fail_cnt = 0;
S
Sritej Velaga 已提交
2687
	adapter->flags &= ~QLCNIC_FW_HANG;
2688
	clear_bit(__QLCNIC_RESETTING, &adapter->state);
2689 2690 2691 2692

	if (!qlcnic_clr_drv_state(adapter))
		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
							FW_POLL_DELAY);
2693 2694 2695 2696 2697
}

static int
qlcnic_check_health(struct qlcnic_adapter *adapter)
{
2698
	u32 state = 0, heartbeat;
2699
	u32 peg_status;
2700 2701 2702 2703

	if (qlcnic_check_temp(adapter))
		goto detach;

A
Amit Kumar Salecha 已提交
2704
	if (adapter->need_fw_reset)
2705
		qlcnic_dev_request_reset(adapter, 0);
2706

2707
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2708
	if (state == QLCNIC_DEV_NEED_RESET) {
2709
		qlcnic_set_npar_non_operational(adapter);
2710
		adapter->need_fw_reset = 1;
2711 2712
	} else if (state == QLCNIC_DEV_NEED_QUISCENT)
		goto detach;
2713

2714
	heartbeat = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_ALIVE_COUNTER);
2715 2716
	if (heartbeat != adapter->heartbeat) {
		adapter->heartbeat = heartbeat;
2717 2718 2719
		adapter->fw_fail_cnt = 0;
		if (adapter->need_fw_reset)
			goto detach;
2720

2721
		if (adapter->ahw->reset_context && qlcnic_auto_fw_reset) {
2722 2723 2724 2725
			qlcnic_reset_hw_context(adapter);
			adapter->netdev->trans_start = jiffies;
		}

2726 2727 2728 2729 2730 2731
		return 0;
	}

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

S
Sritej Velaga 已提交
2732 2733
	adapter->flags |= QLCNIC_FW_HANG;

2734
	qlcnic_dev_request_reset(adapter, 0);
2735

2736
	if (qlcnic_auto_fw_reset)
2737
		clear_bit(__QLCNIC_FW_ATTACHED, &adapter->state);
2738

2739
	dev_err(&adapter->pdev->dev, "firmware hang detected\n");
2740
	peg_status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
2741
	dev_err(&adapter->pdev->dev, "Dumping hw/fw registers\n"
S
Sritej Velaga 已提交
2742 2743 2744 2745
			"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",
2746 2747
			peg_status,
			QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS2),
S
Sritej Velaga 已提交
2748 2749 2750 2751 2752
			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));
2753
	if (QLCNIC_FWERROR_CODE(peg_status) == 0x67)
2754 2755 2756
		dev_err(&adapter->pdev->dev,
			"Firmware aborted with error code 0x00006700. "
				"Device is being reset.\n");
2757 2758 2759 2760
detach:
	adapter->dev_state = (state == QLCNIC_DEV_NEED_QUISCENT) ? state :
		QLCNIC_DEV_NEED_RESET;

2761 2762
	if (qlcnic_auto_fw_reset && !test_and_set_bit(__QLCNIC_RESETTING,
						      &adapter->state)) {
2763

2764
		qlcnic_schedule_work(adapter, qlcnic_detach_work, 0);
2765 2766
		QLCDB(adapter, DRV, "fw recovery scheduled.\n");
	}
2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 2782 2783

	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;

2784 2785 2786
	if (adapter->fhash.fnum)
		qlcnic_prune_lb_filters(adapter);

2787 2788 2789 2790
reschedule:
	qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
}

S
Sucheta Chakraborty 已提交
2791 2792 2793 2794 2795 2796 2797 2798 2799
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));
2800 2801
		if (!oth_pdev)
			continue;
S
Sucheta Chakraborty 已提交
2802

2803 2804
		if (oth_pdev->current_state != PCI_D3cold) {
			pci_dev_put(oth_pdev);
S
Sucheta Chakraborty 已提交
2805
			return 0;
2806 2807
		}
		pci_dev_put(oth_pdev);
S
Sucheta Chakraborty 已提交
2808 2809 2810 2811 2812 2813 2814 2815 2816 2817 2818 2819 2820 2821 2822 2823 2824 2825 2826 2827 2828 2829 2830 2831 2832
	}
	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;

2833
	if (adapter->ahw->op_mode != QLCNIC_NON_PRIV_FUNC && first_func) {
S
Sucheta Chakraborty 已提交
2834 2835
		adapter->need_fw_reset = 1;
		set_bit(__QLCNIC_START_FW, &adapter->state);
2836 2837
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_INITIALIZING);
S
Sucheta Chakraborty 已提交
2838 2839 2840 2841 2842 2843 2844 2845 2846
		QLCDB(adapter, DRV, "Restarting fw\n");
	}
	qlcnic_api_unlock(adapter);

	err = adapter->nic_ops->start_firmware(adapter);
	if (err)
		return err;

	qlcnic_clr_drv_state(adapter);
2847
	qlcnic_setup_intr(adapter, 0);
S
Sucheta Chakraborty 已提交
2848 2849 2850 2851

	if (netif_running(netdev)) {
		err = qlcnic_attach(adapter);
		if (err) {
2852
			qlcnic_clr_all_drv_state(adapter, 1);
S
Sucheta Chakraborty 已提交
2853 2854 2855 2856 2857 2858 2859 2860 2861
			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 已提交
2862
		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
S
Sucheta Chakraborty 已提交
2863 2864 2865 2866 2867 2868 2869 2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907
	}
 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);

	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)
{
2908
	u32 state;
S
Sucheta Chakraborty 已提交
2909 2910 2911
	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);

	pci_cleanup_aer_uncorrect_error_status(pdev);
2912 2913 2914
	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 已提交
2915 2916 2917 2918
		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
						FW_POLL_DELAY);
}

2919 2920 2921 2922 2923 2924 2925 2926 2927
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 已提交
2928 2929 2930
	err = qlcnic_check_npar_opertional(adapter);
	if (err)
		return err;
2931

2932 2933 2934 2935
	err = qlcnic_initialize_nic(adapter);
	if (err)
		return err;

2936 2937
	qlcnic_check_options(adapter);

2938 2939 2940 2941
	err = qlcnic_set_eswitch_port_config(adapter);
	if (err)
		return err;

2942 2943 2944 2945 2946
	adapter->need_fw_reset = 0;

	return err;
}

2947 2948
int qlcnic_validate_max_rss(struct net_device *netdev, u8 max_hw, u8 val)
{
2949
	if (!qlcnic_use_msi_x && !qlcnic_use_msi) {
2950 2951 2952 2953 2954 2955 2956 2957 2958 2959 2960 2961 2962 2963 2964 2965 2966 2967 2968 2969 2970 2971 2972 2973 2974 2975 2976 2977 2978 2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993 2994 2995 2996
		netdev_info(netdev, "no msix or msi support, hence no rss\n");
		return -EINVAL;
	}

	if ((val > max_hw) || (val <  2) || !is_power_of_2(val)) {
		netdev_info(netdev, "rss_ring valid range [2 - %x] in "
			" powers of 2\n", max_hw);
		return -EINVAL;
	}
	return 0;

}

int qlcnic_set_max_rss(struct qlcnic_adapter *adapter, u8 data)
{
	struct net_device *netdev = adapter->netdev;
	int err = 0;

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

	netif_device_detach(netdev);
	if (netif_running(netdev))
		__qlcnic_down(adapter, netdev);
	qlcnic_detach(adapter);
	qlcnic_teardown_intr(adapter);

	if (qlcnic_enable_msix(adapter, data)) {
		netdev_info(netdev, "failed setting max_rss; rss disabled\n");
		qlcnic_enable_msi_legacy(adapter);
	}

	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);
	}
 done:
	netif_device_attach(netdev);
	clear_bit(__QLCNIC_RESETTING, &adapter->state);
	return err;
}

2997 2998 2999 3000 3001
#ifdef CONFIG_INET

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

static void
A
Amit Kumar Salecha 已提交
3002 3003
qlcnic_config_indev_addr(struct qlcnic_adapter *adapter,
			struct net_device *dev, unsigned long event)
3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026 3027 3028
{
	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);
}

A
Amit Kumar Salecha 已提交
3029 3030 3031 3032 3033 3034 3035 3036 3037
static void
qlcnic_restore_indev_addr(struct net_device *netdev, unsigned long event)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	struct net_device *dev;
	u16 vid;

	qlcnic_config_indev_addr(adapter, netdev, event);

3038
	for_each_set_bit(vid, adapter->vlans, VLAN_N_VID) {
3039
		dev = __vlan_find_dev_deep(netdev, vid);
A
Amit Kumar Salecha 已提交
3040 3041 3042 3043 3044 3045
		if (!dev)
			continue;
		qlcnic_config_indev_addr(adapter, dev, event);
	}
}

3046 3047 3048 3049 3050 3051 3052 3053 3054 3055 3056 3057 3058 3059 3060 3061 3062 3063 3064 3065 3066 3067 3068
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;

3069
	if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
3070 3071
		goto done;

A
Amit Kumar Salecha 已提交
3072
	qlcnic_config_indev_addr(adapter, dev, event);
3073 3074 3075 3076 3077 3078 3079 3080 3081 3082 3083 3084 3085 3086 3087 3088
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 已提交
3089
	if (dev == NULL)
3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100 3101
		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 已提交
3102
	if (!adapter)
3103 3104
		goto done;

3105
	if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
3106 3107 3108 3109 3110 3111 3112 3113 3114 3115 3116 3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 3130 3131
		goto done;

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

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 已提交
3132
qlcnic_restore_indev_addr(struct net_device *dev, unsigned long event)
3133 3134
{ }
#endif
3135
static struct pci_error_handlers qlcnic_err_handler = {
S
Sucheta Chakraborty 已提交
3136 3137 3138 3139
	.error_detected = qlcnic_io_error_detected,
	.slot_reset = qlcnic_io_slot_reset,
	.resume = qlcnic_io_resume,
};
3140 3141 3142 3143 3144

static struct pci_driver qlcnic_driver = {
	.name = qlcnic_driver_name,
	.id_table = qlcnic_pci_tbl,
	.probe = qlcnic_probe,
B
Bill Pemberton 已提交
3145
	.remove = qlcnic_remove,
3146 3147 3148 3149
#ifdef CONFIG_PM
	.suspend = qlcnic_suspend,
	.resume = qlcnic_resume,
#endif
S
Sucheta Chakraborty 已提交
3150 3151 3152
	.shutdown = qlcnic_shutdown,
	.err_handler = &qlcnic_err_handler

3153 3154 3155 3156
};

static int __init qlcnic_init_module(void)
{
3157
	int ret;
3158 3159 3160

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

3161 3162 3163 3164 3165 3166
	qlcnic_wq = create_singlethread_workqueue("qlcnic");
	if (qlcnic_wq == NULL) {
		printk(KERN_ERR "qlcnic: cannot create workqueue\n");
		return -ENOMEM;
	}

3167 3168 3169 3170 3171
#ifdef CONFIG_INET
	register_netdevice_notifier(&qlcnic_netdev_cb);
	register_inetaddr_notifier(&qlcnic_inetaddr_cb);
#endif

3172 3173 3174 3175 3176 3177
	ret = pci_register_driver(&qlcnic_driver);
	if (ret) {
#ifdef CONFIG_INET
		unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
		unregister_netdevice_notifier(&qlcnic_netdev_cb);
#endif
3178
		destroy_workqueue(qlcnic_wq);
3179
	}
3180

3181
	return ret;
3182 3183 3184 3185 3186 3187 3188 3189 3190 3191 3192 3193 3194
}

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
3195
	destroy_workqueue(qlcnic_wq);
3196 3197 3198
}

module_exit(qlcnic_exit_module);