Linux Audio

Check our new training course

Loading...
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * QLogic qlcnic NIC Driver
   4 * Copyright (c) 2009-2013 QLogic Corporation
 
 
   5 */
   6
   7#include <linux/vmalloc.h>
   8#include <linux/interrupt.h>
   9#include <linux/swab.h>
  10#include <linux/dma-mapping.h>
  11#include <linux/if_vlan.h>
  12#include <net/ip.h>
  13#include <linux/ipv6.h>
  14#include <linux/inetdevice.h>
 
  15#include <linux/log2.h>
  16#include <linux/pci.h>
  17#include <net/vxlan.h>
  18
  19#include "qlcnic.h"
  20#include "qlcnic_sriov.h"
  21#include "qlcnic_hw.h"
  22
  23MODULE_DESCRIPTION("QLogic 1/10 GbE Converged/Intelligent Ethernet Driver");
  24MODULE_LICENSE("GPL");
  25MODULE_VERSION(QLCNIC_LINUX_VERSIONID);
  26MODULE_FIRMWARE(QLCNIC_UNIFIED_ROMIMAGE_NAME);
  27
  28char qlcnic_driver_name[] = "qlcnic";
  29static const char qlcnic_driver_string[] = "QLogic 1/10 GbE "
  30	"Converged/Intelligent Ethernet Driver v" QLCNIC_LINUX_VERSIONID;
  31
  32static int qlcnic_mac_learn;
  33module_param(qlcnic_mac_learn, int, 0444);
  34MODULE_PARM_DESC(qlcnic_mac_learn,
  35		 "Mac Filter (0=learning is disabled, 1=Driver learning is enabled, 2=FDB learning is enabled)");
  36
  37int qlcnic_use_msi = 1;
  38MODULE_PARM_DESC(use_msi, "MSI interrupt (0=disabled, 1=enabled)");
  39module_param_named(use_msi, qlcnic_use_msi, int, 0444);
  40
  41int qlcnic_use_msi_x = 1;
  42MODULE_PARM_DESC(use_msi_x, "MSI-X interrupt (0=disabled, 1=enabled)");
  43module_param_named(use_msi_x, qlcnic_use_msi_x, int, 0444);
  44
  45int qlcnic_auto_fw_reset = 1;
  46MODULE_PARM_DESC(auto_fw_reset, "Auto firmware reset (0=disabled, 1=enabled)");
  47module_param_named(auto_fw_reset, qlcnic_auto_fw_reset, int, 0644);
  48
  49int qlcnic_load_fw_file;
  50MODULE_PARM_DESC(load_fw_file, "Load firmware from (0=flash, 1=file, 2=POST in fast mode, 3= POST in medium mode, 4=POST in slow mode)");
  51module_param_named(load_fw_file, qlcnic_load_fw_file, int, 0444);
  52
  53static int qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent);
  54static void qlcnic_remove(struct pci_dev *pdev);
  55static int qlcnic_open(struct net_device *netdev);
  56static int qlcnic_close(struct net_device *netdev);
  57static void qlcnic_tx_timeout(struct net_device *netdev, unsigned int txqueue);
  58static void qlcnic_attach_work(struct work_struct *work);
  59static void qlcnic_fwinit_work(struct work_struct *work);
 
 
 
  60
  61static void qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding);
  62static int qlcnic_can_start_firmware(struct qlcnic_adapter *adapter);
  63
  64static irqreturn_t qlcnic_tmp_intr(int irq, void *data);
  65static irqreturn_t qlcnic_intr(int irq, void *data);
  66static irqreturn_t qlcnic_msi_intr(int irq, void *data);
  67static irqreturn_t qlcnic_msix_intr(int irq, void *data);
  68static irqreturn_t qlcnic_msix_tx_intr(int irq, void *data);
  69
  70static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev);
  71static int qlcnic_start_firmware(struct qlcnic_adapter *);
  72
  73static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter);
  74static void qlcnic_dev_set_npar_ready(struct qlcnic_adapter *);
  75static int qlcnicvf_start_firmware(struct qlcnic_adapter *);
  76static int qlcnic_vlan_rx_add(struct net_device *, __be16, u16);
  77static int qlcnic_vlan_rx_del(struct net_device *, __be16, u16);
  78
  79static int qlcnic_82xx_setup_intr(struct qlcnic_adapter *);
  80static void qlcnic_82xx_dev_request_reset(struct qlcnic_adapter *, u32);
  81static irqreturn_t qlcnic_82xx_clear_legacy_intr(struct qlcnic_adapter *);
  82static pci_ers_result_t qlcnic_82xx_io_slot_reset(struct pci_dev *);
  83static int qlcnic_82xx_start_firmware(struct qlcnic_adapter *);
  84static void qlcnic_82xx_io_resume(struct pci_dev *);
  85static void qlcnic_82xx_set_mac_filter_count(struct qlcnic_adapter *);
  86static pci_ers_result_t qlcnic_82xx_io_error_detected(struct pci_dev *,
  87						      pci_channel_state_t);
  88static u32 qlcnic_vlan_tx_check(struct qlcnic_adapter *adapter)
  89{
  90	struct qlcnic_hardware_context *ahw = adapter->ahw;
  91
  92	if (adapter->pdev->device == PCI_DEVICE_ID_QLOGIC_QLE824X)
  93		return ahw->capabilities & QLCNIC_FW_CAPABILITY_FVLANTX;
  94	else
  95		return 1;
  96}
  97
  98/*  PCI Device ID Table  */
  99#define ENTRY(device) \
 100	{PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, (device)), \
 101	.class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0}
 102
 103static const struct pci_device_id qlcnic_pci_tbl[] = {
 104	ENTRY(PCI_DEVICE_ID_QLOGIC_QLE824X),
 105	ENTRY(PCI_DEVICE_ID_QLOGIC_QLE834X),
 106	ENTRY(PCI_DEVICE_ID_QLOGIC_VF_QLE834X),
 107	ENTRY(PCI_DEVICE_ID_QLOGIC_QLE8830),
 108	ENTRY(PCI_DEVICE_ID_QLOGIC_VF_QLE8C30),
 109	ENTRY(PCI_DEVICE_ID_QLOGIC_QLE844X),
 110	ENTRY(PCI_DEVICE_ID_QLOGIC_VF_QLE844X),
 111	{0,}
 112};
 113
 114MODULE_DEVICE_TABLE(pci, qlcnic_pci_tbl);
 115
 116
 117inline void qlcnic_update_cmd_producer(struct qlcnic_host_tx_ring *tx_ring)
 118{
 119	writel(tx_ring->producer, tx_ring->crb_cmd_producer);
 120}
 121
 122static const u32 msi_tgt_status[8] = {
 123	ISR_INT_TARGET_STATUS, ISR_INT_TARGET_STATUS_F1,
 124	ISR_INT_TARGET_STATUS_F2, ISR_INT_TARGET_STATUS_F3,
 125	ISR_INT_TARGET_STATUS_F4, ISR_INT_TARGET_STATUS_F5,
 126	ISR_INT_TARGET_STATUS_F6, ISR_INT_TARGET_STATUS_F7
 127};
 128
 129static const u32 qlcnic_reg_tbl[] = {
 130	0x1B20A8,	/* PEG_HALT_STAT1 */
 131	0x1B20AC,	/* PEG_HALT_STAT2 */
 132	0x1B20B0,	/* FW_HEARTBEAT */
 133	0x1B2100,	/* LOCK ID */
 134	0x1B2128,	/* FW_CAPABILITIES */
 135	0x1B2138,	/* drv active */
 136	0x1B2140,	/* dev state */
 137	0x1B2144,	/* drv state */
 138	0x1B2148,	/* drv scratch */
 139	0x1B214C,	/* dev partition info */
 140	0x1B2174,	/* drv idc ver */
 141	0x1B2150,	/* fw version major */
 142	0x1B2154,	/* fw version minor */
 143	0x1B2158,	/* fw version sub */
 144	0x1B219C,	/* npar state */
 145	0x1B21FC,	/* FW_IMG_VALID */
 146	0x1B2250,	/* CMD_PEG_STATE */
 147	0x1B233C,	/* RCV_PEG_STATE */
 148	0x1B23B4,	/* ASIC TEMP */
 149	0x1B216C,	/* FW api */
 150	0x1B2170,	/* drv op mode */
 151	0x13C010,	/* flash lock */
 152	0x13C014,	/* flash unlock */
 153};
 154
 155static const struct qlcnic_board_info qlcnic_boards[] = {
 156	{ PCI_VENDOR_ID_QLOGIC,
 157	  PCI_DEVICE_ID_QLOGIC_QLE844X,
 158	  0x0,
 159	  0x0,
 160	  "8400 series 10GbE Converged Network Adapter (TCP/IP Networking)" },
 161	{ PCI_VENDOR_ID_QLOGIC,
 162	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 163	  PCI_VENDOR_ID_QLOGIC,
 164	  0x24e,
 165	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 166	  "(TCP/IP Networking)" },
 167	{ PCI_VENDOR_ID_QLOGIC,
 168	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 169	  PCI_VENDOR_ID_QLOGIC,
 170	  0x243,
 171	  "8300 Series Single Port 10GbE Converged Network Adapter "
 172	  "(TCP/IP Networking)" },
 173	{ PCI_VENDOR_ID_QLOGIC,
 174	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 175	  PCI_VENDOR_ID_QLOGIC,
 176	  0x24a,
 177	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 178	  "(TCP/IP Networking)" },
 179	{ PCI_VENDOR_ID_QLOGIC,
 180	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 181	  PCI_VENDOR_ID_QLOGIC,
 182	  0x246,
 183	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 184	  "(TCP/IP Networking)" },
 185	{ PCI_VENDOR_ID_QLOGIC,
 186	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 187	  PCI_VENDOR_ID_QLOGIC,
 188	  0x252,
 189	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 190	  "(TCP/IP Networking)" },
 191	{ PCI_VENDOR_ID_QLOGIC,
 192	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 193	  PCI_VENDOR_ID_QLOGIC,
 194	  0x26e,
 195	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 196	  "(TCP/IP Networking)" },
 197	{ PCI_VENDOR_ID_QLOGIC,
 198	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 199	  PCI_VENDOR_ID_QLOGIC,
 200	  0x260,
 201	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 202	  "(TCP/IP Networking)" },
 203	{ PCI_VENDOR_ID_QLOGIC,
 204	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 205	  PCI_VENDOR_ID_QLOGIC,
 206	  0x266,
 207	  "8300 Series Single Port 10GbE Converged Network Adapter "
 208	  "(TCP/IP Networking)" },
 209	{ PCI_VENDOR_ID_QLOGIC,
 210	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 211	  PCI_VENDOR_ID_QLOGIC,
 212	  0x269,
 213	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 214	  "(TCP/IP Networking)" },
 215	{ PCI_VENDOR_ID_QLOGIC,
 216	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 217	  PCI_VENDOR_ID_QLOGIC,
 218	  0x271,
 219	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 220	  "(TCP/IP Networking)" },
 221	{ PCI_VENDOR_ID_QLOGIC,
 222	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 223	  0x0, 0x0, "8300 Series 1/10GbE Controller" },
 224	{ PCI_VENDOR_ID_QLOGIC,
 225	  PCI_DEVICE_ID_QLOGIC_QLE8830,
 226	  0x0,
 227	  0x0,
 228	  "8830 Series 1/10GbE Controller" },
 229	{ PCI_VENDOR_ID_QLOGIC,
 230	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 231	  PCI_VENDOR_ID_QLOGIC,
 232	  0x203,
 233	  "8200 Series Single Port 10GbE Converged Network Adapter"
 234	  "(TCP/IP Networking)" },
 235	{ PCI_VENDOR_ID_QLOGIC,
 236	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 237	  PCI_VENDOR_ID_QLOGIC,
 238	  0x207,
 239	  "8200 Series Dual Port 10GbE Converged Network Adapter"
 240	  "(TCP/IP Networking)" },
 241	{ PCI_VENDOR_ID_QLOGIC,
 242	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 243	  PCI_VENDOR_ID_QLOGIC,
 244	  0x20b,
 245	  "3200 Series Dual Port 10Gb Intelligent Ethernet Adapter" },
 246	{ PCI_VENDOR_ID_QLOGIC,
 247	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 248	  PCI_VENDOR_ID_QLOGIC,
 249	  0x20c,
 250	  "3200 Series Quad Port 1Gb Intelligent Ethernet Adapter" },
 251	{ PCI_VENDOR_ID_QLOGIC,
 252	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 253	  PCI_VENDOR_ID_QLOGIC,
 254	  0x20f,
 255	  "3200 Series Single Port 10Gb Intelligent Ethernet Adapter" },
 256	{ PCI_VENDOR_ID_QLOGIC,
 257	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 258	  0x103c, 0x3733,
 259	  "NC523SFP 10Gb 2-port Server Adapter" },
 260	{ PCI_VENDOR_ID_QLOGIC,
 261	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 262	  0x103c, 0x3346,
 263	  "CN1000Q Dual Port Converged Network Adapter" },
 264	{ PCI_VENDOR_ID_QLOGIC,
 265	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 266	  PCI_VENDOR_ID_QLOGIC,
 267	  0x210,
 268	  "QME8242-k 10GbE Dual Port Mezzanine Card" },
 269	{ PCI_VENDOR_ID_QLOGIC,
 270	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 271	  0x0, 0x0, "cLOM8214 1/10GbE Controller" },
 272};
 273
 274#define NUM_SUPPORTED_BOARDS ARRAY_SIZE(qlcnic_boards)
 275
 276static const
 277struct qlcnic_legacy_intr_set legacy_intr[] = QLCNIC_LEGACY_INTR_CONFIG;
 278
 279int qlcnic_alloc_sds_rings(struct qlcnic_recv_context *recv_ctx, int count)
 280{
 281	int size = sizeof(struct qlcnic_host_sds_ring) * count;
 282
 283	recv_ctx->sds_rings = kzalloc(size, GFP_KERNEL);
 284
 285	return recv_ctx->sds_rings == NULL;
 286}
 287
 288void qlcnic_free_sds_rings(struct qlcnic_recv_context *recv_ctx)
 289{
 290	kfree(recv_ctx->sds_rings);
 291	recv_ctx->sds_rings = NULL;
 292}
 293
 294int qlcnic_read_mac_addr(struct qlcnic_adapter *adapter)
 295{
 296	struct net_device *netdev = adapter->netdev;
 297	struct pci_dev *pdev = adapter->pdev;
 298	u8 mac_addr[ETH_ALEN];
 299	int ret;
 300
 301	ret = qlcnic_get_mac_address(adapter, mac_addr,
 302				     adapter->ahw->pci_func);
 303	if (ret)
 304		return ret;
 305
 306	eth_hw_addr_set(netdev, mac_addr);
 307	memcpy(adapter->mac_addr, netdev->dev_addr, netdev->addr_len);
 308
 309	/* set station address */
 310
 311	if (!is_valid_ether_addr(netdev->dev_addr))
 312		dev_warn(&pdev->dev, "Bad MAC address %pM.\n",
 313					netdev->dev_addr);
 314
 315	return 0;
 316}
 317
 318static void qlcnic_delete_adapter_mac(struct qlcnic_adapter *adapter)
 319{
 320	struct qlcnic_mac_vlan_list *cur;
 
 321
 322	list_for_each_entry(cur, &adapter->mac_list, list) {
 
 323		if (ether_addr_equal_unaligned(adapter->mac_addr, cur->mac_addr)) {
 324			qlcnic_sre_macaddr_change(adapter, cur->mac_addr,
 325						  0, QLCNIC_MAC_DEL);
 326			list_del(&cur->list);
 327			kfree(cur);
 328			return;
 329		}
 330	}
 331}
 332
 333static int qlcnic_set_mac(struct net_device *netdev, void *p)
 334{
 335	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 336	struct sockaddr *addr = p;
 337
 338	if (qlcnic_sriov_vf_check(adapter))
 339		return -EINVAL;
 340
 341	if ((adapter->flags & QLCNIC_MAC_OVERRIDE_DISABLED))
 342		return -EOPNOTSUPP;
 343
 344	if (!is_valid_ether_addr(addr->sa_data))
 345		return -EINVAL;
 346
 347	if (ether_addr_equal_unaligned(adapter->mac_addr, addr->sa_data) &&
 348	    ether_addr_equal_unaligned(netdev->dev_addr, addr->sa_data))
 349		return 0;
 350
 351	if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
 352		netif_device_detach(netdev);
 353		qlcnic_napi_disable(adapter);
 354	}
 355
 356	qlcnic_delete_adapter_mac(adapter);
 357	memcpy(adapter->mac_addr, addr->sa_data, netdev->addr_len);
 358	eth_hw_addr_set(netdev, addr->sa_data);
 359	qlcnic_set_multi(adapter->netdev);
 360
 361	if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
 362		netif_device_attach(netdev);
 363		qlcnic_napi_enable(adapter);
 364	}
 365	return 0;
 366}
 367
 368static int qlcnic_fdb_del(struct ndmsg *ndm, struct nlattr *tb[],
 369			struct net_device *netdev,
 370			const unsigned char *addr, u16 vid, bool *notified,
 371			struct netlink_ext_ack *extack)
 372{
 373	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 374	int err = -EOPNOTSUPP;
 375
 376	if (!adapter->fdb_mac_learn)
 377		return ndo_dflt_fdb_del(ndm, tb, netdev, addr, vid);
 378
 379	if ((adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
 380	    qlcnic_sriov_check(adapter)) {
 381		if (is_unicast_ether_addr(addr)) {
 382			err = dev_uc_del(netdev, addr);
 383			if (!err)
 384				err = qlcnic_nic_del_mac(adapter, addr);
 385		} else if (is_multicast_ether_addr(addr)) {
 386			err = dev_mc_del(netdev, addr);
 387		} else {
 388			err =  -EINVAL;
 389		}
 390	}
 391	return err;
 392}
 393
 394static int qlcnic_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
 395			struct net_device *netdev,
 396			const unsigned char *addr, u16 vid, u16 flags,
 397			bool *notified, struct netlink_ext_ack *extack)
 398{
 399	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 400	int err = 0;
 401
 402	if (!adapter->fdb_mac_learn)
 403		return ndo_dflt_fdb_add(ndm, tb, netdev, addr, vid, flags);
 404
 405	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED) &&
 406	    !qlcnic_sriov_check(adapter)) {
 407		pr_info("%s: FDB e-switch is not enabled\n", __func__);
 408		return -EOPNOTSUPP;
 409	}
 410
 411	if (ether_addr_equal(addr, adapter->mac_addr))
 412		return err;
 413
 414	if (is_unicast_ether_addr(addr)) {
 415		if (netdev_uc_count(netdev) < adapter->ahw->max_uc_count)
 416			err = dev_uc_add_excl(netdev, addr);
 417		else
 418			err = -ENOMEM;
 419	} else if (is_multicast_ether_addr(addr)) {
 420		err = dev_mc_add_excl(netdev, addr);
 421	} else {
 422		err = -EINVAL;
 423	}
 424
 425	return err;
 426}
 427
 428static int qlcnic_fdb_dump(struct sk_buff *skb, struct netlink_callback *ncb,
 429			struct net_device *netdev,
 430			struct net_device *filter_dev, int *idx)
 431{
 432	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 433	int err = 0;
 434
 435	if (!adapter->fdb_mac_learn)
 436		return ndo_dflt_fdb_dump(skb, ncb, netdev, filter_dev, idx);
 437
 438	if ((adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
 439	    qlcnic_sriov_check(adapter))
 440		err = ndo_dflt_fdb_dump(skb, ncb, netdev, filter_dev, idx);
 441
 442	return err;
 443}
 444
 445static void qlcnic_82xx_cancel_idc_work(struct qlcnic_adapter *adapter)
 446{
 447	while (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
 448		usleep_range(10000, 11000);
 449
 450	if (!adapter->fw_work.work.func)
 451		return;
 452
 453	cancel_delayed_work_sync(&adapter->fw_work);
 454}
 455
 456static int qlcnic_get_phys_port_id(struct net_device *netdev,
 457				   struct netdev_phys_item_id *ppid)
 458{
 459	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 460	struct qlcnic_hardware_context *ahw = adapter->ahw;
 461
 462	if (!(adapter->flags & QLCNIC_HAS_PHYS_PORT_ID))
 463		return -EOPNOTSUPP;
 464
 465	ppid->id_len = sizeof(ahw->phys_port_id);
 466	memcpy(ppid->id, ahw->phys_port_id, ppid->id_len);
 467
 468	return 0;
 469}
 470
 471static int qlcnic_udp_tunnel_sync(struct net_device *dev, unsigned int table)
 
 472{
 473	struct qlcnic_adapter *adapter = netdev_priv(dev);
 474	struct udp_tunnel_info ti;
 475	int err;
 476
 477	udp_tunnel_nic_get_port(dev, table, 0, &ti);
 478	if (ti.port) {
 479		err = qlcnic_set_vxlan_port(adapter, ntohs(ti.port));
 480		if (err)
 481			return err;
 
 
 
 
 
 
 
 
 482	}
 
 
 483
 484	return qlcnic_set_vxlan_parsing(adapter, ntohs(ti.port));
 485}
 486
 487static const struct udp_tunnel_nic_info qlcnic_udp_tunnels = {
 488	.sync_table	= qlcnic_udp_tunnel_sync,
 489	.flags		= UDP_TUNNEL_NIC_INFO_MAY_SLEEP,
 490	.tables		= {
 491		{ .n_entries = 1, .tunnel_types = UDP_TUNNEL_TYPE_VXLAN, },
 492	},
 493};
 
 
 
 
 
 
 
 
 
 
 494
 495static netdev_features_t qlcnic_features_check(struct sk_buff *skb,
 496					       struct net_device *dev,
 497					       netdev_features_t features)
 498{
 499	features = vlan_features_check(skb, features);
 500	return vxlan_features_check(skb, features);
 501}
 502
 503static const struct net_device_ops qlcnic_netdev_ops = {
 504	.ndo_open	   = qlcnic_open,
 505	.ndo_stop	   = qlcnic_close,
 506	.ndo_start_xmit    = qlcnic_xmit_frame,
 507	.ndo_get_stats	   = qlcnic_get_stats,
 508	.ndo_validate_addr = eth_validate_addr,
 509	.ndo_set_rx_mode   = qlcnic_set_multi,
 510	.ndo_set_mac_address    = qlcnic_set_mac,
 511	.ndo_change_mtu	   = qlcnic_change_mtu,
 512	.ndo_fix_features  = qlcnic_fix_features,
 513	.ndo_set_features  = qlcnic_set_features,
 514	.ndo_tx_timeout	   = qlcnic_tx_timeout,
 515	.ndo_vlan_rx_add_vid	= qlcnic_vlan_rx_add,
 516	.ndo_vlan_rx_kill_vid	= qlcnic_vlan_rx_del,
 517	.ndo_fdb_add		= qlcnic_fdb_add,
 518	.ndo_fdb_del		= qlcnic_fdb_del,
 519	.ndo_fdb_dump		= qlcnic_fdb_dump,
 520	.ndo_get_phys_port_id	= qlcnic_get_phys_port_id,
 
 
 521	.ndo_features_check	= qlcnic_features_check,
 
 
 
 522#ifdef CONFIG_QLCNIC_SRIOV
 523	.ndo_set_vf_mac		= qlcnic_sriov_set_vf_mac,
 524	.ndo_set_vf_rate	= qlcnic_sriov_set_vf_tx_rate,
 525	.ndo_get_vf_config	= qlcnic_sriov_get_vf_config,
 526	.ndo_set_vf_vlan	= qlcnic_sriov_set_vf_vlan,
 527	.ndo_set_vf_spoofchk	= qlcnic_sriov_set_vf_spoofchk,
 528#endif
 529};
 530
 531static const struct net_device_ops qlcnic_netdev_failed_ops = {
 532	.ndo_open	   = qlcnic_open,
 533};
 534
 535static struct qlcnic_nic_template qlcnic_ops = {
 536	.config_bridged_mode	= qlcnic_config_bridged_mode,
 537	.config_led		= qlcnic_82xx_config_led,
 538	.start_firmware		= qlcnic_82xx_start_firmware,
 539	.request_reset		= qlcnic_82xx_dev_request_reset,
 540	.cancel_idc_work	= qlcnic_82xx_cancel_idc_work,
 541	.napi_add		= qlcnic_82xx_napi_add,
 542	.napi_del		= qlcnic_82xx_napi_del,
 543	.config_ipaddr		= qlcnic_82xx_config_ipaddr,
 544	.shutdown		= qlcnic_82xx_shutdown,
 545	.resume			= qlcnic_82xx_resume,
 546	.clear_legacy_intr	= qlcnic_82xx_clear_legacy_intr,
 547};
 548
 549struct qlcnic_nic_template qlcnic_vf_ops = {
 550	.config_bridged_mode	= qlcnicvf_config_bridged_mode,
 551	.config_led		= qlcnicvf_config_led,
 552	.start_firmware		= qlcnicvf_start_firmware
 553};
 554
 555static struct qlcnic_hardware_ops qlcnic_hw_ops = {
 556	.read_crb			= qlcnic_82xx_read_crb,
 557	.write_crb			= qlcnic_82xx_write_crb,
 558	.read_reg			= qlcnic_82xx_hw_read_wx_2M,
 559	.write_reg			= qlcnic_82xx_hw_write_wx_2M,
 560	.get_mac_address		= qlcnic_82xx_get_mac_address,
 561	.setup_intr			= qlcnic_82xx_setup_intr,
 562	.alloc_mbx_args			= qlcnic_82xx_alloc_mbx_args,
 563	.mbx_cmd			= qlcnic_82xx_issue_cmd,
 564	.get_func_no			= qlcnic_82xx_get_func_no,
 565	.api_lock			= qlcnic_82xx_api_lock,
 566	.api_unlock			= qlcnic_82xx_api_unlock,
 567	.add_sysfs			= qlcnic_82xx_add_sysfs,
 568	.remove_sysfs			= qlcnic_82xx_remove_sysfs,
 569	.process_lb_rcv_ring_diag	= qlcnic_82xx_process_rcv_ring_diag,
 570	.create_rx_ctx			= qlcnic_82xx_fw_cmd_create_rx_ctx,
 571	.create_tx_ctx			= qlcnic_82xx_fw_cmd_create_tx_ctx,
 572	.del_rx_ctx			= qlcnic_82xx_fw_cmd_del_rx_ctx,
 573	.del_tx_ctx			= qlcnic_82xx_fw_cmd_del_tx_ctx,
 574	.setup_link_event		= qlcnic_82xx_linkevent_request,
 575	.get_nic_info			= qlcnic_82xx_get_nic_info,
 576	.get_pci_info			= qlcnic_82xx_get_pci_info,
 577	.set_nic_info			= qlcnic_82xx_set_nic_info,
 578	.change_macvlan			= qlcnic_82xx_sre_macaddr_change,
 579	.napi_enable			= qlcnic_82xx_napi_enable,
 580	.napi_disable			= qlcnic_82xx_napi_disable,
 581	.config_intr_coal		= qlcnic_82xx_config_intr_coalesce,
 582	.config_rss			= qlcnic_82xx_config_rss,
 583	.config_hw_lro			= qlcnic_82xx_config_hw_lro,
 584	.config_loopback		= qlcnic_82xx_set_lb_mode,
 585	.clear_loopback			= qlcnic_82xx_clear_lb_mode,
 586	.config_promisc_mode		= qlcnic_82xx_nic_set_promisc,
 587	.change_l2_filter		= qlcnic_82xx_change_filter,
 588	.get_board_info			= qlcnic_82xx_get_board_info,
 589	.set_mac_filter_count		= qlcnic_82xx_set_mac_filter_count,
 590	.free_mac_list			= qlcnic_82xx_free_mac_list,
 591	.read_phys_port_id		= qlcnic_82xx_read_phys_port_id,
 592	.io_error_detected		= qlcnic_82xx_io_error_detected,
 593	.io_slot_reset			= qlcnic_82xx_io_slot_reset,
 594	.io_resume			= qlcnic_82xx_io_resume,
 595	.get_beacon_state		= qlcnic_82xx_get_beacon_state,
 596	.enable_sds_intr		= qlcnic_82xx_enable_sds_intr,
 597	.disable_sds_intr		= qlcnic_82xx_disable_sds_intr,
 598	.enable_tx_intr			= qlcnic_82xx_enable_tx_intr,
 599	.disable_tx_intr		= qlcnic_82xx_disable_tx_intr,
 600	.get_saved_state		= qlcnic_82xx_get_saved_state,
 601	.set_saved_state		= qlcnic_82xx_set_saved_state,
 602	.cache_tmpl_hdr_values		= qlcnic_82xx_cache_tmpl_hdr_values,
 603	.get_cap_size			= qlcnic_82xx_get_cap_size,
 604	.set_sys_info			= qlcnic_82xx_set_sys_info,
 605	.store_cap_mask			= qlcnic_82xx_store_cap_mask,
 606	.encap_rx_offload               = qlcnic_82xx_encap_rx_offload,
 607	.encap_tx_offload               = qlcnic_82xx_encap_tx_offload,
 608};
 609
 610static int qlcnic_check_multi_tx_capability(struct qlcnic_adapter *adapter)
 611{
 612	struct qlcnic_hardware_context *ahw = adapter->ahw;
 613
 614	if (qlcnic_82xx_check(adapter) &&
 615	    (ahw->extra_capability[0] & QLCNIC_FW_CAPABILITY_2_MULTI_TX)) {
 616		test_and_set_bit(__QLCNIC_MULTI_TX_UNIQUE, &adapter->state);
 617		return 0;
 618	} else {
 619		return 1;
 620	}
 621}
 622
 623static int qlcnic_max_rings(struct qlcnic_adapter *adapter, u8 ring_cnt,
 624			    int queue_type)
 625{
 626	int num_rings, max_rings = QLCNIC_MAX_SDS_RINGS;
 627
 628	if (queue_type == QLCNIC_RX_QUEUE)
 629		max_rings = adapter->max_sds_rings;
 630	else if (queue_type == QLCNIC_TX_QUEUE)
 631		max_rings = adapter->max_tx_rings;
 632
 633	num_rings = rounddown_pow_of_two(min_t(int, num_online_cpus(),
 634					      max_rings));
 635
 636	if (ring_cnt > num_rings)
 637		return num_rings;
 638	else
 639		return ring_cnt;
 640}
 641
 642void qlcnic_set_tx_ring_count(struct qlcnic_adapter *adapter, u8 tx_cnt)
 643{
 644	/* 83xx adapter does not have max_tx_rings intialized in probe */
 645	if (adapter->max_tx_rings)
 646		adapter->drv_tx_rings = qlcnic_max_rings(adapter, tx_cnt,
 647							 QLCNIC_TX_QUEUE);
 648	else
 649		adapter->drv_tx_rings = tx_cnt;
 650}
 651
 652void qlcnic_set_sds_ring_count(struct qlcnic_adapter *adapter, u8 rx_cnt)
 653{
 654	/* 83xx adapter does not have max_sds_rings intialized in probe */
 655	if (adapter->max_sds_rings)
 656		adapter->drv_sds_rings = qlcnic_max_rings(adapter, rx_cnt,
 657							  QLCNIC_RX_QUEUE);
 658	else
 659		adapter->drv_sds_rings = rx_cnt;
 660}
 661
 662int qlcnic_setup_tss_rss_intr(struct qlcnic_adapter *adapter)
 663{
 664	struct pci_dev *pdev = adapter->pdev;
 665	int num_msix = 0, err = 0, vector;
 666
 667	adapter->flags &= ~QLCNIC_TSS_RSS;
 668
 669	if (adapter->drv_tss_rings > 0)
 670		num_msix += adapter->drv_tss_rings;
 671	else
 672		num_msix += adapter->drv_tx_rings;
 673
 674	if (adapter->drv_rss_rings > 0)
 675		num_msix += adapter->drv_rss_rings;
 676	else
 677		num_msix += adapter->drv_sds_rings;
 678
 679	if (qlcnic_83xx_check(adapter))
 680		num_msix += 1;
 681
 682	if (!adapter->msix_entries) {
 683		adapter->msix_entries = kcalloc(num_msix,
 684						sizeof(struct msix_entry),
 685						GFP_KERNEL);
 686		if (!adapter->msix_entries)
 687			return -ENOMEM;
 688	}
 689
 690	for (vector = 0; vector < num_msix; vector++)
 691		adapter->msix_entries[vector].entry = vector;
 692
 693restore:
 694	err = pci_enable_msix_exact(pdev, adapter->msix_entries, num_msix);
 695	if (err == -ENOSPC) {
 696		if (!adapter->drv_tss_rings && !adapter->drv_rss_rings)
 697			return err;
 698
 699		netdev_info(adapter->netdev,
 700			    "Unable to allocate %d MSI-X vectors, Available vectors %d\n",
 701			    num_msix, err);
 702
 703		num_msix = adapter->drv_tx_rings + adapter->drv_sds_rings;
 704
 705		/* Set rings to 0 so we can restore original TSS/RSS count */
 706		adapter->drv_tss_rings = 0;
 707		adapter->drv_rss_rings = 0;
 708
 709		if (qlcnic_83xx_check(adapter))
 710			num_msix += 1;
 711
 712		netdev_info(adapter->netdev,
 713			    "Restoring %d Tx, %d SDS rings for total %d vectors.\n",
 714			    adapter->drv_tx_rings, adapter->drv_sds_rings,
 715			    num_msix);
 716
 717		goto restore;
 718	} else if (err < 0) {
 719		return err;
 720	}
 721
 722	adapter->ahw->num_msix = num_msix;
 723	if (adapter->drv_tss_rings > 0)
 724		adapter->drv_tx_rings = adapter->drv_tss_rings;
 725
 726	if (adapter->drv_rss_rings > 0)
 727		adapter->drv_sds_rings = adapter->drv_rss_rings;
 728
 729	return 0;
 730}
 731
 732int qlcnic_enable_msix(struct qlcnic_adapter *adapter, u32 num_msix)
 733{
 734	struct pci_dev *pdev = adapter->pdev;
 735	int err, vector;
 736
 737	if (!adapter->msix_entries) {
 738		adapter->msix_entries = kcalloc(num_msix,
 739						sizeof(struct msix_entry),
 740						GFP_KERNEL);
 741		if (!adapter->msix_entries)
 742			return -ENOMEM;
 743	}
 744
 745	adapter->flags &= ~(QLCNIC_MSI_ENABLED | QLCNIC_MSIX_ENABLED);
 746
 747	if (adapter->ahw->msix_supported) {
 748enable_msix:
 749		for (vector = 0; vector < num_msix; vector++)
 750			adapter->msix_entries[vector].entry = vector;
 751
 752		err = pci_enable_msix_range(pdev,
 753					    adapter->msix_entries, 1, num_msix);
 754
 755		if (err == num_msix) {
 756			adapter->flags |= QLCNIC_MSIX_ENABLED;
 757			adapter->ahw->num_msix = num_msix;
 758			dev_info(&pdev->dev, "using msi-x interrupts\n");
 759			return 0;
 760		} else if (err > 0) {
 761			pci_disable_msix(pdev);
 762
 763			dev_info(&pdev->dev,
 764				 "Unable to allocate %d MSI-X vectors, Available vectors %d\n",
 765				 num_msix, err);
 766
 767			if (qlcnic_82xx_check(adapter)) {
 768				num_msix = rounddown_pow_of_two(err);
 769				if (err < QLCNIC_82XX_MINIMUM_VECTOR)
 770					return -ENOSPC;
 771			} else {
 772				num_msix = rounddown_pow_of_two(err - 1);
 773				num_msix += 1;
 774				if (err < QLCNIC_83XX_MINIMUM_VECTOR)
 775					return -ENOSPC;
 776			}
 777
 778			if (qlcnic_82xx_check(adapter) &&
 779			    !qlcnic_check_multi_tx(adapter)) {
 780				adapter->drv_sds_rings = num_msix;
 781				adapter->drv_tx_rings = QLCNIC_SINGLE_RING;
 782			} else {
 783				/* Distribute vectors equally */
 784				adapter->drv_tx_rings = num_msix / 2;
 785				adapter->drv_sds_rings = adapter->drv_tx_rings;
 786			}
 787
 788			if (num_msix) {
 789				dev_info(&pdev->dev,
 790					 "Trying to allocate %d MSI-X interrupt vectors\n",
 791					 num_msix);
 792				goto enable_msix;
 793			}
 794		} else {
 795			dev_info(&pdev->dev,
 796				 "Unable to allocate %d MSI-X vectors, err=%d\n",
 797				 num_msix, err);
 798			return err;
 799		}
 800	}
 801
 802	return -EIO;
 803}
 804
 805static int qlcnic_82xx_calculate_msix_vector(struct qlcnic_adapter *adapter)
 806{
 807	int num_msix;
 808
 809	num_msix = adapter->drv_sds_rings;
 810
 811	if (qlcnic_check_multi_tx(adapter))
 812		num_msix += adapter->drv_tx_rings;
 813	else
 814		num_msix += QLCNIC_SINGLE_RING;
 815
 816	return num_msix;
 817}
 818
 819static int qlcnic_enable_msi_legacy(struct qlcnic_adapter *adapter)
 820{
 821	int err = 0;
 822	u32 offset, mask_reg;
 823	const struct qlcnic_legacy_intr_set *legacy_intrp;
 824	struct qlcnic_hardware_context *ahw = adapter->ahw;
 825	struct pci_dev *pdev = adapter->pdev;
 826
 827	if (qlcnic_use_msi && !pci_enable_msi(pdev)) {
 828		adapter->flags |= QLCNIC_MSI_ENABLED;
 829		offset = msi_tgt_status[adapter->ahw->pci_func];
 830		adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter->ahw,
 831							    offset);
 832		dev_info(&pdev->dev, "using msi interrupts\n");
 833		adapter->msix_entries[0].vector = pdev->irq;
 834		return err;
 835	}
 836
 837	if (qlcnic_use_msi || qlcnic_use_msi_x)
 838		return -EOPNOTSUPP;
 839
 840	legacy_intrp = &legacy_intr[adapter->ahw->pci_func];
 841	adapter->ahw->int_vec_bit = legacy_intrp->int_vec_bit;
 842	offset = legacy_intrp->tgt_status_reg;
 843	adapter->tgt_status_reg = qlcnic_get_ioaddr(ahw, offset);
 844	mask_reg = legacy_intrp->tgt_mask_reg;
 845	adapter->tgt_mask_reg = qlcnic_get_ioaddr(ahw, mask_reg);
 846	adapter->isr_int_vec = qlcnic_get_ioaddr(ahw, ISR_INT_VECTOR);
 847	adapter->crb_int_state_reg = qlcnic_get_ioaddr(ahw, ISR_INT_STATE_REG);
 848	dev_info(&pdev->dev, "using legacy interrupts\n");
 849	adapter->msix_entries[0].vector = pdev->irq;
 850	return err;
 851}
 852
 853static int qlcnic_82xx_setup_intr(struct qlcnic_adapter *adapter)
 854{
 855	int num_msix, err = 0;
 856
 857	if (adapter->flags & QLCNIC_TSS_RSS) {
 858		err = qlcnic_setup_tss_rss_intr(adapter);
 859		if (err < 0)
 860			return err;
 861		num_msix = adapter->ahw->num_msix;
 862	} else {
 863		num_msix = qlcnic_82xx_calculate_msix_vector(adapter);
 864
 865		err = qlcnic_enable_msix(adapter, num_msix);
 866		if (err == -ENOMEM)
 867			return err;
 868
 869		if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) {
 870			qlcnic_disable_multi_tx(adapter);
 871			adapter->drv_sds_rings = QLCNIC_SINGLE_RING;
 872
 873			err = qlcnic_enable_msi_legacy(adapter);
 874			if (err)
 875				return err;
 876		}
 877	}
 878
 879	return 0;
 880}
 881
 882int qlcnic_82xx_mq_intrpt(struct qlcnic_adapter *adapter, int op_type)
 883{
 884	struct qlcnic_hardware_context *ahw = adapter->ahw;
 885	int err, i;
 886
 887	if (qlcnic_check_multi_tx(adapter) &&
 888	    !ahw->diag_test &&
 889	    (adapter->flags & QLCNIC_MSIX_ENABLED)) {
 890		ahw->intr_tbl =
 891			vzalloc(array_size(sizeof(struct qlcnic_intrpt_config),
 892					   ahw->num_msix));
 893		if (!ahw->intr_tbl)
 894			return -ENOMEM;
 895
 896		for (i = 0; i < ahw->num_msix; i++) {
 897			ahw->intr_tbl[i].type = QLCNIC_INTRPT_MSIX;
 898			ahw->intr_tbl[i].id = i;
 899			ahw->intr_tbl[i].src = 0;
 900		}
 901
 902		err = qlcnic_82xx_config_intrpt(adapter, 1);
 903		if (err)
 904			dev_err(&adapter->pdev->dev,
 905				"Failed to configure Interrupt for %d vector\n",
 906				ahw->num_msix);
 907		return err;
 908	}
 909
 910	return 0;
 911}
 912
 913void qlcnic_teardown_intr(struct qlcnic_adapter *adapter)
 914{
 915	if (adapter->flags & QLCNIC_MSIX_ENABLED)
 916		pci_disable_msix(adapter->pdev);
 917	if (adapter->flags & QLCNIC_MSI_ENABLED)
 918		pci_disable_msi(adapter->pdev);
 919
 920	kfree(adapter->msix_entries);
 921	adapter->msix_entries = NULL;
 922
 923	if (adapter->ahw->intr_tbl) {
 924		vfree(adapter->ahw->intr_tbl);
 925		adapter->ahw->intr_tbl = NULL;
 926	}
 927}
 928
 929static void qlcnic_cleanup_pci_map(struct qlcnic_hardware_context *ahw)
 930{
 931	if (ahw->pci_base0 != NULL)
 932		iounmap(ahw->pci_base0);
 933}
 934
 935static int qlcnic_get_act_pci_func(struct qlcnic_adapter *adapter)
 936{
 937	struct qlcnic_hardware_context *ahw = adapter->ahw;
 938	struct qlcnic_pci_info *pci_info;
 939	int ret;
 940
 941	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED)) {
 942		switch (ahw->port_type) {
 943		case QLCNIC_GBE:
 944			ahw->total_nic_func = QLCNIC_NIU_MAX_GBE_PORTS;
 945			break;
 946		case QLCNIC_XGBE:
 947			ahw->total_nic_func = QLCNIC_NIU_MAX_XG_PORTS;
 948			break;
 949		}
 950		return 0;
 951	}
 952
 953	if (ahw->op_mode == QLCNIC_MGMT_FUNC)
 954		return 0;
 955
 956	pci_info = kcalloc(ahw->max_vnic_func, sizeof(*pci_info), GFP_KERNEL);
 957	if (!pci_info)
 958		return -ENOMEM;
 959
 960	ret = qlcnic_get_pci_info(adapter, pci_info);
 961	kfree(pci_info);
 962	return ret;
 963}
 964
 965static bool qlcnic_port_eswitch_cfg_capability(struct qlcnic_adapter *adapter)
 966{
 967	bool ret = false;
 968
 969	if (qlcnic_84xx_check(adapter)) {
 970		ret = true;
 971	} else if (qlcnic_83xx_check(adapter)) {
 972		if (adapter->ahw->extra_capability[0] &
 973		    QLCNIC_FW_CAPABILITY_2_PER_PORT_ESWITCH_CFG)
 974			ret = true;
 975		else
 976			ret = false;
 977	}
 978
 979	return ret;
 980}
 981
 982int qlcnic_init_pci_info(struct qlcnic_adapter *adapter)
 983{
 984	struct qlcnic_hardware_context *ahw = adapter->ahw;
 985	struct qlcnic_pci_info *pci_info;
 986	int i, id = 0, ret = 0, j = 0;
 987	u16 act_pci_func;
 988	u8 pfn;
 989
 990	pci_info = kcalloc(ahw->max_vnic_func, sizeof(*pci_info), GFP_KERNEL);
 991	if (!pci_info)
 992		return -ENOMEM;
 993
 994	ret = qlcnic_get_pci_info(adapter, pci_info);
 995	if (ret)
 996		goto err_pci_info;
 997
 998	act_pci_func = ahw->total_nic_func;
 999
1000	adapter->npars = kcalloc(act_pci_func,
1001				 sizeof(struct qlcnic_npar_info),
1002				 GFP_KERNEL);
1003	if (!adapter->npars) {
1004		ret = -ENOMEM;
1005		goto err_pci_info;
1006	}
1007
1008	adapter->eswitch = kcalloc(QLCNIC_NIU_MAX_XG_PORTS,
1009				   sizeof(struct qlcnic_eswitch),
1010				   GFP_KERNEL);
1011	if (!adapter->eswitch) {
1012		ret = -ENOMEM;
1013		goto err_npars;
1014	}
1015
1016	for (i = 0; i < ahw->max_vnic_func; i++) {
1017		pfn = pci_info[i].id;
1018
1019		if (pfn >= ahw->max_vnic_func) {
1020			ret = -EINVAL;
1021			dev_err(&adapter->pdev->dev, "%s: Invalid function 0x%x, max 0x%x\n",
1022				__func__, pfn, ahw->max_vnic_func);
1023			goto err_eswitch;
1024		}
1025
1026		if (!pci_info[i].active ||
1027		    (pci_info[i].type != QLCNIC_TYPE_NIC))
1028			continue;
1029
1030		if (qlcnic_port_eswitch_cfg_capability(adapter)) {
1031			if (!qlcnic_83xx_set_port_eswitch_status(adapter, pfn,
1032								 &id))
1033				adapter->npars[j].eswitch_status = true;
1034			else
1035				continue;
1036		} else {
1037			adapter->npars[j].eswitch_status = true;
1038		}
1039
1040		adapter->npars[j].pci_func = pfn;
1041		adapter->npars[j].active = (u8)pci_info[i].active;
1042		adapter->npars[j].type = (u8)pci_info[i].type;
1043		adapter->npars[j].phy_port = (u8)pci_info[i].default_port;
1044		adapter->npars[j].min_bw = pci_info[i].tx_min_bw;
1045		adapter->npars[j].max_bw = pci_info[i].tx_max_bw;
1046
1047		memcpy(&adapter->npars[j].mac, &pci_info[i].mac, ETH_ALEN);
1048		j++;
1049	}
1050
1051	/* Update eSwitch status for adapters without per port eSwitch
1052	 * configuration capability
1053	 */
1054	if (!qlcnic_port_eswitch_cfg_capability(adapter)) {
1055		for (i = 0; i < QLCNIC_NIU_MAX_XG_PORTS; i++)
1056			adapter->eswitch[i].flags |= QLCNIC_SWITCH_ENABLE;
1057	}
1058
1059	kfree(pci_info);
1060	return 0;
1061
1062err_eswitch:
1063	kfree(adapter->eswitch);
1064	adapter->eswitch = NULL;
1065err_npars:
1066	kfree(adapter->npars);
1067	adapter->npars = NULL;
1068err_pci_info:
1069	kfree(pci_info);
1070
1071	return ret;
1072}
1073
1074static int
1075qlcnic_set_function_modes(struct qlcnic_adapter *adapter)
1076{
1077	u8 id;
1078	int ret;
1079	u32 data = QLCNIC_MGMT_FUNC;
1080	struct qlcnic_hardware_context *ahw = adapter->ahw;
1081
1082	ret = qlcnic_api_lock(adapter);
1083	if (ret)
1084		goto err_lock;
1085
1086	id = ahw->pci_func;
1087	data = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
1088	data = (data & ~QLC_DEV_SET_DRV(0xf, id)) |
1089	       QLC_DEV_SET_DRV(QLCNIC_MGMT_FUNC, id);
1090	QLC_SHARED_REG_WR32(adapter, QLCNIC_DRV_OP_MODE, data);
1091	qlcnic_api_unlock(adapter);
1092err_lock:
1093	return ret;
1094}
1095
1096static void qlcnic_check_vf(struct qlcnic_adapter *adapter,
1097			    const struct pci_device_id *ent)
1098{
1099	u32 op_mode, priv_level;
1100
1101	/* Determine FW API version */
1102	adapter->ahw->fw_hal_version = QLC_SHARED_REG_RD32(adapter,
1103							   QLCNIC_FW_API);
1104
1105	/* Find PCI function number */
1106	qlcnic_get_func_no(adapter);
1107
1108	/* Determine function privilege level */
1109	op_mode = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
1110	if (op_mode == QLC_DEV_DRV_DEFAULT)
1111		priv_level = QLCNIC_MGMT_FUNC;
1112	else
1113		priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
1114
1115	if (priv_level == QLCNIC_NON_PRIV_FUNC) {
1116		adapter->ahw->op_mode = QLCNIC_NON_PRIV_FUNC;
1117		dev_info(&adapter->pdev->dev,
1118			"HAL Version: %d Non Privileged function\n",
1119			 adapter->ahw->fw_hal_version);
1120		adapter->nic_ops = &qlcnic_vf_ops;
1121	} else
1122		adapter->nic_ops = &qlcnic_ops;
1123}
1124
1125#define QLCNIC_82XX_BAR0_LENGTH 0x00200000UL
1126#define QLCNIC_83XX_BAR0_LENGTH 0x4000
1127static void qlcnic_get_bar_length(u32 dev_id, ulong *bar)
1128{
1129	switch (dev_id) {
1130	case PCI_DEVICE_ID_QLOGIC_QLE824X:
1131		*bar = QLCNIC_82XX_BAR0_LENGTH;
1132		break;
1133	case PCI_DEVICE_ID_QLOGIC_QLE834X:
1134	case PCI_DEVICE_ID_QLOGIC_QLE8830:
1135	case PCI_DEVICE_ID_QLOGIC_QLE844X:
1136	case PCI_DEVICE_ID_QLOGIC_VF_QLE834X:
1137	case PCI_DEVICE_ID_QLOGIC_VF_QLE844X:
1138	case PCI_DEVICE_ID_QLOGIC_VF_QLE8C30:
1139		*bar = QLCNIC_83XX_BAR0_LENGTH;
1140		break;
1141	default:
1142		*bar = 0;
1143	}
1144}
1145
1146static int qlcnic_setup_pci_map(struct pci_dev *pdev,
1147				struct qlcnic_hardware_context *ahw)
1148{
1149	u32 offset;
1150	void __iomem *mem_ptr0 = NULL;
1151	unsigned long mem_len, pci_len0 = 0, bar0_len;
1152
1153	/* remap phys address */
1154	mem_len = pci_resource_len(pdev, 0);
1155
1156	qlcnic_get_bar_length(pdev->device, &bar0_len);
1157	if (mem_len >= bar0_len) {
1158
1159		mem_ptr0 = pci_ioremap_bar(pdev, 0);
1160		if (mem_ptr0 == NULL) {
1161			dev_err(&pdev->dev, "failed to map PCI bar 0\n");
1162			return -EIO;
1163		}
1164		pci_len0 = mem_len;
1165	} else {
1166		return -EIO;
1167	}
1168
1169	dev_info(&pdev->dev, "%dKB memory map\n", (int)(mem_len >> 10));
1170
1171	ahw->pci_base0 = mem_ptr0;
1172	ahw->pci_len0 = pci_len0;
1173	offset = QLCNIC_PCIX_PS_REG(PCIX_OCM_WINDOW_REG(ahw->pci_func));
1174	qlcnic_get_ioaddr(ahw, offset);
1175
1176	return 0;
1177}
1178
1179static bool qlcnic_validate_subsystem_id(struct qlcnic_adapter *adapter,
1180					 int index)
1181{
1182	struct pci_dev *pdev = adapter->pdev;
1183	unsigned short subsystem_vendor;
1184	bool ret = true;
1185
1186	subsystem_vendor = pdev->subsystem_vendor;
1187
1188	if (pdev->device == PCI_DEVICE_ID_QLOGIC_QLE824X ||
1189	    pdev->device == PCI_DEVICE_ID_QLOGIC_QLE834X) {
1190		if (qlcnic_boards[index].sub_vendor == subsystem_vendor &&
1191		    qlcnic_boards[index].sub_device == pdev->subsystem_device)
1192			ret = true;
1193		else
1194			ret = false;
1195	}
1196
1197	return ret;
1198}
1199
1200static void qlcnic_get_board_name(struct qlcnic_adapter *adapter, char *name)
1201{
1202	struct pci_dev *pdev = adapter->pdev;
1203	int i, found = 0;
1204
1205	for (i = 0; i < NUM_SUPPORTED_BOARDS; ++i) {
1206		if (qlcnic_boards[i].vendor == pdev->vendor &&
1207		    qlcnic_boards[i].device == pdev->device &&
1208		    qlcnic_validate_subsystem_id(adapter, i)) {
1209			found = 1;
1210			break;
1211		}
1212	}
1213
1214	if (!found)
1215		sprintf(name, "%pM Gigabit Ethernet", adapter->mac_addr);
1216	else
1217		sprintf(name, "%pM: %s" , adapter->mac_addr,
1218			qlcnic_boards[i].short_name);
1219}
1220
1221static void
1222qlcnic_check_options(struct qlcnic_adapter *adapter)
1223{
1224	int err;
1225	u32 fw_major, fw_minor, fw_build, prev_fw_version;
1226	struct pci_dev *pdev = adapter->pdev;
1227	struct qlcnic_hardware_context *ahw = adapter->ahw;
1228	struct qlcnic_fw_dump *fw_dump = &ahw->fw_dump;
1229
1230	prev_fw_version = adapter->fw_version;
1231
1232	fw_major = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MAJOR);
1233	fw_minor = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MINOR);
1234	fw_build = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_SUB);
1235
1236	adapter->fw_version = QLCNIC_VERSION_CODE(fw_major, fw_minor, fw_build);
1237
1238	err = qlcnic_get_board_info(adapter);
1239	if (err) {
1240		dev_err(&pdev->dev, "Error getting board config info.\n");
1241		return;
1242	}
1243	if (ahw->op_mode != QLCNIC_NON_PRIV_FUNC) {
1244		if (fw_dump->tmpl_hdr == NULL ||
1245				adapter->fw_version > prev_fw_version) {
1246			vfree(fw_dump->tmpl_hdr);
1247			if (!qlcnic_fw_cmd_get_minidump_temp(adapter))
1248				dev_info(&pdev->dev,
1249					"Supports FW dump capability\n");
1250		}
1251	}
1252
1253	dev_info(&pdev->dev, "Driver v%s, firmware v%d.%d.%d\n",
1254		 QLCNIC_LINUX_VERSIONID, fw_major, fw_minor, fw_build);
1255
1256	if (adapter->ahw->port_type == QLCNIC_XGBE) {
1257		if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
1258			adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_VF;
1259			adapter->max_rxd = MAX_RCV_DESCRIPTORS_VF;
1260		} else {
1261			adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_10G;
1262			adapter->max_rxd = MAX_RCV_DESCRIPTORS_10G;
1263		}
1264
1265		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
1266		adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
1267
1268	} else if (adapter->ahw->port_type == QLCNIC_GBE) {
1269		adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G;
1270		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
1271		adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
1272		adapter->max_rxd = MAX_RCV_DESCRIPTORS_1G;
1273	}
1274
1275	adapter->ahw->msix_supported = !!qlcnic_use_msi_x;
1276
1277	adapter->num_txd = MAX_CMD_DESCRIPTORS;
1278
1279	adapter->max_rds_rings = MAX_RDS_RINGS;
1280}
1281
1282static int
1283qlcnic_initialize_nic(struct qlcnic_adapter *adapter)
1284{
1285	struct qlcnic_info nic_info;
1286	int err = 0;
1287
1288	memset(&nic_info, 0, sizeof(struct qlcnic_info));
1289	err = qlcnic_get_nic_info(adapter, &nic_info, adapter->ahw->pci_func);
1290	if (err)
1291		return err;
1292
1293	adapter->ahw->physical_port = (u8)nic_info.phys_port;
1294	adapter->ahw->switch_mode = nic_info.switch_mode;
1295	adapter->ahw->max_tx_ques = nic_info.max_tx_ques;
1296	adapter->ahw->max_rx_ques = nic_info.max_rx_ques;
1297	adapter->ahw->capabilities = nic_info.capabilities;
1298
1299	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_MORE_CAPS) {
1300		u32 temp;
1301		temp = QLCRD32(adapter, CRB_FW_CAPABILITIES_2, &err);
1302		if (err == -EIO)
1303			return err;
1304		adapter->ahw->extra_capability[0] = temp;
1305	} else {
1306		adapter->ahw->extra_capability[0] = 0;
1307	}
1308
1309	adapter->ahw->max_mac_filters = nic_info.max_mac_filters;
1310	adapter->ahw->max_mtu = nic_info.max_mtu;
1311
1312	if (adapter->ahw->capabilities & BIT_6) {
1313		adapter->flags |= QLCNIC_ESWITCH_ENABLED;
1314		adapter->ahw->nic_mode = QLCNIC_VNIC_MODE;
1315		adapter->max_tx_rings = QLCNIC_MAX_HW_VNIC_TX_RINGS;
1316		adapter->max_sds_rings = QLCNIC_MAX_VNIC_SDS_RINGS;
1317
1318		dev_info(&adapter->pdev->dev, "vNIC mode enabled.\n");
1319	} else {
1320		adapter->ahw->nic_mode = QLCNIC_DEFAULT_MODE;
1321		adapter->max_tx_rings = QLCNIC_MAX_HW_TX_RINGS;
1322		adapter->max_sds_rings = QLCNIC_MAX_SDS_RINGS;
1323		adapter->flags &= ~QLCNIC_ESWITCH_ENABLED;
1324	}
1325
1326	return err;
1327}
1328
1329void qlcnic_set_vlan_config(struct qlcnic_adapter *adapter,
1330			    struct qlcnic_esw_func_cfg *esw_cfg)
1331{
1332	if (esw_cfg->discard_tagged)
1333		adapter->flags &= ~QLCNIC_TAGGING_ENABLED;
1334	else
1335		adapter->flags |= QLCNIC_TAGGING_ENABLED;
1336
1337	if (esw_cfg->vlan_id) {
1338		adapter->rx_pvid = esw_cfg->vlan_id;
1339		adapter->tx_pvid = esw_cfg->vlan_id;
1340	} else {
1341		adapter->rx_pvid = 0;
1342		adapter->tx_pvid = 0;
1343	}
1344}
1345
1346static int
1347qlcnic_vlan_rx_add(struct net_device *netdev, __be16 proto, u16 vid)
1348{
1349	struct qlcnic_adapter *adapter = netdev_priv(netdev);
1350	int err;
1351
1352	if (qlcnic_sriov_vf_check(adapter)) {
1353		err = qlcnic_sriov_cfg_vf_guest_vlan(adapter, vid, 1);
1354		if (err) {
1355			netdev_err(netdev,
1356				   "Cannot add VLAN filter for VLAN id %d, err=%d",
1357				   vid, err);
1358			return err;
1359		}
1360	}
1361
1362	set_bit(vid, adapter->vlans);
1363	return 0;
1364}
1365
1366static int
1367qlcnic_vlan_rx_del(struct net_device *netdev, __be16 proto, u16 vid)
1368{
1369	struct qlcnic_adapter *adapter = netdev_priv(netdev);
1370	int err;
1371
1372	if (qlcnic_sriov_vf_check(adapter)) {
1373		err = qlcnic_sriov_cfg_vf_guest_vlan(adapter, vid, 0);
1374		if (err) {
1375			netdev_err(netdev,
1376				   "Cannot delete VLAN filter for VLAN id %d, err=%d",
1377				   vid, err);
1378			return err;
1379		}
1380	}
1381
1382	qlcnic_restore_indev_addr(netdev, NETDEV_DOWN);
1383	clear_bit(vid, adapter->vlans);
1384	return 0;
1385}
1386
1387void qlcnic_set_eswitch_port_features(struct qlcnic_adapter *adapter,
1388				      struct qlcnic_esw_func_cfg *esw_cfg)
1389{
1390	adapter->flags &= ~(QLCNIC_MACSPOOF | QLCNIC_MAC_OVERRIDE_DISABLED |
1391				QLCNIC_PROMISC_DISABLED);
1392
1393	if (esw_cfg->mac_anti_spoof)
1394		adapter->flags |= QLCNIC_MACSPOOF;
1395
1396	if (!esw_cfg->mac_override)
1397		adapter->flags |= QLCNIC_MAC_OVERRIDE_DISABLED;
1398
1399	if (!esw_cfg->promisc_mode)
1400		adapter->flags |= QLCNIC_PROMISC_DISABLED;
1401}
1402
1403int qlcnic_set_eswitch_port_config(struct qlcnic_adapter *adapter)
1404{
1405	struct qlcnic_esw_func_cfg esw_cfg;
1406
1407	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED))
1408		return 0;
1409
1410	esw_cfg.pci_func = adapter->ahw->pci_func;
1411	if (qlcnic_get_eswitch_port_config(adapter, &esw_cfg))
1412			return -EIO;
1413	qlcnic_set_vlan_config(adapter, &esw_cfg);
1414	qlcnic_set_eswitch_port_features(adapter, &esw_cfg);
1415	qlcnic_set_netdev_features(adapter, &esw_cfg);
1416
1417	return 0;
1418}
1419
1420void qlcnic_set_netdev_features(struct qlcnic_adapter *adapter,
1421				struct qlcnic_esw_func_cfg *esw_cfg)
1422{
1423	struct net_device *netdev = adapter->netdev;
1424
1425	if (qlcnic_83xx_check(adapter))
1426		return;
1427
1428	adapter->offload_flags = esw_cfg->offload_flags;
1429	adapter->flags |= QLCNIC_APP_CHANGED_FLAGS;
1430	netdev_update_features(netdev);
1431	adapter->flags &= ~QLCNIC_APP_CHANGED_FLAGS;
1432}
1433
1434static int
1435qlcnic_check_eswitch_mode(struct qlcnic_adapter *adapter)
1436{
1437	u32 op_mode, priv_level;
1438	int err = 0;
1439
1440	err = qlcnic_initialize_nic(adapter);
1441	if (err)
1442		return err;
1443
1444	if (adapter->flags & QLCNIC_ADAPTER_INITIALIZED)
1445		return 0;
1446
1447	op_mode = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
1448	priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
1449
1450	if (op_mode == QLC_DEV_DRV_DEFAULT)
1451		priv_level = QLCNIC_MGMT_FUNC;
1452	else
1453		priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
1454
1455	if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
1456		if (priv_level == QLCNIC_MGMT_FUNC) {
1457			adapter->ahw->op_mode = QLCNIC_MGMT_FUNC;
1458			err = qlcnic_init_pci_info(adapter);
1459			if (err)
1460				return err;
1461			/* Set privilege level for other functions */
1462			qlcnic_set_function_modes(adapter);
1463			dev_info(&adapter->pdev->dev,
1464				"HAL Version: %d, Management function\n",
1465				 adapter->ahw->fw_hal_version);
1466		} else if (priv_level == QLCNIC_PRIV_FUNC) {
1467			adapter->ahw->op_mode = QLCNIC_PRIV_FUNC;
1468			dev_info(&adapter->pdev->dev,
1469				"HAL Version: %d, Privileged function\n",
1470				 adapter->ahw->fw_hal_version);
1471		}
1472	} else {
1473		adapter->ahw->nic_mode = QLCNIC_DEFAULT_MODE;
1474	}
1475
1476	adapter->flags |= QLCNIC_ADAPTER_INITIALIZED;
1477
1478	return err;
1479}
1480
1481int qlcnic_set_default_offload_settings(struct qlcnic_adapter *adapter)
1482{
1483	struct qlcnic_esw_func_cfg esw_cfg;
1484	struct qlcnic_npar_info *npar;
1485	u8 i;
1486
1487	if (adapter->need_fw_reset)
1488		return 0;
1489
1490	for (i = 0; i < adapter->ahw->total_nic_func; i++) {
1491		if (!adapter->npars[i].eswitch_status)
1492			continue;
1493
1494		memset(&esw_cfg, 0, sizeof(struct qlcnic_esw_func_cfg));
1495		esw_cfg.pci_func = adapter->npars[i].pci_func;
1496		esw_cfg.mac_override = BIT_0;
1497		esw_cfg.promisc_mode = BIT_0;
1498		if (qlcnic_82xx_check(adapter)) {
1499			esw_cfg.offload_flags = BIT_0;
1500			if (QLCNIC_IS_TSO_CAPABLE(adapter))
1501				esw_cfg.offload_flags |= (BIT_1 | BIT_2);
1502		}
1503		if (qlcnic_config_switch_port(adapter, &esw_cfg))
1504			return -EIO;
1505		npar = &adapter->npars[i];
1506		npar->pvid = esw_cfg.vlan_id;
1507		npar->mac_override = esw_cfg.mac_override;
1508		npar->mac_anti_spoof = esw_cfg.mac_anti_spoof;
1509		npar->discard_tagged = esw_cfg.discard_tagged;
1510		npar->promisc_mode = esw_cfg.promisc_mode;
1511		npar->offload_flags = esw_cfg.offload_flags;
1512	}
1513
1514	return 0;
1515}
1516
1517
1518static int
1519qlcnic_reset_eswitch_config(struct qlcnic_adapter *adapter,
1520			struct qlcnic_npar_info *npar, int pci_func)
1521{
1522	struct qlcnic_esw_func_cfg esw_cfg;
1523	esw_cfg.op_mode = QLCNIC_PORT_DEFAULTS;
1524	esw_cfg.pci_func = pci_func;
1525	esw_cfg.vlan_id = npar->pvid;
1526	esw_cfg.mac_override = npar->mac_override;
1527	esw_cfg.discard_tagged = npar->discard_tagged;
1528	esw_cfg.mac_anti_spoof = npar->mac_anti_spoof;
1529	esw_cfg.offload_flags = npar->offload_flags;
1530	esw_cfg.promisc_mode = npar->promisc_mode;
1531	if (qlcnic_config_switch_port(adapter, &esw_cfg))
1532		return -EIO;
1533
1534	esw_cfg.op_mode = QLCNIC_ADD_VLAN;
1535	if (qlcnic_config_switch_port(adapter, &esw_cfg))
1536		return -EIO;
1537
1538	return 0;
1539}
1540
1541int qlcnic_reset_npar_config(struct qlcnic_adapter *adapter)
1542{
1543	int i, err;
1544	struct qlcnic_npar_info *npar;
1545	struct qlcnic_info nic_info;
1546	u8 pci_func;
1547
1548	if (qlcnic_82xx_check(adapter))
1549		if (!adapter->need_fw_reset)
1550			return 0;
1551
1552	/* Set the NPAR config data after FW reset */
1553	for (i = 0; i < adapter->ahw->total_nic_func; i++) {
1554		npar = &adapter->npars[i];
1555		pci_func = npar->pci_func;
1556		if (!adapter->npars[i].eswitch_status)
1557			continue;
1558
1559		memset(&nic_info, 0, sizeof(struct qlcnic_info));
1560		err = qlcnic_get_nic_info(adapter, &nic_info, pci_func);
1561		if (err)
1562			return err;
1563		nic_info.min_tx_bw = npar->min_bw;
1564		nic_info.max_tx_bw = npar->max_bw;
1565		err = qlcnic_set_nic_info(adapter, &nic_info);
1566		if (err)
1567			return err;
1568
1569		if (npar->enable_pm) {
1570			err = qlcnic_config_port_mirroring(adapter,
1571							   npar->dest_npar, 1,
1572							   pci_func);
1573			if (err)
1574				return err;
1575		}
1576		err = qlcnic_reset_eswitch_config(adapter, npar, pci_func);
1577		if (err)
1578			return err;
1579	}
1580	return 0;
1581}
1582
1583static int qlcnic_check_npar_opertional(struct qlcnic_adapter *adapter)
1584{
1585	u8 npar_opt_timeo = QLCNIC_DEV_NPAR_OPER_TIMEO;
1586	u32 npar_state;
1587
1588	if (adapter->ahw->op_mode == QLCNIC_MGMT_FUNC)
1589		return 0;
1590
1591	npar_state = QLC_SHARED_REG_RD32(adapter,
1592					 QLCNIC_CRB_DEV_NPAR_STATE);
1593	while (npar_state != QLCNIC_DEV_NPAR_OPER && --npar_opt_timeo) {
1594		msleep(1000);
1595		npar_state = QLC_SHARED_REG_RD32(adapter,
1596						 QLCNIC_CRB_DEV_NPAR_STATE);
1597	}
1598	if (!npar_opt_timeo) {
1599		dev_err(&adapter->pdev->dev,
1600			"Waiting for NPAR state to operational timeout\n");
1601		return -EIO;
1602	}
1603	return 0;
1604}
1605
1606static int
1607qlcnic_set_mgmt_operations(struct qlcnic_adapter *adapter)
1608{
1609	int err;
1610
1611	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
1612	    adapter->ahw->op_mode != QLCNIC_MGMT_FUNC)
1613		return 0;
1614
1615	err = qlcnic_set_default_offload_settings(adapter);
1616	if (err)
1617		return err;
1618
1619	err = qlcnic_reset_npar_config(adapter);
1620	if (err)
1621		return err;
1622
1623	qlcnic_dev_set_npar_ready(adapter);
1624
1625	return err;
1626}
1627
1628static int qlcnic_82xx_start_firmware(struct qlcnic_adapter *adapter)
1629{
1630	int err;
1631
1632	err = qlcnic_can_start_firmware(adapter);
1633	if (err < 0)
1634		return err;
1635	else if (!err)
1636		goto check_fw_status;
1637
1638	if (qlcnic_load_fw_file)
1639		qlcnic_request_firmware(adapter);
1640	else {
1641		err = qlcnic_check_flash_fw_ver(adapter);
1642		if (err)
1643			goto err_out;
1644
1645		adapter->ahw->fw_type = QLCNIC_FLASH_ROMIMAGE;
1646	}
1647
1648	err = qlcnic_need_fw_reset(adapter);
1649	if (err == 0)
1650		goto check_fw_status;
1651
1652	err = qlcnic_pinit_from_rom(adapter);
1653	if (err)
1654		goto err_out;
1655
1656	err = qlcnic_load_firmware(adapter);
1657	if (err)
1658		goto err_out;
1659
1660	qlcnic_release_firmware(adapter);
1661	QLCWR32(adapter, CRB_DRIVER_VERSION, QLCNIC_DRIVER_VERSION);
1662
1663check_fw_status:
1664	err = qlcnic_check_fw_status(adapter);
1665	if (err)
1666		goto err_out;
1667
1668	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_READY);
1669	qlcnic_idc_debug_info(adapter, 1);
1670	err = qlcnic_check_eswitch_mode(adapter);
1671	if (err) {
1672		dev_err(&adapter->pdev->dev,
1673			"Memory allocation failed for eswitch\n");
1674		goto err_out;
1675	}
1676	err = qlcnic_set_mgmt_operations(adapter);
1677	if (err)
1678		goto err_out;
1679
1680	qlcnic_check_options(adapter);
1681	adapter->need_fw_reset = 0;
1682
1683	qlcnic_release_firmware(adapter);
1684	return 0;
1685
1686err_out:
1687	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_FAILED);
1688	dev_err(&adapter->pdev->dev, "Device state set to failed\n");
1689
1690	qlcnic_release_firmware(adapter);
1691	return err;
1692}
1693
1694static int
1695qlcnic_request_irq(struct qlcnic_adapter *adapter)
1696{
1697	irq_handler_t handler;
1698	struct qlcnic_host_sds_ring *sds_ring;
1699	struct qlcnic_host_tx_ring *tx_ring;
1700	int err, ring, num_sds_rings;
1701
1702	unsigned long flags = 0;
1703	struct net_device *netdev = adapter->netdev;
1704	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1705
1706	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
1707		if (qlcnic_82xx_check(adapter))
1708			handler = qlcnic_tmp_intr;
1709		else
1710			handler = qlcnic_83xx_tmp_intr;
1711		if (!QLCNIC_IS_MSI_FAMILY(adapter))
1712			flags |= IRQF_SHARED;
1713
1714	} else {
1715		if (adapter->flags & QLCNIC_MSIX_ENABLED)
1716			handler = qlcnic_msix_intr;
1717		else if (adapter->flags & QLCNIC_MSI_ENABLED)
1718			handler = qlcnic_msi_intr;
1719		else {
1720			flags |= IRQF_SHARED;
1721			if (qlcnic_82xx_check(adapter))
1722				handler = qlcnic_intr;
1723			else
1724				handler = qlcnic_83xx_intr;
1725		}
1726	}
1727	adapter->irq = netdev->irq;
1728
1729	if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST) {
1730		if (qlcnic_82xx_check(adapter) ||
1731		    (qlcnic_83xx_check(adapter) &&
1732		     (adapter->flags & QLCNIC_MSIX_ENABLED))) {
1733			num_sds_rings = adapter->drv_sds_rings;
1734			for (ring = 0; ring < num_sds_rings; ring++) {
1735				sds_ring = &recv_ctx->sds_rings[ring];
1736				if (qlcnic_82xx_check(adapter) &&
1737				    !qlcnic_check_multi_tx(adapter) &&
1738				    (ring == (num_sds_rings - 1))) {
1739					if (!(adapter->flags &
1740					      QLCNIC_MSIX_ENABLED))
1741						snprintf(sds_ring->name,
1742							 sizeof(sds_ring->name),
1743							 "qlcnic");
1744					else
1745						snprintf(sds_ring->name,
1746							 sizeof(sds_ring->name),
1747							 "%s-tx-0-rx-%d",
1748							 netdev->name, ring);
1749				} else {
1750					snprintf(sds_ring->name,
1751						 sizeof(sds_ring->name),
1752						 "%s-rx-%d",
1753						 netdev->name, ring);
1754				}
1755				err = request_irq(sds_ring->irq, handler, flags,
1756						  sds_ring->name, sds_ring);
1757				if (err)
1758					return err;
1759			}
1760		}
1761		if ((qlcnic_82xx_check(adapter) &&
1762		     qlcnic_check_multi_tx(adapter)) ||
1763		    (qlcnic_83xx_check(adapter) &&
1764		     (adapter->flags & QLCNIC_MSIX_ENABLED) &&
1765		     !(adapter->flags & QLCNIC_TX_INTR_SHARED))) {
1766			handler = qlcnic_msix_tx_intr;
1767			for (ring = 0; ring < adapter->drv_tx_rings;
1768			     ring++) {
1769				tx_ring = &adapter->tx_ring[ring];
1770				snprintf(tx_ring->name, sizeof(tx_ring->name),
1771					 "%s-tx-%d", netdev->name, ring);
1772				err = request_irq(tx_ring->irq, handler, flags,
1773						  tx_ring->name, tx_ring);
1774				if (err)
1775					return err;
1776			}
1777		}
1778	}
1779	return 0;
1780}
1781
1782static void
1783qlcnic_free_irq(struct qlcnic_adapter *adapter)
1784{
1785	int ring;
1786	struct qlcnic_host_sds_ring *sds_ring;
1787	struct qlcnic_host_tx_ring *tx_ring;
1788
1789	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1790
1791	if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST) {
1792		if (qlcnic_82xx_check(adapter) ||
1793		    (qlcnic_83xx_check(adapter) &&
1794		     (adapter->flags & QLCNIC_MSIX_ENABLED))) {
1795			for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
1796				sds_ring = &recv_ctx->sds_rings[ring];
1797				free_irq(sds_ring->irq, sds_ring);
1798			}
1799		}
1800		if ((qlcnic_83xx_check(adapter) &&
1801		     !(adapter->flags & QLCNIC_TX_INTR_SHARED)) ||
1802		    (qlcnic_82xx_check(adapter) &&
1803		     qlcnic_check_multi_tx(adapter))) {
1804			for (ring = 0; ring < adapter->drv_tx_rings;
1805			     ring++) {
1806				tx_ring = &adapter->tx_ring[ring];
1807				if (tx_ring->irq)
1808					free_irq(tx_ring->irq, tx_ring);
1809			}
1810		}
1811	}
1812}
1813
1814static void qlcnic_get_lro_mss_capability(struct qlcnic_adapter *adapter)
1815{
1816	u32 capab = 0;
1817
1818	if (qlcnic_82xx_check(adapter)) {
1819		if (adapter->ahw->extra_capability[0] &
1820		    QLCNIC_FW_CAPABILITY_2_LRO_MAX_TCP_SEG)
1821			adapter->flags |= QLCNIC_FW_LRO_MSS_CAP;
1822	} else {
1823		capab = adapter->ahw->capabilities;
1824		if (QLC_83XX_GET_FW_LRO_MSS_CAPABILITY(capab))
1825			adapter->flags |= QLCNIC_FW_LRO_MSS_CAP;
1826	}
1827}
1828
1829static int qlcnic_config_def_intr_coalesce(struct qlcnic_adapter *adapter)
1830{
1831	struct qlcnic_hardware_context *ahw = adapter->ahw;
1832	int err;
1833
1834	/* Initialize interrupt coalesce parameters */
1835	ahw->coal.flag = QLCNIC_INTR_DEFAULT;
1836
1837	if (qlcnic_83xx_check(adapter)) {
1838		ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX_TX;
1839		ahw->coal.tx_time_us = QLCNIC_DEF_INTR_COALESCE_TX_TIME_US;
1840		ahw->coal.tx_packets = QLCNIC_DEF_INTR_COALESCE_TX_PACKETS;
1841		ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
1842		ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
1843
1844		err = qlcnic_83xx_set_rx_tx_intr_coal(adapter);
1845	} else {
1846		ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX;
1847		ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
1848		ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
1849
1850		err = qlcnic_82xx_set_rx_coalesce(adapter);
1851	}
1852
1853	return err;
1854}
1855
1856int __qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1857{
1858	int ring;
1859	struct qlcnic_host_rds_ring *rds_ring;
1860
1861	if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1862		return -EIO;
1863
1864	if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
1865		return 0;
1866
1867	if (qlcnic_set_eswitch_port_config(adapter))
1868		return -EIO;
1869
1870	qlcnic_get_lro_mss_capability(adapter);
1871
1872	if (qlcnic_fw_create_ctx(adapter))
1873		return -EIO;
1874
1875	for (ring = 0; ring < adapter->max_rds_rings; ring++) {
1876		rds_ring = &adapter->recv_ctx->rds_rings[ring];
1877		qlcnic_post_rx_buffers(adapter, rds_ring, ring);
1878	}
1879
1880	qlcnic_set_multi(netdev);
1881	qlcnic_fw_cmd_set_mtu(adapter, netdev->mtu);
1882
1883	adapter->ahw->linkup = 0;
1884
1885	if (adapter->drv_sds_rings > 1)
1886		qlcnic_config_rss(adapter, 1);
1887
1888	qlcnic_config_def_intr_coalesce(adapter);
1889
1890	if (netdev->features & NETIF_F_LRO)
1891		qlcnic_config_hw_lro(adapter, QLCNIC_LRO_ENABLED);
1892
1893	set_bit(__QLCNIC_DEV_UP, &adapter->state);
1894	qlcnic_napi_enable(adapter);
1895
1896	qlcnic_linkevent_request(adapter, 1);
1897
1898	adapter->ahw->reset_context = 0;
1899	netif_tx_start_all_queues(netdev);
1900	return 0;
1901}
1902
1903int qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1904{
1905	int err = 0;
1906
1907	rtnl_lock();
1908	if (netif_running(netdev))
1909		err = __qlcnic_up(adapter, netdev);
1910	rtnl_unlock();
1911
1912	return err;
1913}
1914
1915void __qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1916{
1917	int ring;
1918
1919	if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1920		return;
1921
1922	if (!test_and_clear_bit(__QLCNIC_DEV_UP, &adapter->state))
1923		return;
1924
1925	smp_mb();
1926	netif_carrier_off(netdev);
1927	adapter->ahw->linkup = 0;
1928	netif_tx_disable(netdev);
1929
1930	qlcnic_free_mac_list(adapter);
1931
1932	if (adapter->fhash.fnum)
1933		qlcnic_delete_lb_filters(adapter);
1934
1935	qlcnic_nic_set_promisc(adapter, QLCNIC_NIU_NON_PROMISC_MODE);
1936	if (qlcnic_sriov_vf_check(adapter))
1937		qlcnic_sriov_cleanup_async_list(&adapter->ahw->sriov->bc);
1938
1939	qlcnic_napi_disable(adapter);
1940
1941	qlcnic_fw_destroy_ctx(adapter);
1942	adapter->flags &= ~QLCNIC_FW_LRO_MSS_CAP;
1943
1944	qlcnic_reset_rx_buffers_list(adapter);
1945
1946	for (ring = 0; ring < adapter->drv_tx_rings; ring++)
1947		qlcnic_release_tx_buffers(adapter, &adapter->tx_ring[ring]);
1948}
1949
1950/* Usage: During suspend and firmware recovery module */
1951
1952void qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1953{
1954	rtnl_lock();
1955	if (netif_running(netdev))
1956		__qlcnic_down(adapter, netdev);
1957	rtnl_unlock();
1958
1959}
1960
1961int
1962qlcnic_attach(struct qlcnic_adapter *adapter)
1963{
1964	struct net_device *netdev = adapter->netdev;
1965	struct pci_dev *pdev = adapter->pdev;
1966	int err;
1967
1968	if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC)
1969		return 0;
1970
1971	err = qlcnic_napi_add(adapter, netdev);
1972	if (err)
1973		return err;
1974
1975	err = qlcnic_alloc_sw_resources(adapter);
1976	if (err) {
1977		dev_err(&pdev->dev, "Error in setting sw resources\n");
1978		goto err_out_napi_del;
1979	}
1980
1981	err = qlcnic_alloc_hw_resources(adapter);
1982	if (err) {
1983		dev_err(&pdev->dev, "Error in setting hw resources\n");
1984		goto err_out_free_sw;
1985	}
1986
1987	err = qlcnic_request_irq(adapter);
1988	if (err) {
1989		dev_err(&pdev->dev, "failed to setup interrupt\n");
1990		goto err_out_free_hw;
1991	}
1992
1993	qlcnic_create_sysfs_entries(adapter);
1994
1995	if (qlcnic_encap_rx_offload(adapter))
1996		udp_tunnel_nic_reset_ntf(netdev);
1997
1998	adapter->is_up = QLCNIC_ADAPTER_UP_MAGIC;
1999	return 0;
2000
2001err_out_free_hw:
2002	qlcnic_free_hw_resources(adapter);
2003err_out_free_sw:
2004	qlcnic_free_sw_resources(adapter);
2005err_out_napi_del:
2006	qlcnic_napi_del(adapter);
2007	return err;
2008}
2009
2010void qlcnic_detach(struct qlcnic_adapter *adapter)
2011{
2012	if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
2013		return;
2014
2015	qlcnic_remove_sysfs_entries(adapter);
2016
2017	qlcnic_free_hw_resources(adapter);
2018	qlcnic_release_rx_buffers(adapter);
2019	qlcnic_free_irq(adapter);
2020	qlcnic_napi_del(adapter);
2021	qlcnic_free_sw_resources(adapter);
2022
2023	adapter->is_up = 0;
2024}
2025
2026void qlcnic_diag_free_res(struct net_device *netdev, int drv_sds_rings)
2027{
2028	struct qlcnic_adapter *adapter = netdev_priv(netdev);
2029	struct qlcnic_host_sds_ring *sds_ring;
2030	int drv_tx_rings = adapter->drv_tx_rings;
2031	int ring;
2032
2033	clear_bit(__QLCNIC_DEV_UP, &adapter->state);
2034	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
2035		for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
2036			sds_ring = &adapter->recv_ctx->sds_rings[ring];
2037			qlcnic_disable_sds_intr(adapter, sds_ring);
2038		}
2039	}
2040
2041	qlcnic_fw_destroy_ctx(adapter);
2042
2043	qlcnic_detach(adapter);
2044
2045	adapter->ahw->diag_test = 0;
2046	adapter->drv_sds_rings = drv_sds_rings;
2047	adapter->drv_tx_rings = drv_tx_rings;
2048
2049	if (qlcnic_attach(adapter))
2050		goto out;
2051
2052	if (netif_running(netdev))
2053		__qlcnic_up(adapter, netdev);
2054out:
2055	netif_device_attach(netdev);
2056}
2057
2058static int qlcnic_alloc_adapter_resources(struct qlcnic_adapter *adapter)
2059{
2060	struct qlcnic_hardware_context *ahw = adapter->ahw;
2061	int err = 0;
2062
2063	adapter->recv_ctx = kzalloc(sizeof(struct qlcnic_recv_context),
2064				GFP_KERNEL);
2065	if (!adapter->recv_ctx) {
2066		err = -ENOMEM;
2067		goto err_out;
2068	}
2069
2070	if (qlcnic_83xx_check(adapter)) {
2071		ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX_TX;
2072		ahw->coal.tx_time_us = QLCNIC_DEF_INTR_COALESCE_TX_TIME_US;
2073		ahw->coal.tx_packets = QLCNIC_DEF_INTR_COALESCE_TX_PACKETS;
2074		ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
2075		ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
2076	} else {
2077		ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX;
2078		ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
2079		ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
2080	}
2081
2082	/* clear stats */
2083	memset(&adapter->stats, 0, sizeof(adapter->stats));
2084err_out:
2085	return err;
2086}
2087
2088static void qlcnic_free_adapter_resources(struct qlcnic_adapter *adapter)
2089{
2090	struct qlcnic_fw_dump *fw_dump = &adapter->ahw->fw_dump;
2091
2092	kfree(adapter->recv_ctx);
2093	adapter->recv_ctx = NULL;
2094
2095	if (fw_dump->tmpl_hdr) {
2096		vfree(fw_dump->tmpl_hdr);
2097		fw_dump->tmpl_hdr = NULL;
2098	}
2099
2100	if (fw_dump->dma_buffer) {
2101		dma_free_coherent(&adapter->pdev->dev, QLC_PEX_DMA_READ_SIZE,
2102				  fw_dump->dma_buffer, fw_dump->phys_addr);
2103		fw_dump->dma_buffer = NULL;
2104	}
2105
2106	kfree(adapter->ahw->reset.buff);
2107	adapter->ahw->fw_dump.tmpl_hdr = NULL;
2108}
2109
2110int qlcnic_diag_alloc_res(struct net_device *netdev, int test)
2111{
2112	struct qlcnic_adapter *adapter = netdev_priv(netdev);
2113	struct qlcnic_host_sds_ring *sds_ring;
2114	struct qlcnic_host_rds_ring *rds_ring;
2115	int ring;
2116	int ret;
2117
2118	netif_device_detach(netdev);
2119
2120	if (netif_running(netdev))
2121		__qlcnic_down(adapter, netdev);
2122
2123	qlcnic_detach(adapter);
2124
2125	adapter->drv_sds_rings = QLCNIC_SINGLE_RING;
2126	adapter->ahw->diag_test = test;
2127	adapter->ahw->linkup = 0;
2128
2129	ret = qlcnic_attach(adapter);
2130	if (ret) {
2131		netif_device_attach(netdev);
2132		return ret;
2133	}
2134
2135	ret = qlcnic_fw_create_ctx(adapter);
2136	if (ret) {
2137		qlcnic_detach(adapter);
2138		netif_device_attach(netdev);
2139		return ret;
2140	}
2141
2142	for (ring = 0; ring < adapter->max_rds_rings; ring++) {
2143		rds_ring = &adapter->recv_ctx->rds_rings[ring];
2144		qlcnic_post_rx_buffers(adapter, rds_ring, ring);
2145	}
2146
2147	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
2148		for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
2149			sds_ring = &adapter->recv_ctx->sds_rings[ring];
2150			qlcnic_enable_sds_intr(adapter, sds_ring);
2151		}
2152	}
2153
2154	if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {
2155		adapter->ahw->loopback_state = 0;
2156		qlcnic_linkevent_request(adapter, 1);
2157	}
2158
2159	set_bit(__QLCNIC_DEV_UP, &adapter->state);
2160
2161	return 0;
2162}
2163
2164/* Reset context in hardware only */
2165static int
2166qlcnic_reset_hw_context(struct qlcnic_adapter *adapter)
2167{
2168	struct net_device *netdev = adapter->netdev;
2169
2170	if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
2171		return -EBUSY;
2172
2173	netif_device_detach(netdev);
2174
2175	qlcnic_down(adapter, netdev);
2176
2177	qlcnic_up(adapter, netdev);
2178
2179	netif_device_attach(netdev);
2180
2181	clear_bit(__QLCNIC_RESETTING, &adapter->state);
2182	netdev_info(adapter->netdev, "%s: soft reset complete\n", __func__);
2183	return 0;
2184}
2185
2186int
2187qlcnic_reset_context(struct qlcnic_adapter *adapter)
2188{
2189	int err = 0;
2190	struct net_device *netdev = adapter->netdev;
2191
2192	if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
2193		return -EBUSY;
2194
2195	if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC) {
2196
2197		netif_device_detach(netdev);
2198
2199		if (netif_running(netdev))
2200			__qlcnic_down(adapter, netdev);
2201
2202		qlcnic_detach(adapter);
2203
2204		if (netif_running(netdev)) {
2205			err = qlcnic_attach(adapter);
2206			if (!err) {
2207				__qlcnic_up(adapter, netdev);
2208				qlcnic_restore_indev_addr(netdev, NETDEV_UP);
2209			}
2210		}
2211
2212		netif_device_attach(netdev);
2213	}
2214
2215	clear_bit(__QLCNIC_RESETTING, &adapter->state);
2216	return err;
2217}
2218
2219static void qlcnic_82xx_set_mac_filter_count(struct qlcnic_adapter *adapter)
2220{
2221	struct qlcnic_hardware_context *ahw = adapter->ahw;
2222	u16 act_pci_fn = ahw->total_nic_func;
2223	u16 count;
2224
2225	ahw->max_mc_count = QLCNIC_MAX_MC_COUNT;
2226	if (act_pci_fn <= 2)
2227		count = (QLCNIC_MAX_UC_COUNT - QLCNIC_MAX_MC_COUNT) /
2228			 act_pci_fn;
2229	else
2230		count = (QLCNIC_LB_MAX_FILTERS - QLCNIC_MAX_MC_COUNT) /
2231			 act_pci_fn;
2232	ahw->max_uc_count = count;
2233}
2234
2235static int qlcnic_set_real_num_queues(struct qlcnic_adapter *adapter,
2236				      u8 tx_queues, u8 rx_queues)
2237{
2238	struct net_device *netdev = adapter->netdev;
2239	int err = 0;
2240
2241	if (tx_queues) {
2242		err = netif_set_real_num_tx_queues(netdev, tx_queues);
2243		if (err) {
2244			netdev_err(netdev, "failed to set %d Tx queues\n",
2245				   tx_queues);
2246			return err;
2247		}
2248	}
2249
2250	if (rx_queues) {
2251		err = netif_set_real_num_rx_queues(netdev, rx_queues);
2252		if (err)
2253			netdev_err(netdev, "failed to set %d Rx queues\n",
2254				   rx_queues);
2255	}
2256
2257	return err;
2258}
2259
2260int
2261qlcnic_setup_netdev(struct qlcnic_adapter *adapter, struct net_device *netdev)
 
2262{
2263	int err;
2264	struct pci_dev *pdev = adapter->pdev;
2265
2266	adapter->rx_csum = 1;
2267	adapter->ahw->mc_enabled = 0;
2268	qlcnic_set_mac_filter_count(adapter);
2269
2270	netdev->netdev_ops	   = &qlcnic_netdev_ops;
2271	netdev->watchdog_timeo     = QLCNIC_WATCHDOG_TIMEOUTVALUE * HZ;
2272
2273	qlcnic_change_mtu(netdev, netdev->mtu);
2274
2275	netdev->ethtool_ops = (qlcnic_sriov_vf_check(adapter)) ?
2276		&qlcnic_sriov_vf_ethtool_ops : &qlcnic_ethtool_ops;
2277
2278	netdev->features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |
2279			     NETIF_F_IPV6_CSUM | NETIF_F_GRO |
2280			     NETIF_F_HW_VLAN_CTAG_RX | NETIF_F_HIGHDMA);
2281	netdev->vlan_features |= (NETIF_F_SG | NETIF_F_IP_CSUM |
2282				  NETIF_F_IPV6_CSUM | NETIF_F_HIGHDMA);
2283
2284	if (QLCNIC_IS_TSO_CAPABLE(adapter)) {
2285		netdev->features |= (NETIF_F_TSO | NETIF_F_TSO6);
2286		netdev->vlan_features |= (NETIF_F_TSO | NETIF_F_TSO6);
2287	}
2288
 
 
 
 
 
2289	if (qlcnic_vlan_tx_check(adapter))
2290		netdev->features |= (NETIF_F_HW_VLAN_CTAG_TX);
2291
2292	if (qlcnic_sriov_vf_check(adapter))
2293		netdev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
2294
2295	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)
2296		netdev->features |= NETIF_F_LRO;
2297
2298	if (qlcnic_encap_tx_offload(adapter)) {
2299		netdev->features |= NETIF_F_GSO_UDP_TUNNEL;
2300
2301		/* encapsulation Tx offload supported by Adapter */
2302		netdev->hw_enc_features = NETIF_F_IP_CSUM        |
2303					  NETIF_F_GSO_UDP_TUNNEL |
2304					  NETIF_F_TSO            |
2305					  NETIF_F_TSO6;
2306	}
2307
2308	if (qlcnic_encap_rx_offload(adapter)) {
2309		netdev->hw_enc_features |= NETIF_F_RXCSUM;
2310
2311		netdev->udp_tunnel_nic_info = &qlcnic_udp_tunnels;
2312	}
2313
2314	netdev->hw_features = netdev->features;
2315	netdev->priv_flags |= IFF_UNICAST_FLT;
2316	netdev->irq = adapter->msix_entries[0].vector;
2317
2318	/* MTU range: 68 - 9600 */
2319	netdev->min_mtu = P3P_MIN_MTU;
2320	netdev->max_mtu = P3P_MAX_MTU;
2321
2322	err = qlcnic_set_real_num_queues(adapter, adapter->drv_tx_rings,
2323					 adapter->drv_sds_rings);
2324	if (err)
2325		return err;
2326
2327	qlcnic_dcb_init_dcbnl_ops(adapter->dcb);
2328
2329	err = register_netdev(netdev);
2330	if (err) {
2331		dev_err(&pdev->dev, "failed to register net device\n");
2332		return err;
2333	}
2334
2335	return 0;
2336}
2337
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2338void qlcnic_free_tx_rings(struct qlcnic_adapter *adapter)
2339{
2340	int ring;
2341	struct qlcnic_host_tx_ring *tx_ring;
2342
2343	for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2344		tx_ring = &adapter->tx_ring[ring];
2345		if (tx_ring) {
2346			vfree(tx_ring->cmd_buf_arr);
2347			tx_ring->cmd_buf_arr = NULL;
2348		}
2349	}
2350	kfree(adapter->tx_ring);
2351}
2352
2353int qlcnic_alloc_tx_rings(struct qlcnic_adapter *adapter,
2354			  struct net_device *netdev)
2355{
2356	int ring, vector, index;
2357	struct qlcnic_host_tx_ring *tx_ring;
2358	struct qlcnic_cmd_buffer *cmd_buf_arr;
2359
2360	tx_ring = kcalloc(adapter->drv_tx_rings,
2361			  sizeof(struct qlcnic_host_tx_ring), GFP_KERNEL);
2362	if (tx_ring == NULL)
2363		return -ENOMEM;
2364
2365	adapter->tx_ring = tx_ring;
2366
2367	for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2368		tx_ring = &adapter->tx_ring[ring];
2369		tx_ring->num_desc = adapter->num_txd;
2370		tx_ring->txq = netdev_get_tx_queue(netdev, ring);
2371		cmd_buf_arr = vzalloc(TX_BUFF_RINGSIZE(tx_ring));
2372		if (cmd_buf_arr == NULL) {
2373			qlcnic_free_tx_rings(adapter);
2374			return -ENOMEM;
2375		}
2376		tx_ring->cmd_buf_arr = cmd_buf_arr;
2377		spin_lock_init(&tx_ring->tx_clean_lock);
2378	}
2379
2380	if (qlcnic_83xx_check(adapter) ||
2381	    (qlcnic_82xx_check(adapter) && qlcnic_check_multi_tx(adapter))) {
2382		for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2383			tx_ring = &adapter->tx_ring[ring];
2384			tx_ring->adapter = adapter;
2385			if (adapter->flags & QLCNIC_MSIX_ENABLED) {
2386				index = adapter->drv_sds_rings + ring;
2387				vector = adapter->msix_entries[index].vector;
2388				tx_ring->irq = vector;
2389			}
2390		}
2391	}
2392
2393	return 0;
2394}
2395
2396void qlcnic_set_drv_version(struct qlcnic_adapter *adapter)
2397{
2398	struct qlcnic_hardware_context *ahw = adapter->ahw;
2399	u32 fw_cmd = 0;
2400
2401	if (qlcnic_82xx_check(adapter))
2402		fw_cmd = QLCNIC_CMD_82XX_SET_DRV_VER;
2403	else if (qlcnic_83xx_check(adapter))
2404		fw_cmd = QLCNIC_CMD_83XX_SET_DRV_VER;
2405
2406	if (ahw->extra_capability[0] & QLCNIC_FW_CAPABILITY_SET_DRV_VER)
2407		qlcnic_fw_cmd_set_drv_version(adapter, fw_cmd);
2408}
2409
2410/* Reset firmware API lock */
2411static void qlcnic_reset_api_lock(struct qlcnic_adapter *adapter)
2412{
2413	qlcnic_api_lock(adapter);
2414	qlcnic_api_unlock(adapter);
2415}
2416
2417
2418static int
2419qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
2420{
2421	struct net_device *netdev = NULL;
2422	struct qlcnic_adapter *adapter = NULL;
2423	struct qlcnic_hardware_context *ahw;
 
2424	char board_name[QLCNIC_MAX_BOARD_NAME_LEN + 19]; /* MAC + ": " + name */
2425	int err;
2426
2427	err = pci_enable_device(pdev);
2428	if (err)
2429		return err;
2430
2431	if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
2432		err = -ENODEV;
2433		goto err_out_disable_pdev;
2434	}
2435
2436	err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
2437	if (err) {
2438		dev_err(&pdev->dev, "Unable to set DMA mask, aborting\n");
2439		goto err_out_disable_pdev;
2440	}
2441
2442	err = pci_request_regions(pdev, qlcnic_driver_name);
2443	if (err)
2444		goto err_out_disable_pdev;
2445
2446	pci_set_master(pdev);
 
2447
2448	ahw = kzalloc(sizeof(struct qlcnic_hardware_context), GFP_KERNEL);
2449	if (!ahw) {
2450		err = -ENOMEM;
2451		goto err_out_free_res;
2452	}
2453
2454	switch (ent->device) {
2455	case PCI_DEVICE_ID_QLOGIC_QLE824X:
2456		ahw->hw_ops = &qlcnic_hw_ops;
2457		ahw->reg_tbl = (u32 *) qlcnic_reg_tbl;
2458		break;
2459	case PCI_DEVICE_ID_QLOGIC_QLE834X:
2460	case PCI_DEVICE_ID_QLOGIC_QLE8830:
2461	case PCI_DEVICE_ID_QLOGIC_QLE844X:
2462		qlcnic_83xx_register_map(ahw);
2463		break;
2464	case PCI_DEVICE_ID_QLOGIC_VF_QLE834X:
2465	case PCI_DEVICE_ID_QLOGIC_VF_QLE8C30:
2466	case PCI_DEVICE_ID_QLOGIC_VF_QLE844X:
2467		qlcnic_sriov_vf_register_map(ahw);
2468		break;
2469	default:
2470		err = -EINVAL;
2471		goto err_out_free_hw_res;
2472	}
2473
2474	err = qlcnic_setup_pci_map(pdev, ahw);
2475	if (err)
2476		goto err_out_free_hw_res;
2477
2478	netdev = alloc_etherdev_mq(sizeof(struct qlcnic_adapter),
2479				   QLCNIC_MAX_TX_RINGS);
2480	if (!netdev) {
2481		err = -ENOMEM;
2482		goto err_out_iounmap;
2483	}
2484
2485	SET_NETDEV_DEV(netdev, &pdev->dev);
2486
2487	adapter = netdev_priv(netdev);
2488	adapter->netdev  = netdev;
2489	adapter->pdev    = pdev;
2490	adapter->ahw = ahw;
2491
2492	adapter->qlcnic_wq = create_singlethread_workqueue("qlcnic");
2493	if (adapter->qlcnic_wq == NULL) {
2494		err = -ENOMEM;
2495		dev_err(&pdev->dev, "Failed to create workqueue\n");
2496		goto err_out_free_netdev;
2497	}
2498
2499	err = qlcnic_alloc_adapter_resources(adapter);
2500	if (err)
2501		goto err_out_free_wq;
2502
2503	adapter->dev_rst_time = jiffies;
2504	ahw->revision_id = pdev->revision;
2505	ahw->max_vnic_func = qlcnic_get_vnic_func_count(adapter);
2506	if (qlcnic_mac_learn == FDB_MAC_LEARN)
2507		adapter->fdb_mac_learn = true;
2508	else if (qlcnic_mac_learn == DRV_MAC_LEARN)
2509		adapter->drv_mac_learn = true;
2510
2511	rwlock_init(&adapter->ahw->crb_lock);
2512	mutex_init(&adapter->ahw->mem_lock);
2513
2514	INIT_LIST_HEAD(&adapter->mac_list);
2515
2516	qlcnic_register_dcb(adapter);
2517
2518	if (qlcnic_82xx_check(adapter)) {
2519		qlcnic_check_vf(adapter, ent);
2520		adapter->portnum = adapter->ahw->pci_func;
2521		qlcnic_reset_api_lock(adapter);
2522		err = qlcnic_start_firmware(adapter);
2523		if (err) {
2524			dev_err(&pdev->dev, "Loading fw failed.Please Reboot\n"
2525				"\t\tIf reboot doesn't help, try flashing the card\n");
2526			goto err_out_maintenance_mode;
2527		}
2528
2529		/* compute and set default and max tx/sds rings */
2530		if (adapter->ahw->msix_supported) {
2531			if (qlcnic_check_multi_tx_capability(adapter) == 1)
2532				qlcnic_set_tx_ring_count(adapter,
2533							 QLCNIC_SINGLE_RING);
2534			else
2535				qlcnic_set_tx_ring_count(adapter,
2536							 QLCNIC_DEF_TX_RINGS);
2537			qlcnic_set_sds_ring_count(adapter,
2538						  QLCNIC_DEF_SDS_RINGS);
2539		} else {
2540			qlcnic_set_tx_ring_count(adapter, QLCNIC_SINGLE_RING);
2541			qlcnic_set_sds_ring_count(adapter, QLCNIC_SINGLE_RING);
2542		}
2543
2544		err = qlcnic_setup_idc_param(adapter);
2545		if (err)
2546			goto err_out_free_hw;
2547
2548		adapter->flags |= QLCNIC_NEED_FLR;
2549
2550	} else if (qlcnic_83xx_check(adapter)) {
2551		qlcnic_83xx_check_vf(adapter, ent);
2552		adapter->portnum = adapter->ahw->pci_func;
2553		err = qlcnic_83xx_init(adapter);
2554		if (err) {
2555			switch (err) {
2556			case -ENOTRECOVERABLE:
2557				dev_err(&pdev->dev, "Adapter initialization failed due to a faulty hardware\n");
2558				dev_err(&pdev->dev, "Please replace the adapter with new one and return the faulty adapter for repair\n");
2559				goto err_out_free_hw;
2560			case -ENOMEM:
2561				dev_err(&pdev->dev, "Adapter initialization failed. Please reboot\n");
2562				goto err_out_free_hw;
2563			case -EOPNOTSUPP:
2564				dev_err(&pdev->dev, "Adapter initialization failed\n");
2565				goto err_out_free_hw;
2566			default:
2567				dev_err(&pdev->dev, "Adapter initialization failed. Driver will load in maintenance mode to recover the adapter using the application\n");
2568				goto err_out_maintenance_mode;
2569			}
2570		}
2571
2572		if (qlcnic_sriov_vf_check(adapter))
2573			return 0;
2574	} else {
2575		dev_err(&pdev->dev,
2576			"%s: failed. Please Reboot\n", __func__);
2577		err = -ENODEV;
2578		goto err_out_free_hw;
2579	}
2580
2581	if (qlcnic_read_mac_addr(adapter))
2582		dev_warn(&pdev->dev, "failed to read mac addr\n");
2583
2584	qlcnic_read_phys_port_id(adapter);
2585
2586	if (adapter->portnum == 0) {
2587		qlcnic_get_board_name(adapter, board_name);
2588
2589		pr_info("%s: %s Board Chip rev 0x%x\n",
2590			module_name(THIS_MODULE),
2591			board_name, adapter->ahw->revision_id);
2592	}
2593
2594	if (qlcnic_83xx_check(adapter) && !qlcnic_use_msi_x &&
2595	    !!qlcnic_use_msi)
2596		dev_warn(&pdev->dev,
2597			 "Device does not support MSI interrupts\n");
2598
2599	if (qlcnic_82xx_check(adapter)) {
2600		err = qlcnic_dcb_enable(adapter->dcb);
2601		if (err) {
2602			qlcnic_dcb_free(adapter->dcb);
2603			dev_err(&pdev->dev, "Failed to enable DCB\n");
2604			goto err_out_free_hw;
2605		}
2606
2607		qlcnic_dcb_get_info(adapter->dcb);
2608		err = qlcnic_setup_intr(adapter);
2609
2610		if (err) {
2611			dev_err(&pdev->dev, "Failed to setup interrupt\n");
2612			goto err_out_disable_msi;
2613		}
2614	}
2615
2616	err = qlcnic_get_act_pci_func(adapter);
2617	if (err)
2618		goto err_out_disable_mbx_intr;
2619
2620	if (adapter->portnum == 0)
2621		qlcnic_set_drv_version(adapter);
2622
2623	err = qlcnic_setup_netdev(adapter, netdev);
2624	if (err)
2625		goto err_out_disable_mbx_intr;
2626
2627	pci_set_drvdata(pdev, adapter);
2628
2629	if (qlcnic_82xx_check(adapter))
2630		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
2631				     FW_POLL_DELAY);
2632
2633	switch (adapter->ahw->port_type) {
2634	case QLCNIC_GBE:
2635		dev_info(&adapter->pdev->dev, "%s: GbE port initialized\n",
2636				adapter->netdev->name);
2637		break;
2638	case QLCNIC_XGBE:
2639		dev_info(&adapter->pdev->dev, "%s: XGbE port initialized\n",
2640				adapter->netdev->name);
2641		break;
2642	}
2643
2644	if (adapter->drv_mac_learn)
2645		qlcnic_alloc_lb_filters_mem(adapter);
2646
2647	qlcnic_add_sysfs(adapter);
2648	qlcnic_register_hwmon_dev(adapter);
2649	return 0;
2650
2651err_out_disable_mbx_intr:
2652	if (qlcnic_83xx_check(adapter))
2653		qlcnic_83xx_free_mbx_intr(adapter);
2654
2655err_out_disable_msi:
2656	qlcnic_teardown_intr(adapter);
2657	qlcnic_cancel_idc_work(adapter);
2658	qlcnic_clr_all_drv_state(adapter, 0);
2659
2660err_out_free_hw:
2661	qlcnic_free_adapter_resources(adapter);
2662
2663err_out_free_wq:
2664	destroy_workqueue(adapter->qlcnic_wq);
2665
2666err_out_free_netdev:
2667	free_netdev(netdev);
2668
2669err_out_iounmap:
2670	qlcnic_cleanup_pci_map(ahw);
2671
2672err_out_free_hw_res:
2673	kfree(ahw);
2674
2675err_out_free_res:
2676	pci_release_regions(pdev);
2677
2678err_out_disable_pdev:
2679	pci_disable_device(pdev);
2680	return err;
2681
2682err_out_maintenance_mode:
2683	set_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state);
2684	netdev->netdev_ops = &qlcnic_netdev_failed_ops;
2685	netdev->ethtool_ops = &qlcnic_ethtool_failed_ops;
2686	ahw->port_type = QLCNIC_XGBE;
2687
2688	if (qlcnic_83xx_check(adapter))
2689		adapter->tgt_status_reg = NULL;
2690	else
2691		ahw->board_type = QLCNIC_BRDTYPE_P3P_10G_SFP_PLUS;
2692
2693	err = register_netdev(netdev);
2694
2695	if (err) {
2696		dev_err(&pdev->dev, "Failed to register net device\n");
2697		qlcnic_clr_all_drv_state(adapter, 0);
2698		goto err_out_free_hw;
2699	}
2700
2701	pci_set_drvdata(pdev, adapter);
2702	qlcnic_add_sysfs(adapter);
2703
2704	return 0;
2705}
2706
2707static void qlcnic_remove(struct pci_dev *pdev)
2708{
2709	struct qlcnic_adapter *adapter;
2710	struct net_device *netdev;
2711	struct qlcnic_hardware_context *ahw;
2712
2713	adapter = pci_get_drvdata(pdev);
2714	if (adapter == NULL)
2715		return;
2716
2717	netdev = adapter->netdev;
2718
2719	qlcnic_cancel_idc_work(adapter);
2720	qlcnic_sriov_pf_disable(adapter);
2721	ahw = adapter->ahw;
2722
2723	unregister_netdev(netdev);
2724	qlcnic_sriov_cleanup(adapter);
2725
2726	if (qlcnic_83xx_check(adapter)) {
2727		qlcnic_83xx_initialize_nic(adapter, 0);
2728		cancel_delayed_work_sync(&adapter->idc_aen_work);
2729		qlcnic_83xx_free_mbx_intr(adapter);
2730		qlcnic_83xx_detach_mailbox_work(adapter);
2731		qlcnic_83xx_free_mailbox(ahw->mailbox);
2732		kfree(ahw->fw_info);
2733	}
2734
2735	qlcnic_dcb_free(adapter->dcb);
2736	qlcnic_detach(adapter);
2737	kfree(adapter->npars);
2738	kfree(adapter->eswitch);
2739
2740	if (qlcnic_82xx_check(adapter))
2741		qlcnic_clr_all_drv_state(adapter, 0);
2742
2743	clear_bit(__QLCNIC_RESETTING, &adapter->state);
2744
2745	qlcnic_free_lb_filters_mem(adapter);
2746
2747	qlcnic_teardown_intr(adapter);
2748
2749	qlcnic_remove_sysfs(adapter);
2750
2751	qlcnic_unregister_hwmon_dev(adapter);
2752
2753	qlcnic_cleanup_pci_map(adapter->ahw);
2754
2755	qlcnic_release_firmware(adapter);
2756
 
2757	pci_release_regions(pdev);
2758	pci_disable_device(pdev);
2759
2760	if (adapter->qlcnic_wq) {
2761		destroy_workqueue(adapter->qlcnic_wq);
2762		adapter->qlcnic_wq = NULL;
2763	}
2764
2765	qlcnic_free_adapter_resources(adapter);
2766	kfree(ahw);
2767	free_netdev(netdev);
2768}
2769
2770static void qlcnic_shutdown(struct pci_dev *pdev)
2771{
2772	if (__qlcnic_shutdown(pdev))
2773		return;
2774
2775	pci_disable_device(pdev);
2776}
2777
2778static int __maybe_unused qlcnic_suspend(struct device *dev_d)
 
2779{
2780	return __qlcnic_shutdown(to_pci_dev(dev_d));
 
 
 
 
 
 
 
2781}
2782
2783static int __maybe_unused qlcnic_resume(struct device *dev_d)
2784{
2785	struct qlcnic_adapter *adapter = dev_get_drvdata(dev_d);
 
 
 
 
 
 
 
 
 
2786
2787	return  __qlcnic_resume(adapter);
2788}
 
2789
2790static int qlcnic_open(struct net_device *netdev)
2791{
2792	struct qlcnic_adapter *adapter = netdev_priv(netdev);
2793	int err;
2794
2795	if (test_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state)) {
2796		netdev_err(netdev, "%s: Device is in non-operational state\n",
2797			   __func__);
2798
2799		return -EIO;
2800	}
2801
2802	netif_carrier_off(netdev);
2803
2804	err = qlcnic_attach(adapter);
2805	if (err)
2806		return err;
2807
2808	err = __qlcnic_up(adapter, netdev);
2809	if (err)
2810		qlcnic_detach(adapter);
2811
2812	return err;
2813}
2814
2815/*
2816 * qlcnic_close - Disables a network interface entry point
2817 */
2818static int qlcnic_close(struct net_device *netdev)
2819{
2820	struct qlcnic_adapter *adapter = netdev_priv(netdev);
2821
2822	__qlcnic_down(adapter, netdev);
2823
2824	return 0;
2825}
2826
2827#define QLCNIC_VF_LB_BUCKET_SIZE 1
2828
2829void qlcnic_alloc_lb_filters_mem(struct qlcnic_adapter *adapter)
2830{
2831	void *head;
2832	int i;
2833	struct net_device *netdev = adapter->netdev;
2834	u32 filter_size = 0;
2835	u16 act_pci_func = 0;
2836
2837	if (adapter->fhash.fmax && adapter->fhash.fhead)
2838		return;
2839
2840	act_pci_func = adapter->ahw->total_nic_func;
2841	spin_lock_init(&adapter->mac_learn_lock);
2842	spin_lock_init(&adapter->rx_mac_learn_lock);
2843
2844	if (qlcnic_sriov_vf_check(adapter)) {
2845		filter_size = QLCNIC_83XX_SRIOV_VF_MAX_MAC - 1;
2846		adapter->fhash.fbucket_size = QLCNIC_VF_LB_BUCKET_SIZE;
2847	} else if (qlcnic_82xx_check(adapter)) {
2848		filter_size = QLCNIC_LB_MAX_FILTERS;
2849		adapter->fhash.fbucket_size = QLCNIC_LB_BUCKET_SIZE;
2850	} else {
2851		filter_size = QLC_83XX_LB_MAX_FILTERS;
2852		adapter->fhash.fbucket_size = QLC_83XX_LB_BUCKET_SIZE;
2853	}
2854
2855	head = kcalloc(adapter->fhash.fbucket_size,
2856		       sizeof(struct hlist_head), GFP_ATOMIC);
2857
2858	if (!head)
2859		return;
2860
2861	adapter->fhash.fmax = (filter_size / act_pci_func);
2862	adapter->fhash.fhead = head;
2863
2864	netdev_info(netdev, "active nic func = %d, mac filter size=%d\n",
2865		    act_pci_func, adapter->fhash.fmax);
2866
2867	for (i = 0; i < adapter->fhash.fbucket_size; i++)
2868		INIT_HLIST_HEAD(&adapter->fhash.fhead[i]);
2869
2870	adapter->rx_fhash.fbucket_size = adapter->fhash.fbucket_size;
2871
2872	head = kcalloc(adapter->rx_fhash.fbucket_size,
2873		       sizeof(struct hlist_head), GFP_ATOMIC);
2874
2875	if (!head)
2876		return;
2877
2878	adapter->rx_fhash.fmax = (filter_size / act_pci_func);
2879	adapter->rx_fhash.fhead = head;
2880
2881	for (i = 0; i < adapter->rx_fhash.fbucket_size; i++)
2882		INIT_HLIST_HEAD(&adapter->rx_fhash.fhead[i]);
2883}
2884
2885static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter)
2886{
2887	if (adapter->fhash.fmax)
2888		kfree(adapter->fhash.fhead);
2889
2890	adapter->fhash.fhead = NULL;
2891	adapter->fhash.fmax = 0;
2892
2893	if (adapter->rx_fhash.fmax)
2894		kfree(adapter->rx_fhash.fhead);
2895
2896	adapter->rx_fhash.fmax = 0;
2897	adapter->rx_fhash.fhead = NULL;
2898}
2899
2900int qlcnic_check_temp(struct qlcnic_adapter *adapter)
2901{
2902	struct net_device *netdev = adapter->netdev;
2903	u32 temp_state, temp_val, temp = 0;
2904	int rv = 0;
2905
2906	if (qlcnic_83xx_check(adapter))
2907		temp = QLCRDX(adapter->ahw, QLC_83XX_ASIC_TEMP);
2908
2909	if (qlcnic_82xx_check(adapter))
2910		temp = QLC_SHARED_REG_RD32(adapter, QLCNIC_ASIC_TEMP);
2911
2912	temp_state = qlcnic_get_temp_state(temp);
2913	temp_val = qlcnic_get_temp_val(temp);
2914
2915	if (temp_state == QLCNIC_TEMP_PANIC) {
2916		dev_err(&netdev->dev,
2917		       "Device temperature %d degrees C exceeds"
2918		       " maximum allowed. Hardware has been shut down.\n",
2919		       temp_val);
2920		rv = 1;
2921	} else if (temp_state == QLCNIC_TEMP_WARN) {
2922		if (adapter->ahw->temp == QLCNIC_TEMP_NORMAL) {
2923			dev_err(&netdev->dev,
2924			       "Device temperature %d degrees C "
2925			       "exceeds operating range."
2926			       " Immediate action needed.\n",
2927			       temp_val);
2928		}
2929	} else {
2930		if (adapter->ahw->temp == QLCNIC_TEMP_WARN) {
2931			dev_info(&netdev->dev,
2932			       "Device temperature is now %d degrees C"
2933			       " in normal range.\n", temp_val);
2934		}
2935	}
2936	adapter->ahw->temp = temp_state;
2937	return rv;
2938}
2939
2940static inline void dump_tx_ring_desc(struct qlcnic_host_tx_ring *tx_ring)
2941{
2942	int i;
 
2943
2944	for (i = 0; i < tx_ring->num_desc; i++) {
 
2945		pr_info("TX Desc: %d\n", i);
2946		print_hex_dump(KERN_INFO, "TX: ", DUMP_PREFIX_OFFSET, 16, 1,
2947			       &tx_ring->desc_head[i],
2948			       sizeof(struct cmd_desc_type0), true);
2949	}
2950}
2951
2952static void qlcnic_dump_rings(struct qlcnic_adapter *adapter)
2953{
2954	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
2955	struct net_device *netdev = adapter->netdev;
2956	struct qlcnic_host_rds_ring *rds_ring;
2957	struct qlcnic_host_sds_ring *sds_ring;
2958	struct qlcnic_host_tx_ring *tx_ring;
2959	int ring;
2960
2961	if (!netdev || !netif_running(netdev))
2962		return;
2963
2964	for (ring = 0; ring < adapter->max_rds_rings; ring++) {
2965		rds_ring = &recv_ctx->rds_rings[ring];
2966		if (!rds_ring)
2967			continue;
2968		netdev_info(netdev,
2969			    "rds_ring=%d crb_rcv_producer=%d producer=%u num_desc=%u\n",
2970			     ring, readl(rds_ring->crb_rcv_producer),
2971			     rds_ring->producer, rds_ring->num_desc);
2972	}
2973
2974	for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
2975		sds_ring = &(recv_ctx->sds_rings[ring]);
2976		if (!sds_ring)
2977			continue;
2978		netdev_info(netdev,
2979			    "sds_ring=%d crb_sts_consumer=%d consumer=%u crb_intr_mask=%d num_desc=%u\n",
2980			    ring, readl(sds_ring->crb_sts_consumer),
2981			    sds_ring->consumer, readl(sds_ring->crb_intr_mask),
2982			    sds_ring->num_desc);
2983	}
2984
2985	for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2986		tx_ring = &adapter->tx_ring[ring];
2987		if (!tx_ring)
2988			continue;
2989		netdev_info(netdev, "Tx ring=%d Context Id=0x%x\n",
2990			    ring, tx_ring->ctx_id);
2991		netdev_info(netdev,
2992			    "xmit_finished=%llu, xmit_called=%llu, xmit_on=%llu, xmit_off=%llu\n",
2993			    tx_ring->tx_stats.xmit_finished,
2994			    tx_ring->tx_stats.xmit_called,
2995			    tx_ring->tx_stats.xmit_on,
2996			    tx_ring->tx_stats.xmit_off);
2997
2998		if (tx_ring->crb_intr_mask)
2999			netdev_info(netdev, "crb_intr_mask=%d\n",
3000				    readl(tx_ring->crb_intr_mask));
3001
3002		netdev_info(netdev,
3003			    "hw_producer=%d, sw_producer=%d sw_consumer=%d, hw_consumer=%d\n",
3004			    readl(tx_ring->crb_cmd_producer),
3005			    tx_ring->producer, tx_ring->sw_consumer,
3006			    le32_to_cpu(*(tx_ring->hw_consumer)));
3007
3008		netdev_info(netdev, "Total desc=%d, Available desc=%d\n",
3009			    tx_ring->num_desc, qlcnic_tx_avail(tx_ring));
3010
3011		if (netif_msg_tx_err(adapter->ahw))
3012			dump_tx_ring_desc(tx_ring);
3013	}
3014
3015}
3016
3017static void qlcnic_tx_timeout(struct net_device *netdev, unsigned int txqueue)
3018{
3019	struct qlcnic_adapter *adapter = netdev_priv(netdev);
3020
3021	if (test_bit(__QLCNIC_RESETTING, &adapter->state))
3022		return;
3023
3024	qlcnic_dump_rings(adapter);
3025
3026	if (++adapter->tx_timeo_cnt >= QLCNIC_MAX_TX_TIMEOUTS ||
3027	    netif_msg_tx_err(adapter->ahw)) {
3028		netdev_err(netdev, "Tx timeout, reset the adapter.\n");
3029		if (qlcnic_82xx_check(adapter))
3030			adapter->need_fw_reset = 1;
3031		else if (qlcnic_83xx_check(adapter))
3032			qlcnic_83xx_idc_request_reset(adapter,
3033						      QLCNIC_FORCE_FW_DUMP_KEY);
3034	} else {
3035		netdev_err(netdev, "Tx timeout, reset adapter context.\n");
3036		adapter->ahw->reset_context = 1;
3037	}
3038}
3039
3040static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev)
3041{
3042	struct qlcnic_adapter *adapter = netdev_priv(netdev);
3043	struct net_device_stats *stats = &netdev->stats;
3044
3045	if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
3046		qlcnic_update_stats(adapter);
3047
3048	stats->rx_packets = adapter->stats.rx_pkts + adapter->stats.lro_pkts;
3049	stats->tx_packets = adapter->stats.xmitfinished;
3050	stats->rx_bytes = adapter->stats.rxbytes + adapter->stats.lrobytes;
3051	stats->tx_bytes = adapter->stats.txbytes;
3052	stats->rx_dropped = adapter->stats.rxdropped;
3053	stats->tx_dropped = adapter->stats.txdropped;
3054
3055	return stats;
3056}
3057
3058static irqreturn_t qlcnic_82xx_clear_legacy_intr(struct qlcnic_adapter *adapter)
3059{
3060	u32 status;
3061
3062	status = readl(adapter->isr_int_vec);
3063
3064	if (!(status & adapter->ahw->int_vec_bit))
3065		return IRQ_NONE;
3066
3067	/* check interrupt state machine, to be sure */
3068	status = readl(adapter->crb_int_state_reg);
3069	if (!ISR_LEGACY_INT_TRIGGERED(status))
3070		return IRQ_NONE;
3071
3072	writel(0xffffffff, adapter->tgt_status_reg);
3073	/* read twice to ensure write is flushed */
3074	readl(adapter->isr_int_vec);
3075	readl(adapter->isr_int_vec);
3076
3077	return IRQ_HANDLED;
3078}
3079
3080static irqreturn_t qlcnic_tmp_intr(int irq, void *data)
3081{
3082	struct qlcnic_host_sds_ring *sds_ring = data;
3083	struct qlcnic_adapter *adapter = sds_ring->adapter;
3084
3085	if (adapter->flags & QLCNIC_MSIX_ENABLED)
3086		goto done;
3087	else if (adapter->flags & QLCNIC_MSI_ENABLED) {
3088		writel(0xffffffff, adapter->tgt_status_reg);
3089		goto done;
3090	}
3091
3092	if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
3093		return IRQ_NONE;
3094
3095done:
3096	adapter->ahw->diag_cnt++;
3097	qlcnic_enable_sds_intr(adapter, sds_ring);
3098	return IRQ_HANDLED;
3099}
3100
3101static irqreturn_t qlcnic_intr(int irq, void *data)
3102{
3103	struct qlcnic_host_sds_ring *sds_ring = data;
3104	struct qlcnic_adapter *adapter = sds_ring->adapter;
3105
3106	if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
3107		return IRQ_NONE;
3108
3109	napi_schedule(&sds_ring->napi);
3110
3111	return IRQ_HANDLED;
3112}
3113
3114static irqreturn_t qlcnic_msi_intr(int irq, void *data)
3115{
3116	struct qlcnic_host_sds_ring *sds_ring = data;
3117	struct qlcnic_adapter *adapter = sds_ring->adapter;
3118
3119	/* clear interrupt */
3120	writel(0xffffffff, adapter->tgt_status_reg);
3121
3122	napi_schedule(&sds_ring->napi);
3123	return IRQ_HANDLED;
3124}
3125
3126static irqreturn_t qlcnic_msix_intr(int irq, void *data)
3127{
3128	struct qlcnic_host_sds_ring *sds_ring = data;
3129
3130	napi_schedule(&sds_ring->napi);
3131	return IRQ_HANDLED;
3132}
3133
3134static irqreturn_t qlcnic_msix_tx_intr(int irq, void *data)
3135{
3136	struct qlcnic_host_tx_ring *tx_ring = data;
3137
3138	napi_schedule(&tx_ring->napi);
3139	return IRQ_HANDLED;
3140}
3141
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
3142static void
3143qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding)
3144{
3145	u32 val;
3146
3147	val = adapter->portnum & 0xf;
3148	val |= encoding << 7;
3149	val |= (jiffies - adapter->dev_rst_time) << 8;
3150
3151	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_SCRATCH, val);
3152	adapter->dev_rst_time = jiffies;
3153}
3154
3155static int
3156qlcnic_set_drv_state(struct qlcnic_adapter *adapter, u8 state)
3157{
3158	u32  val;
3159
3160	WARN_ON(state != QLCNIC_DEV_NEED_RESET &&
3161			state != QLCNIC_DEV_NEED_QUISCENT);
3162
3163	if (qlcnic_api_lock(adapter))
3164		return -EIO;
3165
3166	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3167
3168	if (state == QLCNIC_DEV_NEED_RESET)
3169		QLC_DEV_SET_RST_RDY(val, adapter->portnum);
3170	else if (state == QLCNIC_DEV_NEED_QUISCENT)
3171		QLC_DEV_SET_QSCNT_RDY(val, adapter->portnum);
3172
3173	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3174
3175	qlcnic_api_unlock(adapter);
3176
3177	return 0;
3178}
3179
3180static int
3181qlcnic_clr_drv_state(struct qlcnic_adapter *adapter)
3182{
3183	u32  val;
3184
3185	if (qlcnic_api_lock(adapter))
3186		return -EBUSY;
3187
3188	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3189	QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
3190	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3191
3192	qlcnic_api_unlock(adapter);
3193
3194	return 0;
3195}
3196
3197void qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8 failed)
3198{
3199	u32  val;
3200
3201	if (qlcnic_api_lock(adapter))
3202		goto err;
3203
3204	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3205	QLC_DEV_CLR_REF_CNT(val, adapter->portnum);
3206	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
3207
3208	if (failed) {
3209		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3210				    QLCNIC_DEV_FAILED);
3211		dev_info(&adapter->pdev->dev,
3212				"Device state set to Failed. Please Reboot\n");
3213	} else if (!(val & 0x11111111))
3214		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3215				    QLCNIC_DEV_COLD);
3216
3217	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3218	QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
3219	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3220
3221	qlcnic_api_unlock(adapter);
3222err:
3223	adapter->fw_fail_cnt = 0;
3224	adapter->flags &= ~QLCNIC_FW_HANG;
3225	clear_bit(__QLCNIC_START_FW, &adapter->state);
3226	clear_bit(__QLCNIC_RESETTING, &adapter->state);
3227}
3228
3229/* Grab api lock, before checking state */
3230static int
3231qlcnic_check_drv_state(struct qlcnic_adapter *adapter)
3232{
3233	int act, state, active_mask;
3234	struct qlcnic_hardware_context *ahw = adapter->ahw;
3235
3236	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3237	act = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3238
3239	if (adapter->flags & QLCNIC_FW_RESET_OWNER) {
3240		active_mask = (~(1 << (ahw->pci_func * 4)));
3241		act = act & active_mask;
3242	}
3243
3244	if (((state & 0x11111111) == (act & 0x11111111)) ||
3245			((act & 0x11111111) == ((state >> 1) & 0x11111111)))
3246		return 0;
3247	else
3248		return 1;
3249}
3250
3251static int qlcnic_check_idc_ver(struct qlcnic_adapter *adapter)
3252{
3253	u32 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_IDC_VER);
3254
3255	if (val != QLCNIC_DRV_IDC_VER) {
3256		dev_warn(&adapter->pdev->dev, "IDC Version mismatch, driver's"
3257			" idc ver = %x; reqd = %x\n", QLCNIC_DRV_IDC_VER, val);
3258	}
3259
3260	return 0;
3261}
3262
3263static int
3264qlcnic_can_start_firmware(struct qlcnic_adapter *adapter)
3265{
3266	u32 val, prev_state;
3267	u8 dev_init_timeo = adapter->dev_init_timeo;
3268	u8 portnum = adapter->portnum;
3269	u8 ret;
3270
3271	if (test_and_clear_bit(__QLCNIC_START_FW, &adapter->state))
3272		return 1;
3273
3274	if (qlcnic_api_lock(adapter))
3275		return -1;
3276
3277	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3278	if (!(val & (1 << (portnum * 4)))) {
3279		QLC_DEV_SET_REF_CNT(val, portnum);
3280		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
3281	}
3282
3283	prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3284	QLCDB(adapter, HW, "Device state = %u\n", prev_state);
3285
3286	switch (prev_state) {
3287	case QLCNIC_DEV_COLD:
3288		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3289				    QLCNIC_DEV_INITIALIZING);
3290		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_IDC_VER,
3291				    QLCNIC_DRV_IDC_VER);
3292		qlcnic_idc_debug_info(adapter, 0);
3293		qlcnic_api_unlock(adapter);
3294		return 1;
3295
3296	case QLCNIC_DEV_READY:
3297		ret = qlcnic_check_idc_ver(adapter);
3298		qlcnic_api_unlock(adapter);
3299		return ret;
3300
3301	case QLCNIC_DEV_NEED_RESET:
3302		val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3303		QLC_DEV_SET_RST_RDY(val, portnum);
3304		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3305		break;
3306
3307	case QLCNIC_DEV_NEED_QUISCENT:
3308		val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3309		QLC_DEV_SET_QSCNT_RDY(val, portnum);
3310		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3311		break;
3312
3313	case QLCNIC_DEV_FAILED:
3314		dev_err(&adapter->pdev->dev, "Device in failed state.\n");
3315		qlcnic_api_unlock(adapter);
3316		return -1;
3317
3318	case QLCNIC_DEV_INITIALIZING:
3319	case QLCNIC_DEV_QUISCENT:
3320		break;
3321	}
3322
3323	qlcnic_api_unlock(adapter);
3324
3325	do {
3326		msleep(1000);
3327		prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
 
 
 
3328	} while ((prev_state != QLCNIC_DEV_READY) && --dev_init_timeo);
3329
3330	if (!dev_init_timeo) {
3331		dev_err(&adapter->pdev->dev,
3332			"Waiting for device to initialize timeout\n");
3333		return -1;
3334	}
3335
3336	if (qlcnic_api_lock(adapter))
3337		return -1;
3338
3339	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3340	QLC_DEV_CLR_RST_QSCNT(val, portnum);
3341	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3342
3343	ret = qlcnic_check_idc_ver(adapter);
3344	qlcnic_api_unlock(adapter);
3345
3346	return ret;
3347}
3348
3349static void
3350qlcnic_fwinit_work(struct work_struct *work)
3351{
3352	struct qlcnic_adapter *adapter = container_of(work,
3353			struct qlcnic_adapter, fw_work.work);
3354	u32 dev_state = 0xf;
3355	u32 val;
3356
3357	if (qlcnic_api_lock(adapter))
3358		goto err_ret;
3359
3360	dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3361	if (dev_state == QLCNIC_DEV_QUISCENT ||
3362	    dev_state == QLCNIC_DEV_NEED_QUISCENT) {
3363		qlcnic_api_unlock(adapter);
3364		qlcnic_schedule_work(adapter, qlcnic_fwinit_work,
3365						FW_POLL_DELAY * 2);
3366		return;
3367	}
3368
3369	if (adapter->ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
3370		qlcnic_api_unlock(adapter);
3371		goto wait_npar;
3372	}
3373
3374	if (dev_state == QLCNIC_DEV_INITIALIZING ||
3375	    dev_state == QLCNIC_DEV_READY) {
3376		dev_info(&adapter->pdev->dev, "Detected state change from "
3377				"DEV_NEED_RESET, skipping ack check\n");
3378		goto skip_ack_check;
3379	}
3380
3381	if (adapter->fw_wait_cnt++ > adapter->reset_ack_timeo) {
3382		dev_info(&adapter->pdev->dev, "Reset:Failed to get ack %d sec\n",
3383					adapter->reset_ack_timeo);
3384		goto skip_ack_check;
3385	}
3386
3387	if (!qlcnic_check_drv_state(adapter)) {
3388skip_ack_check:
3389		dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3390
3391		if (dev_state == QLCNIC_DEV_NEED_RESET) {
3392			QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3393					    QLCNIC_DEV_INITIALIZING);
3394			set_bit(__QLCNIC_START_FW, &adapter->state);
3395			QLCDB(adapter, DRV, "Restarting fw\n");
3396			qlcnic_idc_debug_info(adapter, 0);
3397			val = QLC_SHARED_REG_RD32(adapter,
3398						  QLCNIC_CRB_DRV_STATE);
3399			QLC_DEV_SET_RST_RDY(val, adapter->portnum);
3400			QLC_SHARED_REG_WR32(adapter,
3401					    QLCNIC_CRB_DRV_STATE, val);
3402		}
3403
3404		qlcnic_api_unlock(adapter);
3405
3406		rtnl_lock();
3407		if (qlcnic_check_fw_dump_state(adapter) &&
3408		    (adapter->flags & QLCNIC_FW_RESET_OWNER)) {
3409			QLCDB(adapter, DRV, "Take FW dump\n");
3410			qlcnic_dump_fw(adapter);
3411			adapter->flags |= QLCNIC_FW_HANG;
3412		}
3413		rtnl_unlock();
3414
3415		adapter->flags &= ~QLCNIC_FW_RESET_OWNER;
3416		if (!adapter->nic_ops->start_firmware(adapter)) {
3417			qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
3418			adapter->fw_wait_cnt = 0;
3419			return;
3420		}
3421		goto err_ret;
3422	}
3423
3424	qlcnic_api_unlock(adapter);
3425
3426wait_npar:
3427	dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3428	QLCDB(adapter, HW, "Func waiting: Device state=%u\n", dev_state);
3429
3430	switch (dev_state) {
3431	case QLCNIC_DEV_READY:
3432		if (!qlcnic_start_firmware(adapter)) {
3433			qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
3434			adapter->fw_wait_cnt = 0;
3435			return;
3436		}
3437		break;
3438	case QLCNIC_DEV_FAILED:
3439		break;
3440	default:
3441		qlcnic_schedule_work(adapter,
3442			qlcnic_fwinit_work, FW_POLL_DELAY);
3443		return;
3444	}
3445
3446err_ret:
3447	dev_err(&adapter->pdev->dev, "Fwinit work failed state=%u "
3448		"fw_wait_cnt=%u\n", dev_state, adapter->fw_wait_cnt);
3449	netif_device_attach(adapter->netdev);
3450	qlcnic_clr_all_drv_state(adapter, 0);
3451}
3452
3453static void
3454qlcnic_detach_work(struct work_struct *work)
3455{
3456	struct qlcnic_adapter *adapter = container_of(work,
3457			struct qlcnic_adapter, fw_work.work);
3458	struct net_device *netdev = adapter->netdev;
3459	u32 status;
3460
3461	netif_device_detach(netdev);
3462
3463	/* Dont grab rtnl lock during Quiscent mode */
3464	if (adapter->dev_state == QLCNIC_DEV_NEED_QUISCENT) {
3465		if (netif_running(netdev))
3466			__qlcnic_down(adapter, netdev);
3467	} else
3468		qlcnic_down(adapter, netdev);
3469
3470	status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
3471
3472	if (status & QLCNIC_RCODE_FATAL_ERROR) {
3473		dev_err(&adapter->pdev->dev,
3474			"Detaching the device: peg halt status1=0x%x\n",
3475					status);
3476
3477		if (QLCNIC_FWERROR_CODE(status) == QLCNIC_FWERROR_FAN_FAILURE) {
3478			dev_err(&adapter->pdev->dev,
3479			"On board active cooling fan failed. "
3480				"Device has been halted.\n");
3481			dev_err(&adapter->pdev->dev,
3482				"Replace the adapter.\n");
3483		}
3484
3485		goto err_ret;
3486	}
3487
3488	if (adapter->ahw->temp == QLCNIC_TEMP_PANIC) {
3489		dev_err(&adapter->pdev->dev, "Detaching the device: temp=%d\n",
3490			adapter->ahw->temp);
3491		goto err_ret;
3492	}
3493
3494	/* Dont ack if this instance is the reset owner */
3495	if (!(adapter->flags & QLCNIC_FW_RESET_OWNER)) {
3496		if (qlcnic_set_drv_state(adapter, adapter->dev_state)) {
3497			dev_err(&adapter->pdev->dev,
3498				"Failed to set driver state,"
3499					"detaching the device.\n");
3500			goto err_ret;
3501		}
3502	}
3503
3504	adapter->fw_wait_cnt = 0;
3505
3506	qlcnic_schedule_work(adapter, qlcnic_fwinit_work, FW_POLL_DELAY);
3507
3508	return;
3509
3510err_ret:
3511	netif_device_attach(netdev);
3512	qlcnic_clr_all_drv_state(adapter, 1);
3513}
3514
3515/*Transit NPAR state to NON Operational */
3516static void
3517qlcnic_set_npar_non_operational(struct qlcnic_adapter *adapter)
3518{
3519	u32 state;
3520
3521	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
3522	if (state == QLCNIC_DEV_NPAR_NON_OPER)
3523		return;
3524
3525	if (qlcnic_api_lock(adapter))
3526		return;
3527	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3528			    QLCNIC_DEV_NPAR_NON_OPER);
3529	qlcnic_api_unlock(adapter);
3530}
3531
3532static void qlcnic_82xx_dev_request_reset(struct qlcnic_adapter *adapter,
3533					  u32 key)
3534{
3535	u32 state, xg_val = 0, gb_val = 0;
3536
3537	qlcnic_xg_set_xg0_mask(xg_val);
3538	qlcnic_xg_set_xg1_mask(xg_val);
3539	QLCWR32(adapter, QLCNIC_NIU_XG_PAUSE_CTL, xg_val);
3540	qlcnic_gb_set_gb0_mask(gb_val);
3541	qlcnic_gb_set_gb1_mask(gb_val);
3542	qlcnic_gb_set_gb2_mask(gb_val);
3543	qlcnic_gb_set_gb3_mask(gb_val);
3544	QLCWR32(adapter, QLCNIC_NIU_GB_PAUSE_CTL, gb_val);
3545	dev_info(&adapter->pdev->dev, "Pause control frames disabled"
3546				" on all ports\n");
3547	adapter->need_fw_reset = 1;
3548
3549	if (qlcnic_api_lock(adapter))
3550		return;
3551
3552	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3553
3554	if (test_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state)) {
3555		netdev_err(adapter->netdev, "%s: Device is in non-operational state\n",
3556			   __func__);
3557		qlcnic_api_unlock(adapter);
3558
3559		return;
3560	}
3561
3562	if (state == QLCNIC_DEV_READY) {
3563		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3564				    QLCNIC_DEV_NEED_RESET);
3565		adapter->flags |= QLCNIC_FW_RESET_OWNER;
3566		QLCDB(adapter, DRV, "NEED_RESET state set\n");
3567		qlcnic_idc_debug_info(adapter, 0);
3568	}
3569
3570	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3571			    QLCNIC_DEV_NPAR_NON_OPER);
3572	qlcnic_api_unlock(adapter);
3573}
3574
3575/* Transit to NPAR READY state from NPAR NOT READY state */
3576static void
3577qlcnic_dev_set_npar_ready(struct qlcnic_adapter *adapter)
3578{
3579	if (qlcnic_api_lock(adapter))
3580		return;
3581
3582	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3583			    QLCNIC_DEV_NPAR_OPER);
3584	QLCDB(adapter, DRV, "NPAR operational state set\n");
3585
3586	qlcnic_api_unlock(adapter);
3587}
3588
3589void qlcnic_schedule_work(struct qlcnic_adapter *adapter,
3590			  work_func_t func, int delay)
3591{
3592	if (test_bit(__QLCNIC_AER, &adapter->state))
3593		return;
3594
3595	INIT_DELAYED_WORK(&adapter->fw_work, func);
3596	queue_delayed_work(adapter->qlcnic_wq, &adapter->fw_work,
3597			   round_jiffies_relative(delay));
3598}
3599
3600static void
3601qlcnic_attach_work(struct work_struct *work)
3602{
3603	struct qlcnic_adapter *adapter = container_of(work,
3604				struct qlcnic_adapter, fw_work.work);
3605	struct net_device *netdev = adapter->netdev;
3606	u32 npar_state;
3607
3608	if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
3609		npar_state = QLC_SHARED_REG_RD32(adapter,
3610						 QLCNIC_CRB_DEV_NPAR_STATE);
3611		if (adapter->fw_wait_cnt++ > QLCNIC_DEV_NPAR_OPER_TIMEO)
3612			qlcnic_clr_all_drv_state(adapter, 0);
3613		else if (npar_state != QLCNIC_DEV_NPAR_OPER)
3614			qlcnic_schedule_work(adapter, qlcnic_attach_work,
3615							FW_POLL_DELAY);
3616		else
3617			goto attach;
3618		QLCDB(adapter, DRV, "Waiting for NPAR state to operational\n");
3619		return;
3620	}
3621attach:
3622	qlcnic_dcb_get_info(adapter->dcb);
3623
3624	if (netif_running(netdev)) {
3625		if (qlcnic_up(adapter, netdev))
3626			goto done;
3627
3628		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3629	}
3630
3631done:
3632	netif_device_attach(netdev);
3633	adapter->fw_fail_cnt = 0;
3634	adapter->flags &= ~QLCNIC_FW_HANG;
3635	clear_bit(__QLCNIC_RESETTING, &adapter->state);
3636	if (adapter->portnum == 0)
3637		qlcnic_set_drv_version(adapter);
3638
3639	if (!qlcnic_clr_drv_state(adapter))
3640		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3641							FW_POLL_DELAY);
3642}
3643
3644static int
3645qlcnic_check_health(struct qlcnic_adapter *adapter)
3646{
3647	struct qlcnic_hardware_context *ahw = adapter->ahw;
3648	struct qlcnic_fw_dump *fw_dump = &ahw->fw_dump;
3649	u32 state = 0, heartbeat;
3650	u32 peg_status;
3651	int err = 0;
3652
3653	if (qlcnic_check_temp(adapter))
3654		goto detach;
3655
3656	if (adapter->need_fw_reset)
3657		qlcnic_dev_request_reset(adapter, 0);
3658
3659	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3660	if (state == QLCNIC_DEV_NEED_RESET) {
3661		qlcnic_set_npar_non_operational(adapter);
3662		adapter->need_fw_reset = 1;
3663	} else if (state == QLCNIC_DEV_NEED_QUISCENT)
3664		goto detach;
3665
3666	heartbeat = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_ALIVE_COUNTER);
3667	if (heartbeat != adapter->heartbeat) {
3668		adapter->heartbeat = heartbeat;
3669		adapter->fw_fail_cnt = 0;
3670		if (adapter->need_fw_reset)
3671			goto detach;
3672
3673		if (ahw->reset_context && qlcnic_auto_fw_reset)
3674			qlcnic_reset_hw_context(adapter);
3675
3676		return 0;
3677	}
3678
3679	if (++adapter->fw_fail_cnt < FW_FAIL_THRESH)
3680		return 0;
3681
3682	adapter->flags |= QLCNIC_FW_HANG;
3683
3684	qlcnic_dev_request_reset(adapter, 0);
3685
3686	if (qlcnic_auto_fw_reset)
3687		clear_bit(__QLCNIC_FW_ATTACHED, &adapter->state);
3688
3689	dev_err(&adapter->pdev->dev, "firmware hang detected\n");
3690	peg_status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
3691	dev_err(&adapter->pdev->dev, "Dumping hw/fw registers\n"
3692			"PEG_HALT_STATUS1: 0x%x, PEG_HALT_STATUS2: 0x%x,\n"
3693			"PEG_NET_0_PC: 0x%x, PEG_NET_1_PC: 0x%x,\n"
3694			"PEG_NET_2_PC: 0x%x, PEG_NET_3_PC: 0x%x,\n"
3695			"PEG_NET_4_PC: 0x%x\n",
3696			peg_status,
3697			QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS2),
3698			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_0 + 0x3c, &err),
3699			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_1 + 0x3c, &err),
3700			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_2 + 0x3c, &err),
3701			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_3 + 0x3c, &err),
3702			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_4 + 0x3c, &err));
3703	if (QLCNIC_FWERROR_CODE(peg_status) == 0x67)
3704		dev_err(&adapter->pdev->dev,
3705			"Firmware aborted with error code 0x00006700. "
3706				"Device is being reset.\n");
3707detach:
3708	adapter->dev_state = (state == QLCNIC_DEV_NEED_QUISCENT) ? state :
3709		QLCNIC_DEV_NEED_RESET;
3710
3711	if (qlcnic_auto_fw_reset && !test_and_set_bit(__QLCNIC_RESETTING,
3712						      &adapter->state)) {
3713
3714		qlcnic_schedule_work(adapter, qlcnic_detach_work, 0);
3715		QLCDB(adapter, DRV, "fw recovery scheduled.\n");
3716	} else if (!qlcnic_auto_fw_reset && fw_dump->enable &&
3717		   adapter->flags & QLCNIC_FW_RESET_OWNER) {
3718		qlcnic_dump_fw(adapter);
3719	}
3720
3721	return 1;
3722}
3723
3724void qlcnic_fw_poll_work(struct work_struct *work)
3725{
3726	struct qlcnic_adapter *adapter = container_of(work,
3727				struct qlcnic_adapter, fw_work.work);
3728
3729	if (test_bit(__QLCNIC_RESETTING, &adapter->state))
3730		goto reschedule;
3731
3732
3733	if (qlcnic_check_health(adapter))
3734		return;
3735
3736	if (adapter->fhash.fnum)
3737		qlcnic_prune_lb_filters(adapter);
3738
3739reschedule:
3740	qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
3741}
3742
3743static int qlcnic_is_first_func(struct pci_dev *pdev)
3744{
3745	struct pci_dev *oth_pdev;
3746	int val = pdev->devfn;
3747
3748	while (val-- > 0) {
3749		oth_pdev = pci_get_domain_bus_and_slot(pci_domain_nr
3750			(pdev->bus), pdev->bus->number,
3751			PCI_DEVFN(PCI_SLOT(pdev->devfn), val));
3752		if (!oth_pdev)
3753			continue;
3754
3755		if (oth_pdev->current_state != PCI_D3cold) {
3756			pci_dev_put(oth_pdev);
3757			return 0;
3758		}
3759		pci_dev_put(oth_pdev);
3760	}
3761	return 1;
3762}
3763
3764static int qlcnic_attach_func(struct pci_dev *pdev)
3765{
3766	int err, first_func;
3767	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3768	struct net_device *netdev = adapter->netdev;
3769
3770	pdev->error_state = pci_channel_io_normal;
3771
3772	err = pci_enable_device(pdev);
3773	if (err)
3774		return err;
3775
3776	pci_set_master(pdev);
3777	pci_restore_state(pdev);
3778
3779	first_func = qlcnic_is_first_func(pdev);
3780
3781	if (qlcnic_api_lock(adapter))
3782		return -EINVAL;
3783
3784	if (adapter->ahw->op_mode != QLCNIC_NON_PRIV_FUNC && first_func) {
3785		adapter->need_fw_reset = 1;
3786		set_bit(__QLCNIC_START_FW, &adapter->state);
3787		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3788				    QLCNIC_DEV_INITIALIZING);
3789		QLCDB(adapter, DRV, "Restarting fw\n");
3790	}
3791	qlcnic_api_unlock(adapter);
3792
3793	err = qlcnic_start_firmware(adapter);
3794	if (err)
3795		return err;
3796
3797	qlcnic_clr_drv_state(adapter);
3798	kfree(adapter->msix_entries);
3799	adapter->msix_entries = NULL;
3800	err = qlcnic_setup_intr(adapter);
3801
3802	if (err) {
3803		kfree(adapter->msix_entries);
3804		netdev_err(netdev, "failed to setup interrupt\n");
3805		return err;
3806	}
3807
3808	if (netif_running(netdev)) {
3809		err = qlcnic_attach(adapter);
3810		if (err) {
3811			qlcnic_clr_all_drv_state(adapter, 1);
3812			clear_bit(__QLCNIC_AER, &adapter->state);
3813			netif_device_attach(netdev);
3814			return err;
3815		}
3816
3817		err = qlcnic_up(adapter, netdev);
3818		if (err)
3819			goto done;
3820
3821		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3822	}
3823 done:
3824	netif_device_attach(netdev);
3825	return err;
3826}
3827
3828static pci_ers_result_t qlcnic_82xx_io_error_detected(struct pci_dev *pdev,
3829						      pci_channel_state_t state)
3830{
3831	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3832	struct net_device *netdev = adapter->netdev;
3833
3834	if (state == pci_channel_io_perm_failure)
3835		return PCI_ERS_RESULT_DISCONNECT;
3836
3837	if (state == pci_channel_io_normal)
3838		return PCI_ERS_RESULT_RECOVERED;
3839
3840	set_bit(__QLCNIC_AER, &adapter->state);
3841	netif_device_detach(netdev);
3842
3843	cancel_delayed_work_sync(&adapter->fw_work);
3844
3845	if (netif_running(netdev))
3846		qlcnic_down(adapter, netdev);
3847
3848	qlcnic_detach(adapter);
3849	qlcnic_teardown_intr(adapter);
3850
3851	clear_bit(__QLCNIC_RESETTING, &adapter->state);
3852
3853	pci_save_state(pdev);
3854	pci_disable_device(pdev);
3855
3856	return PCI_ERS_RESULT_NEED_RESET;
3857}
3858
3859static pci_ers_result_t qlcnic_82xx_io_slot_reset(struct pci_dev *pdev)
3860{
3861	pci_ers_result_t res;
3862
3863	rtnl_lock();
3864	res = qlcnic_attach_func(pdev) ? PCI_ERS_RESULT_DISCONNECT :
3865					 PCI_ERS_RESULT_RECOVERED;
3866	rtnl_unlock();
3867
3868	return res;
3869}
3870
3871static void qlcnic_82xx_io_resume(struct pci_dev *pdev)
3872{
3873	u32 state;
3874	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3875
 
3876	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3877	if (state == QLCNIC_DEV_READY && test_and_clear_bit(__QLCNIC_AER,
3878							    &adapter->state))
3879		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3880				     FW_POLL_DELAY);
3881}
3882
3883static pci_ers_result_t qlcnic_io_error_detected(struct pci_dev *pdev,
3884						 pci_channel_state_t state)
3885{
3886	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3887	struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
3888
3889	if (hw_ops->io_error_detected) {
3890		return hw_ops->io_error_detected(pdev, state);
3891	} else {
3892		dev_err(&pdev->dev, "AER error_detected handler not registered.\n");
3893		return PCI_ERS_RESULT_DISCONNECT;
3894	}
3895}
3896
3897static pci_ers_result_t qlcnic_io_slot_reset(struct pci_dev *pdev)
3898{
3899	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3900	struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
3901
3902	if (hw_ops->io_slot_reset) {
3903		return hw_ops->io_slot_reset(pdev);
3904	} else {
3905		dev_err(&pdev->dev, "AER slot_reset handler not registered.\n");
3906		return PCI_ERS_RESULT_DISCONNECT;
3907	}
3908}
3909
3910static void qlcnic_io_resume(struct pci_dev *pdev)
3911{
3912	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3913	struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
3914
3915	if (hw_ops->io_resume)
3916		hw_ops->io_resume(pdev);
3917	else
3918		dev_err(&pdev->dev, "AER resume handler not registered.\n");
3919}
3920
3921
3922static int
3923qlcnicvf_start_firmware(struct qlcnic_adapter *adapter)
3924{
3925	int err;
3926
3927	err = qlcnic_can_start_firmware(adapter);
3928	if (err)
3929		return err;
3930
3931	err = qlcnic_check_npar_opertional(adapter);
3932	if (err)
3933		return err;
3934
3935	err = qlcnic_initialize_nic(adapter);
3936	if (err)
3937		return err;
3938
3939	qlcnic_check_options(adapter);
3940
3941	err = qlcnic_set_eswitch_port_config(adapter);
3942	if (err)
3943		return err;
3944
3945	adapter->need_fw_reset = 0;
3946
3947	return err;
3948}
3949
3950int qlcnic_validate_rings(struct qlcnic_adapter *adapter, __u32 ring_cnt,
3951			  int queue_type)
3952{
3953	struct net_device *netdev = adapter->netdev;
 
3954	char buf[8];
 
3955
3956	if (queue_type == QLCNIC_RX_QUEUE)
 
 
3957		strcpy(buf, "SDS");
3958	else
 
 
3959		strcpy(buf, "Tx");
 
3960
3961	if (!is_power_of_2(ring_cnt)) {
3962		netdev_err(netdev, "%s rings value should be a power of 2\n",
3963			   buf);
3964		return -EINVAL;
3965	}
3966
3967	if (qlcnic_82xx_check(adapter) && (queue_type == QLCNIC_TX_QUEUE) &&
3968	    !qlcnic_check_multi_tx(adapter)) {
3969			netdev_err(netdev, "No Multi Tx queue support\n");
3970			return -EINVAL;
3971	}
3972
3973	if (ring_cnt > num_online_cpus()) {
3974		netdev_err(netdev,
3975			   "%s value[%u] should not be higher than, number of online CPUs\n",
3976			   buf, num_online_cpus());
3977		return -EINVAL;
3978	}
3979
3980	return 0;
3981}
3982
3983int qlcnic_setup_rings(struct qlcnic_adapter *adapter)
3984{
3985	struct net_device *netdev = adapter->netdev;
3986	u8 tx_rings, rx_rings;
3987	int err;
3988
3989	if (test_bit(__QLCNIC_RESETTING, &adapter->state))
3990		return -EBUSY;
3991
3992	tx_rings = adapter->drv_tss_rings;
3993	rx_rings = adapter->drv_rss_rings;
3994
3995	netif_device_detach(netdev);
3996
3997	err = qlcnic_set_real_num_queues(adapter, tx_rings, rx_rings);
3998	if (err)
3999		goto done;
4000
4001	if (netif_running(netdev))
4002		__qlcnic_down(adapter, netdev);
4003
4004	qlcnic_detach(adapter);
4005
4006	if (qlcnic_83xx_check(adapter)) {
4007		qlcnic_83xx_free_mbx_intr(adapter);
4008		qlcnic_83xx_enable_mbx_poll(adapter);
4009	}
4010
4011	qlcnic_teardown_intr(adapter);
4012
4013	err = qlcnic_setup_intr(adapter);
4014	if (err) {
4015		kfree(adapter->msix_entries);
4016		netdev_err(netdev, "failed to setup interrupt\n");
4017		return err;
4018	}
4019
4020	/* Check if we need to update real_num_{tx|rx}_queues because
4021	 * qlcnic_setup_intr() may change Tx/Rx rings size
4022	 */
4023	if ((tx_rings != adapter->drv_tx_rings) ||
4024	    (rx_rings != adapter->drv_sds_rings)) {
4025		err = qlcnic_set_real_num_queues(adapter,
4026						 adapter->drv_tx_rings,
4027						 adapter->drv_sds_rings);
4028		if (err)
4029			goto done;
4030	}
4031
4032	if (qlcnic_83xx_check(adapter)) {
4033		qlcnic_83xx_initialize_nic(adapter, 1);
4034		err = qlcnic_83xx_setup_mbx_intr(adapter);
4035		qlcnic_83xx_disable_mbx_poll(adapter);
4036		if (err) {
4037			dev_err(&adapter->pdev->dev,
4038				"failed to setup mbx interrupt\n");
4039			goto done;
4040		}
4041	}
4042
4043	if (netif_running(netdev)) {
4044		err = qlcnic_attach(adapter);
4045		if (err)
4046			goto done;
4047		err = __qlcnic_up(adapter, netdev);
4048		if (err)
4049			goto done;
4050		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
4051	}
4052done:
4053	netif_device_attach(netdev);
4054	clear_bit(__QLCNIC_RESETTING, &adapter->state);
4055	return err;
4056}
4057
4058#ifdef CONFIG_INET
4059
4060#define is_qlcnic_netdev(dev) (dev->netdev_ops == &qlcnic_netdev_ops)
4061
4062static void
4063qlcnic_config_indev_addr(struct qlcnic_adapter *adapter,
4064			struct net_device *dev, unsigned long event)
4065{
4066	const struct in_ifaddr *ifa;
4067	struct in_device *indev;
4068
4069	indev = in_dev_get(dev);
4070	if (!indev)
4071		return;
4072
4073	in_dev_for_each_ifa_rtnl(ifa, indev) {
4074		switch (event) {
4075		case NETDEV_UP:
4076			qlcnic_config_ipaddr(adapter,
4077					ifa->ifa_address, QLCNIC_IP_UP);
4078			break;
4079		case NETDEV_DOWN:
4080			qlcnic_config_ipaddr(adapter,
4081					ifa->ifa_address, QLCNIC_IP_DOWN);
4082			break;
4083		default:
4084			break;
4085		}
4086	}
4087
4088	in_dev_put(indev);
4089}
4090
4091void qlcnic_restore_indev_addr(struct net_device *netdev, unsigned long event)
4092{
4093	struct qlcnic_adapter *adapter = netdev_priv(netdev);
4094	struct net_device *dev;
4095	u16 vid;
4096
4097	qlcnic_config_indev_addr(adapter, netdev, event);
4098
4099	rcu_read_lock();
4100	for_each_set_bit(vid, adapter->vlans, VLAN_N_VID) {
4101		dev = __vlan_find_dev_deep_rcu(netdev, htons(ETH_P_8021Q), vid);
4102		if (!dev)
4103			continue;
4104		qlcnic_config_indev_addr(adapter, dev, event);
4105	}
4106	rcu_read_unlock();
4107}
4108
4109static int qlcnic_netdev_event(struct notifier_block *this,
4110				 unsigned long event, void *ptr)
4111{
4112	struct qlcnic_adapter *adapter;
4113	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
4114
4115recheck:
4116	if (dev == NULL)
4117		goto done;
4118
4119	if (is_vlan_dev(dev)) {
4120		dev = vlan_dev_real_dev(dev);
4121		goto recheck;
4122	}
4123
4124	if (!is_qlcnic_netdev(dev))
4125		goto done;
4126
4127	adapter = netdev_priv(dev);
4128
4129	if (!adapter)
4130		goto done;
4131
4132	if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
4133		goto done;
4134
4135	qlcnic_config_indev_addr(adapter, dev, event);
4136done:
4137	return NOTIFY_DONE;
4138}
4139
4140static int
4141qlcnic_inetaddr_event(struct notifier_block *this,
4142		unsigned long event, void *ptr)
4143{
4144	struct qlcnic_adapter *adapter;
4145	struct net_device *dev;
4146
4147	struct in_ifaddr *ifa = (struct in_ifaddr *)ptr;
4148
4149	dev = ifa->ifa_dev->dev;
4150
4151recheck:
4152	if (dev == NULL)
4153		goto done;
4154
4155	if (is_vlan_dev(dev)) {
4156		dev = vlan_dev_real_dev(dev);
4157		goto recheck;
4158	}
4159
4160	if (!is_qlcnic_netdev(dev))
4161		goto done;
4162
4163	adapter = netdev_priv(dev);
4164
4165	if (!adapter)
4166		goto done;
4167
4168	if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
4169		goto done;
4170
4171	switch (event) {
4172	case NETDEV_UP:
4173		qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_UP);
4174
4175		break;
4176	case NETDEV_DOWN:
4177		qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_DOWN);
4178
4179		break;
4180	default:
4181		break;
4182	}
4183
4184done:
4185	return NOTIFY_DONE;
4186}
4187
4188static struct notifier_block	qlcnic_netdev_cb = {
4189	.notifier_call = qlcnic_netdev_event,
4190};
4191
4192static struct notifier_block qlcnic_inetaddr_cb = {
4193	.notifier_call = qlcnic_inetaddr_event,
4194};
4195#else
4196void qlcnic_restore_indev_addr(struct net_device *dev, unsigned long event)
4197{ }
4198#endif
4199static const struct pci_error_handlers qlcnic_err_handler = {
4200	.error_detected = qlcnic_io_error_detected,
4201	.slot_reset = qlcnic_io_slot_reset,
4202	.resume = qlcnic_io_resume,
4203};
4204
4205static SIMPLE_DEV_PM_OPS(qlcnic_pm_ops, qlcnic_suspend, qlcnic_resume);
4206
4207static struct pci_driver qlcnic_driver = {
4208	.name = qlcnic_driver_name,
4209	.id_table = qlcnic_pci_tbl,
4210	.probe = qlcnic_probe,
4211	.remove = qlcnic_remove,
4212	.driver.pm = &qlcnic_pm_ops,
 
 
 
4213	.shutdown = qlcnic_shutdown,
4214	.err_handler = &qlcnic_err_handler,
4215#ifdef CONFIG_QLCNIC_SRIOV
4216	.sriov_configure = qlcnic_pci_sriov_configure,
4217#endif
4218
4219};
4220
4221static int __init qlcnic_init_module(void)
4222{
4223	int ret;
4224
4225	printk(KERN_INFO "%s\n", qlcnic_driver_string);
4226
4227#ifdef CONFIG_INET
4228	register_netdevice_notifier(&qlcnic_netdev_cb);
4229	register_inetaddr_notifier(&qlcnic_inetaddr_cb);
4230#endif
4231
4232	ret = pci_register_driver(&qlcnic_driver);
4233	if (ret) {
4234#ifdef CONFIG_INET
4235		unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4236		unregister_netdevice_notifier(&qlcnic_netdev_cb);
4237#endif
4238	}
4239
4240	return ret;
4241}
4242
4243module_init(qlcnic_init_module);
4244
4245static void __exit qlcnic_exit_module(void)
4246{
4247	pci_unregister_driver(&qlcnic_driver);
4248
4249#ifdef CONFIG_INET
4250	unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4251	unregister_netdevice_notifier(&qlcnic_netdev_cb);
4252#endif
4253}
4254
4255module_exit(qlcnic_exit_module);
v4.17
 
   1/*
   2 * QLogic qlcnic NIC Driver
   3 * Copyright (c) 2009-2013 QLogic Corporation
   4 *
   5 * See LICENSE.qlcnic for copyright and licensing details.
   6 */
   7
   8#include <linux/vmalloc.h>
   9#include <linux/interrupt.h>
  10#include <linux/swab.h>
  11#include <linux/dma-mapping.h>
  12#include <linux/if_vlan.h>
  13#include <net/ip.h>
  14#include <linux/ipv6.h>
  15#include <linux/inetdevice.h>
  16#include <linux/aer.h>
  17#include <linux/log2.h>
  18#include <linux/pci.h>
  19#include <net/vxlan.h>
  20
  21#include "qlcnic.h"
  22#include "qlcnic_sriov.h"
  23#include "qlcnic_hw.h"
  24
  25MODULE_DESCRIPTION("QLogic 1/10 GbE Converged/Intelligent Ethernet Driver");
  26MODULE_LICENSE("GPL");
  27MODULE_VERSION(QLCNIC_LINUX_VERSIONID);
  28MODULE_FIRMWARE(QLCNIC_UNIFIED_ROMIMAGE_NAME);
  29
  30char qlcnic_driver_name[] = "qlcnic";
  31static const char qlcnic_driver_string[] = "QLogic 1/10 GbE "
  32	"Converged/Intelligent Ethernet Driver v" QLCNIC_LINUX_VERSIONID;
  33
  34static int qlcnic_mac_learn;
  35module_param(qlcnic_mac_learn, int, 0444);
  36MODULE_PARM_DESC(qlcnic_mac_learn,
  37		 "Mac Filter (0=learning is disabled, 1=Driver learning is enabled, 2=FDB learning is enabled)");
  38
  39int qlcnic_use_msi = 1;
  40MODULE_PARM_DESC(use_msi, "MSI interrupt (0=disabled, 1=enabled)");
  41module_param_named(use_msi, qlcnic_use_msi, int, 0444);
  42
  43int qlcnic_use_msi_x = 1;
  44MODULE_PARM_DESC(use_msi_x, "MSI-X interrupt (0=disabled, 1=enabled)");
  45module_param_named(use_msi_x, qlcnic_use_msi_x, int, 0444);
  46
  47int qlcnic_auto_fw_reset = 1;
  48MODULE_PARM_DESC(auto_fw_reset, "Auto firmware reset (0=disabled, 1=enabled)");
  49module_param_named(auto_fw_reset, qlcnic_auto_fw_reset, int, 0644);
  50
  51int qlcnic_load_fw_file;
  52MODULE_PARM_DESC(load_fw_file, "Load firmware from (0=flash, 1=file, 2=POST in fast mode, 3= POST in medium mode, 4=POST in slow mode)");
  53module_param_named(load_fw_file, qlcnic_load_fw_file, int, 0444);
  54
  55static int qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent);
  56static void qlcnic_remove(struct pci_dev *pdev);
  57static int qlcnic_open(struct net_device *netdev);
  58static int qlcnic_close(struct net_device *netdev);
  59static void qlcnic_tx_timeout(struct net_device *netdev);
  60static void qlcnic_attach_work(struct work_struct *work);
  61static void qlcnic_fwinit_work(struct work_struct *work);
  62#ifdef CONFIG_NET_POLL_CONTROLLER
  63static void qlcnic_poll_controller(struct net_device *netdev);
  64#endif
  65
  66static void qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding);
  67static int qlcnic_can_start_firmware(struct qlcnic_adapter *adapter);
  68
  69static irqreturn_t qlcnic_tmp_intr(int irq, void *data);
  70static irqreturn_t qlcnic_intr(int irq, void *data);
  71static irqreturn_t qlcnic_msi_intr(int irq, void *data);
  72static irqreturn_t qlcnic_msix_intr(int irq, void *data);
  73static irqreturn_t qlcnic_msix_tx_intr(int irq, void *data);
  74
  75static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev);
  76static int qlcnic_start_firmware(struct qlcnic_adapter *);
  77
  78static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter);
  79static void qlcnic_dev_set_npar_ready(struct qlcnic_adapter *);
  80static int qlcnicvf_start_firmware(struct qlcnic_adapter *);
  81static int qlcnic_vlan_rx_add(struct net_device *, __be16, u16);
  82static int qlcnic_vlan_rx_del(struct net_device *, __be16, u16);
  83
  84static int qlcnic_82xx_setup_intr(struct qlcnic_adapter *);
  85static void qlcnic_82xx_dev_request_reset(struct qlcnic_adapter *, u32);
  86static irqreturn_t qlcnic_82xx_clear_legacy_intr(struct qlcnic_adapter *);
  87static pci_ers_result_t qlcnic_82xx_io_slot_reset(struct pci_dev *);
  88static int qlcnic_82xx_start_firmware(struct qlcnic_adapter *);
  89static void qlcnic_82xx_io_resume(struct pci_dev *);
  90static void qlcnic_82xx_set_mac_filter_count(struct qlcnic_adapter *);
  91static pci_ers_result_t qlcnic_82xx_io_error_detected(struct pci_dev *,
  92						      pci_channel_state_t);
  93static u32 qlcnic_vlan_tx_check(struct qlcnic_adapter *adapter)
  94{
  95	struct qlcnic_hardware_context *ahw = adapter->ahw;
  96
  97	if (adapter->pdev->device == PCI_DEVICE_ID_QLOGIC_QLE824X)
  98		return ahw->capabilities & QLCNIC_FW_CAPABILITY_FVLANTX;
  99	else
 100		return 1;
 101}
 102
 103/*  PCI Device ID Table  */
 104#define ENTRY(device) \
 105	{PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, (device)), \
 106	.class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0}
 107
 108static const struct pci_device_id qlcnic_pci_tbl[] = {
 109	ENTRY(PCI_DEVICE_ID_QLOGIC_QLE824X),
 110	ENTRY(PCI_DEVICE_ID_QLOGIC_QLE834X),
 111	ENTRY(PCI_DEVICE_ID_QLOGIC_VF_QLE834X),
 112	ENTRY(PCI_DEVICE_ID_QLOGIC_QLE8830),
 113	ENTRY(PCI_DEVICE_ID_QLOGIC_VF_QLE8C30),
 114	ENTRY(PCI_DEVICE_ID_QLOGIC_QLE844X),
 115	ENTRY(PCI_DEVICE_ID_QLOGIC_VF_QLE844X),
 116	{0,}
 117};
 118
 119MODULE_DEVICE_TABLE(pci, qlcnic_pci_tbl);
 120
 121
 122inline void qlcnic_update_cmd_producer(struct qlcnic_host_tx_ring *tx_ring)
 123{
 124	writel(tx_ring->producer, tx_ring->crb_cmd_producer);
 125}
 126
 127static const u32 msi_tgt_status[8] = {
 128	ISR_INT_TARGET_STATUS, ISR_INT_TARGET_STATUS_F1,
 129	ISR_INT_TARGET_STATUS_F2, ISR_INT_TARGET_STATUS_F3,
 130	ISR_INT_TARGET_STATUS_F4, ISR_INT_TARGET_STATUS_F5,
 131	ISR_INT_TARGET_STATUS_F6, ISR_INT_TARGET_STATUS_F7
 132};
 133
 134static const u32 qlcnic_reg_tbl[] = {
 135	0x1B20A8,	/* PEG_HALT_STAT1 */
 136	0x1B20AC,	/* PEG_HALT_STAT2 */
 137	0x1B20B0,	/* FW_HEARTBEAT */
 138	0x1B2100,	/* LOCK ID */
 139	0x1B2128,	/* FW_CAPABILITIES */
 140	0x1B2138,	/* drv active */
 141	0x1B2140,	/* dev state */
 142	0x1B2144,	/* drv state */
 143	0x1B2148,	/* drv scratch */
 144	0x1B214C,	/* dev partition info */
 145	0x1B2174,	/* drv idc ver */
 146	0x1B2150,	/* fw version major */
 147	0x1B2154,	/* fw version minor */
 148	0x1B2158,	/* fw version sub */
 149	0x1B219C,	/* npar state */
 150	0x1B21FC,	/* FW_IMG_VALID */
 151	0x1B2250,	/* CMD_PEG_STATE */
 152	0x1B233C,	/* RCV_PEG_STATE */
 153	0x1B23B4,	/* ASIC TEMP */
 154	0x1B216C,	/* FW api */
 155	0x1B2170,	/* drv op mode */
 156	0x13C010,	/* flash lock */
 157	0x13C014,	/* flash unlock */
 158};
 159
 160static const struct qlcnic_board_info qlcnic_boards[] = {
 161	{ PCI_VENDOR_ID_QLOGIC,
 162	  PCI_DEVICE_ID_QLOGIC_QLE844X,
 163	  0x0,
 164	  0x0,
 165	  "8400 series 10GbE Converged Network Adapter (TCP/IP Networking)" },
 166	{ PCI_VENDOR_ID_QLOGIC,
 167	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 168	  PCI_VENDOR_ID_QLOGIC,
 169	  0x24e,
 170	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 171	  "(TCP/IP Networking)" },
 172	{ PCI_VENDOR_ID_QLOGIC,
 173	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 174	  PCI_VENDOR_ID_QLOGIC,
 175	  0x243,
 176	  "8300 Series Single Port 10GbE Converged Network Adapter "
 177	  "(TCP/IP Networking)" },
 178	{ PCI_VENDOR_ID_QLOGIC,
 179	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 180	  PCI_VENDOR_ID_QLOGIC,
 181	  0x24a,
 182	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 183	  "(TCP/IP Networking)" },
 184	{ PCI_VENDOR_ID_QLOGIC,
 185	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 186	  PCI_VENDOR_ID_QLOGIC,
 187	  0x246,
 188	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 189	  "(TCP/IP Networking)" },
 190	{ PCI_VENDOR_ID_QLOGIC,
 191	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 192	  PCI_VENDOR_ID_QLOGIC,
 193	  0x252,
 194	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 195	  "(TCP/IP Networking)" },
 196	{ PCI_VENDOR_ID_QLOGIC,
 197	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 198	  PCI_VENDOR_ID_QLOGIC,
 199	  0x26e,
 200	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 201	  "(TCP/IP Networking)" },
 202	{ PCI_VENDOR_ID_QLOGIC,
 203	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 204	  PCI_VENDOR_ID_QLOGIC,
 205	  0x260,
 206	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 207	  "(TCP/IP Networking)" },
 208	{ PCI_VENDOR_ID_QLOGIC,
 209	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 210	  PCI_VENDOR_ID_QLOGIC,
 211	  0x266,
 212	  "8300 Series Single Port 10GbE Converged Network Adapter "
 213	  "(TCP/IP Networking)" },
 214	{ PCI_VENDOR_ID_QLOGIC,
 215	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 216	  PCI_VENDOR_ID_QLOGIC,
 217	  0x269,
 218	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 219	  "(TCP/IP Networking)" },
 220	{ PCI_VENDOR_ID_QLOGIC,
 221	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 222	  PCI_VENDOR_ID_QLOGIC,
 223	  0x271,
 224	  "8300 Series Dual Port 10GbE Converged Network Adapter "
 225	  "(TCP/IP Networking)" },
 226	{ PCI_VENDOR_ID_QLOGIC,
 227	  PCI_DEVICE_ID_QLOGIC_QLE834X,
 228	  0x0, 0x0, "8300 Series 1/10GbE Controller" },
 229	{ PCI_VENDOR_ID_QLOGIC,
 230	  PCI_DEVICE_ID_QLOGIC_QLE8830,
 231	  0x0,
 232	  0x0,
 233	  "8830 Series 1/10GbE Controller" },
 234	{ PCI_VENDOR_ID_QLOGIC,
 235	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 236	  PCI_VENDOR_ID_QLOGIC,
 237	  0x203,
 238	  "8200 Series Single Port 10GbE Converged Network Adapter"
 239	  "(TCP/IP Networking)" },
 240	{ PCI_VENDOR_ID_QLOGIC,
 241	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 242	  PCI_VENDOR_ID_QLOGIC,
 243	  0x207,
 244	  "8200 Series Dual Port 10GbE Converged Network Adapter"
 245	  "(TCP/IP Networking)" },
 246	{ PCI_VENDOR_ID_QLOGIC,
 247	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 248	  PCI_VENDOR_ID_QLOGIC,
 249	  0x20b,
 250	  "3200 Series Dual Port 10Gb Intelligent Ethernet Adapter" },
 251	{ PCI_VENDOR_ID_QLOGIC,
 252	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 253	  PCI_VENDOR_ID_QLOGIC,
 254	  0x20c,
 255	  "3200 Series Quad Port 1Gb Intelligent Ethernet Adapter" },
 256	{ PCI_VENDOR_ID_QLOGIC,
 257	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 258	  PCI_VENDOR_ID_QLOGIC,
 259	  0x20f,
 260	  "3200 Series Single Port 10Gb Intelligent Ethernet Adapter" },
 261	{ PCI_VENDOR_ID_QLOGIC,
 262	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 263	  0x103c, 0x3733,
 264	  "NC523SFP 10Gb 2-port Server Adapter" },
 265	{ PCI_VENDOR_ID_QLOGIC,
 266	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 267	  0x103c, 0x3346,
 268	  "CN1000Q Dual Port Converged Network Adapter" },
 269	{ PCI_VENDOR_ID_QLOGIC,
 270	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 271	  PCI_VENDOR_ID_QLOGIC,
 272	  0x210,
 273	  "QME8242-k 10GbE Dual Port Mezzanine Card" },
 274	{ PCI_VENDOR_ID_QLOGIC,
 275	  PCI_DEVICE_ID_QLOGIC_QLE824X,
 276	  0x0, 0x0, "cLOM8214 1/10GbE Controller" },
 277};
 278
 279#define NUM_SUPPORTED_BOARDS ARRAY_SIZE(qlcnic_boards)
 280
 281static const
 282struct qlcnic_legacy_intr_set legacy_intr[] = QLCNIC_LEGACY_INTR_CONFIG;
 283
 284int qlcnic_alloc_sds_rings(struct qlcnic_recv_context *recv_ctx, int count)
 285{
 286	int size = sizeof(struct qlcnic_host_sds_ring) * count;
 287
 288	recv_ctx->sds_rings = kzalloc(size, GFP_KERNEL);
 289
 290	return recv_ctx->sds_rings == NULL;
 291}
 292
 293void qlcnic_free_sds_rings(struct qlcnic_recv_context *recv_ctx)
 294{
 295	kfree(recv_ctx->sds_rings);
 296	recv_ctx->sds_rings = NULL;
 297}
 298
 299int qlcnic_read_mac_addr(struct qlcnic_adapter *adapter)
 300{
 301	struct net_device *netdev = adapter->netdev;
 302	struct pci_dev *pdev = adapter->pdev;
 303	u8 mac_addr[ETH_ALEN];
 304	int ret;
 305
 306	ret = qlcnic_get_mac_address(adapter, mac_addr,
 307				     adapter->ahw->pci_func);
 308	if (ret)
 309		return ret;
 310
 311	memcpy(netdev->dev_addr, mac_addr, ETH_ALEN);
 312	memcpy(adapter->mac_addr, netdev->dev_addr, netdev->addr_len);
 313
 314	/* set station address */
 315
 316	if (!is_valid_ether_addr(netdev->dev_addr))
 317		dev_warn(&pdev->dev, "Bad MAC address %pM.\n",
 318					netdev->dev_addr);
 319
 320	return 0;
 321}
 322
 323static void qlcnic_delete_adapter_mac(struct qlcnic_adapter *adapter)
 324{
 325	struct qlcnic_mac_vlan_list *cur;
 326	struct list_head *head;
 327
 328	list_for_each(head, &adapter->mac_list) {
 329		cur = list_entry(head, struct qlcnic_mac_vlan_list, list);
 330		if (ether_addr_equal_unaligned(adapter->mac_addr, cur->mac_addr)) {
 331			qlcnic_sre_macaddr_change(adapter, cur->mac_addr,
 332						  0, QLCNIC_MAC_DEL);
 333			list_del(&cur->list);
 334			kfree(cur);
 335			return;
 336		}
 337	}
 338}
 339
 340static int qlcnic_set_mac(struct net_device *netdev, void *p)
 341{
 342	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 343	struct sockaddr *addr = p;
 344
 345	if (qlcnic_sriov_vf_check(adapter))
 346		return -EINVAL;
 347
 348	if ((adapter->flags & QLCNIC_MAC_OVERRIDE_DISABLED))
 349		return -EOPNOTSUPP;
 350
 351	if (!is_valid_ether_addr(addr->sa_data))
 352		return -EINVAL;
 353
 354	if (ether_addr_equal_unaligned(adapter->mac_addr, addr->sa_data) &&
 355	    ether_addr_equal_unaligned(netdev->dev_addr, addr->sa_data))
 356		return 0;
 357
 358	if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
 359		netif_device_detach(netdev);
 360		qlcnic_napi_disable(adapter);
 361	}
 362
 363	qlcnic_delete_adapter_mac(adapter);
 364	memcpy(adapter->mac_addr, addr->sa_data, netdev->addr_len);
 365	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
 366	qlcnic_set_multi(adapter->netdev);
 367
 368	if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
 369		netif_device_attach(netdev);
 370		qlcnic_napi_enable(adapter);
 371	}
 372	return 0;
 373}
 374
 375static int qlcnic_fdb_del(struct ndmsg *ndm, struct nlattr *tb[],
 376			struct net_device *netdev,
 377			const unsigned char *addr, u16 vid)
 
 378{
 379	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 380	int err = -EOPNOTSUPP;
 381
 382	if (!adapter->fdb_mac_learn)
 383		return ndo_dflt_fdb_del(ndm, tb, netdev, addr, vid);
 384
 385	if ((adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
 386	    qlcnic_sriov_check(adapter)) {
 387		if (is_unicast_ether_addr(addr)) {
 388			err = dev_uc_del(netdev, addr);
 389			if (!err)
 390				err = qlcnic_nic_del_mac(adapter, addr);
 391		} else if (is_multicast_ether_addr(addr)) {
 392			err = dev_mc_del(netdev, addr);
 393		} else {
 394			err =  -EINVAL;
 395		}
 396	}
 397	return err;
 398}
 399
 400static int qlcnic_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
 401			struct net_device *netdev,
 402			const unsigned char *addr, u16 vid, u16 flags)
 
 403{
 404	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 405	int err = 0;
 406
 407	if (!adapter->fdb_mac_learn)
 408		return ndo_dflt_fdb_add(ndm, tb, netdev, addr, vid, flags);
 409
 410	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED) &&
 411	    !qlcnic_sriov_check(adapter)) {
 412		pr_info("%s: FDB e-switch is not enabled\n", __func__);
 413		return -EOPNOTSUPP;
 414	}
 415
 416	if (ether_addr_equal(addr, adapter->mac_addr))
 417		return err;
 418
 419	if (is_unicast_ether_addr(addr)) {
 420		if (netdev_uc_count(netdev) < adapter->ahw->max_uc_count)
 421			err = dev_uc_add_excl(netdev, addr);
 422		else
 423			err = -ENOMEM;
 424	} else if (is_multicast_ether_addr(addr)) {
 425		err = dev_mc_add_excl(netdev, addr);
 426	} else {
 427		err = -EINVAL;
 428	}
 429
 430	return err;
 431}
 432
 433static int qlcnic_fdb_dump(struct sk_buff *skb, struct netlink_callback *ncb,
 434			struct net_device *netdev,
 435			struct net_device *filter_dev, int *idx)
 436{
 437	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 438	int err = 0;
 439
 440	if (!adapter->fdb_mac_learn)
 441		return ndo_dflt_fdb_dump(skb, ncb, netdev, filter_dev, idx);
 442
 443	if ((adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
 444	    qlcnic_sriov_check(adapter))
 445		err = ndo_dflt_fdb_dump(skb, ncb, netdev, filter_dev, idx);
 446
 447	return err;
 448}
 449
 450static void qlcnic_82xx_cancel_idc_work(struct qlcnic_adapter *adapter)
 451{
 452	while (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
 453		usleep_range(10000, 11000);
 454
 455	if (!adapter->fw_work.work.func)
 456		return;
 457
 458	cancel_delayed_work_sync(&adapter->fw_work);
 459}
 460
 461static int qlcnic_get_phys_port_id(struct net_device *netdev,
 462				   struct netdev_phys_item_id *ppid)
 463{
 464	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 465	struct qlcnic_hardware_context *ahw = adapter->ahw;
 466
 467	if (!(adapter->flags & QLCNIC_HAS_PHYS_PORT_ID))
 468		return -EOPNOTSUPP;
 469
 470	ppid->id_len = sizeof(ahw->phys_port_id);
 471	memcpy(ppid->id, ahw->phys_port_id, ppid->id_len);
 472
 473	return 0;
 474}
 475
 476static void qlcnic_add_vxlan_port(struct net_device *netdev,
 477				  struct udp_tunnel_info *ti)
 478{
 479	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 480	struct qlcnic_hardware_context *ahw = adapter->ahw;
 
 481
 482	if (ti->type != UDP_TUNNEL_TYPE_VXLAN)
 483		return;
 484
 485	/* Adapter supports only one VXLAN port. Use very first port
 486	 * for enabling offload
 487	 */
 488	if (!qlcnic_encap_rx_offload(adapter))
 489		return;
 490	if (!ahw->vxlan_port_count) {
 491		ahw->vxlan_port_count = 1;
 492		ahw->vxlan_port = ntohs(ti->port);
 493		adapter->flags |= QLCNIC_ADD_VXLAN_PORT;
 494		return;
 495	}
 496	if (ahw->vxlan_port == ntohs(ti->port))
 497		ahw->vxlan_port_count++;
 498
 
 499}
 500
 501static void qlcnic_del_vxlan_port(struct net_device *netdev,
 502				  struct udp_tunnel_info *ti)
 503{
 504	struct qlcnic_adapter *adapter = netdev_priv(netdev);
 505	struct qlcnic_hardware_context *ahw = adapter->ahw;
 506
 507	if (ti->type != UDP_TUNNEL_TYPE_VXLAN)
 508		return;
 509
 510	if (!qlcnic_encap_rx_offload(adapter) || !ahw->vxlan_port_count ||
 511	    (ahw->vxlan_port != ntohs(ti->port)))
 512		return;
 513
 514	ahw->vxlan_port_count--;
 515	if (!ahw->vxlan_port_count)
 516		adapter->flags |= QLCNIC_DEL_VXLAN_PORT;
 517}
 518
 519static netdev_features_t qlcnic_features_check(struct sk_buff *skb,
 520					       struct net_device *dev,
 521					       netdev_features_t features)
 522{
 523	features = vlan_features_check(skb, features);
 524	return vxlan_features_check(skb, features);
 525}
 526
 527static const struct net_device_ops qlcnic_netdev_ops = {
 528	.ndo_open	   = qlcnic_open,
 529	.ndo_stop	   = qlcnic_close,
 530	.ndo_start_xmit    = qlcnic_xmit_frame,
 531	.ndo_get_stats	   = qlcnic_get_stats,
 532	.ndo_validate_addr = eth_validate_addr,
 533	.ndo_set_rx_mode   = qlcnic_set_multi,
 534	.ndo_set_mac_address    = qlcnic_set_mac,
 535	.ndo_change_mtu	   = qlcnic_change_mtu,
 536	.ndo_fix_features  = qlcnic_fix_features,
 537	.ndo_set_features  = qlcnic_set_features,
 538	.ndo_tx_timeout	   = qlcnic_tx_timeout,
 539	.ndo_vlan_rx_add_vid	= qlcnic_vlan_rx_add,
 540	.ndo_vlan_rx_kill_vid	= qlcnic_vlan_rx_del,
 541	.ndo_fdb_add		= qlcnic_fdb_add,
 542	.ndo_fdb_del		= qlcnic_fdb_del,
 543	.ndo_fdb_dump		= qlcnic_fdb_dump,
 544	.ndo_get_phys_port_id	= qlcnic_get_phys_port_id,
 545	.ndo_udp_tunnel_add	= qlcnic_add_vxlan_port,
 546	.ndo_udp_tunnel_del	= qlcnic_del_vxlan_port,
 547	.ndo_features_check	= qlcnic_features_check,
 548#ifdef CONFIG_NET_POLL_CONTROLLER
 549	.ndo_poll_controller = qlcnic_poll_controller,
 550#endif
 551#ifdef CONFIG_QLCNIC_SRIOV
 552	.ndo_set_vf_mac		= qlcnic_sriov_set_vf_mac,
 553	.ndo_set_vf_rate	= qlcnic_sriov_set_vf_tx_rate,
 554	.ndo_get_vf_config	= qlcnic_sriov_get_vf_config,
 555	.ndo_set_vf_vlan	= qlcnic_sriov_set_vf_vlan,
 556	.ndo_set_vf_spoofchk	= qlcnic_sriov_set_vf_spoofchk,
 557#endif
 558};
 559
 560static const struct net_device_ops qlcnic_netdev_failed_ops = {
 561	.ndo_open	   = qlcnic_open,
 562};
 563
 564static struct qlcnic_nic_template qlcnic_ops = {
 565	.config_bridged_mode	= qlcnic_config_bridged_mode,
 566	.config_led		= qlcnic_82xx_config_led,
 567	.start_firmware		= qlcnic_82xx_start_firmware,
 568	.request_reset		= qlcnic_82xx_dev_request_reset,
 569	.cancel_idc_work	= qlcnic_82xx_cancel_idc_work,
 570	.napi_add		= qlcnic_82xx_napi_add,
 571	.napi_del		= qlcnic_82xx_napi_del,
 572	.config_ipaddr		= qlcnic_82xx_config_ipaddr,
 573	.shutdown		= qlcnic_82xx_shutdown,
 574	.resume			= qlcnic_82xx_resume,
 575	.clear_legacy_intr	= qlcnic_82xx_clear_legacy_intr,
 576};
 577
 578struct qlcnic_nic_template qlcnic_vf_ops = {
 579	.config_bridged_mode	= qlcnicvf_config_bridged_mode,
 580	.config_led		= qlcnicvf_config_led,
 581	.start_firmware		= qlcnicvf_start_firmware
 582};
 583
 584static struct qlcnic_hardware_ops qlcnic_hw_ops = {
 585	.read_crb			= qlcnic_82xx_read_crb,
 586	.write_crb			= qlcnic_82xx_write_crb,
 587	.read_reg			= qlcnic_82xx_hw_read_wx_2M,
 588	.write_reg			= qlcnic_82xx_hw_write_wx_2M,
 589	.get_mac_address		= qlcnic_82xx_get_mac_address,
 590	.setup_intr			= qlcnic_82xx_setup_intr,
 591	.alloc_mbx_args			= qlcnic_82xx_alloc_mbx_args,
 592	.mbx_cmd			= qlcnic_82xx_issue_cmd,
 593	.get_func_no			= qlcnic_82xx_get_func_no,
 594	.api_lock			= qlcnic_82xx_api_lock,
 595	.api_unlock			= qlcnic_82xx_api_unlock,
 596	.add_sysfs			= qlcnic_82xx_add_sysfs,
 597	.remove_sysfs			= qlcnic_82xx_remove_sysfs,
 598	.process_lb_rcv_ring_diag	= qlcnic_82xx_process_rcv_ring_diag,
 599	.create_rx_ctx			= qlcnic_82xx_fw_cmd_create_rx_ctx,
 600	.create_tx_ctx			= qlcnic_82xx_fw_cmd_create_tx_ctx,
 601	.del_rx_ctx			= qlcnic_82xx_fw_cmd_del_rx_ctx,
 602	.del_tx_ctx			= qlcnic_82xx_fw_cmd_del_tx_ctx,
 603	.setup_link_event		= qlcnic_82xx_linkevent_request,
 604	.get_nic_info			= qlcnic_82xx_get_nic_info,
 605	.get_pci_info			= qlcnic_82xx_get_pci_info,
 606	.set_nic_info			= qlcnic_82xx_set_nic_info,
 607	.change_macvlan			= qlcnic_82xx_sre_macaddr_change,
 608	.napi_enable			= qlcnic_82xx_napi_enable,
 609	.napi_disable			= qlcnic_82xx_napi_disable,
 610	.config_intr_coal		= qlcnic_82xx_config_intr_coalesce,
 611	.config_rss			= qlcnic_82xx_config_rss,
 612	.config_hw_lro			= qlcnic_82xx_config_hw_lro,
 613	.config_loopback		= qlcnic_82xx_set_lb_mode,
 614	.clear_loopback			= qlcnic_82xx_clear_lb_mode,
 615	.config_promisc_mode		= qlcnic_82xx_nic_set_promisc,
 616	.change_l2_filter		= qlcnic_82xx_change_filter,
 617	.get_board_info			= qlcnic_82xx_get_board_info,
 618	.set_mac_filter_count		= qlcnic_82xx_set_mac_filter_count,
 619	.free_mac_list			= qlcnic_82xx_free_mac_list,
 620	.read_phys_port_id		= qlcnic_82xx_read_phys_port_id,
 621	.io_error_detected		= qlcnic_82xx_io_error_detected,
 622	.io_slot_reset			= qlcnic_82xx_io_slot_reset,
 623	.io_resume			= qlcnic_82xx_io_resume,
 624	.get_beacon_state		= qlcnic_82xx_get_beacon_state,
 625	.enable_sds_intr		= qlcnic_82xx_enable_sds_intr,
 626	.disable_sds_intr		= qlcnic_82xx_disable_sds_intr,
 627	.enable_tx_intr			= qlcnic_82xx_enable_tx_intr,
 628	.disable_tx_intr		= qlcnic_82xx_disable_tx_intr,
 629	.get_saved_state		= qlcnic_82xx_get_saved_state,
 630	.set_saved_state		= qlcnic_82xx_set_saved_state,
 631	.cache_tmpl_hdr_values		= qlcnic_82xx_cache_tmpl_hdr_values,
 632	.get_cap_size			= qlcnic_82xx_get_cap_size,
 633	.set_sys_info			= qlcnic_82xx_set_sys_info,
 634	.store_cap_mask			= qlcnic_82xx_store_cap_mask,
 635	.encap_rx_offload               = qlcnic_82xx_encap_rx_offload,
 636	.encap_tx_offload               = qlcnic_82xx_encap_tx_offload,
 637};
 638
 639static int qlcnic_check_multi_tx_capability(struct qlcnic_adapter *adapter)
 640{
 641	struct qlcnic_hardware_context *ahw = adapter->ahw;
 642
 643	if (qlcnic_82xx_check(adapter) &&
 644	    (ahw->extra_capability[0] & QLCNIC_FW_CAPABILITY_2_MULTI_TX)) {
 645		test_and_set_bit(__QLCNIC_MULTI_TX_UNIQUE, &adapter->state);
 646		return 0;
 647	} else {
 648		return 1;
 649	}
 650}
 651
 652static int qlcnic_max_rings(struct qlcnic_adapter *adapter, u8 ring_cnt,
 653			    int queue_type)
 654{
 655	int num_rings, max_rings = QLCNIC_MAX_SDS_RINGS;
 656
 657	if (queue_type == QLCNIC_RX_QUEUE)
 658		max_rings = adapter->max_sds_rings;
 659	else if (queue_type == QLCNIC_TX_QUEUE)
 660		max_rings = adapter->max_tx_rings;
 661
 662	num_rings = rounddown_pow_of_two(min_t(int, num_online_cpus(),
 663					      max_rings));
 664
 665	if (ring_cnt > num_rings)
 666		return num_rings;
 667	else
 668		return ring_cnt;
 669}
 670
 671void qlcnic_set_tx_ring_count(struct qlcnic_adapter *adapter, u8 tx_cnt)
 672{
 673	/* 83xx adapter does not have max_tx_rings intialized in probe */
 674	if (adapter->max_tx_rings)
 675		adapter->drv_tx_rings = qlcnic_max_rings(adapter, tx_cnt,
 676							 QLCNIC_TX_QUEUE);
 677	else
 678		adapter->drv_tx_rings = tx_cnt;
 679}
 680
 681void qlcnic_set_sds_ring_count(struct qlcnic_adapter *adapter, u8 rx_cnt)
 682{
 683	/* 83xx adapter does not have max_sds_rings intialized in probe */
 684	if (adapter->max_sds_rings)
 685		adapter->drv_sds_rings = qlcnic_max_rings(adapter, rx_cnt,
 686							  QLCNIC_RX_QUEUE);
 687	else
 688		adapter->drv_sds_rings = rx_cnt;
 689}
 690
 691int qlcnic_setup_tss_rss_intr(struct qlcnic_adapter *adapter)
 692{
 693	struct pci_dev *pdev = adapter->pdev;
 694	int num_msix = 0, err = 0, vector;
 695
 696	adapter->flags &= ~QLCNIC_TSS_RSS;
 697
 698	if (adapter->drv_tss_rings > 0)
 699		num_msix += adapter->drv_tss_rings;
 700	else
 701		num_msix += adapter->drv_tx_rings;
 702
 703	if (adapter->drv_rss_rings > 0)
 704		num_msix += adapter->drv_rss_rings;
 705	else
 706		num_msix += adapter->drv_sds_rings;
 707
 708	if (qlcnic_83xx_check(adapter))
 709		num_msix += 1;
 710
 711	if (!adapter->msix_entries) {
 712		adapter->msix_entries = kcalloc(num_msix,
 713						sizeof(struct msix_entry),
 714						GFP_KERNEL);
 715		if (!adapter->msix_entries)
 716			return -ENOMEM;
 717	}
 718
 719	for (vector = 0; vector < num_msix; vector++)
 720		adapter->msix_entries[vector].entry = vector;
 721
 722restore:
 723	err = pci_enable_msix_exact(pdev, adapter->msix_entries, num_msix);
 724	if (err == -ENOSPC) {
 725		if (!adapter->drv_tss_rings && !adapter->drv_rss_rings)
 726			return err;
 727
 728		netdev_info(adapter->netdev,
 729			    "Unable to allocate %d MSI-X vectors, Available vectors %d\n",
 730			    num_msix, err);
 731
 732		num_msix = adapter->drv_tx_rings + adapter->drv_sds_rings;
 733
 734		/* Set rings to 0 so we can restore original TSS/RSS count */
 735		adapter->drv_tss_rings = 0;
 736		adapter->drv_rss_rings = 0;
 737
 738		if (qlcnic_83xx_check(adapter))
 739			num_msix += 1;
 740
 741		netdev_info(adapter->netdev,
 742			    "Restoring %d Tx, %d SDS rings for total %d vectors.\n",
 743			    adapter->drv_tx_rings, adapter->drv_sds_rings,
 744			    num_msix);
 745
 746		goto restore;
 747	} else if (err < 0) {
 748		return err;
 749	}
 750
 751	adapter->ahw->num_msix = num_msix;
 752	if (adapter->drv_tss_rings > 0)
 753		adapter->drv_tx_rings = adapter->drv_tss_rings;
 754
 755	if (adapter->drv_rss_rings > 0)
 756		adapter->drv_sds_rings = adapter->drv_rss_rings;
 757
 758	return 0;
 759}
 760
 761int qlcnic_enable_msix(struct qlcnic_adapter *adapter, u32 num_msix)
 762{
 763	struct pci_dev *pdev = adapter->pdev;
 764	int err, vector;
 765
 766	if (!adapter->msix_entries) {
 767		adapter->msix_entries = kcalloc(num_msix,
 768						sizeof(struct msix_entry),
 769						GFP_KERNEL);
 770		if (!adapter->msix_entries)
 771			return -ENOMEM;
 772	}
 773
 774	adapter->flags &= ~(QLCNIC_MSI_ENABLED | QLCNIC_MSIX_ENABLED);
 775
 776	if (adapter->ahw->msix_supported) {
 777enable_msix:
 778		for (vector = 0; vector < num_msix; vector++)
 779			adapter->msix_entries[vector].entry = vector;
 780
 781		err = pci_enable_msix_range(pdev,
 782					    adapter->msix_entries, 1, num_msix);
 783
 784		if (err == num_msix) {
 785			adapter->flags |= QLCNIC_MSIX_ENABLED;
 786			adapter->ahw->num_msix = num_msix;
 787			dev_info(&pdev->dev, "using msi-x interrupts\n");
 788			return 0;
 789		} else if (err > 0) {
 790			pci_disable_msix(pdev);
 791
 792			dev_info(&pdev->dev,
 793				 "Unable to allocate %d MSI-X vectors, Available vectors %d\n",
 794				 num_msix, err);
 795
 796			if (qlcnic_82xx_check(adapter)) {
 797				num_msix = rounddown_pow_of_two(err);
 798				if (err < QLCNIC_82XX_MINIMUM_VECTOR)
 799					return -ENOSPC;
 800			} else {
 801				num_msix = rounddown_pow_of_two(err - 1);
 802				num_msix += 1;
 803				if (err < QLCNIC_83XX_MINIMUM_VECTOR)
 804					return -ENOSPC;
 805			}
 806
 807			if (qlcnic_82xx_check(adapter) &&
 808			    !qlcnic_check_multi_tx(adapter)) {
 809				adapter->drv_sds_rings = num_msix;
 810				adapter->drv_tx_rings = QLCNIC_SINGLE_RING;
 811			} else {
 812				/* Distribute vectors equally */
 813				adapter->drv_tx_rings = num_msix / 2;
 814				adapter->drv_sds_rings = adapter->drv_tx_rings;
 815			}
 816
 817			if (num_msix) {
 818				dev_info(&pdev->dev,
 819					 "Trying to allocate %d MSI-X interrupt vectors\n",
 820					 num_msix);
 821				goto enable_msix;
 822			}
 823		} else {
 824			dev_info(&pdev->dev,
 825				 "Unable to allocate %d MSI-X vectors, err=%d\n",
 826				 num_msix, err);
 827			return err;
 828		}
 829	}
 830
 831	return -EIO;
 832}
 833
 834static int qlcnic_82xx_calculate_msix_vector(struct qlcnic_adapter *adapter)
 835{
 836	int num_msix;
 837
 838	num_msix = adapter->drv_sds_rings;
 839
 840	if (qlcnic_check_multi_tx(adapter))
 841		num_msix += adapter->drv_tx_rings;
 842	else
 843		num_msix += QLCNIC_SINGLE_RING;
 844
 845	return num_msix;
 846}
 847
 848static int qlcnic_enable_msi_legacy(struct qlcnic_adapter *adapter)
 849{
 850	int err = 0;
 851	u32 offset, mask_reg;
 852	const struct qlcnic_legacy_intr_set *legacy_intrp;
 853	struct qlcnic_hardware_context *ahw = adapter->ahw;
 854	struct pci_dev *pdev = adapter->pdev;
 855
 856	if (qlcnic_use_msi && !pci_enable_msi(pdev)) {
 857		adapter->flags |= QLCNIC_MSI_ENABLED;
 858		offset = msi_tgt_status[adapter->ahw->pci_func];
 859		adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter->ahw,
 860							    offset);
 861		dev_info(&pdev->dev, "using msi interrupts\n");
 862		adapter->msix_entries[0].vector = pdev->irq;
 863		return err;
 864	}
 865
 866	if (qlcnic_use_msi || qlcnic_use_msi_x)
 867		return -EOPNOTSUPP;
 868
 869	legacy_intrp = &legacy_intr[adapter->ahw->pci_func];
 870	adapter->ahw->int_vec_bit = legacy_intrp->int_vec_bit;
 871	offset = legacy_intrp->tgt_status_reg;
 872	adapter->tgt_status_reg = qlcnic_get_ioaddr(ahw, offset);
 873	mask_reg = legacy_intrp->tgt_mask_reg;
 874	adapter->tgt_mask_reg = qlcnic_get_ioaddr(ahw, mask_reg);
 875	adapter->isr_int_vec = qlcnic_get_ioaddr(ahw, ISR_INT_VECTOR);
 876	adapter->crb_int_state_reg = qlcnic_get_ioaddr(ahw, ISR_INT_STATE_REG);
 877	dev_info(&pdev->dev, "using legacy interrupts\n");
 878	adapter->msix_entries[0].vector = pdev->irq;
 879	return err;
 880}
 881
 882static int qlcnic_82xx_setup_intr(struct qlcnic_adapter *adapter)
 883{
 884	int num_msix, err = 0;
 885
 886	if (adapter->flags & QLCNIC_TSS_RSS) {
 887		err = qlcnic_setup_tss_rss_intr(adapter);
 888		if (err < 0)
 889			return err;
 890		num_msix = adapter->ahw->num_msix;
 891	} else {
 892		num_msix = qlcnic_82xx_calculate_msix_vector(adapter);
 893
 894		err = qlcnic_enable_msix(adapter, num_msix);
 895		if (err == -ENOMEM)
 896			return err;
 897
 898		if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) {
 899			qlcnic_disable_multi_tx(adapter);
 900			adapter->drv_sds_rings = QLCNIC_SINGLE_RING;
 901
 902			err = qlcnic_enable_msi_legacy(adapter);
 903			if (err)
 904				return err;
 905		}
 906	}
 907
 908	return 0;
 909}
 910
 911int qlcnic_82xx_mq_intrpt(struct qlcnic_adapter *adapter, int op_type)
 912{
 913	struct qlcnic_hardware_context *ahw = adapter->ahw;
 914	int err, i;
 915
 916	if (qlcnic_check_multi_tx(adapter) &&
 917	    !ahw->diag_test &&
 918	    (adapter->flags & QLCNIC_MSIX_ENABLED)) {
 919		ahw->intr_tbl = vzalloc(ahw->num_msix *
 920					sizeof(struct qlcnic_intrpt_config));
 
 921		if (!ahw->intr_tbl)
 922			return -ENOMEM;
 923
 924		for (i = 0; i < ahw->num_msix; i++) {
 925			ahw->intr_tbl[i].type = QLCNIC_INTRPT_MSIX;
 926			ahw->intr_tbl[i].id = i;
 927			ahw->intr_tbl[i].src = 0;
 928		}
 929
 930		err = qlcnic_82xx_config_intrpt(adapter, 1);
 931		if (err)
 932			dev_err(&adapter->pdev->dev,
 933				"Failed to configure Interrupt for %d vector\n",
 934				ahw->num_msix);
 935		return err;
 936	}
 937
 938	return 0;
 939}
 940
 941void qlcnic_teardown_intr(struct qlcnic_adapter *adapter)
 942{
 943	if (adapter->flags & QLCNIC_MSIX_ENABLED)
 944		pci_disable_msix(adapter->pdev);
 945	if (adapter->flags & QLCNIC_MSI_ENABLED)
 946		pci_disable_msi(adapter->pdev);
 947
 948	kfree(adapter->msix_entries);
 949	adapter->msix_entries = NULL;
 950
 951	if (adapter->ahw->intr_tbl) {
 952		vfree(adapter->ahw->intr_tbl);
 953		adapter->ahw->intr_tbl = NULL;
 954	}
 955}
 956
 957static void qlcnic_cleanup_pci_map(struct qlcnic_hardware_context *ahw)
 958{
 959	if (ahw->pci_base0 != NULL)
 960		iounmap(ahw->pci_base0);
 961}
 962
 963static int qlcnic_get_act_pci_func(struct qlcnic_adapter *adapter)
 964{
 965	struct qlcnic_hardware_context *ahw = adapter->ahw;
 966	struct qlcnic_pci_info *pci_info;
 967	int ret;
 968
 969	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED)) {
 970		switch (ahw->port_type) {
 971		case QLCNIC_GBE:
 972			ahw->total_nic_func = QLCNIC_NIU_MAX_GBE_PORTS;
 973			break;
 974		case QLCNIC_XGBE:
 975			ahw->total_nic_func = QLCNIC_NIU_MAX_XG_PORTS;
 976			break;
 977		}
 978		return 0;
 979	}
 980
 981	if (ahw->op_mode == QLCNIC_MGMT_FUNC)
 982		return 0;
 983
 984	pci_info = kcalloc(ahw->max_vnic_func, sizeof(*pci_info), GFP_KERNEL);
 985	if (!pci_info)
 986		return -ENOMEM;
 987
 988	ret = qlcnic_get_pci_info(adapter, pci_info);
 989	kfree(pci_info);
 990	return ret;
 991}
 992
 993static bool qlcnic_port_eswitch_cfg_capability(struct qlcnic_adapter *adapter)
 994{
 995	bool ret = false;
 996
 997	if (qlcnic_84xx_check(adapter)) {
 998		ret = true;
 999	} else if (qlcnic_83xx_check(adapter)) {
1000		if (adapter->ahw->extra_capability[0] &
1001		    QLCNIC_FW_CAPABILITY_2_PER_PORT_ESWITCH_CFG)
1002			ret = true;
1003		else
1004			ret = false;
1005	}
1006
1007	return ret;
1008}
1009
1010int qlcnic_init_pci_info(struct qlcnic_adapter *adapter)
1011{
1012	struct qlcnic_hardware_context *ahw = adapter->ahw;
1013	struct qlcnic_pci_info *pci_info;
1014	int i, id = 0, ret = 0, j = 0;
1015	u16 act_pci_func;
1016	u8 pfn;
1017
1018	pci_info = kcalloc(ahw->max_vnic_func, sizeof(*pci_info), GFP_KERNEL);
1019	if (!pci_info)
1020		return -ENOMEM;
1021
1022	ret = qlcnic_get_pci_info(adapter, pci_info);
1023	if (ret)
1024		goto err_pci_info;
1025
1026	act_pci_func = ahw->total_nic_func;
1027
1028	adapter->npars = kzalloc(sizeof(struct qlcnic_npar_info) *
1029				 act_pci_func, GFP_KERNEL);
 
1030	if (!adapter->npars) {
1031		ret = -ENOMEM;
1032		goto err_pci_info;
1033	}
1034
1035	adapter->eswitch = kzalloc(sizeof(struct qlcnic_eswitch) *
1036				QLCNIC_NIU_MAX_XG_PORTS, GFP_KERNEL);
 
1037	if (!adapter->eswitch) {
1038		ret = -ENOMEM;
1039		goto err_npars;
1040	}
1041
1042	for (i = 0; i < ahw->max_vnic_func; i++) {
1043		pfn = pci_info[i].id;
1044
1045		if (pfn >= ahw->max_vnic_func) {
1046			ret = -EINVAL;
1047			dev_err(&adapter->pdev->dev, "%s: Invalid function 0x%x, max 0x%x\n",
1048				__func__, pfn, ahw->max_vnic_func);
1049			goto err_eswitch;
1050		}
1051
1052		if (!pci_info[i].active ||
1053		    (pci_info[i].type != QLCNIC_TYPE_NIC))
1054			continue;
1055
1056		if (qlcnic_port_eswitch_cfg_capability(adapter)) {
1057			if (!qlcnic_83xx_set_port_eswitch_status(adapter, pfn,
1058								 &id))
1059				adapter->npars[j].eswitch_status = true;
1060			else
1061				continue;
1062		} else {
1063			adapter->npars[j].eswitch_status = true;
1064		}
1065
1066		adapter->npars[j].pci_func = pfn;
1067		adapter->npars[j].active = (u8)pci_info[i].active;
1068		adapter->npars[j].type = (u8)pci_info[i].type;
1069		adapter->npars[j].phy_port = (u8)pci_info[i].default_port;
1070		adapter->npars[j].min_bw = pci_info[i].tx_min_bw;
1071		adapter->npars[j].max_bw = pci_info[i].tx_max_bw;
1072
1073		memcpy(&adapter->npars[j].mac, &pci_info[i].mac, ETH_ALEN);
1074		j++;
1075	}
1076
1077	/* Update eSwitch status for adapters without per port eSwitch
1078	 * configuration capability
1079	 */
1080	if (!qlcnic_port_eswitch_cfg_capability(adapter)) {
1081		for (i = 0; i < QLCNIC_NIU_MAX_XG_PORTS; i++)
1082			adapter->eswitch[i].flags |= QLCNIC_SWITCH_ENABLE;
1083	}
1084
1085	kfree(pci_info);
1086	return 0;
1087
1088err_eswitch:
1089	kfree(adapter->eswitch);
1090	adapter->eswitch = NULL;
1091err_npars:
1092	kfree(adapter->npars);
1093	adapter->npars = NULL;
1094err_pci_info:
1095	kfree(pci_info);
1096
1097	return ret;
1098}
1099
1100static int
1101qlcnic_set_function_modes(struct qlcnic_adapter *adapter)
1102{
1103	u8 id;
1104	int ret;
1105	u32 data = QLCNIC_MGMT_FUNC;
1106	struct qlcnic_hardware_context *ahw = adapter->ahw;
1107
1108	ret = qlcnic_api_lock(adapter);
1109	if (ret)
1110		goto err_lock;
1111
1112	id = ahw->pci_func;
1113	data = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
1114	data = (data & ~QLC_DEV_SET_DRV(0xf, id)) |
1115	       QLC_DEV_SET_DRV(QLCNIC_MGMT_FUNC, id);
1116	QLC_SHARED_REG_WR32(adapter, QLCNIC_DRV_OP_MODE, data);
1117	qlcnic_api_unlock(adapter);
1118err_lock:
1119	return ret;
1120}
1121
1122static void qlcnic_check_vf(struct qlcnic_adapter *adapter,
1123			    const struct pci_device_id *ent)
1124{
1125	u32 op_mode, priv_level;
1126
1127	/* Determine FW API version */
1128	adapter->ahw->fw_hal_version = QLC_SHARED_REG_RD32(adapter,
1129							   QLCNIC_FW_API);
1130
1131	/* Find PCI function number */
1132	qlcnic_get_func_no(adapter);
1133
1134	/* Determine function privilege level */
1135	op_mode = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
1136	if (op_mode == QLC_DEV_DRV_DEFAULT)
1137		priv_level = QLCNIC_MGMT_FUNC;
1138	else
1139		priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
1140
1141	if (priv_level == QLCNIC_NON_PRIV_FUNC) {
1142		adapter->ahw->op_mode = QLCNIC_NON_PRIV_FUNC;
1143		dev_info(&adapter->pdev->dev,
1144			"HAL Version: %d Non Privileged function\n",
1145			 adapter->ahw->fw_hal_version);
1146		adapter->nic_ops = &qlcnic_vf_ops;
1147	} else
1148		adapter->nic_ops = &qlcnic_ops;
1149}
1150
1151#define QLCNIC_82XX_BAR0_LENGTH 0x00200000UL
1152#define QLCNIC_83XX_BAR0_LENGTH 0x4000
1153static void qlcnic_get_bar_length(u32 dev_id, ulong *bar)
1154{
1155	switch (dev_id) {
1156	case PCI_DEVICE_ID_QLOGIC_QLE824X:
1157		*bar = QLCNIC_82XX_BAR0_LENGTH;
1158		break;
1159	case PCI_DEVICE_ID_QLOGIC_QLE834X:
1160	case PCI_DEVICE_ID_QLOGIC_QLE8830:
1161	case PCI_DEVICE_ID_QLOGIC_QLE844X:
1162	case PCI_DEVICE_ID_QLOGIC_VF_QLE834X:
1163	case PCI_DEVICE_ID_QLOGIC_VF_QLE844X:
1164	case PCI_DEVICE_ID_QLOGIC_VF_QLE8C30:
1165		*bar = QLCNIC_83XX_BAR0_LENGTH;
1166		break;
1167	default:
1168		*bar = 0;
1169	}
1170}
1171
1172static int qlcnic_setup_pci_map(struct pci_dev *pdev,
1173				struct qlcnic_hardware_context *ahw)
1174{
1175	u32 offset;
1176	void __iomem *mem_ptr0 = NULL;
1177	unsigned long mem_len, pci_len0 = 0, bar0_len;
1178
1179	/* remap phys address */
1180	mem_len = pci_resource_len(pdev, 0);
1181
1182	qlcnic_get_bar_length(pdev->device, &bar0_len);
1183	if (mem_len >= bar0_len) {
1184
1185		mem_ptr0 = pci_ioremap_bar(pdev, 0);
1186		if (mem_ptr0 == NULL) {
1187			dev_err(&pdev->dev, "failed to map PCI bar 0\n");
1188			return -EIO;
1189		}
1190		pci_len0 = mem_len;
1191	} else {
1192		return -EIO;
1193	}
1194
1195	dev_info(&pdev->dev, "%dKB memory map\n", (int)(mem_len >> 10));
1196
1197	ahw->pci_base0 = mem_ptr0;
1198	ahw->pci_len0 = pci_len0;
1199	offset = QLCNIC_PCIX_PS_REG(PCIX_OCM_WINDOW_REG(ahw->pci_func));
1200	qlcnic_get_ioaddr(ahw, offset);
1201
1202	return 0;
1203}
1204
1205static bool qlcnic_validate_subsystem_id(struct qlcnic_adapter *adapter,
1206					 int index)
1207{
1208	struct pci_dev *pdev = adapter->pdev;
1209	unsigned short subsystem_vendor;
1210	bool ret = true;
1211
1212	subsystem_vendor = pdev->subsystem_vendor;
1213
1214	if (pdev->device == PCI_DEVICE_ID_QLOGIC_QLE824X ||
1215	    pdev->device == PCI_DEVICE_ID_QLOGIC_QLE834X) {
1216		if (qlcnic_boards[index].sub_vendor == subsystem_vendor &&
1217		    qlcnic_boards[index].sub_device == pdev->subsystem_device)
1218			ret = true;
1219		else
1220			ret = false;
1221	}
1222
1223	return ret;
1224}
1225
1226static void qlcnic_get_board_name(struct qlcnic_adapter *adapter, char *name)
1227{
1228	struct pci_dev *pdev = adapter->pdev;
1229	int i, found = 0;
1230
1231	for (i = 0; i < NUM_SUPPORTED_BOARDS; ++i) {
1232		if (qlcnic_boards[i].vendor == pdev->vendor &&
1233		    qlcnic_boards[i].device == pdev->device &&
1234		    qlcnic_validate_subsystem_id(adapter, i)) {
1235			found = 1;
1236			break;
1237		}
1238	}
1239
1240	if (!found)
1241		sprintf(name, "%pM Gigabit Ethernet", adapter->mac_addr);
1242	else
1243		sprintf(name, "%pM: %s" , adapter->mac_addr,
1244			qlcnic_boards[i].short_name);
1245}
1246
1247static void
1248qlcnic_check_options(struct qlcnic_adapter *adapter)
1249{
1250	int err;
1251	u32 fw_major, fw_minor, fw_build, prev_fw_version;
1252	struct pci_dev *pdev = adapter->pdev;
1253	struct qlcnic_hardware_context *ahw = adapter->ahw;
1254	struct qlcnic_fw_dump *fw_dump = &ahw->fw_dump;
1255
1256	prev_fw_version = adapter->fw_version;
1257
1258	fw_major = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MAJOR);
1259	fw_minor = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MINOR);
1260	fw_build = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_SUB);
1261
1262	adapter->fw_version = QLCNIC_VERSION_CODE(fw_major, fw_minor, fw_build);
1263
1264	err = qlcnic_get_board_info(adapter);
1265	if (err) {
1266		dev_err(&pdev->dev, "Error getting board config info.\n");
1267		return;
1268	}
1269	if (ahw->op_mode != QLCNIC_NON_PRIV_FUNC) {
1270		if (fw_dump->tmpl_hdr == NULL ||
1271				adapter->fw_version > prev_fw_version) {
1272			vfree(fw_dump->tmpl_hdr);
1273			if (!qlcnic_fw_cmd_get_minidump_temp(adapter))
1274				dev_info(&pdev->dev,
1275					"Supports FW dump capability\n");
1276		}
1277	}
1278
1279	dev_info(&pdev->dev, "Driver v%s, firmware v%d.%d.%d\n",
1280		 QLCNIC_LINUX_VERSIONID, fw_major, fw_minor, fw_build);
1281
1282	if (adapter->ahw->port_type == QLCNIC_XGBE) {
1283		if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
1284			adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_VF;
1285			adapter->max_rxd = MAX_RCV_DESCRIPTORS_VF;
1286		} else {
1287			adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_10G;
1288			adapter->max_rxd = MAX_RCV_DESCRIPTORS_10G;
1289		}
1290
1291		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
1292		adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
1293
1294	} else if (adapter->ahw->port_type == QLCNIC_GBE) {
1295		adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G;
1296		adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
1297		adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
1298		adapter->max_rxd = MAX_RCV_DESCRIPTORS_1G;
1299	}
1300
1301	adapter->ahw->msix_supported = !!qlcnic_use_msi_x;
1302
1303	adapter->num_txd = MAX_CMD_DESCRIPTORS;
1304
1305	adapter->max_rds_rings = MAX_RDS_RINGS;
1306}
1307
1308static int
1309qlcnic_initialize_nic(struct qlcnic_adapter *adapter)
1310{
1311	struct qlcnic_info nic_info;
1312	int err = 0;
1313
1314	memset(&nic_info, 0, sizeof(struct qlcnic_info));
1315	err = qlcnic_get_nic_info(adapter, &nic_info, adapter->ahw->pci_func);
1316	if (err)
1317		return err;
1318
1319	adapter->ahw->physical_port = (u8)nic_info.phys_port;
1320	adapter->ahw->switch_mode = nic_info.switch_mode;
1321	adapter->ahw->max_tx_ques = nic_info.max_tx_ques;
1322	adapter->ahw->max_rx_ques = nic_info.max_rx_ques;
1323	adapter->ahw->capabilities = nic_info.capabilities;
1324
1325	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_MORE_CAPS) {
1326		u32 temp;
1327		temp = QLCRD32(adapter, CRB_FW_CAPABILITIES_2, &err);
1328		if (err == -EIO)
1329			return err;
1330		adapter->ahw->extra_capability[0] = temp;
1331	} else {
1332		adapter->ahw->extra_capability[0] = 0;
1333	}
1334
1335	adapter->ahw->max_mac_filters = nic_info.max_mac_filters;
1336	adapter->ahw->max_mtu = nic_info.max_mtu;
1337
1338	if (adapter->ahw->capabilities & BIT_6) {
1339		adapter->flags |= QLCNIC_ESWITCH_ENABLED;
1340		adapter->ahw->nic_mode = QLCNIC_VNIC_MODE;
1341		adapter->max_tx_rings = QLCNIC_MAX_HW_VNIC_TX_RINGS;
1342		adapter->max_sds_rings = QLCNIC_MAX_VNIC_SDS_RINGS;
1343
1344		dev_info(&adapter->pdev->dev, "vNIC mode enabled.\n");
1345	} else {
1346		adapter->ahw->nic_mode = QLCNIC_DEFAULT_MODE;
1347		adapter->max_tx_rings = QLCNIC_MAX_HW_TX_RINGS;
1348		adapter->max_sds_rings = QLCNIC_MAX_SDS_RINGS;
1349		adapter->flags &= ~QLCNIC_ESWITCH_ENABLED;
1350	}
1351
1352	return err;
1353}
1354
1355void qlcnic_set_vlan_config(struct qlcnic_adapter *adapter,
1356			    struct qlcnic_esw_func_cfg *esw_cfg)
1357{
1358	if (esw_cfg->discard_tagged)
1359		adapter->flags &= ~QLCNIC_TAGGING_ENABLED;
1360	else
1361		adapter->flags |= QLCNIC_TAGGING_ENABLED;
1362
1363	if (esw_cfg->vlan_id) {
1364		adapter->rx_pvid = esw_cfg->vlan_id;
1365		adapter->tx_pvid = esw_cfg->vlan_id;
1366	} else {
1367		adapter->rx_pvid = 0;
1368		adapter->tx_pvid = 0;
1369	}
1370}
1371
1372static int
1373qlcnic_vlan_rx_add(struct net_device *netdev, __be16 proto, u16 vid)
1374{
1375	struct qlcnic_adapter *adapter = netdev_priv(netdev);
1376	int err;
1377
1378	if (qlcnic_sriov_vf_check(adapter)) {
1379		err = qlcnic_sriov_cfg_vf_guest_vlan(adapter, vid, 1);
1380		if (err) {
1381			netdev_err(netdev,
1382				   "Cannot add VLAN filter for VLAN id %d, err=%d",
1383				   vid, err);
1384			return err;
1385		}
1386	}
1387
1388	set_bit(vid, adapter->vlans);
1389	return 0;
1390}
1391
1392static int
1393qlcnic_vlan_rx_del(struct net_device *netdev, __be16 proto, u16 vid)
1394{
1395	struct qlcnic_adapter *adapter = netdev_priv(netdev);
1396	int err;
1397
1398	if (qlcnic_sriov_vf_check(adapter)) {
1399		err = qlcnic_sriov_cfg_vf_guest_vlan(adapter, vid, 0);
1400		if (err) {
1401			netdev_err(netdev,
1402				   "Cannot delete VLAN filter for VLAN id %d, err=%d",
1403				   vid, err);
1404			return err;
1405		}
1406	}
1407
1408	qlcnic_restore_indev_addr(netdev, NETDEV_DOWN);
1409	clear_bit(vid, adapter->vlans);
1410	return 0;
1411}
1412
1413void qlcnic_set_eswitch_port_features(struct qlcnic_adapter *adapter,
1414				      struct qlcnic_esw_func_cfg *esw_cfg)
1415{
1416	adapter->flags &= ~(QLCNIC_MACSPOOF | QLCNIC_MAC_OVERRIDE_DISABLED |
1417				QLCNIC_PROMISC_DISABLED);
1418
1419	if (esw_cfg->mac_anti_spoof)
1420		adapter->flags |= QLCNIC_MACSPOOF;
1421
1422	if (!esw_cfg->mac_override)
1423		adapter->flags |= QLCNIC_MAC_OVERRIDE_DISABLED;
1424
1425	if (!esw_cfg->promisc_mode)
1426		adapter->flags |= QLCNIC_PROMISC_DISABLED;
1427}
1428
1429int qlcnic_set_eswitch_port_config(struct qlcnic_adapter *adapter)
1430{
1431	struct qlcnic_esw_func_cfg esw_cfg;
1432
1433	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED))
1434		return 0;
1435
1436	esw_cfg.pci_func = adapter->ahw->pci_func;
1437	if (qlcnic_get_eswitch_port_config(adapter, &esw_cfg))
1438			return -EIO;
1439	qlcnic_set_vlan_config(adapter, &esw_cfg);
1440	qlcnic_set_eswitch_port_features(adapter, &esw_cfg);
1441	qlcnic_set_netdev_features(adapter, &esw_cfg);
1442
1443	return 0;
1444}
1445
1446void qlcnic_set_netdev_features(struct qlcnic_adapter *adapter,
1447				struct qlcnic_esw_func_cfg *esw_cfg)
1448{
1449	struct net_device *netdev = adapter->netdev;
1450
1451	if (qlcnic_83xx_check(adapter))
1452		return;
1453
1454	adapter->offload_flags = esw_cfg->offload_flags;
1455	adapter->flags |= QLCNIC_APP_CHANGED_FLAGS;
1456	netdev_update_features(netdev);
1457	adapter->flags &= ~QLCNIC_APP_CHANGED_FLAGS;
1458}
1459
1460static int
1461qlcnic_check_eswitch_mode(struct qlcnic_adapter *adapter)
1462{
1463	u32 op_mode, priv_level;
1464	int err = 0;
1465
1466	err = qlcnic_initialize_nic(adapter);
1467	if (err)
1468		return err;
1469
1470	if (adapter->flags & QLCNIC_ADAPTER_INITIALIZED)
1471		return 0;
1472
1473	op_mode = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
1474	priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
1475
1476	if (op_mode == QLC_DEV_DRV_DEFAULT)
1477		priv_level = QLCNIC_MGMT_FUNC;
1478	else
1479		priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
1480
1481	if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
1482		if (priv_level == QLCNIC_MGMT_FUNC) {
1483			adapter->ahw->op_mode = QLCNIC_MGMT_FUNC;
1484			err = qlcnic_init_pci_info(adapter);
1485			if (err)
1486				return err;
1487			/* Set privilege level for other functions */
1488			qlcnic_set_function_modes(adapter);
1489			dev_info(&adapter->pdev->dev,
1490				"HAL Version: %d, Management function\n",
1491				 adapter->ahw->fw_hal_version);
1492		} else if (priv_level == QLCNIC_PRIV_FUNC) {
1493			adapter->ahw->op_mode = QLCNIC_PRIV_FUNC;
1494			dev_info(&adapter->pdev->dev,
1495				"HAL Version: %d, Privileged function\n",
1496				 adapter->ahw->fw_hal_version);
1497		}
1498	} else {
1499		adapter->ahw->nic_mode = QLCNIC_DEFAULT_MODE;
1500	}
1501
1502	adapter->flags |= QLCNIC_ADAPTER_INITIALIZED;
1503
1504	return err;
1505}
1506
1507int qlcnic_set_default_offload_settings(struct qlcnic_adapter *adapter)
1508{
1509	struct qlcnic_esw_func_cfg esw_cfg;
1510	struct qlcnic_npar_info *npar;
1511	u8 i;
1512
1513	if (adapter->need_fw_reset)
1514		return 0;
1515
1516	for (i = 0; i < adapter->ahw->total_nic_func; i++) {
1517		if (!adapter->npars[i].eswitch_status)
1518			continue;
1519
1520		memset(&esw_cfg, 0, sizeof(struct qlcnic_esw_func_cfg));
1521		esw_cfg.pci_func = adapter->npars[i].pci_func;
1522		esw_cfg.mac_override = BIT_0;
1523		esw_cfg.promisc_mode = BIT_0;
1524		if (qlcnic_82xx_check(adapter)) {
1525			esw_cfg.offload_flags = BIT_0;
1526			if (QLCNIC_IS_TSO_CAPABLE(adapter))
1527				esw_cfg.offload_flags |= (BIT_1 | BIT_2);
1528		}
1529		if (qlcnic_config_switch_port(adapter, &esw_cfg))
1530			return -EIO;
1531		npar = &adapter->npars[i];
1532		npar->pvid = esw_cfg.vlan_id;
1533		npar->mac_override = esw_cfg.mac_override;
1534		npar->mac_anti_spoof = esw_cfg.mac_anti_spoof;
1535		npar->discard_tagged = esw_cfg.discard_tagged;
1536		npar->promisc_mode = esw_cfg.promisc_mode;
1537		npar->offload_flags = esw_cfg.offload_flags;
1538	}
1539
1540	return 0;
1541}
1542
1543
1544static int
1545qlcnic_reset_eswitch_config(struct qlcnic_adapter *adapter,
1546			struct qlcnic_npar_info *npar, int pci_func)
1547{
1548	struct qlcnic_esw_func_cfg esw_cfg;
1549	esw_cfg.op_mode = QLCNIC_PORT_DEFAULTS;
1550	esw_cfg.pci_func = pci_func;
1551	esw_cfg.vlan_id = npar->pvid;
1552	esw_cfg.mac_override = npar->mac_override;
1553	esw_cfg.discard_tagged = npar->discard_tagged;
1554	esw_cfg.mac_anti_spoof = npar->mac_anti_spoof;
1555	esw_cfg.offload_flags = npar->offload_flags;
1556	esw_cfg.promisc_mode = npar->promisc_mode;
1557	if (qlcnic_config_switch_port(adapter, &esw_cfg))
1558		return -EIO;
1559
1560	esw_cfg.op_mode = QLCNIC_ADD_VLAN;
1561	if (qlcnic_config_switch_port(adapter, &esw_cfg))
1562		return -EIO;
1563
1564	return 0;
1565}
1566
1567int qlcnic_reset_npar_config(struct qlcnic_adapter *adapter)
1568{
1569	int i, err;
1570	struct qlcnic_npar_info *npar;
1571	struct qlcnic_info nic_info;
1572	u8 pci_func;
1573
1574	if (qlcnic_82xx_check(adapter))
1575		if (!adapter->need_fw_reset)
1576			return 0;
1577
1578	/* Set the NPAR config data after FW reset */
1579	for (i = 0; i < adapter->ahw->total_nic_func; i++) {
1580		npar = &adapter->npars[i];
1581		pci_func = npar->pci_func;
1582		if (!adapter->npars[i].eswitch_status)
1583			continue;
1584
1585		memset(&nic_info, 0, sizeof(struct qlcnic_info));
1586		err = qlcnic_get_nic_info(adapter, &nic_info, pci_func);
1587		if (err)
1588			return err;
1589		nic_info.min_tx_bw = npar->min_bw;
1590		nic_info.max_tx_bw = npar->max_bw;
1591		err = qlcnic_set_nic_info(adapter, &nic_info);
1592		if (err)
1593			return err;
1594
1595		if (npar->enable_pm) {
1596			err = qlcnic_config_port_mirroring(adapter,
1597							   npar->dest_npar, 1,
1598							   pci_func);
1599			if (err)
1600				return err;
1601		}
1602		err = qlcnic_reset_eswitch_config(adapter, npar, pci_func);
1603		if (err)
1604			return err;
1605	}
1606	return 0;
1607}
1608
1609static int qlcnic_check_npar_opertional(struct qlcnic_adapter *adapter)
1610{
1611	u8 npar_opt_timeo = QLCNIC_DEV_NPAR_OPER_TIMEO;
1612	u32 npar_state;
1613
1614	if (adapter->ahw->op_mode == QLCNIC_MGMT_FUNC)
1615		return 0;
1616
1617	npar_state = QLC_SHARED_REG_RD32(adapter,
1618					 QLCNIC_CRB_DEV_NPAR_STATE);
1619	while (npar_state != QLCNIC_DEV_NPAR_OPER && --npar_opt_timeo) {
1620		msleep(1000);
1621		npar_state = QLC_SHARED_REG_RD32(adapter,
1622						 QLCNIC_CRB_DEV_NPAR_STATE);
1623	}
1624	if (!npar_opt_timeo) {
1625		dev_err(&adapter->pdev->dev,
1626			"Waiting for NPAR state to operational timeout\n");
1627		return -EIO;
1628	}
1629	return 0;
1630}
1631
1632static int
1633qlcnic_set_mgmt_operations(struct qlcnic_adapter *adapter)
1634{
1635	int err;
1636
1637	if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
1638	    adapter->ahw->op_mode != QLCNIC_MGMT_FUNC)
1639		return 0;
1640
1641	err = qlcnic_set_default_offload_settings(adapter);
1642	if (err)
1643		return err;
1644
1645	err = qlcnic_reset_npar_config(adapter);
1646	if (err)
1647		return err;
1648
1649	qlcnic_dev_set_npar_ready(adapter);
1650
1651	return err;
1652}
1653
1654static int qlcnic_82xx_start_firmware(struct qlcnic_adapter *adapter)
1655{
1656	int err;
1657
1658	err = qlcnic_can_start_firmware(adapter);
1659	if (err < 0)
1660		return err;
1661	else if (!err)
1662		goto check_fw_status;
1663
1664	if (qlcnic_load_fw_file)
1665		qlcnic_request_firmware(adapter);
1666	else {
1667		err = qlcnic_check_flash_fw_ver(adapter);
1668		if (err)
1669			goto err_out;
1670
1671		adapter->ahw->fw_type = QLCNIC_FLASH_ROMIMAGE;
1672	}
1673
1674	err = qlcnic_need_fw_reset(adapter);
1675	if (err == 0)
1676		goto check_fw_status;
1677
1678	err = qlcnic_pinit_from_rom(adapter);
1679	if (err)
1680		goto err_out;
1681
1682	err = qlcnic_load_firmware(adapter);
1683	if (err)
1684		goto err_out;
1685
1686	qlcnic_release_firmware(adapter);
1687	QLCWR32(adapter, CRB_DRIVER_VERSION, QLCNIC_DRIVER_VERSION);
1688
1689check_fw_status:
1690	err = qlcnic_check_fw_status(adapter);
1691	if (err)
1692		goto err_out;
1693
1694	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_READY);
1695	qlcnic_idc_debug_info(adapter, 1);
1696	err = qlcnic_check_eswitch_mode(adapter);
1697	if (err) {
1698		dev_err(&adapter->pdev->dev,
1699			"Memory allocation failed for eswitch\n");
1700		goto err_out;
1701	}
1702	err = qlcnic_set_mgmt_operations(adapter);
1703	if (err)
1704		goto err_out;
1705
1706	qlcnic_check_options(adapter);
1707	adapter->need_fw_reset = 0;
1708
1709	qlcnic_release_firmware(adapter);
1710	return 0;
1711
1712err_out:
1713	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_FAILED);
1714	dev_err(&adapter->pdev->dev, "Device state set to failed\n");
1715
1716	qlcnic_release_firmware(adapter);
1717	return err;
1718}
1719
1720static int
1721qlcnic_request_irq(struct qlcnic_adapter *adapter)
1722{
1723	irq_handler_t handler;
1724	struct qlcnic_host_sds_ring *sds_ring;
1725	struct qlcnic_host_tx_ring *tx_ring;
1726	int err, ring, num_sds_rings;
1727
1728	unsigned long flags = 0;
1729	struct net_device *netdev = adapter->netdev;
1730	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1731
1732	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
1733		if (qlcnic_82xx_check(adapter))
1734			handler = qlcnic_tmp_intr;
1735		else
1736			handler = qlcnic_83xx_tmp_intr;
1737		if (!QLCNIC_IS_MSI_FAMILY(adapter))
1738			flags |= IRQF_SHARED;
1739
1740	} else {
1741		if (adapter->flags & QLCNIC_MSIX_ENABLED)
1742			handler = qlcnic_msix_intr;
1743		else if (adapter->flags & QLCNIC_MSI_ENABLED)
1744			handler = qlcnic_msi_intr;
1745		else {
1746			flags |= IRQF_SHARED;
1747			if (qlcnic_82xx_check(adapter))
1748				handler = qlcnic_intr;
1749			else
1750				handler = qlcnic_83xx_intr;
1751		}
1752	}
1753	adapter->irq = netdev->irq;
1754
1755	if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST) {
1756		if (qlcnic_82xx_check(adapter) ||
1757		    (qlcnic_83xx_check(adapter) &&
1758		     (adapter->flags & QLCNIC_MSIX_ENABLED))) {
1759			num_sds_rings = adapter->drv_sds_rings;
1760			for (ring = 0; ring < num_sds_rings; ring++) {
1761				sds_ring = &recv_ctx->sds_rings[ring];
1762				if (qlcnic_82xx_check(adapter) &&
1763				    !qlcnic_check_multi_tx(adapter) &&
1764				    (ring == (num_sds_rings - 1))) {
1765					if (!(adapter->flags &
1766					      QLCNIC_MSIX_ENABLED))
1767						snprintf(sds_ring->name,
1768							 sizeof(sds_ring->name),
1769							 "qlcnic");
1770					else
1771						snprintf(sds_ring->name,
1772							 sizeof(sds_ring->name),
1773							 "%s-tx-0-rx-%d",
1774							 netdev->name, ring);
1775				} else {
1776					snprintf(sds_ring->name,
1777						 sizeof(sds_ring->name),
1778						 "%s-rx-%d",
1779						 netdev->name, ring);
1780				}
1781				err = request_irq(sds_ring->irq, handler, flags,
1782						  sds_ring->name, sds_ring);
1783				if (err)
1784					return err;
1785			}
1786		}
1787		if ((qlcnic_82xx_check(adapter) &&
1788		     qlcnic_check_multi_tx(adapter)) ||
1789		    (qlcnic_83xx_check(adapter) &&
1790		     (adapter->flags & QLCNIC_MSIX_ENABLED) &&
1791		     !(adapter->flags & QLCNIC_TX_INTR_SHARED))) {
1792			handler = qlcnic_msix_tx_intr;
1793			for (ring = 0; ring < adapter->drv_tx_rings;
1794			     ring++) {
1795				tx_ring = &adapter->tx_ring[ring];
1796				snprintf(tx_ring->name, sizeof(tx_ring->name),
1797					 "%s-tx-%d", netdev->name, ring);
1798				err = request_irq(tx_ring->irq, handler, flags,
1799						  tx_ring->name, tx_ring);
1800				if (err)
1801					return err;
1802			}
1803		}
1804	}
1805	return 0;
1806}
1807
1808static void
1809qlcnic_free_irq(struct qlcnic_adapter *adapter)
1810{
1811	int ring;
1812	struct qlcnic_host_sds_ring *sds_ring;
1813	struct qlcnic_host_tx_ring *tx_ring;
1814
1815	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1816
1817	if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST) {
1818		if (qlcnic_82xx_check(adapter) ||
1819		    (qlcnic_83xx_check(adapter) &&
1820		     (adapter->flags & QLCNIC_MSIX_ENABLED))) {
1821			for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
1822				sds_ring = &recv_ctx->sds_rings[ring];
1823				free_irq(sds_ring->irq, sds_ring);
1824			}
1825		}
1826		if ((qlcnic_83xx_check(adapter) &&
1827		     !(adapter->flags & QLCNIC_TX_INTR_SHARED)) ||
1828		    (qlcnic_82xx_check(adapter) &&
1829		     qlcnic_check_multi_tx(adapter))) {
1830			for (ring = 0; ring < adapter->drv_tx_rings;
1831			     ring++) {
1832				tx_ring = &adapter->tx_ring[ring];
1833				if (tx_ring->irq)
1834					free_irq(tx_ring->irq, tx_ring);
1835			}
1836		}
1837	}
1838}
1839
1840static void qlcnic_get_lro_mss_capability(struct qlcnic_adapter *adapter)
1841{
1842	u32 capab = 0;
1843
1844	if (qlcnic_82xx_check(adapter)) {
1845		if (adapter->ahw->extra_capability[0] &
1846		    QLCNIC_FW_CAPABILITY_2_LRO_MAX_TCP_SEG)
1847			adapter->flags |= QLCNIC_FW_LRO_MSS_CAP;
1848	} else {
1849		capab = adapter->ahw->capabilities;
1850		if (QLC_83XX_GET_FW_LRO_MSS_CAPABILITY(capab))
1851			adapter->flags |= QLCNIC_FW_LRO_MSS_CAP;
1852	}
1853}
1854
1855static int qlcnic_config_def_intr_coalesce(struct qlcnic_adapter *adapter)
1856{
1857	struct qlcnic_hardware_context *ahw = adapter->ahw;
1858	int err;
1859
1860	/* Initialize interrupt coalesce parameters */
1861	ahw->coal.flag = QLCNIC_INTR_DEFAULT;
1862
1863	if (qlcnic_83xx_check(adapter)) {
1864		ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX_TX;
1865		ahw->coal.tx_time_us = QLCNIC_DEF_INTR_COALESCE_TX_TIME_US;
1866		ahw->coal.tx_packets = QLCNIC_DEF_INTR_COALESCE_TX_PACKETS;
1867		ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
1868		ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
1869
1870		err = qlcnic_83xx_set_rx_tx_intr_coal(adapter);
1871	} else {
1872		ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX;
1873		ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
1874		ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
1875
1876		err = qlcnic_82xx_set_rx_coalesce(adapter);
1877	}
1878
1879	return err;
1880}
1881
1882int __qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1883{
1884	int ring;
1885	struct qlcnic_host_rds_ring *rds_ring;
1886
1887	if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1888		return -EIO;
1889
1890	if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
1891		return 0;
1892
1893	if (qlcnic_set_eswitch_port_config(adapter))
1894		return -EIO;
1895
1896	qlcnic_get_lro_mss_capability(adapter);
1897
1898	if (qlcnic_fw_create_ctx(adapter))
1899		return -EIO;
1900
1901	for (ring = 0; ring < adapter->max_rds_rings; ring++) {
1902		rds_ring = &adapter->recv_ctx->rds_rings[ring];
1903		qlcnic_post_rx_buffers(adapter, rds_ring, ring);
1904	}
1905
1906	qlcnic_set_multi(netdev);
1907	qlcnic_fw_cmd_set_mtu(adapter, netdev->mtu);
1908
1909	adapter->ahw->linkup = 0;
1910
1911	if (adapter->drv_sds_rings > 1)
1912		qlcnic_config_rss(adapter, 1);
1913
1914	qlcnic_config_def_intr_coalesce(adapter);
1915
1916	if (netdev->features & NETIF_F_LRO)
1917		qlcnic_config_hw_lro(adapter, QLCNIC_LRO_ENABLED);
1918
1919	set_bit(__QLCNIC_DEV_UP, &adapter->state);
1920	qlcnic_napi_enable(adapter);
1921
1922	qlcnic_linkevent_request(adapter, 1);
1923
1924	adapter->ahw->reset_context = 0;
1925	netif_tx_start_all_queues(netdev);
1926	return 0;
1927}
1928
1929int qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1930{
1931	int err = 0;
1932
1933	rtnl_lock();
1934	if (netif_running(netdev))
1935		err = __qlcnic_up(adapter, netdev);
1936	rtnl_unlock();
1937
1938	return err;
1939}
1940
1941void __qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1942{
1943	int ring;
1944
1945	if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1946		return;
1947
1948	if (!test_and_clear_bit(__QLCNIC_DEV_UP, &adapter->state))
1949		return;
1950
1951	smp_mb();
1952	netif_carrier_off(netdev);
1953	adapter->ahw->linkup = 0;
1954	netif_tx_disable(netdev);
1955
1956	qlcnic_free_mac_list(adapter);
1957
1958	if (adapter->fhash.fnum)
1959		qlcnic_delete_lb_filters(adapter);
1960
1961	qlcnic_nic_set_promisc(adapter, QLCNIC_NIU_NON_PROMISC_MODE);
1962	if (qlcnic_sriov_vf_check(adapter))
1963		qlcnic_sriov_cleanup_async_list(&adapter->ahw->sriov->bc);
1964
1965	qlcnic_napi_disable(adapter);
1966
1967	qlcnic_fw_destroy_ctx(adapter);
1968	adapter->flags &= ~QLCNIC_FW_LRO_MSS_CAP;
1969
1970	qlcnic_reset_rx_buffers_list(adapter);
1971
1972	for (ring = 0; ring < adapter->drv_tx_rings; ring++)
1973		qlcnic_release_tx_buffers(adapter, &adapter->tx_ring[ring]);
1974}
1975
1976/* Usage: During suspend and firmware recovery module */
1977
1978void qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1979{
1980	rtnl_lock();
1981	if (netif_running(netdev))
1982		__qlcnic_down(adapter, netdev);
1983	rtnl_unlock();
1984
1985}
1986
1987int
1988qlcnic_attach(struct qlcnic_adapter *adapter)
1989{
1990	struct net_device *netdev = adapter->netdev;
1991	struct pci_dev *pdev = adapter->pdev;
1992	int err;
1993
1994	if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC)
1995		return 0;
1996
1997	err = qlcnic_napi_add(adapter, netdev);
1998	if (err)
1999		return err;
2000
2001	err = qlcnic_alloc_sw_resources(adapter);
2002	if (err) {
2003		dev_err(&pdev->dev, "Error in setting sw resources\n");
2004		goto err_out_napi_del;
2005	}
2006
2007	err = qlcnic_alloc_hw_resources(adapter);
2008	if (err) {
2009		dev_err(&pdev->dev, "Error in setting hw resources\n");
2010		goto err_out_free_sw;
2011	}
2012
2013	err = qlcnic_request_irq(adapter);
2014	if (err) {
2015		dev_err(&pdev->dev, "failed to setup interrupt\n");
2016		goto err_out_free_hw;
2017	}
2018
2019	qlcnic_create_sysfs_entries(adapter);
2020
2021	if (qlcnic_encap_rx_offload(adapter))
2022		udp_tunnel_get_rx_info(netdev);
2023
2024	adapter->is_up = QLCNIC_ADAPTER_UP_MAGIC;
2025	return 0;
2026
2027err_out_free_hw:
2028	qlcnic_free_hw_resources(adapter);
2029err_out_free_sw:
2030	qlcnic_free_sw_resources(adapter);
2031err_out_napi_del:
2032	qlcnic_napi_del(adapter);
2033	return err;
2034}
2035
2036void qlcnic_detach(struct qlcnic_adapter *adapter)
2037{
2038	if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
2039		return;
2040
2041	qlcnic_remove_sysfs_entries(adapter);
2042
2043	qlcnic_free_hw_resources(adapter);
2044	qlcnic_release_rx_buffers(adapter);
2045	qlcnic_free_irq(adapter);
2046	qlcnic_napi_del(adapter);
2047	qlcnic_free_sw_resources(adapter);
2048
2049	adapter->is_up = 0;
2050}
2051
2052void qlcnic_diag_free_res(struct net_device *netdev, int drv_sds_rings)
2053{
2054	struct qlcnic_adapter *adapter = netdev_priv(netdev);
2055	struct qlcnic_host_sds_ring *sds_ring;
2056	int drv_tx_rings = adapter->drv_tx_rings;
2057	int ring;
2058
2059	clear_bit(__QLCNIC_DEV_UP, &adapter->state);
2060	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
2061		for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
2062			sds_ring = &adapter->recv_ctx->sds_rings[ring];
2063			qlcnic_disable_sds_intr(adapter, sds_ring);
2064		}
2065	}
2066
2067	qlcnic_fw_destroy_ctx(adapter);
2068
2069	qlcnic_detach(adapter);
2070
2071	adapter->ahw->diag_test = 0;
2072	adapter->drv_sds_rings = drv_sds_rings;
2073	adapter->drv_tx_rings = drv_tx_rings;
2074
2075	if (qlcnic_attach(adapter))
2076		goto out;
2077
2078	if (netif_running(netdev))
2079		__qlcnic_up(adapter, netdev);
2080out:
2081	netif_device_attach(netdev);
2082}
2083
2084static int qlcnic_alloc_adapter_resources(struct qlcnic_adapter *adapter)
2085{
2086	struct qlcnic_hardware_context *ahw = adapter->ahw;
2087	int err = 0;
2088
2089	adapter->recv_ctx = kzalloc(sizeof(struct qlcnic_recv_context),
2090				GFP_KERNEL);
2091	if (!adapter->recv_ctx) {
2092		err = -ENOMEM;
2093		goto err_out;
2094	}
2095
2096	if (qlcnic_83xx_check(adapter)) {
2097		ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX_TX;
2098		ahw->coal.tx_time_us = QLCNIC_DEF_INTR_COALESCE_TX_TIME_US;
2099		ahw->coal.tx_packets = QLCNIC_DEF_INTR_COALESCE_TX_PACKETS;
2100		ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
2101		ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
2102	} else {
2103		ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX;
2104		ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
2105		ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
2106	}
2107
2108	/* clear stats */
2109	memset(&adapter->stats, 0, sizeof(adapter->stats));
2110err_out:
2111	return err;
2112}
2113
2114static void qlcnic_free_adapter_resources(struct qlcnic_adapter *adapter)
2115{
2116	struct qlcnic_fw_dump *fw_dump = &adapter->ahw->fw_dump;
2117
2118	kfree(adapter->recv_ctx);
2119	adapter->recv_ctx = NULL;
2120
2121	if (fw_dump->tmpl_hdr) {
2122		vfree(fw_dump->tmpl_hdr);
2123		fw_dump->tmpl_hdr = NULL;
2124	}
2125
2126	if (fw_dump->dma_buffer) {
2127		dma_free_coherent(&adapter->pdev->dev, QLC_PEX_DMA_READ_SIZE,
2128				  fw_dump->dma_buffer, fw_dump->phys_addr);
2129		fw_dump->dma_buffer = NULL;
2130	}
2131
2132	kfree(adapter->ahw->reset.buff);
2133	adapter->ahw->fw_dump.tmpl_hdr = NULL;
2134}
2135
2136int qlcnic_diag_alloc_res(struct net_device *netdev, int test)
2137{
2138	struct qlcnic_adapter *adapter = netdev_priv(netdev);
2139	struct qlcnic_host_sds_ring *sds_ring;
2140	struct qlcnic_host_rds_ring *rds_ring;
2141	int ring;
2142	int ret;
2143
2144	netif_device_detach(netdev);
2145
2146	if (netif_running(netdev))
2147		__qlcnic_down(adapter, netdev);
2148
2149	qlcnic_detach(adapter);
2150
2151	adapter->drv_sds_rings = QLCNIC_SINGLE_RING;
2152	adapter->ahw->diag_test = test;
2153	adapter->ahw->linkup = 0;
2154
2155	ret = qlcnic_attach(adapter);
2156	if (ret) {
2157		netif_device_attach(netdev);
2158		return ret;
2159	}
2160
2161	ret = qlcnic_fw_create_ctx(adapter);
2162	if (ret) {
2163		qlcnic_detach(adapter);
2164		netif_device_attach(netdev);
2165		return ret;
2166	}
2167
2168	for (ring = 0; ring < adapter->max_rds_rings; ring++) {
2169		rds_ring = &adapter->recv_ctx->rds_rings[ring];
2170		qlcnic_post_rx_buffers(adapter, rds_ring, ring);
2171	}
2172
2173	if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
2174		for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
2175			sds_ring = &adapter->recv_ctx->sds_rings[ring];
2176			qlcnic_enable_sds_intr(adapter, sds_ring);
2177		}
2178	}
2179
2180	if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {
2181		adapter->ahw->loopback_state = 0;
2182		qlcnic_linkevent_request(adapter, 1);
2183	}
2184
2185	set_bit(__QLCNIC_DEV_UP, &adapter->state);
2186
2187	return 0;
2188}
2189
2190/* Reset context in hardware only */
2191static int
2192qlcnic_reset_hw_context(struct qlcnic_adapter *adapter)
2193{
2194	struct net_device *netdev = adapter->netdev;
2195
2196	if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
2197		return -EBUSY;
2198
2199	netif_device_detach(netdev);
2200
2201	qlcnic_down(adapter, netdev);
2202
2203	qlcnic_up(adapter, netdev);
2204
2205	netif_device_attach(netdev);
2206
2207	clear_bit(__QLCNIC_RESETTING, &adapter->state);
2208	netdev_info(adapter->netdev, "%s: soft reset complete\n", __func__);
2209	return 0;
2210}
2211
2212int
2213qlcnic_reset_context(struct qlcnic_adapter *adapter)
2214{
2215	int err = 0;
2216	struct net_device *netdev = adapter->netdev;
2217
2218	if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
2219		return -EBUSY;
2220
2221	if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC) {
2222
2223		netif_device_detach(netdev);
2224
2225		if (netif_running(netdev))
2226			__qlcnic_down(adapter, netdev);
2227
2228		qlcnic_detach(adapter);
2229
2230		if (netif_running(netdev)) {
2231			err = qlcnic_attach(adapter);
2232			if (!err) {
2233				__qlcnic_up(adapter, netdev);
2234				qlcnic_restore_indev_addr(netdev, NETDEV_UP);
2235			}
2236		}
2237
2238		netif_device_attach(netdev);
2239	}
2240
2241	clear_bit(__QLCNIC_RESETTING, &adapter->state);
2242	return err;
2243}
2244
2245static void qlcnic_82xx_set_mac_filter_count(struct qlcnic_adapter *adapter)
2246{
2247	struct qlcnic_hardware_context *ahw = adapter->ahw;
2248	u16 act_pci_fn = ahw->total_nic_func;
2249	u16 count;
2250
2251	ahw->max_mc_count = QLCNIC_MAX_MC_COUNT;
2252	if (act_pci_fn <= 2)
2253		count = (QLCNIC_MAX_UC_COUNT - QLCNIC_MAX_MC_COUNT) /
2254			 act_pci_fn;
2255	else
2256		count = (QLCNIC_LB_MAX_FILTERS - QLCNIC_MAX_MC_COUNT) /
2257			 act_pci_fn;
2258	ahw->max_uc_count = count;
2259}
2260
2261static int qlcnic_set_real_num_queues(struct qlcnic_adapter *adapter,
2262				      u8 tx_queues, u8 rx_queues)
2263{
2264	struct net_device *netdev = adapter->netdev;
2265	int err = 0;
2266
2267	if (tx_queues) {
2268		err = netif_set_real_num_tx_queues(netdev, tx_queues);
2269		if (err) {
2270			netdev_err(netdev, "failed to set %d Tx queues\n",
2271				   tx_queues);
2272			return err;
2273		}
2274	}
2275
2276	if (rx_queues) {
2277		err = netif_set_real_num_rx_queues(netdev, rx_queues);
2278		if (err)
2279			netdev_err(netdev, "failed to set %d Rx queues\n",
2280				   rx_queues);
2281	}
2282
2283	return err;
2284}
2285
2286int
2287qlcnic_setup_netdev(struct qlcnic_adapter *adapter, struct net_device *netdev,
2288		    int pci_using_dac)
2289{
2290	int err;
2291	struct pci_dev *pdev = adapter->pdev;
2292
2293	adapter->rx_csum = 1;
2294	adapter->ahw->mc_enabled = 0;
2295	qlcnic_set_mac_filter_count(adapter);
2296
2297	netdev->netdev_ops	   = &qlcnic_netdev_ops;
2298	netdev->watchdog_timeo     = QLCNIC_WATCHDOG_TIMEOUTVALUE * HZ;
2299
2300	qlcnic_change_mtu(netdev, netdev->mtu);
2301
2302	netdev->ethtool_ops = (qlcnic_sriov_vf_check(adapter)) ?
2303		&qlcnic_sriov_vf_ethtool_ops : &qlcnic_ethtool_ops;
2304
2305	netdev->features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |
2306			     NETIF_F_IPV6_CSUM | NETIF_F_GRO |
2307			     NETIF_F_HW_VLAN_CTAG_RX);
2308	netdev->vlan_features |= (NETIF_F_SG | NETIF_F_IP_CSUM |
2309				  NETIF_F_IPV6_CSUM);
2310
2311	if (QLCNIC_IS_TSO_CAPABLE(adapter)) {
2312		netdev->features |= (NETIF_F_TSO | NETIF_F_TSO6);
2313		netdev->vlan_features |= (NETIF_F_TSO | NETIF_F_TSO6);
2314	}
2315
2316	if (pci_using_dac) {
2317		netdev->features |= NETIF_F_HIGHDMA;
2318		netdev->vlan_features |= NETIF_F_HIGHDMA;
2319	}
2320
2321	if (qlcnic_vlan_tx_check(adapter))
2322		netdev->features |= (NETIF_F_HW_VLAN_CTAG_TX);
2323
2324	if (qlcnic_sriov_vf_check(adapter))
2325		netdev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
2326
2327	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)
2328		netdev->features |= NETIF_F_LRO;
2329
2330	if (qlcnic_encap_tx_offload(adapter)) {
2331		netdev->features |= NETIF_F_GSO_UDP_TUNNEL;
2332
2333		/* encapsulation Tx offload supported by Adapter */
2334		netdev->hw_enc_features = NETIF_F_IP_CSUM        |
2335					  NETIF_F_GSO_UDP_TUNNEL |
2336					  NETIF_F_TSO            |
2337					  NETIF_F_TSO6;
2338	}
2339
2340	if (qlcnic_encap_rx_offload(adapter))
2341		netdev->hw_enc_features |= NETIF_F_RXCSUM;
2342
 
 
 
2343	netdev->hw_features = netdev->features;
2344	netdev->priv_flags |= IFF_UNICAST_FLT;
2345	netdev->irq = adapter->msix_entries[0].vector;
2346
2347	/* MTU range: 68 - 9600 */
2348	netdev->min_mtu = P3P_MIN_MTU;
2349	netdev->max_mtu = P3P_MAX_MTU;
2350
2351	err = qlcnic_set_real_num_queues(adapter, adapter->drv_tx_rings,
2352					 adapter->drv_sds_rings);
2353	if (err)
2354		return err;
2355
2356	qlcnic_dcb_init_dcbnl_ops(adapter->dcb);
2357
2358	err = register_netdev(netdev);
2359	if (err) {
2360		dev_err(&pdev->dev, "failed to register net device\n");
2361		return err;
2362	}
2363
2364	return 0;
2365}
2366
2367static int qlcnic_set_dma_mask(struct pci_dev *pdev, int *pci_using_dac)
2368{
2369	if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) &&
2370			!pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)))
2371		*pci_using_dac = 1;
2372	else if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) &&
2373			!pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)))
2374		*pci_using_dac = 0;
2375	else {
2376		dev_err(&pdev->dev, "Unable to set DMA mask, aborting\n");
2377		return -EIO;
2378	}
2379
2380	return 0;
2381}
2382
2383void qlcnic_free_tx_rings(struct qlcnic_adapter *adapter)
2384{
2385	int ring;
2386	struct qlcnic_host_tx_ring *tx_ring;
2387
2388	for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2389		tx_ring = &adapter->tx_ring[ring];
2390		if (tx_ring) {
2391			vfree(tx_ring->cmd_buf_arr);
2392			tx_ring->cmd_buf_arr = NULL;
2393		}
2394	}
2395	kfree(adapter->tx_ring);
2396}
2397
2398int qlcnic_alloc_tx_rings(struct qlcnic_adapter *adapter,
2399			  struct net_device *netdev)
2400{
2401	int ring, vector, index;
2402	struct qlcnic_host_tx_ring *tx_ring;
2403	struct qlcnic_cmd_buffer *cmd_buf_arr;
2404
2405	tx_ring = kcalloc(adapter->drv_tx_rings,
2406			  sizeof(struct qlcnic_host_tx_ring), GFP_KERNEL);
2407	if (tx_ring == NULL)
2408		return -ENOMEM;
2409
2410	adapter->tx_ring = tx_ring;
2411
2412	for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2413		tx_ring = &adapter->tx_ring[ring];
2414		tx_ring->num_desc = adapter->num_txd;
2415		tx_ring->txq = netdev_get_tx_queue(netdev, ring);
2416		cmd_buf_arr = vzalloc(TX_BUFF_RINGSIZE(tx_ring));
2417		if (cmd_buf_arr == NULL) {
2418			qlcnic_free_tx_rings(adapter);
2419			return -ENOMEM;
2420		}
2421		tx_ring->cmd_buf_arr = cmd_buf_arr;
2422		spin_lock_init(&tx_ring->tx_clean_lock);
2423	}
2424
2425	if (qlcnic_83xx_check(adapter) ||
2426	    (qlcnic_82xx_check(adapter) && qlcnic_check_multi_tx(adapter))) {
2427		for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2428			tx_ring = &adapter->tx_ring[ring];
2429			tx_ring->adapter = adapter;
2430			if (adapter->flags & QLCNIC_MSIX_ENABLED) {
2431				index = adapter->drv_sds_rings + ring;
2432				vector = adapter->msix_entries[index].vector;
2433				tx_ring->irq = vector;
2434			}
2435		}
2436	}
2437
2438	return 0;
2439}
2440
2441void qlcnic_set_drv_version(struct qlcnic_adapter *adapter)
2442{
2443	struct qlcnic_hardware_context *ahw = adapter->ahw;
2444	u32 fw_cmd = 0;
2445
2446	if (qlcnic_82xx_check(adapter))
2447		fw_cmd = QLCNIC_CMD_82XX_SET_DRV_VER;
2448	else if (qlcnic_83xx_check(adapter))
2449		fw_cmd = QLCNIC_CMD_83XX_SET_DRV_VER;
2450
2451	if (ahw->extra_capability[0] & QLCNIC_FW_CAPABILITY_SET_DRV_VER)
2452		qlcnic_fw_cmd_set_drv_version(adapter, fw_cmd);
2453}
2454
2455/* Reset firmware API lock */
2456static void qlcnic_reset_api_lock(struct qlcnic_adapter *adapter)
2457{
2458	qlcnic_api_lock(adapter);
2459	qlcnic_api_unlock(adapter);
2460}
2461
2462
2463static int
2464qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
2465{
2466	struct net_device *netdev = NULL;
2467	struct qlcnic_adapter *adapter = NULL;
2468	struct qlcnic_hardware_context *ahw;
2469	int err, pci_using_dac = -1;
2470	char board_name[QLCNIC_MAX_BOARD_NAME_LEN + 19]; /* MAC + ": " + name */
 
2471
2472	err = pci_enable_device(pdev);
2473	if (err)
2474		return err;
2475
2476	if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
2477		err = -ENODEV;
2478		goto err_out_disable_pdev;
2479	}
2480
2481	err = qlcnic_set_dma_mask(pdev, &pci_using_dac);
2482	if (err)
 
2483		goto err_out_disable_pdev;
 
2484
2485	err = pci_request_regions(pdev, qlcnic_driver_name);
2486	if (err)
2487		goto err_out_disable_pdev;
2488
2489	pci_set_master(pdev);
2490	pci_enable_pcie_error_reporting(pdev);
2491
2492	ahw = kzalloc(sizeof(struct qlcnic_hardware_context), GFP_KERNEL);
2493	if (!ahw) {
2494		err = -ENOMEM;
2495		goto err_out_free_res;
2496	}
2497
2498	switch (ent->device) {
2499	case PCI_DEVICE_ID_QLOGIC_QLE824X:
2500		ahw->hw_ops = &qlcnic_hw_ops;
2501		ahw->reg_tbl = (u32 *) qlcnic_reg_tbl;
2502		break;
2503	case PCI_DEVICE_ID_QLOGIC_QLE834X:
2504	case PCI_DEVICE_ID_QLOGIC_QLE8830:
2505	case PCI_DEVICE_ID_QLOGIC_QLE844X:
2506		qlcnic_83xx_register_map(ahw);
2507		break;
2508	case PCI_DEVICE_ID_QLOGIC_VF_QLE834X:
2509	case PCI_DEVICE_ID_QLOGIC_VF_QLE8C30:
2510	case PCI_DEVICE_ID_QLOGIC_VF_QLE844X:
2511		qlcnic_sriov_vf_register_map(ahw);
2512		break;
2513	default:
 
2514		goto err_out_free_hw_res;
2515	}
2516
2517	err = qlcnic_setup_pci_map(pdev, ahw);
2518	if (err)
2519		goto err_out_free_hw_res;
2520
2521	netdev = alloc_etherdev_mq(sizeof(struct qlcnic_adapter),
2522				   QLCNIC_MAX_TX_RINGS);
2523	if (!netdev) {
2524		err = -ENOMEM;
2525		goto err_out_iounmap;
2526	}
2527
2528	SET_NETDEV_DEV(netdev, &pdev->dev);
2529
2530	adapter = netdev_priv(netdev);
2531	adapter->netdev  = netdev;
2532	adapter->pdev    = pdev;
2533	adapter->ahw = ahw;
2534
2535	adapter->qlcnic_wq = create_singlethread_workqueue("qlcnic");
2536	if (adapter->qlcnic_wq == NULL) {
2537		err = -ENOMEM;
2538		dev_err(&pdev->dev, "Failed to create workqueue\n");
2539		goto err_out_free_netdev;
2540	}
2541
2542	err = qlcnic_alloc_adapter_resources(adapter);
2543	if (err)
2544		goto err_out_free_wq;
2545
2546	adapter->dev_rst_time = jiffies;
2547	ahw->revision_id = pdev->revision;
2548	ahw->max_vnic_func = qlcnic_get_vnic_func_count(adapter);
2549	if (qlcnic_mac_learn == FDB_MAC_LEARN)
2550		adapter->fdb_mac_learn = true;
2551	else if (qlcnic_mac_learn == DRV_MAC_LEARN)
2552		adapter->drv_mac_learn = true;
2553
2554	rwlock_init(&adapter->ahw->crb_lock);
2555	mutex_init(&adapter->ahw->mem_lock);
2556
2557	INIT_LIST_HEAD(&adapter->mac_list);
2558
2559	qlcnic_register_dcb(adapter);
2560
2561	if (qlcnic_82xx_check(adapter)) {
2562		qlcnic_check_vf(adapter, ent);
2563		adapter->portnum = adapter->ahw->pci_func;
2564		qlcnic_reset_api_lock(adapter);
2565		err = qlcnic_start_firmware(adapter);
2566		if (err) {
2567			dev_err(&pdev->dev, "Loading fw failed.Please Reboot\n"
2568				"\t\tIf reboot doesn't help, try flashing the card\n");
2569			goto err_out_maintenance_mode;
2570		}
2571
2572		/* compute and set default and max tx/sds rings */
2573		if (adapter->ahw->msix_supported) {
2574			if (qlcnic_check_multi_tx_capability(adapter) == 1)
2575				qlcnic_set_tx_ring_count(adapter,
2576							 QLCNIC_SINGLE_RING);
2577			else
2578				qlcnic_set_tx_ring_count(adapter,
2579							 QLCNIC_DEF_TX_RINGS);
2580			qlcnic_set_sds_ring_count(adapter,
2581						  QLCNIC_DEF_SDS_RINGS);
2582		} else {
2583			qlcnic_set_tx_ring_count(adapter, QLCNIC_SINGLE_RING);
2584			qlcnic_set_sds_ring_count(adapter, QLCNIC_SINGLE_RING);
2585		}
2586
2587		err = qlcnic_setup_idc_param(adapter);
2588		if (err)
2589			goto err_out_free_hw;
2590
2591		adapter->flags |= QLCNIC_NEED_FLR;
2592
2593	} else if (qlcnic_83xx_check(adapter)) {
2594		qlcnic_83xx_check_vf(adapter, ent);
2595		adapter->portnum = adapter->ahw->pci_func;
2596		err = qlcnic_83xx_init(adapter, pci_using_dac);
2597		if (err) {
2598			switch (err) {
2599			case -ENOTRECOVERABLE:
2600				dev_err(&pdev->dev, "Adapter initialization failed due to a faulty hardware\n");
2601				dev_err(&pdev->dev, "Please replace the adapter with new one and return the faulty adapter for repair\n");
2602				goto err_out_free_hw;
2603			case -ENOMEM:
2604				dev_err(&pdev->dev, "Adapter initialization failed. Please reboot\n");
2605				goto err_out_free_hw;
2606			case -EOPNOTSUPP:
2607				dev_err(&pdev->dev, "Adapter initialization failed\n");
2608				goto err_out_free_hw;
2609			default:
2610				dev_err(&pdev->dev, "Adapter initialization failed. Driver will load in maintenance mode to recover the adapter using the application\n");
2611				goto err_out_maintenance_mode;
2612			}
2613		}
2614
2615		if (qlcnic_sriov_vf_check(adapter))
2616			return 0;
2617	} else {
2618		dev_err(&pdev->dev,
2619			"%s: failed. Please Reboot\n", __func__);
2620		err = -ENODEV;
2621		goto err_out_free_hw;
2622	}
2623
2624	if (qlcnic_read_mac_addr(adapter))
2625		dev_warn(&pdev->dev, "failed to read mac addr\n");
2626
2627	qlcnic_read_phys_port_id(adapter);
2628
2629	if (adapter->portnum == 0) {
2630		qlcnic_get_board_name(adapter, board_name);
2631
2632		pr_info("%s: %s Board Chip rev 0x%x\n",
2633			module_name(THIS_MODULE),
2634			board_name, adapter->ahw->revision_id);
2635	}
2636
2637	if (qlcnic_83xx_check(adapter) && !qlcnic_use_msi_x &&
2638	    !!qlcnic_use_msi)
2639		dev_warn(&pdev->dev,
2640			 "Device does not support MSI interrupts\n");
2641
2642	if (qlcnic_82xx_check(adapter)) {
2643		qlcnic_dcb_enable(adapter->dcb);
 
 
 
 
 
 
2644		qlcnic_dcb_get_info(adapter->dcb);
2645		err = qlcnic_setup_intr(adapter);
2646
2647		if (err) {
2648			dev_err(&pdev->dev, "Failed to setup interrupt\n");
2649			goto err_out_disable_msi;
2650		}
2651	}
2652
2653	err = qlcnic_get_act_pci_func(adapter);
2654	if (err)
2655		goto err_out_disable_mbx_intr;
2656
2657	if (adapter->portnum == 0)
2658		qlcnic_set_drv_version(adapter);
2659
2660	err = qlcnic_setup_netdev(adapter, netdev, pci_using_dac);
2661	if (err)
2662		goto err_out_disable_mbx_intr;
2663
2664	pci_set_drvdata(pdev, adapter);
2665
2666	if (qlcnic_82xx_check(adapter))
2667		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
2668				     FW_POLL_DELAY);
2669
2670	switch (adapter->ahw->port_type) {
2671	case QLCNIC_GBE:
2672		dev_info(&adapter->pdev->dev, "%s: GbE port initialized\n",
2673				adapter->netdev->name);
2674		break;
2675	case QLCNIC_XGBE:
2676		dev_info(&adapter->pdev->dev, "%s: XGbE port initialized\n",
2677				adapter->netdev->name);
2678		break;
2679	}
2680
2681	if (adapter->drv_mac_learn)
2682		qlcnic_alloc_lb_filters_mem(adapter);
2683
2684	qlcnic_add_sysfs(adapter);
2685	qlcnic_register_hwmon_dev(adapter);
2686	return 0;
2687
2688err_out_disable_mbx_intr:
2689	if (qlcnic_83xx_check(adapter))
2690		qlcnic_83xx_free_mbx_intr(adapter);
2691
2692err_out_disable_msi:
2693	qlcnic_teardown_intr(adapter);
2694	qlcnic_cancel_idc_work(adapter);
2695	qlcnic_clr_all_drv_state(adapter, 0);
2696
2697err_out_free_hw:
2698	qlcnic_free_adapter_resources(adapter);
2699
2700err_out_free_wq:
2701	destroy_workqueue(adapter->qlcnic_wq);
2702
2703err_out_free_netdev:
2704	free_netdev(netdev);
2705
2706err_out_iounmap:
2707	qlcnic_cleanup_pci_map(ahw);
2708
2709err_out_free_hw_res:
2710	kfree(ahw);
2711
2712err_out_free_res:
2713	pci_release_regions(pdev);
2714
2715err_out_disable_pdev:
2716	pci_disable_device(pdev);
2717	return err;
2718
2719err_out_maintenance_mode:
2720	set_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state);
2721	netdev->netdev_ops = &qlcnic_netdev_failed_ops;
2722	netdev->ethtool_ops = &qlcnic_ethtool_failed_ops;
2723	ahw->port_type = QLCNIC_XGBE;
2724
2725	if (qlcnic_83xx_check(adapter))
2726		adapter->tgt_status_reg = NULL;
2727	else
2728		ahw->board_type = QLCNIC_BRDTYPE_P3P_10G_SFP_PLUS;
2729
2730	err = register_netdev(netdev);
2731
2732	if (err) {
2733		dev_err(&pdev->dev, "Failed to register net device\n");
2734		qlcnic_clr_all_drv_state(adapter, 0);
2735		goto err_out_free_hw;
2736	}
2737
2738	pci_set_drvdata(pdev, adapter);
2739	qlcnic_add_sysfs(adapter);
2740
2741	return 0;
2742}
2743
2744static void qlcnic_remove(struct pci_dev *pdev)
2745{
2746	struct qlcnic_adapter *adapter;
2747	struct net_device *netdev;
2748	struct qlcnic_hardware_context *ahw;
2749
2750	adapter = pci_get_drvdata(pdev);
2751	if (adapter == NULL)
2752		return;
2753
2754	netdev = adapter->netdev;
2755
2756	qlcnic_cancel_idc_work(adapter);
2757	qlcnic_sriov_pf_disable(adapter);
2758	ahw = adapter->ahw;
2759
2760	unregister_netdev(netdev);
2761	qlcnic_sriov_cleanup(adapter);
2762
2763	if (qlcnic_83xx_check(adapter)) {
2764		qlcnic_83xx_initialize_nic(adapter, 0);
2765		cancel_delayed_work_sync(&adapter->idc_aen_work);
2766		qlcnic_83xx_free_mbx_intr(adapter);
2767		qlcnic_83xx_detach_mailbox_work(adapter);
2768		qlcnic_83xx_free_mailbox(ahw->mailbox);
2769		kfree(ahw->fw_info);
2770	}
2771
2772	qlcnic_dcb_free(adapter->dcb);
2773	qlcnic_detach(adapter);
2774	kfree(adapter->npars);
2775	kfree(adapter->eswitch);
2776
2777	if (qlcnic_82xx_check(adapter))
2778		qlcnic_clr_all_drv_state(adapter, 0);
2779
2780	clear_bit(__QLCNIC_RESETTING, &adapter->state);
2781
2782	qlcnic_free_lb_filters_mem(adapter);
2783
2784	qlcnic_teardown_intr(adapter);
2785
2786	qlcnic_remove_sysfs(adapter);
2787
2788	qlcnic_unregister_hwmon_dev(adapter);
2789
2790	qlcnic_cleanup_pci_map(adapter->ahw);
2791
2792	qlcnic_release_firmware(adapter);
2793
2794	pci_disable_pcie_error_reporting(pdev);
2795	pci_release_regions(pdev);
2796	pci_disable_device(pdev);
2797
2798	if (adapter->qlcnic_wq) {
2799		destroy_workqueue(adapter->qlcnic_wq);
2800		adapter->qlcnic_wq = NULL;
2801	}
2802
2803	qlcnic_free_adapter_resources(adapter);
2804	kfree(ahw);
2805	free_netdev(netdev);
2806}
2807
2808static void qlcnic_shutdown(struct pci_dev *pdev)
2809{
2810	if (__qlcnic_shutdown(pdev))
2811		return;
2812
2813	pci_disable_device(pdev);
2814}
2815
2816#ifdef CONFIG_PM
2817static int qlcnic_suspend(struct pci_dev *pdev, pm_message_t state)
2818{
2819	int retval;
2820
2821	retval = __qlcnic_shutdown(pdev);
2822	if (retval)
2823		return retval;
2824
2825	pci_set_power_state(pdev, pci_choose_state(pdev, state));
2826	return 0;
2827}
2828
2829static int qlcnic_resume(struct pci_dev *pdev)
2830{
2831	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
2832	int err;
2833
2834	err = pci_enable_device(pdev);
2835	if (err)
2836		return err;
2837
2838	pci_set_power_state(pdev, PCI_D0);
2839	pci_set_master(pdev);
2840	pci_restore_state(pdev);
2841
2842	return  __qlcnic_resume(adapter);
2843}
2844#endif
2845
2846static int qlcnic_open(struct net_device *netdev)
2847{
2848	struct qlcnic_adapter *adapter = netdev_priv(netdev);
2849	int err;
2850
2851	if (test_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state)) {
2852		netdev_err(netdev, "%s: Device is in non-operational state\n",
2853			   __func__);
2854
2855		return -EIO;
2856	}
2857
2858	netif_carrier_off(netdev);
2859
2860	err = qlcnic_attach(adapter);
2861	if (err)
2862		return err;
2863
2864	err = __qlcnic_up(adapter, netdev);
2865	if (err)
2866		qlcnic_detach(adapter);
2867
2868	return err;
2869}
2870
2871/*
2872 * qlcnic_close - Disables a network interface entry point
2873 */
2874static int qlcnic_close(struct net_device *netdev)
2875{
2876	struct qlcnic_adapter *adapter = netdev_priv(netdev);
2877
2878	__qlcnic_down(adapter, netdev);
2879
2880	return 0;
2881}
2882
2883#define QLCNIC_VF_LB_BUCKET_SIZE 1
2884
2885void qlcnic_alloc_lb_filters_mem(struct qlcnic_adapter *adapter)
2886{
2887	void *head;
2888	int i;
2889	struct net_device *netdev = adapter->netdev;
2890	u32 filter_size = 0;
2891	u16 act_pci_func = 0;
2892
2893	if (adapter->fhash.fmax && adapter->fhash.fhead)
2894		return;
2895
2896	act_pci_func = adapter->ahw->total_nic_func;
2897	spin_lock_init(&adapter->mac_learn_lock);
2898	spin_lock_init(&adapter->rx_mac_learn_lock);
2899
2900	if (qlcnic_sriov_vf_check(adapter)) {
2901		filter_size = QLCNIC_83XX_SRIOV_VF_MAX_MAC - 1;
2902		adapter->fhash.fbucket_size = QLCNIC_VF_LB_BUCKET_SIZE;
2903	} else if (qlcnic_82xx_check(adapter)) {
2904		filter_size = QLCNIC_LB_MAX_FILTERS;
2905		adapter->fhash.fbucket_size = QLCNIC_LB_BUCKET_SIZE;
2906	} else {
2907		filter_size = QLC_83XX_LB_MAX_FILTERS;
2908		adapter->fhash.fbucket_size = QLC_83XX_LB_BUCKET_SIZE;
2909	}
2910
2911	head = kcalloc(adapter->fhash.fbucket_size,
2912		       sizeof(struct hlist_head), GFP_ATOMIC);
2913
2914	if (!head)
2915		return;
2916
2917	adapter->fhash.fmax = (filter_size / act_pci_func);
2918	adapter->fhash.fhead = head;
2919
2920	netdev_info(netdev, "active nic func = %d, mac filter size=%d\n",
2921		    act_pci_func, adapter->fhash.fmax);
2922
2923	for (i = 0; i < adapter->fhash.fbucket_size; i++)
2924		INIT_HLIST_HEAD(&adapter->fhash.fhead[i]);
2925
2926	adapter->rx_fhash.fbucket_size = adapter->fhash.fbucket_size;
2927
2928	head = kcalloc(adapter->rx_fhash.fbucket_size,
2929		       sizeof(struct hlist_head), GFP_ATOMIC);
2930
2931	if (!head)
2932		return;
2933
2934	adapter->rx_fhash.fmax = (filter_size / act_pci_func);
2935	adapter->rx_fhash.fhead = head;
2936
2937	for (i = 0; i < adapter->rx_fhash.fbucket_size; i++)
2938		INIT_HLIST_HEAD(&adapter->rx_fhash.fhead[i]);
2939}
2940
2941static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter)
2942{
2943	if (adapter->fhash.fmax)
2944		kfree(adapter->fhash.fhead);
2945
2946	adapter->fhash.fhead = NULL;
2947	adapter->fhash.fmax = 0;
2948
2949	if (adapter->rx_fhash.fmax)
2950		kfree(adapter->rx_fhash.fhead);
2951
2952	adapter->rx_fhash.fmax = 0;
2953	adapter->rx_fhash.fhead = NULL;
2954}
2955
2956int qlcnic_check_temp(struct qlcnic_adapter *adapter)
2957{
2958	struct net_device *netdev = adapter->netdev;
2959	u32 temp_state, temp_val, temp = 0;
2960	int rv = 0;
2961
2962	if (qlcnic_83xx_check(adapter))
2963		temp = QLCRDX(adapter->ahw, QLC_83XX_ASIC_TEMP);
2964
2965	if (qlcnic_82xx_check(adapter))
2966		temp = QLC_SHARED_REG_RD32(adapter, QLCNIC_ASIC_TEMP);
2967
2968	temp_state = qlcnic_get_temp_state(temp);
2969	temp_val = qlcnic_get_temp_val(temp);
2970
2971	if (temp_state == QLCNIC_TEMP_PANIC) {
2972		dev_err(&netdev->dev,
2973		       "Device temperature %d degrees C exceeds"
2974		       " maximum allowed. Hardware has been shut down.\n",
2975		       temp_val);
2976		rv = 1;
2977	} else if (temp_state == QLCNIC_TEMP_WARN) {
2978		if (adapter->ahw->temp == QLCNIC_TEMP_NORMAL) {
2979			dev_err(&netdev->dev,
2980			       "Device temperature %d degrees C "
2981			       "exceeds operating range."
2982			       " Immediate action needed.\n",
2983			       temp_val);
2984		}
2985	} else {
2986		if (adapter->ahw->temp == QLCNIC_TEMP_WARN) {
2987			dev_info(&netdev->dev,
2988			       "Device temperature is now %d degrees C"
2989			       " in normal range.\n", temp_val);
2990		}
2991	}
2992	adapter->ahw->temp = temp_state;
2993	return rv;
2994}
2995
2996static inline void dump_tx_ring_desc(struct qlcnic_host_tx_ring *tx_ring)
2997{
2998	int i;
2999	struct cmd_desc_type0 *tx_desc_info;
3000
3001	for (i = 0; i < tx_ring->num_desc; i++) {
3002		tx_desc_info = &tx_ring->desc_head[i];
3003		pr_info("TX Desc: %d\n", i);
3004		print_hex_dump(KERN_INFO, "TX: ", DUMP_PREFIX_OFFSET, 16, 1,
3005			       &tx_ring->desc_head[i],
3006			       sizeof(struct cmd_desc_type0), true);
3007	}
3008}
3009
3010static void qlcnic_dump_rings(struct qlcnic_adapter *adapter)
3011{
3012	struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
3013	struct net_device *netdev = adapter->netdev;
3014	struct qlcnic_host_rds_ring *rds_ring;
3015	struct qlcnic_host_sds_ring *sds_ring;
3016	struct qlcnic_host_tx_ring *tx_ring;
3017	int ring;
3018
3019	if (!netdev || !netif_running(netdev))
3020		return;
3021
3022	for (ring = 0; ring < adapter->max_rds_rings; ring++) {
3023		rds_ring = &recv_ctx->rds_rings[ring];
3024		if (!rds_ring)
3025			continue;
3026		netdev_info(netdev,
3027			    "rds_ring=%d crb_rcv_producer=%d producer=%u num_desc=%u\n",
3028			     ring, readl(rds_ring->crb_rcv_producer),
3029			     rds_ring->producer, rds_ring->num_desc);
3030	}
3031
3032	for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
3033		sds_ring = &(recv_ctx->sds_rings[ring]);
3034		if (!sds_ring)
3035			continue;
3036		netdev_info(netdev,
3037			    "sds_ring=%d crb_sts_consumer=%d consumer=%u crb_intr_mask=%d num_desc=%u\n",
3038			    ring, readl(sds_ring->crb_sts_consumer),
3039			    sds_ring->consumer, readl(sds_ring->crb_intr_mask),
3040			    sds_ring->num_desc);
3041	}
3042
3043	for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
3044		tx_ring = &adapter->tx_ring[ring];
3045		if (!tx_ring)
3046			continue;
3047		netdev_info(netdev, "Tx ring=%d Context Id=0x%x\n",
3048			    ring, tx_ring->ctx_id);
3049		netdev_info(netdev,
3050			    "xmit_finished=%llu, xmit_called=%llu, xmit_on=%llu, xmit_off=%llu\n",
3051			    tx_ring->tx_stats.xmit_finished,
3052			    tx_ring->tx_stats.xmit_called,
3053			    tx_ring->tx_stats.xmit_on,
3054			    tx_ring->tx_stats.xmit_off);
3055
3056		if (tx_ring->crb_intr_mask)
3057			netdev_info(netdev, "crb_intr_mask=%d\n",
3058				    readl(tx_ring->crb_intr_mask));
3059
3060		netdev_info(netdev,
3061			    "hw_producer=%d, sw_producer=%d sw_consumer=%d, hw_consumer=%d\n",
3062			    readl(tx_ring->crb_cmd_producer),
3063			    tx_ring->producer, tx_ring->sw_consumer,
3064			    le32_to_cpu(*(tx_ring->hw_consumer)));
3065
3066		netdev_info(netdev, "Total desc=%d, Available desc=%d\n",
3067			    tx_ring->num_desc, qlcnic_tx_avail(tx_ring));
3068
3069		if (netif_msg_tx_err(adapter->ahw))
3070			dump_tx_ring_desc(tx_ring);
3071	}
3072
3073}
3074
3075static void qlcnic_tx_timeout(struct net_device *netdev)
3076{
3077	struct qlcnic_adapter *adapter = netdev_priv(netdev);
3078
3079	if (test_bit(__QLCNIC_RESETTING, &adapter->state))
3080		return;
3081
3082	qlcnic_dump_rings(adapter);
3083
3084	if (++adapter->tx_timeo_cnt >= QLCNIC_MAX_TX_TIMEOUTS ||
3085	    netif_msg_tx_err(adapter->ahw)) {
3086		netdev_err(netdev, "Tx timeout, reset the adapter.\n");
3087		if (qlcnic_82xx_check(adapter))
3088			adapter->need_fw_reset = 1;
3089		else if (qlcnic_83xx_check(adapter))
3090			qlcnic_83xx_idc_request_reset(adapter,
3091						      QLCNIC_FORCE_FW_DUMP_KEY);
3092	} else {
3093		netdev_err(netdev, "Tx timeout, reset adapter context.\n");
3094		adapter->ahw->reset_context = 1;
3095	}
3096}
3097
3098static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev)
3099{
3100	struct qlcnic_adapter *adapter = netdev_priv(netdev);
3101	struct net_device_stats *stats = &netdev->stats;
3102
3103	if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
3104		qlcnic_update_stats(adapter);
3105
3106	stats->rx_packets = adapter->stats.rx_pkts + adapter->stats.lro_pkts;
3107	stats->tx_packets = adapter->stats.xmitfinished;
3108	stats->rx_bytes = adapter->stats.rxbytes + adapter->stats.lrobytes;
3109	stats->tx_bytes = adapter->stats.txbytes;
3110	stats->rx_dropped = adapter->stats.rxdropped;
3111	stats->tx_dropped = adapter->stats.txdropped;
3112
3113	return stats;
3114}
3115
3116static irqreturn_t qlcnic_82xx_clear_legacy_intr(struct qlcnic_adapter *adapter)
3117{
3118	u32 status;
3119
3120	status = readl(adapter->isr_int_vec);
3121
3122	if (!(status & adapter->ahw->int_vec_bit))
3123		return IRQ_NONE;
3124
3125	/* check interrupt state machine, to be sure */
3126	status = readl(adapter->crb_int_state_reg);
3127	if (!ISR_LEGACY_INT_TRIGGERED(status))
3128		return IRQ_NONE;
3129
3130	writel(0xffffffff, adapter->tgt_status_reg);
3131	/* read twice to ensure write is flushed */
3132	readl(adapter->isr_int_vec);
3133	readl(adapter->isr_int_vec);
3134
3135	return IRQ_HANDLED;
3136}
3137
3138static irqreturn_t qlcnic_tmp_intr(int irq, void *data)
3139{
3140	struct qlcnic_host_sds_ring *sds_ring = data;
3141	struct qlcnic_adapter *adapter = sds_ring->adapter;
3142
3143	if (adapter->flags & QLCNIC_MSIX_ENABLED)
3144		goto done;
3145	else if (adapter->flags & QLCNIC_MSI_ENABLED) {
3146		writel(0xffffffff, adapter->tgt_status_reg);
3147		goto done;
3148	}
3149
3150	if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
3151		return IRQ_NONE;
3152
3153done:
3154	adapter->ahw->diag_cnt++;
3155	qlcnic_enable_sds_intr(adapter, sds_ring);
3156	return IRQ_HANDLED;
3157}
3158
3159static irqreturn_t qlcnic_intr(int irq, void *data)
3160{
3161	struct qlcnic_host_sds_ring *sds_ring = data;
3162	struct qlcnic_adapter *adapter = sds_ring->adapter;
3163
3164	if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
3165		return IRQ_NONE;
3166
3167	napi_schedule(&sds_ring->napi);
3168
3169	return IRQ_HANDLED;
3170}
3171
3172static irqreturn_t qlcnic_msi_intr(int irq, void *data)
3173{
3174	struct qlcnic_host_sds_ring *sds_ring = data;
3175	struct qlcnic_adapter *adapter = sds_ring->adapter;
3176
3177	/* clear interrupt */
3178	writel(0xffffffff, adapter->tgt_status_reg);
3179
3180	napi_schedule(&sds_ring->napi);
3181	return IRQ_HANDLED;
3182}
3183
3184static irqreturn_t qlcnic_msix_intr(int irq, void *data)
3185{
3186	struct qlcnic_host_sds_ring *sds_ring = data;
3187
3188	napi_schedule(&sds_ring->napi);
3189	return IRQ_HANDLED;
3190}
3191
3192static irqreturn_t qlcnic_msix_tx_intr(int irq, void *data)
3193{
3194	struct qlcnic_host_tx_ring *tx_ring = data;
3195
3196	napi_schedule(&tx_ring->napi);
3197	return IRQ_HANDLED;
3198}
3199
3200#ifdef CONFIG_NET_POLL_CONTROLLER
3201static void qlcnic_poll_controller(struct net_device *netdev)
3202{
3203	struct qlcnic_adapter *adapter = netdev_priv(netdev);
3204	struct qlcnic_host_sds_ring *sds_ring;
3205	struct qlcnic_recv_context *recv_ctx;
3206	struct qlcnic_host_tx_ring *tx_ring;
3207	int ring;
3208
3209	if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
3210		return;
3211
3212	recv_ctx = adapter->recv_ctx;
3213
3214	for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
3215		sds_ring = &recv_ctx->sds_rings[ring];
3216		qlcnic_disable_sds_intr(adapter, sds_ring);
3217		napi_schedule(&sds_ring->napi);
3218	}
3219
3220	if (adapter->flags & QLCNIC_MSIX_ENABLED) {
3221		/* Only Multi-Tx queue capable devices need to
3222		 * schedule NAPI for TX rings
3223		 */
3224		if ((qlcnic_83xx_check(adapter) &&
3225		     (adapter->flags & QLCNIC_TX_INTR_SHARED)) ||
3226		    (qlcnic_82xx_check(adapter) &&
3227		     !qlcnic_check_multi_tx(adapter)))
3228			return;
3229
3230		for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
3231			tx_ring = &adapter->tx_ring[ring];
3232			qlcnic_disable_tx_intr(adapter, tx_ring);
3233			napi_schedule(&tx_ring->napi);
3234		}
3235	}
3236}
3237#endif
3238
3239static void
3240qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding)
3241{
3242	u32 val;
3243
3244	val = adapter->portnum & 0xf;
3245	val |= encoding << 7;
3246	val |= (jiffies - adapter->dev_rst_time) << 8;
3247
3248	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_SCRATCH, val);
3249	adapter->dev_rst_time = jiffies;
3250}
3251
3252static int
3253qlcnic_set_drv_state(struct qlcnic_adapter *adapter, u8 state)
3254{
3255	u32  val;
3256
3257	WARN_ON(state != QLCNIC_DEV_NEED_RESET &&
3258			state != QLCNIC_DEV_NEED_QUISCENT);
3259
3260	if (qlcnic_api_lock(adapter))
3261		return -EIO;
3262
3263	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3264
3265	if (state == QLCNIC_DEV_NEED_RESET)
3266		QLC_DEV_SET_RST_RDY(val, adapter->portnum);
3267	else if (state == QLCNIC_DEV_NEED_QUISCENT)
3268		QLC_DEV_SET_QSCNT_RDY(val, adapter->portnum);
3269
3270	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3271
3272	qlcnic_api_unlock(adapter);
3273
3274	return 0;
3275}
3276
3277static int
3278qlcnic_clr_drv_state(struct qlcnic_adapter *adapter)
3279{
3280	u32  val;
3281
3282	if (qlcnic_api_lock(adapter))
3283		return -EBUSY;
3284
3285	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3286	QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
3287	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3288
3289	qlcnic_api_unlock(adapter);
3290
3291	return 0;
3292}
3293
3294void qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8 failed)
3295{
3296	u32  val;
3297
3298	if (qlcnic_api_lock(adapter))
3299		goto err;
3300
3301	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3302	QLC_DEV_CLR_REF_CNT(val, adapter->portnum);
3303	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
3304
3305	if (failed) {
3306		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3307				    QLCNIC_DEV_FAILED);
3308		dev_info(&adapter->pdev->dev,
3309				"Device state set to Failed. Please Reboot\n");
3310	} else if (!(val & 0x11111111))
3311		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3312				    QLCNIC_DEV_COLD);
3313
3314	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3315	QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
3316	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3317
3318	qlcnic_api_unlock(adapter);
3319err:
3320	adapter->fw_fail_cnt = 0;
3321	adapter->flags &= ~QLCNIC_FW_HANG;
3322	clear_bit(__QLCNIC_START_FW, &adapter->state);
3323	clear_bit(__QLCNIC_RESETTING, &adapter->state);
3324}
3325
3326/* Grab api lock, before checking state */
3327static int
3328qlcnic_check_drv_state(struct qlcnic_adapter *adapter)
3329{
3330	int act, state, active_mask;
3331	struct qlcnic_hardware_context *ahw = adapter->ahw;
3332
3333	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3334	act = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3335
3336	if (adapter->flags & QLCNIC_FW_RESET_OWNER) {
3337		active_mask = (~(1 << (ahw->pci_func * 4)));
3338		act = act & active_mask;
3339	}
3340
3341	if (((state & 0x11111111) == (act & 0x11111111)) ||
3342			((act & 0x11111111) == ((state >> 1) & 0x11111111)))
3343		return 0;
3344	else
3345		return 1;
3346}
3347
3348static int qlcnic_check_idc_ver(struct qlcnic_adapter *adapter)
3349{
3350	u32 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_IDC_VER);
3351
3352	if (val != QLCNIC_DRV_IDC_VER) {
3353		dev_warn(&adapter->pdev->dev, "IDC Version mismatch, driver's"
3354			" idc ver = %x; reqd = %x\n", QLCNIC_DRV_IDC_VER, val);
3355	}
3356
3357	return 0;
3358}
3359
3360static int
3361qlcnic_can_start_firmware(struct qlcnic_adapter *adapter)
3362{
3363	u32 val, prev_state;
3364	u8 dev_init_timeo = adapter->dev_init_timeo;
3365	u8 portnum = adapter->portnum;
3366	u8 ret;
3367
3368	if (test_and_clear_bit(__QLCNIC_START_FW, &adapter->state))
3369		return 1;
3370
3371	if (qlcnic_api_lock(adapter))
3372		return -1;
3373
3374	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3375	if (!(val & (1 << (portnum * 4)))) {
3376		QLC_DEV_SET_REF_CNT(val, portnum);
3377		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
3378	}
3379
3380	prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3381	QLCDB(adapter, HW, "Device state = %u\n", prev_state);
3382
3383	switch (prev_state) {
3384	case QLCNIC_DEV_COLD:
3385		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3386				    QLCNIC_DEV_INITIALIZING);
3387		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_IDC_VER,
3388				    QLCNIC_DRV_IDC_VER);
3389		qlcnic_idc_debug_info(adapter, 0);
3390		qlcnic_api_unlock(adapter);
3391		return 1;
3392
3393	case QLCNIC_DEV_READY:
3394		ret = qlcnic_check_idc_ver(adapter);
3395		qlcnic_api_unlock(adapter);
3396		return ret;
3397
3398	case QLCNIC_DEV_NEED_RESET:
3399		val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3400		QLC_DEV_SET_RST_RDY(val, portnum);
3401		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3402		break;
3403
3404	case QLCNIC_DEV_NEED_QUISCENT:
3405		val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3406		QLC_DEV_SET_QSCNT_RDY(val, portnum);
3407		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3408		break;
3409
3410	case QLCNIC_DEV_FAILED:
3411		dev_err(&adapter->pdev->dev, "Device in failed state.\n");
3412		qlcnic_api_unlock(adapter);
3413		return -1;
3414
3415	case QLCNIC_DEV_INITIALIZING:
3416	case QLCNIC_DEV_QUISCENT:
3417		break;
3418	}
3419
3420	qlcnic_api_unlock(adapter);
3421
3422	do {
3423		msleep(1000);
3424		prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3425
3426		if (prev_state == QLCNIC_DEV_QUISCENT)
3427			continue;
3428	} while ((prev_state != QLCNIC_DEV_READY) && --dev_init_timeo);
3429
3430	if (!dev_init_timeo) {
3431		dev_err(&adapter->pdev->dev,
3432			"Waiting for device to initialize timeout\n");
3433		return -1;
3434	}
3435
3436	if (qlcnic_api_lock(adapter))
3437		return -1;
3438
3439	val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3440	QLC_DEV_CLR_RST_QSCNT(val, portnum);
3441	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3442
3443	ret = qlcnic_check_idc_ver(adapter);
3444	qlcnic_api_unlock(adapter);
3445
3446	return ret;
3447}
3448
3449static void
3450qlcnic_fwinit_work(struct work_struct *work)
3451{
3452	struct qlcnic_adapter *adapter = container_of(work,
3453			struct qlcnic_adapter, fw_work.work);
3454	u32 dev_state = 0xf;
3455	u32 val;
3456
3457	if (qlcnic_api_lock(adapter))
3458		goto err_ret;
3459
3460	dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3461	if (dev_state == QLCNIC_DEV_QUISCENT ||
3462	    dev_state == QLCNIC_DEV_NEED_QUISCENT) {
3463		qlcnic_api_unlock(adapter);
3464		qlcnic_schedule_work(adapter, qlcnic_fwinit_work,
3465						FW_POLL_DELAY * 2);
3466		return;
3467	}
3468
3469	if (adapter->ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
3470		qlcnic_api_unlock(adapter);
3471		goto wait_npar;
3472	}
3473
3474	if (dev_state == QLCNIC_DEV_INITIALIZING ||
3475	    dev_state == QLCNIC_DEV_READY) {
3476		dev_info(&adapter->pdev->dev, "Detected state change from "
3477				"DEV_NEED_RESET, skipping ack check\n");
3478		goto skip_ack_check;
3479	}
3480
3481	if (adapter->fw_wait_cnt++ > adapter->reset_ack_timeo) {
3482		dev_info(&adapter->pdev->dev, "Reset:Failed to get ack %d sec\n",
3483					adapter->reset_ack_timeo);
3484		goto skip_ack_check;
3485	}
3486
3487	if (!qlcnic_check_drv_state(adapter)) {
3488skip_ack_check:
3489		dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3490
3491		if (dev_state == QLCNIC_DEV_NEED_RESET) {
3492			QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3493					    QLCNIC_DEV_INITIALIZING);
3494			set_bit(__QLCNIC_START_FW, &adapter->state);
3495			QLCDB(adapter, DRV, "Restarting fw\n");
3496			qlcnic_idc_debug_info(adapter, 0);
3497			val = QLC_SHARED_REG_RD32(adapter,
3498						  QLCNIC_CRB_DRV_STATE);
3499			QLC_DEV_SET_RST_RDY(val, adapter->portnum);
3500			QLC_SHARED_REG_WR32(adapter,
3501					    QLCNIC_CRB_DRV_STATE, val);
3502		}
3503
3504		qlcnic_api_unlock(adapter);
3505
3506		rtnl_lock();
3507		if (qlcnic_check_fw_dump_state(adapter) &&
3508		    (adapter->flags & QLCNIC_FW_RESET_OWNER)) {
3509			QLCDB(adapter, DRV, "Take FW dump\n");
3510			qlcnic_dump_fw(adapter);
3511			adapter->flags |= QLCNIC_FW_HANG;
3512		}
3513		rtnl_unlock();
3514
3515		adapter->flags &= ~QLCNIC_FW_RESET_OWNER;
3516		if (!adapter->nic_ops->start_firmware(adapter)) {
3517			qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
3518			adapter->fw_wait_cnt = 0;
3519			return;
3520		}
3521		goto err_ret;
3522	}
3523
3524	qlcnic_api_unlock(adapter);
3525
3526wait_npar:
3527	dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3528	QLCDB(adapter, HW, "Func waiting: Device state=%u\n", dev_state);
3529
3530	switch (dev_state) {
3531	case QLCNIC_DEV_READY:
3532		if (!qlcnic_start_firmware(adapter)) {
3533			qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
3534			adapter->fw_wait_cnt = 0;
3535			return;
3536		}
 
3537	case QLCNIC_DEV_FAILED:
3538		break;
3539	default:
3540		qlcnic_schedule_work(adapter,
3541			qlcnic_fwinit_work, FW_POLL_DELAY);
3542		return;
3543	}
3544
3545err_ret:
3546	dev_err(&adapter->pdev->dev, "Fwinit work failed state=%u "
3547		"fw_wait_cnt=%u\n", dev_state, adapter->fw_wait_cnt);
3548	netif_device_attach(adapter->netdev);
3549	qlcnic_clr_all_drv_state(adapter, 0);
3550}
3551
3552static void
3553qlcnic_detach_work(struct work_struct *work)
3554{
3555	struct qlcnic_adapter *adapter = container_of(work,
3556			struct qlcnic_adapter, fw_work.work);
3557	struct net_device *netdev = adapter->netdev;
3558	u32 status;
3559
3560	netif_device_detach(netdev);
3561
3562	/* Dont grab rtnl lock during Quiscent mode */
3563	if (adapter->dev_state == QLCNIC_DEV_NEED_QUISCENT) {
3564		if (netif_running(netdev))
3565			__qlcnic_down(adapter, netdev);
3566	} else
3567		qlcnic_down(adapter, netdev);
3568
3569	status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
3570
3571	if (status & QLCNIC_RCODE_FATAL_ERROR) {
3572		dev_err(&adapter->pdev->dev,
3573			"Detaching the device: peg halt status1=0x%x\n",
3574					status);
3575
3576		if (QLCNIC_FWERROR_CODE(status) == QLCNIC_FWERROR_FAN_FAILURE) {
3577			dev_err(&adapter->pdev->dev,
3578			"On board active cooling fan failed. "
3579				"Device has been halted.\n");
3580			dev_err(&adapter->pdev->dev,
3581				"Replace the adapter.\n");
3582		}
3583
3584		goto err_ret;
3585	}
3586
3587	if (adapter->ahw->temp == QLCNIC_TEMP_PANIC) {
3588		dev_err(&adapter->pdev->dev, "Detaching the device: temp=%d\n",
3589			adapter->ahw->temp);
3590		goto err_ret;
3591	}
3592
3593	/* Dont ack if this instance is the reset owner */
3594	if (!(adapter->flags & QLCNIC_FW_RESET_OWNER)) {
3595		if (qlcnic_set_drv_state(adapter, adapter->dev_state)) {
3596			dev_err(&adapter->pdev->dev,
3597				"Failed to set driver state,"
3598					"detaching the device.\n");
3599			goto err_ret;
3600		}
3601	}
3602
3603	adapter->fw_wait_cnt = 0;
3604
3605	qlcnic_schedule_work(adapter, qlcnic_fwinit_work, FW_POLL_DELAY);
3606
3607	return;
3608
3609err_ret:
3610	netif_device_attach(netdev);
3611	qlcnic_clr_all_drv_state(adapter, 1);
3612}
3613
3614/*Transit NPAR state to NON Operational */
3615static void
3616qlcnic_set_npar_non_operational(struct qlcnic_adapter *adapter)
3617{
3618	u32 state;
3619
3620	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
3621	if (state == QLCNIC_DEV_NPAR_NON_OPER)
3622		return;
3623
3624	if (qlcnic_api_lock(adapter))
3625		return;
3626	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3627			    QLCNIC_DEV_NPAR_NON_OPER);
3628	qlcnic_api_unlock(adapter);
3629}
3630
3631static void qlcnic_82xx_dev_request_reset(struct qlcnic_adapter *adapter,
3632					  u32 key)
3633{
3634	u32 state, xg_val = 0, gb_val = 0;
3635
3636	qlcnic_xg_set_xg0_mask(xg_val);
3637	qlcnic_xg_set_xg1_mask(xg_val);
3638	QLCWR32(adapter, QLCNIC_NIU_XG_PAUSE_CTL, xg_val);
3639	qlcnic_gb_set_gb0_mask(gb_val);
3640	qlcnic_gb_set_gb1_mask(gb_val);
3641	qlcnic_gb_set_gb2_mask(gb_val);
3642	qlcnic_gb_set_gb3_mask(gb_val);
3643	QLCWR32(adapter, QLCNIC_NIU_GB_PAUSE_CTL, gb_val);
3644	dev_info(&adapter->pdev->dev, "Pause control frames disabled"
3645				" on all ports\n");
3646	adapter->need_fw_reset = 1;
3647
3648	if (qlcnic_api_lock(adapter))
3649		return;
3650
3651	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3652
3653	if (test_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state)) {
3654		netdev_err(adapter->netdev, "%s: Device is in non-operational state\n",
3655			   __func__);
3656		qlcnic_api_unlock(adapter);
3657
3658		return;
3659	}
3660
3661	if (state == QLCNIC_DEV_READY) {
3662		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3663				    QLCNIC_DEV_NEED_RESET);
3664		adapter->flags |= QLCNIC_FW_RESET_OWNER;
3665		QLCDB(adapter, DRV, "NEED_RESET state set\n");
3666		qlcnic_idc_debug_info(adapter, 0);
3667	}
3668
3669	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3670			    QLCNIC_DEV_NPAR_NON_OPER);
3671	qlcnic_api_unlock(adapter);
3672}
3673
3674/* Transit to NPAR READY state from NPAR NOT READY state */
3675static void
3676qlcnic_dev_set_npar_ready(struct qlcnic_adapter *adapter)
3677{
3678	if (qlcnic_api_lock(adapter))
3679		return;
3680
3681	QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3682			    QLCNIC_DEV_NPAR_OPER);
3683	QLCDB(adapter, DRV, "NPAR operational state set\n");
3684
3685	qlcnic_api_unlock(adapter);
3686}
3687
3688void qlcnic_schedule_work(struct qlcnic_adapter *adapter,
3689			  work_func_t func, int delay)
3690{
3691	if (test_bit(__QLCNIC_AER, &adapter->state))
3692		return;
3693
3694	INIT_DELAYED_WORK(&adapter->fw_work, func);
3695	queue_delayed_work(adapter->qlcnic_wq, &adapter->fw_work,
3696			   round_jiffies_relative(delay));
3697}
3698
3699static void
3700qlcnic_attach_work(struct work_struct *work)
3701{
3702	struct qlcnic_adapter *adapter = container_of(work,
3703				struct qlcnic_adapter, fw_work.work);
3704	struct net_device *netdev = adapter->netdev;
3705	u32 npar_state;
3706
3707	if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
3708		npar_state = QLC_SHARED_REG_RD32(adapter,
3709						 QLCNIC_CRB_DEV_NPAR_STATE);
3710		if (adapter->fw_wait_cnt++ > QLCNIC_DEV_NPAR_OPER_TIMEO)
3711			qlcnic_clr_all_drv_state(adapter, 0);
3712		else if (npar_state != QLCNIC_DEV_NPAR_OPER)
3713			qlcnic_schedule_work(adapter, qlcnic_attach_work,
3714							FW_POLL_DELAY);
3715		else
3716			goto attach;
3717		QLCDB(adapter, DRV, "Waiting for NPAR state to operational\n");
3718		return;
3719	}
3720attach:
3721	qlcnic_dcb_get_info(adapter->dcb);
3722
3723	if (netif_running(netdev)) {
3724		if (qlcnic_up(adapter, netdev))
3725			goto done;
3726
3727		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3728	}
3729
3730done:
3731	netif_device_attach(netdev);
3732	adapter->fw_fail_cnt = 0;
3733	adapter->flags &= ~QLCNIC_FW_HANG;
3734	clear_bit(__QLCNIC_RESETTING, &adapter->state);
3735	if (adapter->portnum == 0)
3736		qlcnic_set_drv_version(adapter);
3737
3738	if (!qlcnic_clr_drv_state(adapter))
3739		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3740							FW_POLL_DELAY);
3741}
3742
3743static int
3744qlcnic_check_health(struct qlcnic_adapter *adapter)
3745{
3746	struct qlcnic_hardware_context *ahw = adapter->ahw;
3747	struct qlcnic_fw_dump *fw_dump = &ahw->fw_dump;
3748	u32 state = 0, heartbeat;
3749	u32 peg_status;
3750	int err = 0;
3751
3752	if (qlcnic_check_temp(adapter))
3753		goto detach;
3754
3755	if (adapter->need_fw_reset)
3756		qlcnic_dev_request_reset(adapter, 0);
3757
3758	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3759	if (state == QLCNIC_DEV_NEED_RESET) {
3760		qlcnic_set_npar_non_operational(adapter);
3761		adapter->need_fw_reset = 1;
3762	} else if (state == QLCNIC_DEV_NEED_QUISCENT)
3763		goto detach;
3764
3765	heartbeat = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_ALIVE_COUNTER);
3766	if (heartbeat != adapter->heartbeat) {
3767		adapter->heartbeat = heartbeat;
3768		adapter->fw_fail_cnt = 0;
3769		if (adapter->need_fw_reset)
3770			goto detach;
3771
3772		if (ahw->reset_context && qlcnic_auto_fw_reset)
3773			qlcnic_reset_hw_context(adapter);
3774
3775		return 0;
3776	}
3777
3778	if (++adapter->fw_fail_cnt < FW_FAIL_THRESH)
3779		return 0;
3780
3781	adapter->flags |= QLCNIC_FW_HANG;
3782
3783	qlcnic_dev_request_reset(adapter, 0);
3784
3785	if (qlcnic_auto_fw_reset)
3786		clear_bit(__QLCNIC_FW_ATTACHED, &adapter->state);
3787
3788	dev_err(&adapter->pdev->dev, "firmware hang detected\n");
3789	peg_status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
3790	dev_err(&adapter->pdev->dev, "Dumping hw/fw registers\n"
3791			"PEG_HALT_STATUS1: 0x%x, PEG_HALT_STATUS2: 0x%x,\n"
3792			"PEG_NET_0_PC: 0x%x, PEG_NET_1_PC: 0x%x,\n"
3793			"PEG_NET_2_PC: 0x%x, PEG_NET_3_PC: 0x%x,\n"
3794			"PEG_NET_4_PC: 0x%x\n",
3795			peg_status,
3796			QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS2),
3797			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_0 + 0x3c, &err),
3798			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_1 + 0x3c, &err),
3799			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_2 + 0x3c, &err),
3800			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_3 + 0x3c, &err),
3801			QLCRD32(adapter, QLCNIC_CRB_PEG_NET_4 + 0x3c, &err));
3802	if (QLCNIC_FWERROR_CODE(peg_status) == 0x67)
3803		dev_err(&adapter->pdev->dev,
3804			"Firmware aborted with error code 0x00006700. "
3805				"Device is being reset.\n");
3806detach:
3807	adapter->dev_state = (state == QLCNIC_DEV_NEED_QUISCENT) ? state :
3808		QLCNIC_DEV_NEED_RESET;
3809
3810	if (qlcnic_auto_fw_reset && !test_and_set_bit(__QLCNIC_RESETTING,
3811						      &adapter->state)) {
3812
3813		qlcnic_schedule_work(adapter, qlcnic_detach_work, 0);
3814		QLCDB(adapter, DRV, "fw recovery scheduled.\n");
3815	} else if (!qlcnic_auto_fw_reset && fw_dump->enable &&
3816		   adapter->flags & QLCNIC_FW_RESET_OWNER) {
3817		qlcnic_dump_fw(adapter);
3818	}
3819
3820	return 1;
3821}
3822
3823void qlcnic_fw_poll_work(struct work_struct *work)
3824{
3825	struct qlcnic_adapter *adapter = container_of(work,
3826				struct qlcnic_adapter, fw_work.work);
3827
3828	if (test_bit(__QLCNIC_RESETTING, &adapter->state))
3829		goto reschedule;
3830
3831
3832	if (qlcnic_check_health(adapter))
3833		return;
3834
3835	if (adapter->fhash.fnum)
3836		qlcnic_prune_lb_filters(adapter);
3837
3838reschedule:
3839	qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
3840}
3841
3842static int qlcnic_is_first_func(struct pci_dev *pdev)
3843{
3844	struct pci_dev *oth_pdev;
3845	int val = pdev->devfn;
3846
3847	while (val-- > 0) {
3848		oth_pdev = pci_get_domain_bus_and_slot(pci_domain_nr
3849			(pdev->bus), pdev->bus->number,
3850			PCI_DEVFN(PCI_SLOT(pdev->devfn), val));
3851		if (!oth_pdev)
3852			continue;
3853
3854		if (oth_pdev->current_state != PCI_D3cold) {
3855			pci_dev_put(oth_pdev);
3856			return 0;
3857		}
3858		pci_dev_put(oth_pdev);
3859	}
3860	return 1;
3861}
3862
3863static int qlcnic_attach_func(struct pci_dev *pdev)
3864{
3865	int err, first_func;
3866	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3867	struct net_device *netdev = adapter->netdev;
3868
3869	pdev->error_state = pci_channel_io_normal;
3870
3871	err = pci_enable_device(pdev);
3872	if (err)
3873		return err;
3874
3875	pci_set_master(pdev);
3876	pci_restore_state(pdev);
3877
3878	first_func = qlcnic_is_first_func(pdev);
3879
3880	if (qlcnic_api_lock(adapter))
3881		return -EINVAL;
3882
3883	if (adapter->ahw->op_mode != QLCNIC_NON_PRIV_FUNC && first_func) {
3884		adapter->need_fw_reset = 1;
3885		set_bit(__QLCNIC_START_FW, &adapter->state);
3886		QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3887				    QLCNIC_DEV_INITIALIZING);
3888		QLCDB(adapter, DRV, "Restarting fw\n");
3889	}
3890	qlcnic_api_unlock(adapter);
3891
3892	err = qlcnic_start_firmware(adapter);
3893	if (err)
3894		return err;
3895
3896	qlcnic_clr_drv_state(adapter);
3897	kfree(adapter->msix_entries);
3898	adapter->msix_entries = NULL;
3899	err = qlcnic_setup_intr(adapter);
3900
3901	if (err) {
3902		kfree(adapter->msix_entries);
3903		netdev_err(netdev, "failed to setup interrupt\n");
3904		return err;
3905	}
3906
3907	if (netif_running(netdev)) {
3908		err = qlcnic_attach(adapter);
3909		if (err) {
3910			qlcnic_clr_all_drv_state(adapter, 1);
3911			clear_bit(__QLCNIC_AER, &adapter->state);
3912			netif_device_attach(netdev);
3913			return err;
3914		}
3915
3916		err = qlcnic_up(adapter, netdev);
3917		if (err)
3918			goto done;
3919
3920		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3921	}
3922 done:
3923	netif_device_attach(netdev);
3924	return err;
3925}
3926
3927static pci_ers_result_t qlcnic_82xx_io_error_detected(struct pci_dev *pdev,
3928						      pci_channel_state_t state)
3929{
3930	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3931	struct net_device *netdev = adapter->netdev;
3932
3933	if (state == pci_channel_io_perm_failure)
3934		return PCI_ERS_RESULT_DISCONNECT;
3935
3936	if (state == pci_channel_io_normal)
3937		return PCI_ERS_RESULT_RECOVERED;
3938
3939	set_bit(__QLCNIC_AER, &adapter->state);
3940	netif_device_detach(netdev);
3941
3942	cancel_delayed_work_sync(&adapter->fw_work);
3943
3944	if (netif_running(netdev))
3945		qlcnic_down(adapter, netdev);
3946
3947	qlcnic_detach(adapter);
3948	qlcnic_teardown_intr(adapter);
3949
3950	clear_bit(__QLCNIC_RESETTING, &adapter->state);
3951
3952	pci_save_state(pdev);
3953	pci_disable_device(pdev);
3954
3955	return PCI_ERS_RESULT_NEED_RESET;
3956}
3957
3958static pci_ers_result_t qlcnic_82xx_io_slot_reset(struct pci_dev *pdev)
3959{
3960	pci_ers_result_t res;
3961
3962	rtnl_lock();
3963	res = qlcnic_attach_func(pdev) ? PCI_ERS_RESULT_DISCONNECT :
3964					 PCI_ERS_RESULT_RECOVERED;
3965	rtnl_unlock();
3966
3967	return res;
3968}
3969
3970static void qlcnic_82xx_io_resume(struct pci_dev *pdev)
3971{
3972	u32 state;
3973	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3974
3975	pci_cleanup_aer_uncorrect_error_status(pdev);
3976	state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3977	if (state == QLCNIC_DEV_READY && test_and_clear_bit(__QLCNIC_AER,
3978							    &adapter->state))
3979		qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3980				     FW_POLL_DELAY);
3981}
3982
3983static pci_ers_result_t qlcnic_io_error_detected(struct pci_dev *pdev,
3984						 pci_channel_state_t state)
3985{
3986	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3987	struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
3988
3989	if (hw_ops->io_error_detected) {
3990		return hw_ops->io_error_detected(pdev, state);
3991	} else {
3992		dev_err(&pdev->dev, "AER error_detected handler not registered.\n");
3993		return PCI_ERS_RESULT_DISCONNECT;
3994	}
3995}
3996
3997static pci_ers_result_t qlcnic_io_slot_reset(struct pci_dev *pdev)
3998{
3999	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
4000	struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
4001
4002	if (hw_ops->io_slot_reset) {
4003		return hw_ops->io_slot_reset(pdev);
4004	} else {
4005		dev_err(&pdev->dev, "AER slot_reset handler not registered.\n");
4006		return PCI_ERS_RESULT_DISCONNECT;
4007	}
4008}
4009
4010static void qlcnic_io_resume(struct pci_dev *pdev)
4011{
4012	struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
4013	struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
4014
4015	if (hw_ops->io_resume)
4016		hw_ops->io_resume(pdev);
4017	else
4018		dev_err(&pdev->dev, "AER resume handler not registered.\n");
4019}
4020
4021
4022static int
4023qlcnicvf_start_firmware(struct qlcnic_adapter *adapter)
4024{
4025	int err;
4026
4027	err = qlcnic_can_start_firmware(adapter);
4028	if (err)
4029		return err;
4030
4031	err = qlcnic_check_npar_opertional(adapter);
4032	if (err)
4033		return err;
4034
4035	err = qlcnic_initialize_nic(adapter);
4036	if (err)
4037		return err;
4038
4039	qlcnic_check_options(adapter);
4040
4041	err = qlcnic_set_eswitch_port_config(adapter);
4042	if (err)
4043		return err;
4044
4045	adapter->need_fw_reset = 0;
4046
4047	return err;
4048}
4049
4050int qlcnic_validate_rings(struct qlcnic_adapter *adapter, __u32 ring_cnt,
4051			  int queue_type)
4052{
4053	struct net_device *netdev = adapter->netdev;
4054	u8 max_hw_rings = 0;
4055	char buf[8];
4056	int cur_rings;
4057
4058	if (queue_type == QLCNIC_RX_QUEUE) {
4059		max_hw_rings = adapter->max_sds_rings;
4060		cur_rings = adapter->drv_sds_rings;
4061		strcpy(buf, "SDS");
4062	} else if (queue_type == QLCNIC_TX_QUEUE) {
4063		max_hw_rings = adapter->max_tx_rings;
4064		cur_rings = adapter->drv_tx_rings;
4065		strcpy(buf, "Tx");
4066	}
4067
4068	if (!is_power_of_2(ring_cnt)) {
4069		netdev_err(netdev, "%s rings value should be a power of 2\n",
4070			   buf);
4071		return -EINVAL;
4072	}
4073
4074	if (qlcnic_82xx_check(adapter) && (queue_type == QLCNIC_TX_QUEUE) &&
4075	    !qlcnic_check_multi_tx(adapter)) {
4076			netdev_err(netdev, "No Multi Tx queue support\n");
4077			return -EINVAL;
4078	}
4079
4080	if (ring_cnt > num_online_cpus()) {
4081		netdev_err(netdev,
4082			   "%s value[%u] should not be higher than, number of online CPUs\n",
4083			   buf, num_online_cpus());
4084		return -EINVAL;
4085	}
4086
4087	return 0;
4088}
4089
4090int qlcnic_setup_rings(struct qlcnic_adapter *adapter)
4091{
4092	struct net_device *netdev = adapter->netdev;
4093	u8 tx_rings, rx_rings;
4094	int err;
4095
4096	if (test_bit(__QLCNIC_RESETTING, &adapter->state))
4097		return -EBUSY;
4098
4099	tx_rings = adapter->drv_tss_rings;
4100	rx_rings = adapter->drv_rss_rings;
4101
4102	netif_device_detach(netdev);
4103
4104	err = qlcnic_set_real_num_queues(adapter, tx_rings, rx_rings);
4105	if (err)
4106		goto done;
4107
4108	if (netif_running(netdev))
4109		__qlcnic_down(adapter, netdev);
4110
4111	qlcnic_detach(adapter);
4112
4113	if (qlcnic_83xx_check(adapter)) {
4114		qlcnic_83xx_free_mbx_intr(adapter);
4115		qlcnic_83xx_enable_mbx_poll(adapter);
4116	}
4117
4118	qlcnic_teardown_intr(adapter);
4119
4120	err = qlcnic_setup_intr(adapter);
4121	if (err) {
4122		kfree(adapter->msix_entries);
4123		netdev_err(netdev, "failed to setup interrupt\n");
4124		return err;
4125	}
4126
4127	/* Check if we need to update real_num_{tx|rx}_queues because
4128	 * qlcnic_setup_intr() may change Tx/Rx rings size
4129	 */
4130	if ((tx_rings != adapter->drv_tx_rings) ||
4131	    (rx_rings != adapter->drv_sds_rings)) {
4132		err = qlcnic_set_real_num_queues(adapter,
4133						 adapter->drv_tx_rings,
4134						 adapter->drv_sds_rings);
4135		if (err)
4136			goto done;
4137	}
4138
4139	if (qlcnic_83xx_check(adapter)) {
4140		qlcnic_83xx_initialize_nic(adapter, 1);
4141		err = qlcnic_83xx_setup_mbx_intr(adapter);
4142		qlcnic_83xx_disable_mbx_poll(adapter);
4143		if (err) {
4144			dev_err(&adapter->pdev->dev,
4145				"failed to setup mbx interrupt\n");
4146			goto done;
4147		}
4148	}
4149
4150	if (netif_running(netdev)) {
4151		err = qlcnic_attach(adapter);
4152		if (err)
4153			goto done;
4154		err = __qlcnic_up(adapter, netdev);
4155		if (err)
4156			goto done;
4157		qlcnic_restore_indev_addr(netdev, NETDEV_UP);
4158	}
4159done:
4160	netif_device_attach(netdev);
4161	clear_bit(__QLCNIC_RESETTING, &adapter->state);
4162	return err;
4163}
4164
4165#ifdef CONFIG_INET
4166
4167#define is_qlcnic_netdev(dev) (dev->netdev_ops == &qlcnic_netdev_ops)
4168
4169static void
4170qlcnic_config_indev_addr(struct qlcnic_adapter *adapter,
4171			struct net_device *dev, unsigned long event)
4172{
 
4173	struct in_device *indev;
4174
4175	indev = in_dev_get(dev);
4176	if (!indev)
4177		return;
4178
4179	for_ifa(indev) {
4180		switch (event) {
4181		case NETDEV_UP:
4182			qlcnic_config_ipaddr(adapter,
4183					ifa->ifa_address, QLCNIC_IP_UP);
4184			break;
4185		case NETDEV_DOWN:
4186			qlcnic_config_ipaddr(adapter,
4187					ifa->ifa_address, QLCNIC_IP_DOWN);
4188			break;
4189		default:
4190			break;
4191		}
4192	} endfor_ifa(indev);
4193
4194	in_dev_put(indev);
4195}
4196
4197void qlcnic_restore_indev_addr(struct net_device *netdev, unsigned long event)
4198{
4199	struct qlcnic_adapter *adapter = netdev_priv(netdev);
4200	struct net_device *dev;
4201	u16 vid;
4202
4203	qlcnic_config_indev_addr(adapter, netdev, event);
4204
4205	rcu_read_lock();
4206	for_each_set_bit(vid, adapter->vlans, VLAN_N_VID) {
4207		dev = __vlan_find_dev_deep_rcu(netdev, htons(ETH_P_8021Q), vid);
4208		if (!dev)
4209			continue;
4210		qlcnic_config_indev_addr(adapter, dev, event);
4211	}
4212	rcu_read_unlock();
4213}
4214
4215static int qlcnic_netdev_event(struct notifier_block *this,
4216				 unsigned long event, void *ptr)
4217{
4218	struct qlcnic_adapter *adapter;
4219	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
4220
4221recheck:
4222	if (dev == NULL)
4223		goto done;
4224
4225	if (is_vlan_dev(dev)) {
4226		dev = vlan_dev_real_dev(dev);
4227		goto recheck;
4228	}
4229
4230	if (!is_qlcnic_netdev(dev))
4231		goto done;
4232
4233	adapter = netdev_priv(dev);
4234
4235	if (!adapter)
4236		goto done;
4237
4238	if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
4239		goto done;
4240
4241	qlcnic_config_indev_addr(adapter, dev, event);
4242done:
4243	return NOTIFY_DONE;
4244}
4245
4246static int
4247qlcnic_inetaddr_event(struct notifier_block *this,
4248		unsigned long event, void *ptr)
4249{
4250	struct qlcnic_adapter *adapter;
4251	struct net_device *dev;
4252
4253	struct in_ifaddr *ifa = (struct in_ifaddr *)ptr;
4254
4255	dev = ifa->ifa_dev ? ifa->ifa_dev->dev : NULL;
4256
4257recheck:
4258	if (dev == NULL)
4259		goto done;
4260
4261	if (is_vlan_dev(dev)) {
4262		dev = vlan_dev_real_dev(dev);
4263		goto recheck;
4264	}
4265
4266	if (!is_qlcnic_netdev(dev))
4267		goto done;
4268
4269	adapter = netdev_priv(dev);
4270
4271	if (!adapter)
4272		goto done;
4273
4274	if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
4275		goto done;
4276
4277	switch (event) {
4278	case NETDEV_UP:
4279		qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_UP);
4280
4281		break;
4282	case NETDEV_DOWN:
4283		qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_DOWN);
4284
4285		break;
4286	default:
4287		break;
4288	}
4289
4290done:
4291	return NOTIFY_DONE;
4292}
4293
4294static struct notifier_block	qlcnic_netdev_cb = {
4295	.notifier_call = qlcnic_netdev_event,
4296};
4297
4298static struct notifier_block qlcnic_inetaddr_cb = {
4299	.notifier_call = qlcnic_inetaddr_event,
4300};
4301#else
4302void qlcnic_restore_indev_addr(struct net_device *dev, unsigned long event)
4303{ }
4304#endif
4305static const struct pci_error_handlers qlcnic_err_handler = {
4306	.error_detected = qlcnic_io_error_detected,
4307	.slot_reset = qlcnic_io_slot_reset,
4308	.resume = qlcnic_io_resume,
4309};
4310
 
 
4311static struct pci_driver qlcnic_driver = {
4312	.name = qlcnic_driver_name,
4313	.id_table = qlcnic_pci_tbl,
4314	.probe = qlcnic_probe,
4315	.remove = qlcnic_remove,
4316#ifdef CONFIG_PM
4317	.suspend = qlcnic_suspend,
4318	.resume = qlcnic_resume,
4319#endif
4320	.shutdown = qlcnic_shutdown,
4321	.err_handler = &qlcnic_err_handler,
4322#ifdef CONFIG_QLCNIC_SRIOV
4323	.sriov_configure = qlcnic_pci_sriov_configure,
4324#endif
4325
4326};
4327
4328static int __init qlcnic_init_module(void)
4329{
4330	int ret;
4331
4332	printk(KERN_INFO "%s\n", qlcnic_driver_string);
4333
4334#ifdef CONFIG_INET
4335	register_netdevice_notifier(&qlcnic_netdev_cb);
4336	register_inetaddr_notifier(&qlcnic_inetaddr_cb);
4337#endif
4338
4339	ret = pci_register_driver(&qlcnic_driver);
4340	if (ret) {
4341#ifdef CONFIG_INET
4342		unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4343		unregister_netdevice_notifier(&qlcnic_netdev_cb);
4344#endif
4345	}
4346
4347	return ret;
4348}
4349
4350module_init(qlcnic_init_module);
4351
4352static void __exit qlcnic_exit_module(void)
4353{
4354	pci_unregister_driver(&qlcnic_driver);
4355
4356#ifdef CONFIG_INET
4357	unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4358	unregister_netdevice_notifier(&qlcnic_netdev_cb);
4359#endif
4360}
4361
4362module_exit(qlcnic_exit_module);