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

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

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

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

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

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

33
static int qlcnic_mac_learn;
34
module_param(qlcnic_mac_learn, int, 0444);
35 36
MODULE_PARM_DESC(qlcnic_mac_learn,
		 "Mac Filter (0=learning is disabled, 1=Driver learning is enabled, 2=FDB learning is enabled)");
37

38
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
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
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
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
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
static int qlcnic_open(struct net_device *netdev);
static int qlcnic_close(struct net_device *netdev);
static void qlcnic_tx_timeout(struct net_device *netdev);
static void qlcnic_attach_work(struct work_struct *work);
static void qlcnic_fwinit_work(struct work_struct *work);
static void qlcnic_fw_poll_work(struct work_struct *work);
#ifdef CONFIG_NET_POLL_CONTROLLER
static void qlcnic_poll_controller(struct net_device *netdev);
#endif

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

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

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

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

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

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

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

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

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

MODULE_DEVICE_TABLE(pci, qlcnic_pci_tbl);


S
Sony Chacko 已提交
118
inline void qlcnic_update_cmd_producer(struct qlcnic_host_tx_ring *tx_ring)
119 120 121 122 123 124 125 126 127 128 129
{
	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
};

130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155
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 已提交
156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178
static const struct qlcnic_board_info qlcnic_boards[] = {
	{0x1077, 0x8020, 0x1077, 0x203,
	 "8200 Series Single Port 10GbE Converged Network Adapter"
	 "(TCP/IP Networking)"},
	{0x1077, 0x8020, 0x1077, 0x207,
	 "8200 Series Dual Port 10GbE Converged Network Adapter"
	 "(TCP/IP Networking)"},
	{0x1077, 0x8020, 0x1077, 0x20b,
	 "3200 Series Dual Port 10Gb Intelligent Ethernet Adapter"},
	{0x1077, 0x8020, 0x1077, 0x20c,
	 "3200 Series Quad Port 1Gb Intelligent Ethernet Adapter"},
	{0x1077, 0x8020, 0x1077, 0x20f,
	 "3200 Series Single Port 10Gb Intelligent Ethernet Adapter"},
	{0x1077, 0x8020, 0x103c, 0x3733,
	 "NC523SFP 10Gb 2-port Server Adapter"},
	{0x1077, 0x8020, 0x103c, 0x3346,
	 "CN1000Q Dual Port Converged Network Adapter"},
	{0x1077, 0x8020, 0x1077, 0x210,
	 "QME8242-k 10GbE Dual Port Mezzanine Card"},
	{0x1077, 0x8020, 0x0, 0x0, "cLOM8214 1/10GbE Controller"},
};

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

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

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

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

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

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

	recv_ctx->sds_rings = NULL;
}

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

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

211
	memcpy(netdev->dev_addr, mac_addr, ETH_ALEN);
212 213 214 215
	memcpy(adapter->mac_addr, netdev->dev_addr, netdev->addr_len);

	/* set station address */

216
	if (!is_valid_ether_addr(netdev->dev_addr))
217 218 219 220 221 222 223 224 225 226 227
		dev_warn(&pdev->dev, "Bad MAC address %pM.\n",
					netdev->dev_addr);

	return 0;
}

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

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

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

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

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

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

250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320
static int qlcnic_fdb_del(struct ndmsg *ndm, struct net_device *netdev,
			const unsigned char *addr)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	int err = -EOPNOTSUPP;

	if (!adapter->fdb_mac_learn) {
		pr_info("%s: Driver mac learn is enabled, FDB operation not allowed\n",
			__func__);
		return err;
	}

	if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
		if (is_unicast_ether_addr(addr))
			err = qlcnic_nic_del_mac(adapter, addr);
		else if (is_multicast_ether_addr(addr))
			err = dev_mc_del(netdev, addr);
		else
			err =  -EINVAL;
	}
	return err;
}

static int qlcnic_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
			struct net_device *netdev,
			const unsigned char *addr, u16 flags)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	int err = 0;

	if (!adapter->fdb_mac_learn) {
		pr_info("%s: Driver mac learn is enabled, FDB operation not allowed\n",
			__func__);
		return -EOPNOTSUPP;
	}

	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED)) {
		pr_info("%s: FDB e-switch is not enabled\n", __func__);
		return -EOPNOTSUPP;
	}

	if (ether_addr_equal(addr, adapter->mac_addr))
		return err;

	if (is_unicast_ether_addr(addr))
		err = qlcnic_nic_add_mac(adapter, addr);
	else if (is_multicast_ether_addr(addr))
		err = dev_mc_add_excl(netdev, addr);
	else
		err = -EINVAL;

	return err;
}

static int qlcnic_fdb_dump(struct sk_buff *skb, struct netlink_callback *ncb,
			struct net_device *netdev, int idx)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);

	if (!adapter->fdb_mac_learn) {
		pr_info("%s: Driver mac learn is enabled, FDB operation not allowed\n",
			__func__);
		return -EOPNOTSUPP;
	}

	if (adapter->flags & QLCNIC_ESWITCH_ENABLED)
		idx = ndo_dflt_fdb_dump(skb, ncb, netdev, idx);

	return idx;
}

321 322 323 324 325 326 327 328
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);
}

329 330 331 332 333 334
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,
335
	.ndo_set_rx_mode   = qlcnic_set_multi,
336 337
	.ndo_set_mac_address    = qlcnic_set_mac,
	.ndo_change_mtu	   = qlcnic_change_mtu,
338 339
	.ndo_fix_features  = qlcnic_fix_features,
	.ndo_set_features  = qlcnic_set_features,
340
	.ndo_tx_timeout	   = qlcnic_tx_timeout,
341 342
	.ndo_vlan_rx_add_vid	= qlcnic_vlan_rx_add,
	.ndo_vlan_rx_kill_vid	= qlcnic_vlan_rx_del,
343 344 345
	.ndo_fdb_add		= qlcnic_fdb_add,
	.ndo_fdb_del		= qlcnic_fdb_del,
	.ndo_fdb_dump		= qlcnic_fdb_dump,
346 347 348 349 350
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller = qlcnic_poll_controller,
#endif
};

351 352 353 354
static const struct net_device_ops qlcnic_netdev_failed_ops = {
	.ndo_open	   = qlcnic_open,
};

355
static struct qlcnic_nic_template qlcnic_ops = {
356 357 358 359 360 361
	.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 已提交
362
	.napi_del		= qlcnic_82xx_napi_del,
363 364 365 366 367 368 369 370
	.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
371 372
};

373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404
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,
405 406
};

407
int qlcnic_enable_msix(struct qlcnic_adapter *adapter, u32 num_msix)
408 409
{
	struct pci_dev *pdev = adapter->pdev;
S
Sony Chacko 已提交
410 411 412 413 414 415 416
	int err = -1, i;
	int max_tx_rings;

	if (!adapter->msix_entries) {
		adapter->msix_entries = kcalloc(num_msix,
						sizeof(struct msix_entry),
						GFP_KERNEL);
417
		if (!adapter->msix_entries)
S
Sony Chacko 已提交
418 419
			return -ENOMEM;
	}
420 421 422 423

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

424
	if (adapter->ahw->msix_supported) {
425
 enable_msix:
S
Sony Chacko 已提交
426 427
		for (i = 0; i < num_msix; i++)
			adapter->msix_entries[i].entry = i;
428 429 430
		err = pci_enable_msix(pdev, adapter->msix_entries, num_msix);
		if (err == 0) {
			adapter->flags |= QLCNIC_MSIX_ENABLED;
S
Sony Chacko 已提交
431 432 433 434 435 436 437 438 439
			if (qlcnic_83xx_check(adapter)) {
				adapter->ahw->num_msix = num_msix;
				/* subtract mail box and tx ring vectors */
				max_tx_rings = adapter->max_drv_tx_rings;
				adapter->max_sds_rings = num_msix -
							 max_tx_rings - 1;
			} else {
				adapter->max_sds_rings = num_msix;
			}
440
			dev_info(&pdev->dev, "using msi-x interrupts\n");
441
			return err;
S
Sony Chacko 已提交
442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459
		} else if (err > 0) {
			dev_info(&pdev->dev,
				 "Unable to allocate %d MSI-X interrupt vectors\n",
				 num_msix);
			if (qlcnic_83xx_check(adapter)) {
				if (err < QLC_83XX_MINIMUM_VECTOR)
					return err;
				err -= (adapter->max_drv_tx_rings + 1);
				num_msix = rounddown_pow_of_two(err);
				num_msix += (adapter->max_drv_tx_rings + 1);
			} else {
				num_msix = rounddown_pow_of_two(err);
			}

			if (num_msix) {
				dev_info(&pdev->dev,
					 "Trying %d MSI-X interrupt vectors\n",
					 num_msix);
460
				goto enable_msix;
S
Sony Chacko 已提交
461 462 463 464
			}
		} else {
			dev_info(&pdev->dev, "Failed to get %d vectors\n",
				 num_msix);
465 466
		}
	}
S
Sony Chacko 已提交
467

468 469
	return err;
}
470

471
static int qlcnic_enable_msi_legacy(struct qlcnic_adapter *adapter)
472
{
473
	int err = 0;
474
	u32 offset, mask_reg;
475
	const struct qlcnic_legacy_intr_set *legacy_intrp;
476
	struct qlcnic_hardware_context *ahw = adapter->ahw;
477
	struct pci_dev *pdev = adapter->pdev;
478

479
	if (qlcnic_use_msi && !pci_enable_msi(pdev)) {
480
		adapter->flags |= QLCNIC_MSI_ENABLED;
481 482 483
		offset = msi_tgt_status[adapter->ahw->pci_func];
		adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter->ahw,
							    offset);
484 485
		dev_info(&pdev->dev, "using msi interrupts\n");
		adapter->msix_entries[0].vector = pdev->irq;
486
		return err;
487
	}
488 489
	if (qlcnic_use_msi || qlcnic_use_msi_x)
		return -EOPNOTSUPP;
490

491
	legacy_intrp = &legacy_intr[adapter->ahw->pci_func];
492
	adapter->ahw->int_vec_bit = legacy_intrp->int_vec_bit;
493 494 495 496 497 498
	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);
499 500
	dev_info(&pdev->dev, "using legacy interrupts\n");
	adapter->msix_entries[0].vector = pdev->irq;
501
	return err;
502 503
}

504
int qlcnic_82xx_setup_intr(struct qlcnic_adapter *adapter, u8 num_intr)
505
{
506
	int num_msix, err = 0;
507

508 509 510 511
	if (!num_intr)
		num_intr = QLCNIC_DEF_NUM_STS_DESC_RINGS;

	if (adapter->ahw->msix_supported)
512
		num_msix = rounddown_pow_of_two(min_t(int, num_online_cpus(),
513 514
						num_intr));
	else
515 516
		num_msix = 1;

517 518 519
	err = qlcnic_enable_msix(adapter, num_msix);
	if (err == -ENOMEM || !err)
		return err;
520

521 522 523 524 525
	err = qlcnic_enable_msi_legacy(adapter);
	if (!err)
		return err;

	return -EIO;
526
}
S
Sony Chacko 已提交
527

S
Sony Chacko 已提交
528
void qlcnic_teardown_intr(struct qlcnic_adapter *adapter)
529 530 531 532 533
{
	if (adapter->flags & QLCNIC_MSIX_ENABLED)
		pci_disable_msix(adapter->pdev);
	if (adapter->flags & QLCNIC_MSI_ENABLED)
		pci_disable_msi(adapter->pdev);
S
Sony Chacko 已提交
534 535 536 537 538 539 540 541

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

	if (adapter->ahw->intr_tbl) {
		vfree(adapter->ahw->intr_tbl);
		adapter->ahw->intr_tbl = NULL;
	}
542 543 544 545 546
}

static void
qlcnic_cleanup_pci_map(struct qlcnic_adapter *adapter)
{
A
Anirban Chakraborty 已提交
547 548
	if (adapter->ahw->pci_base0 != NULL)
		iounmap(adapter->ahw->pci_base0);
549 550
}

551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578
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;
}
579 580

int qlcnic_init_pci_info(struct qlcnic_adapter *adapter)
581
{
D
Dan Carpenter 已提交
582
	struct qlcnic_pci_info *pci_info;
583 584
	int i, ret = 0, j = 0;
	u16 act_pci_func;
585 586
	u8 pfn;

D
Dan Carpenter 已提交
587 588 589 590
	pci_info = kcalloc(QLCNIC_MAX_PCI_FUNC, sizeof(*pci_info), GFP_KERNEL);
	if (!pci_info)
		return -ENOMEM;

591 592 593 594 595 596
	ret = qlcnic_get_pci_info(adapter, pci_info);
	if (ret)
		goto err_pci_info;

	act_pci_func = adapter->ahw->act_pci_func;

597
	adapter->npars = kzalloc(sizeof(struct qlcnic_npar_info) *
598
				 act_pci_func, GFP_KERNEL);
D
Dan Carpenter 已提交
599
	if (!adapter->npars) {
600
		ret = -ENOMEM;
D
Dan Carpenter 已提交
601 602
		goto err_pci_info;
	}
603

604
	adapter->eswitch = kzalloc(sizeof(struct qlcnic_eswitch) *
605 606
				QLCNIC_NIU_MAX_XG_PORTS, GFP_KERNEL);
	if (!adapter->eswitch) {
607
		ret = -ENOMEM;
608
		goto err_npars;
609 610
	}

611 612
	for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
		pfn = pci_info[i].id;
613

614
		if (pfn >= QLCNIC_MAX_PCI_FUNC) {
S
Sony Chacko 已提交
615 616 617
			ret = QL_STATUS_INVALID_PARAM;
			goto err_eswitch;
		}
618 619 620 621 622 623 624 625 626 627 628 629

		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++;
630 631
	}

S
Sony Chacko 已提交
632
	for (i = 0; i < QLCNIC_NIU_MAX_XG_PORTS; i++) {
633
		adapter->eswitch[i].flags |= QLCNIC_SWITCH_ENABLE;
S
Sony Chacko 已提交
634 635 636
		if (qlcnic_83xx_check(adapter))
			qlcnic_enable_eswitch(adapter, i, 1);
	}
637

D
Dan Carpenter 已提交
638
	kfree(pci_info);
639 640 641
	return 0;

err_eswitch:
642 643
	kfree(adapter->eswitch);
	adapter->eswitch = NULL;
644
err_npars:
645
	kfree(adapter->npars);
646
	adapter->npars = NULL;
D
Dan Carpenter 已提交
647 648
err_pci_info:
	kfree(pci_info);
649 650 651 652

	return ret;
}

653 654 655 656 657 658
static int
qlcnic_set_function_modes(struct qlcnic_adapter *adapter)
{
	u8 id;
	int i, ret = 1;
	u32 data = QLCNIC_MGMT_FUNC;
659
	struct qlcnic_hardware_context *ahw = adapter->ahw;
660 661 662 663 664

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

665
	if (qlcnic_config_npars) {
666 667 668
		for (i = 0; i < ahw->act_pci_func; i++) {
			id = adapter->npars[i].pci_func;
			if (id == ahw->pci_func)
669 670 671 672 673
				continue;
			data |= (qlcnic_config_npars &
					QLC_DEV_SET_DRV(0xf, id));
		}
	} else {
674
		data = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
675
		data = (data & ~QLC_DEV_SET_DRV(0xf, ahw->pci_func)) |
676
			(QLC_DEV_SET_DRV(QLCNIC_MGMT_FUNC,
677
					 ahw->pci_func));
678
	}
679
	QLC_SHARED_REG_WR32(adapter, QLCNIC_DRV_OP_MODE, data);
680 681 682 683 684
	qlcnic_api_unlock(adapter);
err_lock:
	return ret;
}

S
Sony Chacko 已提交
685 686
static void qlcnic_check_vf(struct qlcnic_adapter *adapter,
			    const struct pci_device_id *ent)
687 688 689 690
{
	u32 op_mode, priv_level;

	/* Determine FW API version */
S
Sony Chacko 已提交
691 692
	adapter->ahw->fw_hal_version = QLC_SHARED_REG_RD32(adapter,
							   QLCNIC_FW_API);
693 694

	/* Find PCI function number */
S
Sony Chacko 已提交
695
	qlcnic_get_func_no(adapter);
696 697

	/* Determine function privilege level */
S
Sony Chacko 已提交
698
	op_mode = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
699
	if (op_mode == QLC_DEV_DRV_DEFAULT)
700
		priv_level = QLCNIC_MGMT_FUNC;
701
	else
A
Anirban Chakraborty 已提交
702
		priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
703

704
	if (priv_level == QLCNIC_NON_PRIV_FUNC) {
705
		adapter->ahw->op_mode = QLCNIC_NON_PRIV_FUNC;
706 707
		dev_info(&adapter->pdev->dev,
			"HAL Version: %d Non Privileged function\n",
708
			 adapter->ahw->fw_hal_version);
709
		adapter->nic_ops = &qlcnic_vf_ops;
710 711
	} else
		adapter->nic_ops = &qlcnic_ops;
712 713
}

714
#define QLCNIC_82XX_BAR0_LENGTH 0x00200000UL
S
Sony Chacko 已提交
715
#define QLCNIC_83XX_BAR0_LENGTH 0x4000
716 717 718 719 720 721
static void qlcnic_get_bar_length(u32 dev_id, ulong *bar)
{
	switch (dev_id) {
	case PCI_DEVICE_ID_QLOGIC_QLE824X:
		*bar = QLCNIC_82XX_BAR0_LENGTH;
		break;
S
Sony Chacko 已提交
722 723 724
	case PCI_DEVICE_ID_QLOGIC_QLE834X:
		*bar = QLCNIC_83XX_BAR0_LENGTH;
		break;
725 726 727 728 729 730 731
	default:
		*bar = 0;
	}
}

static int qlcnic_setup_pci_map(struct pci_dev *pdev,
				struct qlcnic_hardware_context *ahw)
732
{
733
	u32 offset;
734
	void __iomem *mem_ptr0 = NULL;
735
	unsigned long mem_len, pci_len0 = 0, bar0_len;
736 737 738 739

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

740 741
	qlcnic_get_bar_length(pdev->device, &bar0_len);
	if (mem_len >= bar0_len) {
742 743 744 745 746 747 748 749 750 751 752 753

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

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

	return 0;
}

S
Sony Chacko 已提交
763
static void qlcnic_get_board_name(struct qlcnic_adapter *adapter, char *name)
764 765 766 767 768 769 770 771 772
{
	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) {
773 774 775
				sprintf(name, "%pM: %s" ,
					adapter->mac_addr,
					qlcnic_boards[i].short_name);
776 777 778 779 780 781 782
				found = 1;
				break;
		}

	}

	if (!found)
783
		sprintf(name, "%pM Gigabit Ethernet", adapter->mac_addr);
784 785 786 787 788
}

static void
qlcnic_check_options(struct qlcnic_adapter *adapter)
{
789
	int err;
790
	u32 fw_major, fw_minor, fw_build, prev_fw_version;
791
	struct pci_dev *pdev = adapter->pdev;
792 793
	struct qlcnic_hardware_context *ahw = adapter->ahw;
	struct qlcnic_fw_dump *fw_dump = &ahw->fw_dump;
794 795

	prev_fw_version = adapter->fw_version;
796

797 798 799
	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);
800 801 802

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

803 804 805 806 807 808
	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) {
809 810 811 812 813 814 815 816 817 818
		if (fw_dump->tmpl_hdr == NULL ||
				adapter->fw_version > prev_fw_version) {
			if (fw_dump->tmpl_hdr)
				vfree(fw_dump->tmpl_hdr);
			if (!qlcnic_fw_cmd_get_minidump_temp(adapter))
				dev_info(&pdev->dev,
					"Supports FW dump capability\n");
		}
	}

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

A
Anirban Chakraborty 已提交
822
	if (adapter->ahw->port_type == QLCNIC_XGBE) {
S
Sony Chacko 已提交
823 824 825 826 827 828 829 830
		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;
		}

831
		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
S
Sony Chacko 已提交
832 833
		adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;

A
Anirban Chakraborty 已提交
834
	} else if (adapter->ahw->port_type == QLCNIC_GBE) {
835 836
		adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G;
		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
S
Sony Chacko 已提交
837 838
		adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
		adapter->max_rxd = MAX_RCV_DESCRIPTORS_1G;
839 840
	}

841
	adapter->ahw->msix_supported = !!qlcnic_use_msi_x;
842 843 844

	adapter->num_txd = MAX_CMD_DESCRIPTORS;

845
	adapter->max_rds_rings = MAX_RDS_RINGS;
846 847
}

848 849 850 851 852 853
static int
qlcnic_initialize_nic(struct qlcnic_adapter *adapter)
{
	int err;
	struct qlcnic_info nic_info;

854
	memset(&nic_info, 0, sizeof(struct qlcnic_info));
A
Anirban Chakraborty 已提交
855
	err = qlcnic_get_nic_info(adapter, &nic_info, adapter->ahw->pci_func);
856 857 858
	if (err)
		return err;

859 860 861 862 863
	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;
864 865 866 867 868 869

	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_MORE_CAPS) {
		u32 temp;
		temp = QLCRD32(adapter, CRB_FW_CAPABILITIES_2);
		adapter->ahw->capabilities2 = temp;
	}
870 871
	adapter->ahw->max_mac_filters = nic_info.max_mac_filters;
	adapter->ahw->max_mtu = nic_info.max_mtu;
872

S
Sony Chacko 已提交
873 874 875 876
	/* Disable NPAR for 83XX */
	if (qlcnic_83xx_check(adapter))
		return err;

877
	if (adapter->ahw->capabilities & BIT_6)
878 879 880 881 882 883 884
		adapter->flags |= QLCNIC_ESWITCH_ENABLED;
	else
		adapter->flags &= ~QLCNIC_ESWITCH_ENABLED;

	return err;
}

885 886
void qlcnic_set_vlan_config(struct qlcnic_adapter *adapter,
			    struct qlcnic_esw_func_cfg *esw_cfg)
887 888 889 890 891 892 893 894 895 896 897 898
{
	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;
}

899
static int
900 901 902 903
qlcnic_vlan_rx_add(struct net_device *netdev, u16 vid)
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	set_bit(vid, adapter->vlans);
904
	return 0;
905 906
}

907
static int
908 909 910 911 912 913
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);
914
	return 0;
915 916
}

917 918
void qlcnic_set_eswitch_port_features(struct qlcnic_adapter *adapter,
				      struct qlcnic_esw_func_cfg *esw_cfg)
919
{
920 921
	adapter->flags &= ~(QLCNIC_MACSPOOF | QLCNIC_MAC_OVERRIDE_DISABLED |
				QLCNIC_PROMISC_DISABLED);
922 923 924

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

926 927 928
	if (!esw_cfg->mac_override)
		adapter->flags |= QLCNIC_MAC_OVERRIDE_DISABLED;

929 930 931
	if (!esw_cfg->promisc_mode)
		adapter->flags |= QLCNIC_PROMISC_DISABLED;

932 933 934
	qlcnic_set_netdev_features(adapter, esw_cfg);
}

935
int qlcnic_set_eswitch_port_config(struct qlcnic_adapter *adapter)
936 937 938 939 940 941
{
	struct qlcnic_esw_func_cfg esw_cfg;

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

A
Anirban Chakraborty 已提交
942
	esw_cfg.pci_func = adapter->ahw->pci_func;
943 944
	if (qlcnic_get_eswitch_port_config(adapter, &esw_cfg))
			return -EIO;
945
	qlcnic_set_vlan_config(adapter, &esw_cfg);
946 947 948 949 950 951 952 953 954 955
	qlcnic_set_eswitch_port_features(adapter, &esw_cfg);

	return 0;
}

static void
qlcnic_set_netdev_features(struct qlcnic_adapter *adapter,
		struct qlcnic_esw_func_cfg *esw_cfg)
{
	struct net_device *netdev = adapter->netdev;
S
Sony Chacko 已提交
956 957 958 959
	unsigned long features, vlan_features;

	if (qlcnic_83xx_check(adapter))
		return;
960

961 962
	features = (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |
		    NETIF_F_IPV6_CSUM | NETIF_F_GRO);
963
	vlan_features = (NETIF_F_SG | NETIF_F_IP_CSUM |
S
Sony Chacko 已提交
964
			NETIF_F_IPV6_CSUM);
965

S
Sony Chacko 已提交
966
	if (QLCNIC_IS_TSO_CAPABLE(adapter)) {
967 968 969
		features |= (NETIF_F_TSO | NETIF_F_TSO6);
		vlan_features |= (NETIF_F_TSO | NETIF_F_TSO6);
	}
R
Rajesh Borundia 已提交
970 971

	if (netdev->features & NETIF_F_LRO)
972 973 974 975
		features |= NETIF_F_LRO;

	if (esw_cfg->offload_flags & BIT_0) {
		netdev->features |= features;
S
Sony Chacko 已提交
976
		adapter->rx_csum = 1;
977
		if (!(esw_cfg->offload_flags & BIT_1)) {
978
			netdev->features &= ~NETIF_F_TSO;
979 980 981
			features &= ~NETIF_F_TSO;
		}
		if (!(esw_cfg->offload_flags & BIT_2)) {
982
			netdev->features &= ~NETIF_F_TSO6;
983 984
			features &= ~NETIF_F_TSO6;
		}
985 986
	} else {
		netdev->features &= ~features;
987
		features &= ~features;
S
Sony Chacko 已提交
988
		adapter->rx_csum = 0;
989 990 991 992 993
	}

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

994 995 996 997 998 999
static int
qlcnic_check_eswitch_mode(struct qlcnic_adapter *adapter)
{
	u32 op_mode, priv_level;
	int err = 0;

1000 1001 1002 1003
	err = qlcnic_initialize_nic(adapter);
	if (err)
		return err;

1004 1005 1006
	if (adapter->flags & QLCNIC_ADAPTER_INITIALIZED)
		return 0;

S
Sony Chacko 已提交
1007
	op_mode = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
A
Anirban Chakraborty 已提交
1008
	priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
1009 1010 1011 1012

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

1015
	if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
1016
		if (priv_level == QLCNIC_MGMT_FUNC) {
1017
			adapter->ahw->op_mode = QLCNIC_MGMT_FUNC;
1018 1019 1020 1021 1022 1023 1024
			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",
1025
				 adapter->ahw->fw_hal_version);
1026
		} else if (priv_level == QLCNIC_PRIV_FUNC) {
1027
			adapter->ahw->op_mode = QLCNIC_PRIV_FUNC;
1028 1029
			dev_info(&adapter->pdev->dev,
				"HAL Version: %d, Privileged function\n",
1030
				 adapter->ahw->fw_hal_version);
1031
		}
1032
	}
1033 1034 1035 1036 1037 1038

	adapter->flags |= QLCNIC_ADAPTER_INITIALIZED;

	return err;
}

1039
int qlcnic_set_default_offload_settings(struct qlcnic_adapter *adapter)
1040 1041 1042 1043 1044
{
	struct qlcnic_esw_func_cfg esw_cfg;
	struct qlcnic_npar_info *npar;
	u8 i;

1045
	if (adapter->need_fw_reset)
1046 1047
		return 0;

1048
	for (i = 0; i < adapter->ahw->act_pci_func; i++) {
1049
		memset(&esw_cfg, 0, sizeof(struct qlcnic_esw_func_cfg));
1050
		esw_cfg.pci_func = adapter->npars[i].pci_func;
1051
		esw_cfg.mac_override = BIT_0;
1052
		esw_cfg.promisc_mode = BIT_0;
1053 1054 1055 1056 1057
		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);
		}
1058 1059 1060 1061
		if (qlcnic_config_switch_port(adapter, &esw_cfg))
			return -EIO;
		npar = &adapter->npars[i];
		npar->pvid = esw_cfg.vlan_id;
1062
		npar->mac_override = esw_cfg.mac_override;
1063 1064 1065 1066 1067 1068 1069 1070 1071
		npar->mac_anti_spoof = esw_cfg.mac_anti_spoof;
		npar->discard_tagged = esw_cfg.discard_tagged;
		npar->promisc_mode = esw_cfg.promisc_mode;
		npar->offload_flags = esw_cfg.offload_flags;
	}

	return 0;
}

S
Sony Chacko 已提交
1072

1073 1074 1075 1076 1077 1078 1079 1080
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;
1081
	esw_cfg.mac_override = npar->mac_override;
1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095
	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;
}

1096
int qlcnic_reset_npar_config(struct qlcnic_adapter *adapter)
1097
{
1098
	int i, err;
1099 1100
	struct qlcnic_npar_info *npar;
	struct qlcnic_info nic_info;
1101
	u8 pci_func;
1102

1103 1104 1105
	if (qlcnic_82xx_check(adapter))
		if (!adapter->need_fw_reset)
			return 0;
1106

1107
	/* Set the NPAR config data after FW reset */
1108
	for (i = 0; i < adapter->ahw->act_pci_func; i++) {
1109
		npar = &adapter->npars[i];
1110 1111
		pci_func = npar->pci_func;
		memset(&nic_info, 0, sizeof(struct qlcnic_info));
S
Sony Chacko 已提交
1112
		err = qlcnic_get_nic_info(adapter, &nic_info, pci_func);
1113 1114 1115 1116 1117 1118 1119
		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;
1120

1121 1122
		if (npar->enable_pm) {
			err = qlcnic_config_port_mirroring(adapter,
1123 1124
							   npar->dest_npar, 1,
							   pci_func);
1125 1126
			if (err)
				return err;
1127
		}
1128
		err = qlcnic_reset_eswitch_config(adapter, npar, pci_func);
1129 1130
		if (err)
			return err;
1131
	}
1132
	return 0;
1133 1134
}

A
Amit Kumar Salecha 已提交
1135 1136 1137 1138 1139
static int qlcnic_check_npar_opertional(struct qlcnic_adapter *adapter)
{
	u8 npar_opt_timeo = QLCNIC_DEV_NPAR_OPER_TIMEO;
	u32 npar_state;

1140
	if (adapter->ahw->op_mode == QLCNIC_MGMT_FUNC)
A
Amit Kumar Salecha 已提交
1141 1142
		return 0;

1143 1144
	npar_state = QLC_SHARED_REG_RD32(adapter,
					 QLCNIC_CRB_DEV_NPAR_STATE);
A
Amit Kumar Salecha 已提交
1145 1146
	while (npar_state != QLCNIC_DEV_NPAR_OPER && --npar_opt_timeo) {
		msleep(1000);
1147 1148
		npar_state = QLC_SHARED_REG_RD32(adapter,
						 QLCNIC_CRB_DEV_NPAR_STATE);
A
Amit Kumar Salecha 已提交
1149 1150 1151 1152 1153 1154 1155 1156 1157
	}
	if (!npar_opt_timeo) {
		dev_err(&adapter->pdev->dev,
			"Waiting for NPAR state to opertional timeout\n");
		return -EIO;
	}
	return 0;
}

1158 1159 1160 1161 1162 1163
static int
qlcnic_set_mgmt_operations(struct qlcnic_adapter *adapter)
{
	int err;

	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
1164
	    adapter->ahw->op_mode != QLCNIC_MGMT_FUNC)
1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179
		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;
}

1180
int qlcnic_82xx_start_firmware(struct qlcnic_adapter *adapter)
1181
{
1182
	int err;
1183

1184 1185 1186 1187
	err = qlcnic_can_start_firmware(adapter);
	if (err < 0)
		return err;
	else if (!err)
1188
		goto check_fw_status;
1189

1190
	if (qlcnic_load_fw_file)
1191
		qlcnic_request_firmware(adapter);
S
schacko 已提交
1192
	else {
S
Sony Chacko 已提交
1193 1194
		err = qlcnic_check_flash_fw_ver(adapter);
		if (err)
S
schacko 已提交
1195 1196
			goto err_out;

1197
		adapter->ahw->fw_type = QLCNIC_FLASH_ROMIMAGE;
S
schacko 已提交
1198
	}
1199 1200 1201

	err = qlcnic_need_fw_reset(adapter);
	if (err == 0)
1202
		goto check_fw_status;
1203

1204 1205 1206
	err = qlcnic_pinit_from_rom(adapter);
	if (err)
		goto err_out;
1207 1208 1209 1210 1211 1212

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

	qlcnic_release_firmware(adapter);
1213
	QLCWR32(adapter, CRB_DRIVER_VERSION, QLCNIC_DRIVER_VERSION);
1214

1215 1216
check_fw_status:
	err = qlcnic_check_fw_status(adapter);
1217 1218 1219
	if (err)
		goto err_out;

1220
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_READY);
1221
	qlcnic_idc_debug_info(adapter, 1);
1222 1223 1224 1225 1226 1227
	err = qlcnic_check_eswitch_mode(adapter);
	if (err) {
		dev_err(&adapter->pdev->dev,
			"Memory allocation failed for eswitch\n");
		goto err_out;
	}
1228 1229 1230 1231 1232
	err = qlcnic_set_mgmt_operations(adapter);
	if (err)
		goto err_out;

	qlcnic_check_options(adapter);
1233 1234
	adapter->need_fw_reset = 0;

1235 1236
	qlcnic_release_firmware(adapter);
	return 0;
1237 1238

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

1242 1243 1244 1245 1246 1247 1248 1249 1250
	qlcnic_release_firmware(adapter);
	return err;
}

static int
qlcnic_request_irq(struct qlcnic_adapter *adapter)
{
	irq_handler_t handler;
	struct qlcnic_host_sds_ring *sds_ring;
S
Sony Chacko 已提交
1251
	struct qlcnic_host_tx_ring *tx_ring;
1252 1253 1254 1255
	int err, ring;

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

1258
	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
S
Sony Chacko 已提交
1259 1260
		if (qlcnic_82xx_check(adapter))
			handler = qlcnic_tmp_intr;
1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272
		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;
		}
1273 1274 1275
	}
	adapter->irq = netdev->irq;

S
Sony Chacko 已提交
1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300
	if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST) {
		for (ring = 0; ring < adapter->max_sds_rings; ring++) {
			sds_ring = &recv_ctx->sds_rings[ring];
			snprintf(sds_ring->name, sizeof(int) + IFNAMSIZ,
				 "%s[%d]", netdev->name, ring);
			err = request_irq(sds_ring->irq, handler, flags,
					  sds_ring->name, sds_ring);
			if (err)
				return err;
		}
		if (qlcnic_83xx_check(adapter) &&
		    (adapter->flags & QLCNIC_MSIX_ENABLED)) {
			handler = qlcnic_msix_tx_intr;
			for (ring = 0; ring < adapter->max_drv_tx_rings;
			     ring++) {
				tx_ring = &adapter->tx_ring[ring];
				snprintf(tx_ring->name, sizeof(int) + IFNAMSIZ,
					 "%s[%d]", netdev->name,
				adapter->max_sds_rings + ring);
				err = request_irq(tx_ring->irq, handler, flags,
						  tx_ring->name, tx_ring);
				if (err)
					return err;
			}
		}
1301 1302 1303 1304 1305 1306 1307 1308 1309
	}
	return 0;
}

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

A
Anirban Chakraborty 已提交
1312
	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1313

S
Sony Chacko 已提交
1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326
	if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST) {
		for (ring = 0; ring < adapter->max_sds_rings; ring++) {
			sds_ring = &recv_ctx->sds_rings[ring];
			free_irq(sds_ring->irq, sds_ring);
		}
		if (qlcnic_83xx_check(adapter)) {
			for (ring = 0; ring < adapter->max_drv_tx_rings;
			     ring++) {
				tx_ring = &adapter->tx_ring[ring];
				if (tx_ring->irq)
					free_irq(tx_ring->irq, tx_ring);
			}
		}
1327 1328 1329
	}
}

S
Sony Chacko 已提交
1330
int __qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1331
{
1332
	int ring;
1333 1334
	u32 capab2;

1335 1336
	struct qlcnic_host_rds_ring *rds_ring;

1337 1338 1339
	if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
		return -EIO;

1340 1341
	if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
		return 0;
1342 1343
	if (qlcnic_set_eswitch_port_config(adapter))
		return -EIO;
1344

1345
	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_MORE_CAPS) {
1346 1347 1348 1349 1350
		capab2 = QLCRD32(adapter, CRB_FW_CAPABILITIES_2);
		if (capab2 & QLCNIC_FW_CAPABILITY_2_LRO_MAX_TCP_SEG)
			adapter->flags |= QLCNIC_FW_LRO_MSS_CAP;
	}

1351 1352 1353 1354
	if (qlcnic_fw_create_ctx(adapter))
		return -EIO;

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

1359 1360 1361
	qlcnic_set_multi(netdev);
	qlcnic_fw_cmd_set_mtu(adapter, netdev->mtu);

A
Anirban Chakraborty 已提交
1362
	adapter->ahw->linkup = 0;
1363 1364 1365 1366 1367 1368

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

	qlcnic_config_intr_coalesce(adapter);

1369
	if (netdev->features & NETIF_F_LRO)
1370 1371 1372 1373 1374 1375
		qlcnic_config_hw_lro(adapter, QLCNIC_LRO_ENABLED);

	qlcnic_napi_enable(adapter);

	qlcnic_linkevent_request(adapter, 1);

1376
	adapter->ahw->reset_context = 0;
1377 1378 1379 1380
	set_bit(__QLCNIC_DEV_UP, &adapter->state);
	return 0;
}

1381
int qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392
{
	int err = 0;

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

	return err;
}

S
Sony Chacko 已提交
1393
void __qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407
{
	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);

1408 1409 1410
	if (adapter->fhash.fnum)
		qlcnic_delete_lb_filters(adapter);

1411 1412 1413 1414
	qlcnic_nic_set_promisc(adapter, QLCNIC_NIU_NON_PROMISC_MODE);

	qlcnic_napi_disable(adapter);

1415
	qlcnic_fw_destroy_ctx(adapter);
1416
	adapter->flags &= ~QLCNIC_FW_LRO_MSS_CAP;
1417 1418

	qlcnic_reset_rx_buffers_list(adapter);
1419 1420 1421 1422 1423 1424
	qlcnic_release_tx_buffers(adapter);
	spin_unlock(&adapter->tx_clean_lock);
}

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

1425
void qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1426 1427 1428 1429 1430 1431 1432 1433
{
	rtnl_lock();
	if (netif_running(netdev))
		__qlcnic_down(adapter, netdev);
	rtnl_unlock();

}

S
Sony Chacko 已提交
1434
int
1435 1436 1437 1438
qlcnic_attach(struct qlcnic_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	struct pci_dev *pdev = adapter->pdev;
1439
	int err;
1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450

	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");
1451
		goto err_out_napi_del;
1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462
	}

	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");
1463
		goto err_out_free_hw;
1464 1465 1466 1467 1468 1469 1470
	}

	qlcnic_create_sysfs_entries(adapter);

	adapter->is_up = QLCNIC_ADAPTER_UP_MAGIC;
	return 0;

1471
err_out_free_hw:
1472 1473 1474
	qlcnic_free_hw_resources(adapter);
err_out_free_sw:
	qlcnic_free_sw_resources(adapter);
1475 1476
err_out_napi_del:
	qlcnic_napi_del(adapter);
1477 1478 1479
	return err;
}

S
Sony Chacko 已提交
1480
void qlcnic_detach(struct qlcnic_adapter *adapter)
1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495
{
	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;
}

1496 1497 1498 1499 1500 1501
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;

1502
	clear_bit(__QLCNIC_DEV_UP, &adapter->state);
1503
	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
1504
		for (ring = 0; ring < adapter->max_sds_rings; ring++) {
A
Anirban Chakraborty 已提交
1505
			sds_ring = &adapter->recv_ctx->sds_rings[ring];
S
Sony Chacko 已提交
1506 1507 1508 1509
			if (qlcnic_83xx_check(adapter))
				writel(1, sds_ring->crb_intr_mask);
			else
				qlcnic_disable_int(sds_ring);
1510
		}
1511 1512
	}

1513 1514
	qlcnic_fw_destroy_ctx(adapter);

1515 1516
	qlcnic_detach(adapter);

1517
	adapter->ahw->diag_test = 0;
1518 1519 1520
	adapter->max_sds_rings = max_sds_rings;

	if (qlcnic_attach(adapter))
1521
		goto out;
1522 1523 1524

	if (netif_running(netdev))
		__qlcnic_up(adapter, netdev);
1525
out:
1526 1527 1528
	netif_device_attach(netdev);
}

A
Anirban Chakraborty 已提交
1529 1530 1531 1532 1533 1534 1535
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) {
		err = -ENOMEM;
A
Anirban Chakraborty 已提交
1536
		goto err_out;
A
Anirban Chakraborty 已提交
1537
	}
A
Anirban Chakraborty 已提交
1538 1539 1540 1541
	/* 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 已提交
1542 1543
	/* clear stats */
	memset(&adapter->stats, 0, sizeof(adapter->stats));
A
Anirban Chakraborty 已提交
1544 1545 1546 1547 1548 1549 1550 1551 1552
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 已提交
1553 1554 1555 1556
	if (adapter->ahw->fw_dump.tmpl_hdr) {
		vfree(adapter->ahw->fw_dump.tmpl_hdr);
		adapter->ahw->fw_dump.tmpl_hdr = NULL;
	}
S
Sony Chacko 已提交
1557

1558
	kfree(adapter->ahw->reset.buff);
S
Sony Chacko 已提交
1559
	adapter->ahw->fw_dump.tmpl_hdr = NULL;
A
Anirban Chakraborty 已提交
1560 1561
}

1562 1563 1564 1565
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;
1566
	struct qlcnic_host_rds_ring *rds_ring;
1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577
	int ring;
	int ret;

	netif_device_detach(netdev);

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

	qlcnic_detach(adapter);

	adapter->max_sds_rings = 1;
1578
	adapter->ahw->diag_test = test;
S
Sony Chacko 已提交
1579
	adapter->ahw->linkup = 0;
1580 1581

	ret = qlcnic_attach(adapter);
1582 1583
	if (ret) {
		netif_device_attach(netdev);
1584
		return ret;
1585
	}
1586

1587 1588 1589
	ret = qlcnic_fw_create_ctx(adapter);
	if (ret) {
		qlcnic_detach(adapter);
1590
		netif_device_attach(netdev);
1591 1592 1593 1594
		return ret;
	}

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

1599
	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
1600
		for (ring = 0; ring < adapter->max_sds_rings; ring++) {
A
Anirban Chakraborty 已提交
1601
			sds_ring = &adapter->recv_ctx->sds_rings[ring];
1602 1603 1604 1605
			if (qlcnic_82xx_check(adapter))
				qlcnic_enable_int(sds_ring);
			else
				qlcnic_83xx_enable_intr(adapter, sds_ring);
1606
		}
1607
	}
1608

1609
	if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {
1610 1611 1612 1613
		adapter->ahw->loopback_state = 0;
		qlcnic_linkevent_request(adapter, 1);
	}

1614
	set_bit(__QLCNIC_DEV_UP, &adapter->state);
1615 1616 1617 1618

	return 0;
}

1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636
/* Reset context in hardware only */
static int
qlcnic_reset_hw_context(struct qlcnic_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;

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

	netif_device_detach(netdev);

	qlcnic_down(adapter, netdev);

	qlcnic_up(adapter, netdev);

	netif_device_attach(netdev);

	clear_bit(__QLCNIC_RESETTING, &adapter->state);
S
Sony Chacko 已提交
1637
	dev_err(&adapter->pdev->dev, "%s:\n", __func__);
1638 1639 1640
	return 0;
}

1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660
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 已提交
1661
			if (!err) {
1662
				__qlcnic_up(adapter, netdev);
A
Anirban Chakraborty 已提交
1663 1664
				qlcnic_restore_indev_addr(netdev, NETDEV_UP);
			}
1665 1666 1667 1668 1669 1670 1671 1672 1673 1674
		}

		netif_device_attach(netdev);
	}

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

static int
S
Sony Chacko 已提交
1675 1676
qlcnic_setup_netdev(struct qlcnic_adapter *adapter, struct net_device *netdev,
		    int pci_using_dac)
1677 1678 1679 1680
{
	int err;
	struct pci_dev *pdev = adapter->pdev;

S
Sony Chacko 已提交
1681
	adapter->rx_csum = 1;
1682
	adapter->ahw->mc_enabled = 0;
S
Sony Chacko 已提交
1683
	adapter->ahw->max_mc_count = QLCNIC_MAX_MC_COUNT;
1684 1685

	netdev->netdev_ops	   = &qlcnic_netdev_ops;
S
Sony Chacko 已提交
1686
	netdev->watchdog_timeo     = QLCNIC_WATCHDOG_TIMEOUTVALUE * HZ;
1687 1688 1689 1690 1691

	qlcnic_change_mtu(netdev, netdev->mtu);

	SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_ops);

1692
	netdev->features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |
S
Sony Chacko 已提交
1693 1694 1695 1696
			     NETIF_F_IPV6_CSUM | NETIF_F_GRO |
			     NETIF_F_HW_VLAN_RX);
	netdev->vlan_features |= (NETIF_F_SG | NETIF_F_IP_CSUM |
				  NETIF_F_IPV6_CSUM);
1697

S
Sony Chacko 已提交
1698 1699 1700 1701
	if (QLCNIC_IS_TSO_CAPABLE(adapter)) {
		netdev->features |= (NETIF_F_TSO | NETIF_F_TSO6);
		netdev->vlan_features |= (NETIF_F_TSO | NETIF_F_TSO6);
	}
1702

S
Sony Chacko 已提交
1703 1704 1705 1706
	if (pci_using_dac) {
		netdev->features |= NETIF_F_HIGHDMA;
		netdev->vlan_features |= NETIF_F_HIGHDMA;
	}
1707

S
Sony Chacko 已提交
1708 1709
	if (qlcnic_vlan_tx_check(adapter))
		netdev->features |= (NETIF_F_HW_VLAN_TX);
1710

S
Sony Chacko 已提交
1711 1712
	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)
		netdev->features |= NETIF_F_LRO;
1713

1714
	netdev->hw_features = netdev->features;
1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725
	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 已提交
1726
static int qlcnic_set_dma_mask(struct pci_dev *pdev, int *pci_using_dac)
1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741
{
	if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) &&
			!pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)))
		*pci_using_dac = 1;
	else if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) &&
			!pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)))
		*pci_using_dac = 0;
	else {
		dev_err(&pdev->dev, "Unable to set DMA mask, aborting\n");
		return -EIO;
	}

	return 0;
}

S
Sony Chacko 已提交
1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760
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)
{
1761
	int ring, vector, index;
S
Sony Chacko 已提交
1762 1763 1764
	struct qlcnic_host_tx_ring *tx_ring;
	struct qlcnic_cmd_buffer *cmd_buf_arr;

1765 1766 1767
	tx_ring = kcalloc(adapter->max_drv_tx_rings,
			  sizeof(struct qlcnic_host_tx_ring), GFP_KERNEL);
	if (tx_ring == NULL)
S
Sony Chacko 已提交
1768
		return -ENOMEM;
1769

S
Sony Chacko 已提交
1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798
	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) {
			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;
}

B
Bill Pemberton 已提交
1799
static int
1800 1801 1802 1803
qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
{
	struct net_device *netdev = NULL;
	struct qlcnic_adapter *adapter = NULL;
1804
	struct qlcnic_hardware_context *ahw;
S
Sony Chacko 已提交
1805
	int err, pci_using_dac = -1;
1806
	u32 capab2;
1807
	char board_name[QLCNIC_MAX_BOARD_NAME_LEN + 19]; /* MAC + ": " + name */
1808 1809 1810 1811 1812 1813 1814 1815 1816 1817

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

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

1818 1819 1820 1821
	err = qlcnic_set_dma_mask(pdev, &pci_using_dac);
	if (err)
		goto err_out_disable_pdev;

1822 1823 1824 1825 1826
	err = pci_request_regions(pdev, qlcnic_driver_name);
	if (err)
		goto err_out_disable_pdev;

	pci_set_master(pdev);
S
Sucheta Chakraborty 已提交
1827
	pci_enable_pcie_error_reporting(pdev);
1828

1829 1830 1831 1832 1833 1834 1835
	ahw = kzalloc(sizeof(struct qlcnic_hardware_context), GFP_KERNEL);
	if (!ahw)
		goto err_out_free_res;

	if (ent->device == PCI_DEVICE_ID_QLOGIC_QLE824X) {
		ahw->hw_ops = &qlcnic_hw_ops;
		ahw->reg_tbl = (u32 *)qlcnic_reg_tbl;
S
Sony Chacko 已提交
1836 1837 1838 1839
	} else if (ent->device == PCI_DEVICE_ID_QLOGIC_QLE834X) {
		qlcnic_83xx_register_map(ahw);
	} else {
		goto err_out_free_hw_res;
1840 1841 1842 1843 1844 1845
	}

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

1846 1847 1848
	netdev = alloc_etherdev(sizeof(struct qlcnic_adapter));
	if (!netdev) {
		err = -ENOMEM;
1849
		goto err_out_iounmap;
1850 1851 1852 1853 1854 1855 1856
	}

	SET_NETDEV_DEV(netdev, &pdev->dev);

	adapter = netdev_priv(netdev);
	adapter->netdev  = netdev;
	adapter->pdev    = pdev;
S
Sony Chacko 已提交
1857 1858 1859 1860 1861 1862 1863
	adapter->ahw = ahw;

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

1865 1866
	err = qlcnic_alloc_adapter_resources(adapter);
	if (err)
A
Anirban Chakraborty 已提交
1867 1868 1869
		goto err_out_free_netdev;

	adapter->dev_rst_time = jiffies;
1870
	adapter->ahw->revision_id = pdev->revision;
1871 1872 1873 1874
	if (qlcnic_mac_learn == FDB_MAC_LEARN)
		adapter->fdb_mac_learn = true;
	else if (qlcnic_mac_learn == DRV_MAC_LEARN)
		adapter->drv_mac_learn = true;
1875
	adapter->max_drv_tx_rings = 1;
1876

A
Anirban Chakraborty 已提交
1877 1878
	rwlock_init(&adapter->ahw->crb_lock);
	mutex_init(&adapter->ahw->mem_lock);
1879 1880 1881 1882

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

1883
	if (qlcnic_82xx_check(adapter)) {
S
Sony Chacko 已提交
1884
		qlcnic_check_vf(adapter, ent);
1885 1886 1887 1888 1889 1890
		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;
		}
1891

1892 1893 1894
		err = qlcnic_setup_idc_param(adapter);
		if (err)
			goto err_out_free_hw;
1895

1896
		adapter->flags |= QLCNIC_NEED_FLR;
S
Sony Chacko 已提交
1897 1898 1899
	} else if (qlcnic_83xx_check(adapter)) {
		qlcnic_83xx_check_vf(adapter, ent);
		adapter->portnum = adapter->ahw->pci_func;
1900 1901 1902 1903 1904
		err = qlcnic_83xx_init(adapter);
		if (err) {
			dev_err(&pdev->dev, "%s: failed\n", __func__);
			goto err_out_free_hw;
		}
S
Sony Chacko 已提交
1905 1906 1907 1908
	} else {
		dev_err(&pdev->dev,
			"%s: failed. Please Reboot\n", __func__);
		goto err_out_free_hw;
1909
	}
1910

R
Rajesh Borundia 已提交
1911 1912 1913 1914
	if (qlcnic_read_mac_addr(adapter))
		dev_warn(&pdev->dev, "failed to read mac addr\n");

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

R
Rajesh Borundia 已提交
1917
		pr_info("%s: %s Board Chip rev 0x%x\n",
S
Sony Chacko 已提交
1918 1919
			module_name(THIS_MODULE),
			board_name, adapter->ahw->revision_id);
R
Rajesh Borundia 已提交
1920
	}
1921
	err = qlcnic_setup_intr(adapter, 0);
1922 1923
	if (err) {
		dev_err(&pdev->dev, "Failed to setup interrupt\n");
1924
		goto err_out_disable_msi;
1925
	}
1926

S
Sony Chacko 已提交
1927 1928 1929 1930 1931
	if (qlcnic_83xx_check(adapter)) {
		err = qlcnic_83xx_setup_mbx_intr(adapter);
		if (err)
			goto err_out_disable_msi;
	}
1932

1933
	err = qlcnic_setup_netdev(adapter, netdev, pci_using_dac);
1934
	if (err)
1935
		goto err_out_disable_mbx_intr;
1936

1937 1938 1939 1940 1941 1942 1943 1944
	if (qlcnic_82xx_check(adapter)) {
		if (ahw->capabilities & QLCNIC_FW_CAPABILITY_MORE_CAPS) {
			capab2 = QLCRD32(adapter, CRB_FW_CAPABILITIES_2);
			if (capab2 & QLCNIC_FW_CAPABILITY_2_OCBB)
				qlcnic_fw_cmd_set_drv_version(adapter);
		}
	}

1945 1946
	pci_set_drvdata(pdev, adapter);

1947 1948 1949
	if (qlcnic_82xx_check(adapter))
		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
				     FW_POLL_DELAY);
1950

A
Anirban Chakraborty 已提交
1951
	switch (adapter->ahw->port_type) {
1952 1953 1954 1955 1956 1957 1958 1959 1960 1961
	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;
	}

1962 1963 1964
	if (qlcnic_get_act_pci_func(adapter))
		goto err_out_disable_mbx_intr;

1965
	if (adapter->drv_mac_learn)
1966 1967
		qlcnic_alloc_lb_filters_mem(adapter);

1968
	qlcnic_add_sysfs(adapter);
1969 1970 1971

	return 0;

1972
err_out_disable_mbx_intr:
S
Sony Chacko 已提交
1973 1974 1975 1976 1977
	if (qlcnic_83xx_check(adapter)) {
		if (adapter->flags & QLCNIC_MSIX_ENABLED)
			qlcnic_83xx_config_intrpt(adapter, 0);
		qlcnic_83xx_free_mbx_intr(adapter);
	}
1978

1979 1980
err_out_disable_msi:
	qlcnic_teardown_intr(adapter);
1981
	qlcnic_cancel_idc_work(adapter);
1982
	qlcnic_clr_all_drv_state(adapter, 0);
1983

A
Anirban Chakraborty 已提交
1984 1985 1986
err_out_free_hw:
	qlcnic_free_adapter_resources(adapter);

1987 1988 1989
err_out_free_netdev:
	free_netdev(netdev);

1990 1991 1992 1993 1994 1995
err_out_iounmap:
	qlcnic_cleanup_pci_map(adapter);

err_out_free_hw_res:
	kfree(ahw);

1996 1997 1998 1999 2000 2001 2002 2003 2004
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 已提交
2005
static void qlcnic_remove(struct pci_dev *pdev)
2006 2007 2008
{
	struct qlcnic_adapter *adapter;
	struct net_device *netdev;
S
Sony Chacko 已提交
2009
	struct qlcnic_hardware_context *ahw;
2010 2011 2012 2013 2014 2015 2016

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

	netdev = adapter->netdev;

S
Sony Chacko 已提交
2017 2018
	qlcnic_cancel_idc_work(adapter);
	ahw = adapter->ahw;
2019 2020 2021

	unregister_netdev(netdev);

S
Sony Chacko 已提交
2022 2023 2024 2025 2026 2027
	if (qlcnic_83xx_check(adapter)) {
		if (adapter->flags & QLCNIC_MSIX_ENABLED)
			qlcnic_83xx_config_intrpt(adapter, 0);
		qlcnic_83xx_free_mbx_intr(adapter);
	}

2028 2029
	qlcnic_detach(adapter);

2030 2031 2032 2033 2034
	if (adapter->npars != NULL)
		kfree(adapter->npars);
	if (adapter->eswitch != NULL)
		kfree(adapter->eswitch);

2035 2036
	if (qlcnic_82xx_check(adapter))
		qlcnic_clr_all_drv_state(adapter, 0);
2037 2038 2039

	clear_bit(__QLCNIC_RESETTING, &adapter->state);

2040 2041
	qlcnic_free_lb_filters_mem(adapter);

2042 2043
	qlcnic_teardown_intr(adapter);

S
Sony Chacko 已提交
2044
	qlcnic_remove_sysfs(adapter);
2045 2046 2047 2048 2049

	qlcnic_cleanup_pci_map(adapter);

	qlcnic_release_firmware(adapter);

S
Sucheta Chakraborty 已提交
2050
	pci_disable_pcie_error_reporting(pdev);
2051 2052 2053 2054
	pci_release_regions(pdev);
	pci_disable_device(pdev);
	pci_set_drvdata(pdev, NULL);

S
Sony Chacko 已提交
2055 2056 2057 2058
	if (adapter->qlcnic_wq) {
		destroy_workqueue(adapter->qlcnic_wq);
		adapter->qlcnic_wq = NULL;
	}
A
Anirban Chakraborty 已提交
2059
	qlcnic_free_adapter_resources(adapter);
S
Sony Chacko 已提交
2060
	kfree(ahw);
2061 2062 2063 2064 2065 2066 2067 2068 2069 2070
	free_netdev(netdev);
}
static int __qlcnic_shutdown(struct pci_dev *pdev)
{
	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
	int retval;

	netif_device_detach(netdev);

S
Sony Chacko 已提交
2071
	qlcnic_cancel_idc_work(adapter);
2072 2073 2074 2075

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

2076 2077
	if (qlcnic_82xx_check(adapter))
		qlcnic_clr_all_drv_state(adapter, 0);
2078 2079 2080 2081 2082 2083

	clear_bit(__QLCNIC_RESETTING, &adapter->state);

	retval = pci_save_state(pdev);
	if (retval)
		return retval;
2084 2085 2086 2087 2088
	if (qlcnic_82xx_check(adapter)) {
		if (qlcnic_wol_supported(adapter)) {
			pci_enable_wake(pdev, PCI_D3cold, 1);
			pci_enable_wake(pdev, PCI_D3hot, 1);
		}
2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130
	}

	return 0;
}

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

	pci_disable_device(pdev);
}

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

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

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

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

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

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

S
Sony Chacko 已提交
2131
	err = qlcnic_start_firmware(adapter);
2132 2133 2134 2135 2136 2137 2138 2139
	if (err) {
		dev_err(&pdev->dev, "failed to start firmware\n");
		return err;
	}

	if (netif_running(netdev)) {
		err = qlcnic_up(adapter, netdev);
		if (err)
2140
			goto done;
2141

A
Amit Kumar Salecha 已提交
2142
		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
2143
	}
2144
done:
2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155
	netif_device_attach(netdev);
	qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
	return 0;
}
#endif

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

2156 2157
	netif_carrier_off(netdev);

2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182
	err = qlcnic_attach(adapter);
	if (err)
		return err;

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

	netif_start_queue(netdev);

	return 0;

err_out:
	qlcnic_detach(adapter);
	return err;
}

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

	__qlcnic_down(adapter, netdev);
S
Sony Chacko 已提交
2183 2184 2185 2186 2187
	if (qlcnic_83xx_check(adapter)) {
		qlcnic_83xx_register_nic_idc_func(adapter, 0);
		cancel_delayed_work_sync(&adapter->idc_aen_work);
	}

2188 2189 2190
	return 0;
}

2191
void qlcnic_alloc_lb_filters_mem(struct qlcnic_adapter *adapter)
2192 2193 2194
{
	void *head;
	int i;
S
Sony Chacko 已提交
2195 2196 2197
	struct net_device *netdev = adapter->netdev;
	u32 filter_size = 0;
	u16 act_pci_func = 0;
2198

2199
	if (adapter->fhash.fmax && adapter->fhash.fhead)
2200 2201
		return;

S
Sony Chacko 已提交
2202
	act_pci_func = adapter->ahw->act_pci_func;
2203 2204
	spin_lock_init(&adapter->mac_learn_lock);

S
Sony Chacko 已提交
2205 2206 2207 2208 2209 2210 2211 2212 2213
	if (qlcnic_82xx_check(adapter)) {
		filter_size = QLCNIC_LB_MAX_FILTERS;
		adapter->fhash.fbucket_size = QLCNIC_LB_BUCKET_SIZE;
	} else {
		filter_size = QLC_83XX_LB_MAX_FILTERS;
		adapter->fhash.fbucket_size = QLC_83XX_LB_BUCKET_SIZE;
	}

	head = kcalloc(adapter->fhash.fbucket_size,
2214
		       sizeof(struct hlist_head), GFP_ATOMIC);
S
Sony Chacko 已提交
2215

2216 2217 2218
	if (!head)
		return;

S
Sony Chacko 已提交
2219
	adapter->fhash.fmax = (filter_size / act_pci_func);
2220
	adapter->fhash.fhead = head;
2221

S
Sony Chacko 已提交
2222 2223 2224 2225
	netdev_info(netdev, "active nic func = %d, mac filter size=%d\n",
		    act_pci_func, adapter->fhash.fmax);

	for (i = 0; i < adapter->fhash.fbucket_size; i++)
2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237
		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;
}

2238
int qlcnic_check_temp(struct qlcnic_adapter *adapter)
2239 2240
{
	struct net_device *netdev = adapter->netdev;
2241
	u32 temp_state, temp_val, temp = 0;
2242 2243
	int rv = 0;

S
Sony Chacko 已提交
2244 2245 2246
	if (qlcnic_83xx_check(adapter))
		temp = QLCRDX(adapter->ahw, QLC_83XX_ASIC_TEMP);

2247
	if (qlcnic_82xx_check(adapter))
2248
		temp = QLC_SHARED_REG_RD32(adapter, QLCNIC_ASIC_TEMP);
2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259

	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) {
2260
		if (adapter->ahw->temp == QLCNIC_TEMP_NORMAL) {
2261 2262 2263 2264 2265 2266 2267
			dev_err(&netdev->dev,
			       "Device temperature %d degrees C "
			       "exceeds operating range."
			       " Immediate action needed.\n",
			       temp_val);
		}
	} else {
2268
		if (adapter->ahw->temp == QLCNIC_TEMP_WARN) {
2269 2270 2271 2272 2273
			dev_info(&netdev->dev,
			       "Device temperature is now %d degrees C"
			       " in normal range.\n", temp_val);
		}
	}
2274
	adapter->ahw->temp = temp_state;
2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287
	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)
2288 2289
		adapter->need_fw_reset = 1;
	else
2290
		adapter->ahw->reset_context = 1;
2291 2292 2293 2294 2295 2296 2297 2298 2299
}

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;
2300
	stats->rx_bytes = adapter->stats.rxbytes + adapter->stats.lrobytes;
2301 2302 2303 2304 2305 2306 2307
	stats->tx_bytes = adapter->stats.txbytes;
	stats->rx_dropped = adapter->stats.rxdropped;
	stats->tx_dropped = adapter->stats.txdropped;

	return stats;
}

2308
irqreturn_t qlcnic_82xx_clear_legacy_intr(struct qlcnic_adapter *adapter)
2309 2310 2311 2312 2313
{
	u32 status;

	status = readl(adapter->isr_int_vec);

2314
	if (!(status & adapter->ahw->int_vec_bit))
2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326
		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);

2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345
	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:
2346
	adapter->ahw->diag_cnt++;
2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358
	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;

2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383
	napi_schedule(&sds_ring->napi);

	return IRQ_HANDLED;
}

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

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

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

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

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

S
Sony Chacko 已提交
2384 2385 2386 2387 2388 2389 2390 2391
static irqreturn_t qlcnic_msix_tx_intr(int irq, void *data)
{
	struct qlcnic_host_tx_ring *tx_ring = data;

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

2392 2393 2394
#ifdef CONFIG_NET_POLL_CONTROLLER
static void qlcnic_poll_controller(struct net_device *netdev)
{
Y
Yinglin Luan 已提交
2395 2396
	int ring;
	struct qlcnic_host_sds_ring *sds_ring;
2397
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
A
Anirban Chakraborty 已提交
2398
	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
Y
Yinglin Luan 已提交
2399

2400
	disable_irq(adapter->irq);
Y
Yinglin Luan 已提交
2401 2402 2403 2404
	for (ring = 0; ring < adapter->max_sds_rings; ring++) {
		sds_ring = &recv_ctx->sds_rings[ring];
		qlcnic_intr(adapter->irq, sds_ring);
	}
2405 2406 2407 2408
	enable_irq(adapter->irq);
}
#endif

2409 2410 2411 2412 2413 2414 2415 2416 2417
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;

2418
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_SCRATCH, val);
2419 2420 2421
	adapter->dev_rst_time = jiffies;
}

2422 2423
static int
qlcnic_set_drv_state(struct qlcnic_adapter *adapter, u8 state)
2424 2425 2426 2427 2428 2429 2430
{
	u32  val;

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

	if (qlcnic_api_lock(adapter))
2431
		return -EIO;
2432

2433
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2434 2435

	if (state == QLCNIC_DEV_NEED_RESET)
2436
		QLC_DEV_SET_RST_RDY(val, adapter->portnum);
2437
	else if (state == QLCNIC_DEV_NEED_QUISCENT)
2438
		QLC_DEV_SET_QSCNT_RDY(val, adapter->portnum);
2439

2440
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2441 2442

	qlcnic_api_unlock(adapter);
2443 2444

	return 0;
2445 2446
}

2447 2448 2449 2450 2451 2452 2453 2454
static int
qlcnic_clr_drv_state(struct qlcnic_adapter *adapter)
{
	u32  val;

	if (qlcnic_api_lock(adapter))
		return -EBUSY;

2455
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2456
	QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
2457
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2458 2459 2460 2461 2462 2463

	qlcnic_api_unlock(adapter);

	return 0;
}

2464
static void
2465
qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8 failed)
2466 2467 2468 2469 2470 2471
{
	u32  val;

	if (qlcnic_api_lock(adapter))
		goto err;

2472
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2473
	QLC_DEV_CLR_REF_CNT(val, adapter->portnum);
2474
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
2475

2476
	if (failed) {
2477 2478
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_FAILED);
2479 2480 2481
		dev_info(&adapter->pdev->dev,
				"Device state set to Failed. Please Reboot\n");
	} else if (!(val & 0x11111111))
2482 2483
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_COLD);
2484

2485
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2486
	QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
2487
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2488 2489 2490 2491

	qlcnic_api_unlock(adapter);
err:
	adapter->fw_fail_cnt = 0;
S
Sritej Velaga 已提交
2492
	adapter->flags &= ~QLCNIC_FW_HANG;
2493 2494 2495 2496
	clear_bit(__QLCNIC_START_FW, &adapter->state);
	clear_bit(__QLCNIC_RESETTING, &adapter->state);
}

2497
/* Grab api lock, before checking state */
2498 2499 2500
static int
qlcnic_check_drv_state(struct qlcnic_adapter *adapter)
{
2501
	int act, state, active_mask;
2502
	struct qlcnic_hardware_context *ahw = adapter->ahw;
2503

2504 2505
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
	act = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2506

2507
	if (adapter->flags & QLCNIC_FW_RESET_OWNER) {
2508
		active_mask = (~(1 << (ahw->pci_func * 4)));
2509 2510 2511
		act = act & active_mask;
	}

2512 2513 2514 2515 2516 2517 2518
	if (((state & 0x11111111) == (act & 0x11111111)) ||
			((act & 0x11111111) == ((state >> 1) & 0x11111111)))
		return 0;
	else
		return 1;
}

S
Sucheta Chakraborty 已提交
2519 2520
static int qlcnic_check_idc_ver(struct qlcnic_adapter *adapter)
{
2521
	u32 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_IDC_VER);
S
Sucheta Chakraborty 已提交
2522 2523 2524 2525 2526 2527 2528 2529 2530

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

2531 2532 2533 2534
static int
qlcnic_can_start_firmware(struct qlcnic_adapter *adapter)
{
	u32 val, prev_state;
2535
	u8 dev_init_timeo = adapter->dev_init_timeo;
2536
	u8 portnum = adapter->portnum;
S
Sucheta Chakraborty 已提交
2537
	u8 ret;
2538

2539 2540 2541
	if (test_and_clear_bit(__QLCNIC_START_FW, &adapter->state))
		return 1;

2542 2543 2544
	if (qlcnic_api_lock(adapter))
		return -1;

2545
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2546 2547
	if (!(val & (1 << (portnum * 4)))) {
		QLC_DEV_SET_REF_CNT(val, portnum);
2548
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
2549 2550
	}

2551
	prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2552
	QLCDB(adapter, HW, "Device state = %u\n", prev_state);
2553 2554 2555

	switch (prev_state) {
	case QLCNIC_DEV_COLD:
2556 2557 2558 2559
		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);
2560
		qlcnic_idc_debug_info(adapter, 0);
2561 2562 2563 2564
		qlcnic_api_unlock(adapter);
		return 1;

	case QLCNIC_DEV_READY:
S
Sucheta Chakraborty 已提交
2565
		ret = qlcnic_check_idc_ver(adapter);
2566
		qlcnic_api_unlock(adapter);
S
Sucheta Chakraborty 已提交
2567
		return ret;
2568 2569

	case QLCNIC_DEV_NEED_RESET:
2570
		val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2571
		QLC_DEV_SET_RST_RDY(val, portnum);
2572
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2573 2574 2575
		break;

	case QLCNIC_DEV_NEED_QUISCENT:
2576
		val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2577
		QLC_DEV_SET_QSCNT_RDY(val, portnum);
2578
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2579 2580 2581
		break;

	case QLCNIC_DEV_FAILED:
2582
		dev_err(&adapter->pdev->dev, "Device in failed state.\n");
2583 2584
		qlcnic_api_unlock(adapter);
		return -1;
2585 2586 2587 2588

	case QLCNIC_DEV_INITIALIZING:
	case QLCNIC_DEV_QUISCENT:
		break;
2589 2590 2591
	}

	qlcnic_api_unlock(adapter);
2592 2593

	do {
2594
		msleep(1000);
2595
		prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2596 2597 2598 2599

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

2601 2602 2603
	if (!dev_init_timeo) {
		dev_err(&adapter->pdev->dev,
			"Waiting for device to initialize timeout\n");
2604
		return -1;
2605
	}
2606 2607 2608 2609

	if (qlcnic_api_lock(adapter))
		return -1;

2610
	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
2611
	QLC_DEV_CLR_RST_QSCNT(val, portnum);
2612
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2613

S
Sucheta Chakraborty 已提交
2614
	ret = qlcnic_check_idc_ver(adapter);
2615 2616
	qlcnic_api_unlock(adapter);

S
Sucheta Chakraborty 已提交
2617
	return ret;
2618 2619 2620 2621 2622 2623 2624
}

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

2628 2629
	if (qlcnic_api_lock(adapter))
		goto err_ret;
2630

2631
	dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2632 2633
	if (dev_state == QLCNIC_DEV_QUISCENT ||
	    dev_state == QLCNIC_DEV_NEED_QUISCENT) {
2634 2635 2636 2637 2638 2639
		qlcnic_api_unlock(adapter);
		qlcnic_schedule_work(adapter, qlcnic_fwinit_work,
						FW_POLL_DELAY * 2);
		return;
	}

2640
	if (adapter->ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
2641 2642
		qlcnic_api_unlock(adapter);
		goto wait_npar;
2643 2644
	}

2645 2646 2647 2648 2649 2650 2651
	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;
	}

2652
	if (adapter->fw_wait_cnt++ > adapter->reset_ack_timeo) {
2653
		dev_info(&adapter->pdev->dev, "Reset:Failed to get ack %d sec\n",
2654 2655 2656 2657 2658 2659
					adapter->reset_ack_timeo);
		goto skip_ack_check;
	}

	if (!qlcnic_check_drv_state(adapter)) {
skip_ack_check:
2660
		dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2661

2662
		if (dev_state == QLCNIC_DEV_NEED_RESET) {
2663 2664
			QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
					    QLCNIC_DEV_INITIALIZING);
2665 2666
			set_bit(__QLCNIC_START_FW, &adapter->state);
			QLCDB(adapter, DRV, "Restarting fw\n");
2667
			qlcnic_idc_debug_info(adapter, 0);
2668 2669
			val = QLC_SHARED_REG_RD32(adapter,
						  QLCNIC_CRB_DRV_STATE);
S
Sritej Velaga 已提交
2670
			QLC_DEV_SET_RST_RDY(val, adapter->portnum);
2671 2672
			QLC_SHARED_REG_WR32(adapter,
					    QLCNIC_CRB_DRV_STATE, val);
2673 2674
		}

2675 2676
		qlcnic_api_unlock(adapter);

2677
		rtnl_lock();
S
Sritej Velaga 已提交
2678 2679
		if (adapter->ahw->fw_dump.enable &&
		    (adapter->flags & QLCNIC_FW_RESET_OWNER)) {
2680 2681
			QLCDB(adapter, DRV, "Take FW dump\n");
			qlcnic_dump_fw(adapter);
S
Sritej Velaga 已提交
2682
			adapter->flags |= QLCNIC_FW_HANG;
2683
		}
2684
		rtnl_unlock();
S
Sritej Velaga 已提交
2685 2686

		adapter->flags &= ~QLCNIC_FW_RESET_OWNER;
2687
		if (!adapter->nic_ops->start_firmware(adapter)) {
2688
			qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
2689
			adapter->fw_wait_cnt = 0;
2690 2691 2692 2693 2694
			return;
		}
		goto err_ret;
	}

2695
	qlcnic_api_unlock(adapter);
2696

2697
wait_npar:
2698
	dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2699
	QLCDB(adapter, HW, "Func waiting: Device state=%u\n", dev_state);
2700

2701
	switch (dev_state) {
2702
	case QLCNIC_DEV_READY:
2703
		if (!qlcnic_start_firmware(adapter)) {
2704
			qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
2705
			adapter->fw_wait_cnt = 0;
2706 2707
			return;
		}
2708 2709 2710 2711 2712 2713
	case QLCNIC_DEV_FAILED:
		break;
	default:
		qlcnic_schedule_work(adapter,
			qlcnic_fwinit_work, FW_POLL_DELAY);
		return;
2714 2715 2716
	}

err_ret:
2717 2718
	dev_err(&adapter->pdev->dev, "Fwinit work failed state=%u "
		"fw_wait_cnt=%u\n", dev_state, adapter->fw_wait_cnt);
2719
	netif_device_attach(adapter->netdev);
2720
	qlcnic_clr_all_drv_state(adapter, 0);
2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732
}

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

2733 2734 2735 2736 2737 2738
	/* 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);
2739

2740
	status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
2741

S
Sony Chacko 已提交
2742 2743 2744 2745 2746 2747 2748 2749 2750 2751 2752 2753 2754
	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");
		}

2755
		goto err_ret;
S
Sony Chacko 已提交
2756
	}
2757

2758
	if (adapter->ahw->temp == QLCNIC_TEMP_PANIC) {
S
Sony Chacko 已提交
2759
		dev_err(&adapter->pdev->dev, "Detaching the device: temp=%d\n",
2760
			adapter->ahw->temp);
2761
		goto err_ret;
S
Sony Chacko 已提交
2762 2763
	}

2764 2765
	/* Dont ack if this instance is the reset owner */
	if (!(adapter->flags & QLCNIC_FW_RESET_OWNER)) {
S
Sony Chacko 已提交
2766 2767 2768 2769
		if (qlcnic_set_drv_state(adapter, adapter->dev_state)) {
			dev_err(&adapter->pdev->dev,
				"Failed to set driver state,"
					"detaching the device.\n");
2770
			goto err_ret;
S
Sony Chacko 已提交
2771
		}
2772
	}
2773 2774 2775 2776 2777 2778 2779 2780

	adapter->fw_wait_cnt = 0;

	qlcnic_schedule_work(adapter, qlcnic_fwinit_work, FW_POLL_DELAY);

	return;

err_ret:
2781
	netif_device_attach(netdev);
2782
	qlcnic_clr_all_drv_state(adapter, 1);
2783 2784
}

2785 2786 2787 2788 2789 2790
/*Transit NPAR state to NON Operational */
static void
qlcnic_set_npar_non_operational(struct qlcnic_adapter *adapter)
{
	u32 state;

2791
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
2792 2793 2794 2795 2796
	if (state == QLCNIC_DEV_NPAR_NON_OPER)
		return;

	if (qlcnic_api_lock(adapter))
		return;
2797 2798
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
			    QLCNIC_DEV_NPAR_NON_OPER);
2799 2800 2801
	qlcnic_api_unlock(adapter);
}

2802
void qlcnic_82xx_dev_request_reset(struct qlcnic_adapter *adapter, u32 key)
2803
{
2804 2805 2806 2807 2808 2809 2810 2811 2812 2813 2814 2815
	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");
2816
	adapter->need_fw_reset = 1;
S
Sony Chacko 已提交
2817

2818 2819 2820
	if (qlcnic_api_lock(adapter))
		return;

S
Sony Chacko 已提交
2821
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2822

2823
	if (state == QLCNIC_DEV_READY) {
S
Sony Chacko 已提交
2824 2825
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_NEED_RESET);
2826
		adapter->flags |= QLCNIC_FW_RESET_OWNER;
2827
		QLCDB(adapter, DRV, "NEED_RESET state set\n");
2828
		qlcnic_idc_debug_info(adapter, 0);
2829 2830
	}

S
Sony Chacko 已提交
2831 2832
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
			    QLCNIC_DEV_NPAR_NON_OPER);
2833 2834 2835
	qlcnic_api_unlock(adapter);
}

2836 2837 2838 2839 2840 2841 2842
/* 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;

2843 2844
	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
			    QLCNIC_DEV_NPAR_OPER);
2845
	QLCDB(adapter, DRV, "NPAR operational state set\n");
2846 2847 2848 2849

	qlcnic_api_unlock(adapter);
}

S
Sony Chacko 已提交
2850 2851
void qlcnic_schedule_work(struct qlcnic_adapter *adapter,
			  work_func_t func, int delay)
2852
{
S
Sucheta Chakraborty 已提交
2853 2854 2855
	if (test_bit(__QLCNIC_AER, &adapter->state))
		return;

2856
	INIT_DELAYED_WORK(&adapter->fw_work, func);
S
Sony Chacko 已提交
2857 2858
	queue_delayed_work(adapter->qlcnic_wq, &adapter->fw_work,
			   round_jiffies_relative(delay));
2859 2860 2861 2862 2863 2864 2865 2866
}

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;
2867
	u32 npar_state;
2868

2869
	if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
2870 2871
		npar_state = QLC_SHARED_REG_RD32(adapter,
						 QLCNIC_CRB_DEV_NPAR_STATE);
2872 2873 2874 2875 2876 2877 2878 2879 2880 2881 2882
		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:
2883
	if (netif_running(netdev)) {
2884
		if (qlcnic_up(adapter, netdev))
2885 2886
			goto done;

A
Amit Kumar Salecha 已提交
2887
		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
2888 2889 2890
	}

done:
2891
	netif_device_attach(netdev);
2892
	adapter->fw_fail_cnt = 0;
S
Sritej Velaga 已提交
2893
	adapter->flags &= ~QLCNIC_FW_HANG;
2894
	clear_bit(__QLCNIC_RESETTING, &adapter->state);
2895 2896 2897 2898

	if (!qlcnic_clr_drv_state(adapter))
		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
							FW_POLL_DELAY);
2899 2900 2901 2902 2903
}

static int
qlcnic_check_health(struct qlcnic_adapter *adapter)
{
2904
	u32 state = 0, heartbeat;
2905
	u32 peg_status;
2906 2907 2908 2909

	if (qlcnic_check_temp(adapter))
		goto detach;

A
Amit Kumar Salecha 已提交
2910
	if (adapter->need_fw_reset)
2911
		qlcnic_dev_request_reset(adapter, 0);
2912

2913
	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
2914
	if (state == QLCNIC_DEV_NEED_RESET) {
2915
		qlcnic_set_npar_non_operational(adapter);
2916
		adapter->need_fw_reset = 1;
2917 2918
	} else if (state == QLCNIC_DEV_NEED_QUISCENT)
		goto detach;
2919

2920
	heartbeat = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_ALIVE_COUNTER);
2921 2922
	if (heartbeat != adapter->heartbeat) {
		adapter->heartbeat = heartbeat;
2923 2924 2925
		adapter->fw_fail_cnt = 0;
		if (adapter->need_fw_reset)
			goto detach;
2926

2927
		if (adapter->ahw->reset_context && qlcnic_auto_fw_reset) {
2928 2929 2930 2931
			qlcnic_reset_hw_context(adapter);
			adapter->netdev->trans_start = jiffies;
		}

2932 2933 2934 2935 2936 2937
		return 0;
	}

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

S
Sritej Velaga 已提交
2938 2939
	adapter->flags |= QLCNIC_FW_HANG;

2940
	qlcnic_dev_request_reset(adapter, 0);
2941

2942
	if (qlcnic_auto_fw_reset)
2943
		clear_bit(__QLCNIC_FW_ATTACHED, &adapter->state);
2944

2945
	dev_err(&adapter->pdev->dev, "firmware hang detected\n");
2946
	peg_status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
2947
	dev_err(&adapter->pdev->dev, "Dumping hw/fw registers\n"
S
Sritej Velaga 已提交
2948 2949 2950 2951
			"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",
2952 2953
			peg_status,
			QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS2),
S
Sritej Velaga 已提交
2954 2955 2956 2957 2958
			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));
2959
	if (QLCNIC_FWERROR_CODE(peg_status) == 0x67)
2960 2961 2962
		dev_err(&adapter->pdev->dev,
			"Firmware aborted with error code 0x00006700. "
				"Device is being reset.\n");
2963 2964 2965 2966
detach:
	adapter->dev_state = (state == QLCNIC_DEV_NEED_QUISCENT) ? state :
		QLCNIC_DEV_NEED_RESET;

2967 2968
	if (qlcnic_auto_fw_reset && !test_and_set_bit(__QLCNIC_RESETTING,
						      &adapter->state)) {
2969

2970
		qlcnic_schedule_work(adapter, qlcnic_detach_work, 0);
2971 2972
		QLCDB(adapter, DRV, "fw recovery scheduled.\n");
	}
2973 2974 2975 2976 2977 2978 2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989

	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;

2990 2991 2992
	if (adapter->fhash.fnum)
		qlcnic_prune_lb_filters(adapter);

2993 2994 2995 2996
reschedule:
	qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
}

S
Sucheta Chakraborty 已提交
2997 2998 2999 3000 3001 3002 3003 3004 3005
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));
3006 3007
		if (!oth_pdev)
			continue;
S
Sucheta Chakraborty 已提交
3008

3009 3010
		if (oth_pdev->current_state != PCI_D3cold) {
			pci_dev_put(oth_pdev);
S
Sucheta Chakraborty 已提交
3011
			return 0;
3012 3013
		}
		pci_dev_put(oth_pdev);
S
Sucheta Chakraborty 已提交
3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037 3038
	}
	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;

3039
	if (adapter->ahw->op_mode != QLCNIC_NON_PRIV_FUNC && first_func) {
S
Sucheta Chakraborty 已提交
3040 3041
		adapter->need_fw_reset = 1;
		set_bit(__QLCNIC_START_FW, &adapter->state);
3042 3043
		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
				    QLCNIC_DEV_INITIALIZING);
S
Sucheta Chakraborty 已提交
3044 3045 3046 3047
		QLCDB(adapter, DRV, "Restarting fw\n");
	}
	qlcnic_api_unlock(adapter);

S
Sony Chacko 已提交
3048
	err = qlcnic_start_firmware(adapter);
S
Sucheta Chakraborty 已提交
3049 3050 3051 3052
	if (err)
		return err;

	qlcnic_clr_drv_state(adapter);
S
Sony Chacko 已提交
3053 3054 3055 3056
	kfree(adapter->msix_entries);
	adapter->msix_entries = NULL;
	err = qlcnic_setup_intr(adapter, 0);

3057 3058 3059 3060 3061 3062
	if (err) {
		kfree(adapter->msix_entries);
		netdev_err(netdev, "failed to setup interrupt\n");
		return err;
	}

S
Sony Chacko 已提交
3063
	if (qlcnic_83xx_check(adapter)) {
3064 3065
		/* register for NIC IDC AEN Events */
		qlcnic_83xx_register_nic_idc_func(adapter, 1);
S
Sony Chacko 已提交
3066 3067 3068 3069 3070 3071 3072 3073 3074
		err = qlcnic_83xx_setup_mbx_intr(adapter);
		if (err) {
			dev_err(&adapter->pdev->dev,
				"failed to setup mbx interrupt\n");
			qlcnic_clr_all_drv_state(adapter, 1);
			clear_bit(__QLCNIC_AER, &adapter->state);
			goto done;
		}
	}
S
Sucheta Chakraborty 已提交
3075 3076 3077 3078

	if (netif_running(netdev)) {
		err = qlcnic_attach(adapter);
		if (err) {
3079
			qlcnic_clr_all_drv_state(adapter, 1);
S
Sucheta Chakraborty 已提交
3080 3081 3082 3083 3084 3085 3086 3087 3088
			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 已提交
3089
		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
S
Sucheta Chakraborty 已提交
3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108 3109 3110 3111 3112 3113 3114 3115
	}
 done:
	netif_device_attach(netdev);
	return err;
}

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

	if (state == pci_channel_io_perm_failure)
		return PCI_ERS_RESULT_DISCONNECT;

	if (state == pci_channel_io_normal)
		return PCI_ERS_RESULT_RECOVERED;

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

	cancel_delayed_work_sync(&adapter->fw_work);

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

S
Sony Chacko 已提交
3116 3117 3118 3119 3120 3121
	if (qlcnic_83xx_check(adapter)) {
		if (adapter->flags & QLCNIC_MSIX_ENABLED)
			qlcnic_83xx_config_intrpt(adapter, 0);
		qlcnic_83xx_free_mbx_intr(adapter);
	}

S
Sucheta Chakraborty 已提交
3122 3123 3124 3125 3126 3127 3128 3129 3130 3131 3132 3133 3134 3135 3136 3137 3138 3139 3140
	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)
{
3141
	u32 state;
S
Sucheta Chakraborty 已提交
3142 3143 3144
	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);

	pci_cleanup_aer_uncorrect_error_status(pdev);
3145 3146 3147
	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 已提交
3148 3149 3150 3151
		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
						FW_POLL_DELAY);
}

3152 3153 3154 3155 3156 3157 3158 3159 3160
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 已提交
3161 3162 3163
	err = qlcnic_check_npar_opertional(adapter);
	if (err)
		return err;
3164

3165 3166 3167 3168
	err = qlcnic_initialize_nic(adapter);
	if (err)
		return err;

3169 3170
	qlcnic_check_options(adapter);

3171 3172 3173 3174
	err = qlcnic_set_eswitch_port_config(adapter);
	if (err)
		return err;

3175 3176 3177 3178 3179
	adapter->need_fw_reset = 0;

	return err;
}

S
Sony Chacko 已提交
3180
int qlcnic_validate_max_rss(u8 max_hw, u8 val)
3181
{
S
Sony Chacko 已提交
3182 3183 3184 3185 3186
	u32 max_allowed;

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

S
Sony Chacko 已提交
3189 3190 3191 3192 3193
	max_allowed = rounddown_pow_of_two(min_t(int, max_hw,
						 num_online_cpus()));
	if ((val > max_allowed) || (val < 2) || !is_power_of_2(val)) {
		pr_info("rss_ring valid range [2 - %x] in powers of 2\n",
			max_allowed);
3194 3195 3196 3197 3198
		return -EINVAL;
	}
	return 0;
}

S
Sony Chacko 已提交
3199
int qlcnic_set_max_rss(struct qlcnic_adapter *adapter, u8 data, size_t len)
3200
{
S
Sony Chacko 已提交
3201
	int err;
3202 3203
	struct net_device *netdev = adapter->netdev;

S
Sony Chacko 已提交
3204 3205 3206
	if (test_bit(__QLCNIC_RESETTING, &adapter->state))
		return -EBUSY;

3207 3208 3209
	netif_device_detach(netdev);
	if (netif_running(netdev))
		__qlcnic_down(adapter, netdev);
S
Sony Chacko 已提交
3210

3211
	if (qlcnic_83xx_check(adapter)) {
S
Sony Chacko 已提交
3212 3213 3214 3215 3216
		if (adapter->flags & QLCNIC_MSIX_ENABLED)
			qlcnic_83xx_config_intrpt(adapter, 0);
		qlcnic_83xx_free_mbx_intr(adapter);
	}

3217 3218
	qlcnic_detach(adapter);
	qlcnic_teardown_intr(adapter);
S
Sony Chacko 已提交
3219
	err = qlcnic_setup_intr(adapter, data);
3220 3221 3222 3223 3224
	if (err) {
		kfree(adapter->msix_entries);
		netdev_err(netdev, "failed to setup interrupt\n");
		return err;
	}
3225

S
Sony Chacko 已提交
3226
	if (qlcnic_83xx_check(adapter)) {
3227 3228
		/* register for NIC IDC AEN Events */
		qlcnic_83xx_register_nic_idc_func(adapter, 1);
S
Sony Chacko 已提交
3229 3230 3231 3232 3233 3234
		err = qlcnic_83xx_setup_mbx_intr(adapter);
		if (err) {
			dev_err(&adapter->pdev->dev,
				"failed to setup mbx interrupt\n");
			goto done;
		}
3235 3236 3237 3238 3239 3240 3241 3242 3243 3244 3245
	}

	if (netif_running(netdev)) {
		err = qlcnic_attach(adapter);
		if (err)
			goto done;
		err = __qlcnic_up(adapter, netdev);
		if (err)
			goto done;
		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
	}
S
Sony Chacko 已提交
3246
	err = len;
3247 3248 3249 3250 3251 3252
 done:
	netif_device_attach(netdev);
	clear_bit(__QLCNIC_RESETTING, &adapter->state);
	return err;
}

3253 3254 3255 3256 3257
#ifdef CONFIG_INET

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

static void
A
Amit Kumar Salecha 已提交
3258 3259
qlcnic_config_indev_addr(struct qlcnic_adapter *adapter,
			struct net_device *dev, unsigned long event)
3260 3261 3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282 3283 3284
{
	struct in_device *indev;

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

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

	in_dev_put(indev);
}

S
Sony Chacko 已提交
3285
void qlcnic_restore_indev_addr(struct net_device *netdev, unsigned long event)
A
Amit Kumar Salecha 已提交
3286 3287 3288 3289 3290 3291 3292
{
	struct qlcnic_adapter *adapter = netdev_priv(netdev);
	struct net_device *dev;
	u16 vid;

	qlcnic_config_indev_addr(adapter, netdev, event);

3293
	rcu_read_lock();
3294
	for_each_set_bit(vid, adapter->vlans, VLAN_N_VID) {
3295
		dev = __vlan_find_dev_deep(netdev, vid);
A
Amit Kumar Salecha 已提交
3296 3297 3298 3299
		if (!dev)
			continue;
		qlcnic_config_indev_addr(adapter, dev, event);
	}
3300
	rcu_read_unlock();
A
Amit Kumar Salecha 已提交
3301 3302
}

3303 3304 3305 3306 3307 3308 3309 3310 3311 3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323 3324 3325
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;

3326
	if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
3327 3328
		goto done;

A
Amit Kumar Salecha 已提交
3329
	qlcnic_config_indev_addr(adapter, dev, event);
3330 3331 3332 3333 3334 3335 3336 3337 3338 3339 3340 3341 3342 3343 3344 3345
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 已提交
3346
	if (dev == NULL)
3347 3348 3349 3350 3351 3352 3353 3354 3355 3356 3357 3358
		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 已提交
3359
	if (!adapter)
3360 3361
		goto done;

3362
	if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
3363 3364 3365 3366 3367
		goto done;

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

3369 3370 3371
		break;
	case NETDEV_DOWN:
		qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_DOWN);
S
Sony Chacko 已提交
3372

3373 3374 3375 3376 3377 3378 3379 3380 3381 3382 3383 3384 3385 3386 3387 3388 3389
		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
S
Sony Chacko 已提交
3390
void qlcnic_restore_indev_addr(struct net_device *dev, unsigned long event)
3391 3392
{ }
#endif
3393
static const struct pci_error_handlers qlcnic_err_handler = {
S
Sucheta Chakraborty 已提交
3394 3395 3396 3397
	.error_detected = qlcnic_io_error_detected,
	.slot_reset = qlcnic_io_slot_reset,
	.resume = qlcnic_io_resume,
};
3398 3399 3400 3401 3402

static struct pci_driver qlcnic_driver = {
	.name = qlcnic_driver_name,
	.id_table = qlcnic_pci_tbl,
	.probe = qlcnic_probe,
B
Bill Pemberton 已提交
3403
	.remove = qlcnic_remove,
3404 3405 3406 3407
#ifdef CONFIG_PM
	.suspend = qlcnic_suspend,
	.resume = qlcnic_resume,
#endif
S
Sucheta Chakraborty 已提交
3408 3409 3410
	.shutdown = qlcnic_shutdown,
	.err_handler = &qlcnic_err_handler

3411 3412 3413 3414
};

static int __init qlcnic_init_module(void)
{
3415
	int ret;
3416 3417 3418 3419 3420 3421 3422 3423

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

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

3424 3425 3426 3427 3428 3429 3430
	ret = pci_register_driver(&qlcnic_driver);
	if (ret) {
#ifdef CONFIG_INET
		unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
		unregister_netdevice_notifier(&qlcnic_netdev_cb);
#endif
	}
3431

3432
	return ret;
3433 3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445 3446 3447
}

module_init(qlcnic_init_module);

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

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

module_exit(qlcnic_exit_module);