be_main.c 144.2 KB
Newer Older
S
Sathya Perla 已提交
1
/*
2
 * Copyright (C) 2005 - 2015 Emulex
S
Sathya Perla 已提交
3 4 5 6 7 8 9 10
 * All rights reserved.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License version 2
 * as published by the Free Software Foundation.  The full GNU General
 * Public License is included in this distribution in the file called COPYING.
 *
 * Contact Information:
11
 * linux-drivers@emulex.com
S
Sathya Perla 已提交
12
 *
13 14 15
 * Emulex
 * 3333 Susan Street
 * Costa Mesa, CA 92626
S
Sathya Perla 已提交
16 17
 */

18
#include <linux/prefetch.h>
19
#include <linux/module.h>
S
Sathya Perla 已提交
20
#include "be.h"
21
#include "be_cmds.h"
22
#include <asm/div64.h>
S
Sathya Perla 已提交
23
#include <linux/aer.h>
24
#include <linux/if_bridge.h>
25
#include <net/busy_poll.h>
26
#include <net/vxlan.h>
S
Sathya Perla 已提交
27 28 29

MODULE_VERSION(DRV_VER);
MODULE_DESCRIPTION(DRV_DESC " " DRV_VER);
30
MODULE_AUTHOR("Emulex Corporation");
S
Sathya Perla 已提交
31 32
MODULE_LICENSE("GPL");

33 34 35
/* num_vfs module param is obsolete.
 * Use sysfs method to enable/disable VFs.
 */
36 37 38
static unsigned int num_vfs;
module_param(num_vfs, uint, S_IRUGO);
MODULE_PARM_DESC(num_vfs, "Number of PCI VFs to initialize");
S
Sathya Perla 已提交
39

40 41 42 43
static ushort rx_frag_size = 2048;
module_param(rx_frag_size, ushort, S_IRUGO);
MODULE_PARM_DESC(rx_frag_size, "Size of a fragment that holds rcvd data.");

44
static const struct pci_device_id be_dev_ids[] = {
45
	{ PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID1) },
46
	{ PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID2) },
47 48
	{ PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID1) },
	{ PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID2) },
49
	{ PCI_DEVICE(EMULEX_VENDOR_ID, OC_DEVICE_ID3)},
50
	{ PCI_DEVICE(EMULEX_VENDOR_ID, OC_DEVICE_ID4)},
51
	{ PCI_DEVICE(EMULEX_VENDOR_ID, OC_DEVICE_ID5)},
52
	{ PCI_DEVICE(EMULEX_VENDOR_ID, OC_DEVICE_ID6)},
S
Sathya Perla 已提交
53 54 55
	{ 0 }
};
MODULE_DEVICE_TABLE(pci, be_dev_ids);
56
/* UE Status Low CSR */
57
static const char * const ue_status_low_desc[] = {
58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85
	"CEV",
	"CTX",
	"DBUF",
	"ERX",
	"Host",
	"MPU",
	"NDMA",
	"PTC ",
	"RDMA ",
	"RXF ",
	"RXIPS ",
	"RXULP0 ",
	"RXULP1 ",
	"RXULP2 ",
	"TIM ",
	"TPOST ",
	"TPRE ",
	"TXIPS ",
	"TXULP0 ",
	"TXULP1 ",
	"UC ",
	"WDMA ",
	"TXULP2 ",
	"HOST1 ",
	"P0_OB_LINK ",
	"P1_OB_LINK ",
	"HOST_GPIO ",
	"MBOX ",
86 87 88 89
	"ERX2 ",
	"SPARE ",
	"JTAG ",
	"MPU_INTPEND "
90
};
91

92
/* UE Status High CSR */
93
static const char * const ue_status_hi_desc[] = {
94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114
	"LPCMEMHOST",
	"MGMT_MAC",
	"PCS0ONLINE",
	"MPU_IRAM",
	"PCS1ONLINE",
	"PCTL0",
	"PCTL1",
	"PMEM",
	"RR",
	"TXPB",
	"RXPP",
	"XAUI",
	"TXP",
	"ARM",
	"IPC",
	"HOST2",
	"HOST3",
	"HOST4",
	"HOST5",
	"HOST6",
	"HOST7",
115 116
	"ECRC",
	"Poison TLP",
117
	"NETC",
118 119 120 121 122 123 124
	"PERIPH",
	"LLTXULP",
	"D2P",
	"RCON",
	"LDMA",
	"LLTXP",
	"LLTXPB",
125 126
	"Unknown"
};
S
Sathya Perla 已提交
127

128 129 130 131 132
#define BE_VF_IF_EN_FLAGS	(BE_IF_FLAGS_UNTAGGED | \
				 BE_IF_FLAGS_BROADCAST | \
				 BE_IF_FLAGS_MULTICAST | \
				 BE_IF_FLAGS_PASS_L3L4_ERRORS)

S
Sathya Perla 已提交
133 134 135
static void be_queue_free(struct be_adapter *adapter, struct be_queue_info *q)
{
	struct be_dma_mem *mem = &q->dma_mem;
136

137
	if (mem->va) {
I
Ivan Vecera 已提交
138 139
		dma_free_coherent(&adapter->pdev->dev, mem->size, mem->va,
				  mem->dma);
140 141
		mem->va = NULL;
	}
S
Sathya Perla 已提交
142 143 144
}

static int be_queue_alloc(struct be_adapter *adapter, struct be_queue_info *q,
145
			  u16 len, u16 entry_size)
S
Sathya Perla 已提交
146 147 148 149 150 151 152
{
	struct be_dma_mem *mem = &q->dma_mem;

	memset(q, 0, sizeof(*q));
	q->len = len;
	q->entry_size = entry_size;
	mem->size = len * entry_size;
153 154
	mem->va = dma_zalloc_coherent(&adapter->pdev->dev, mem->size, &mem->dma,
				      GFP_KERNEL);
S
Sathya Perla 已提交
155
	if (!mem->va)
S
Sathya Perla 已提交
156
		return -ENOMEM;
S
Sathya Perla 已提交
157 158 159
	return 0;
}

160
static void be_reg_intr_set(struct be_adapter *adapter, bool enable)
S
Sathya Perla 已提交
161
{
162
	u32 reg, enabled;
163

164
	pci_read_config_dword(adapter->pdev, PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET,
165
			      &reg);
166 167
	enabled = reg & MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;

168
	if (!enabled && enable)
S
Sathya Perla 已提交
169
		reg |= MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
170
	else if (enabled && !enable)
S
Sathya Perla 已提交
171
		reg &= ~MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
172
	else
S
Sathya Perla 已提交
173
		return;
174

175
	pci_write_config_dword(adapter->pdev,
176
			       PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET, reg);
S
Sathya Perla 已提交
177 178
}

179 180 181 182 183 184 185 186
static void be_intr_set(struct be_adapter *adapter, bool enable)
{
	int status = 0;

	/* On lancer interrupts can't be controlled via this register */
	if (lancer_chip(adapter))
		return;

187
	if (be_check_error(adapter, BE_ERROR_EEH))
188 189 190 191 192 193 194
		return;

	status = be_cmd_intr_set(adapter, enable);
	if (status)
		be_reg_intr_set(adapter, enable);
}

195
static void be_rxq_notify(struct be_adapter *adapter, u16 qid, u16 posted)
S
Sathya Perla 已提交
196 197
{
	u32 val = 0;
198

199 200 201
	if (be_check_error(adapter, BE_ERROR_HW))
		return;

S
Sathya Perla 已提交
202 203
	val |= qid & DB_RQ_RING_ID_MASK;
	val |= posted << DB_RQ_NUM_POSTED_SHIFT;
204 205

	wmb();
206
	iowrite32(val, adapter->db + DB_RQ_OFFSET);
S
Sathya Perla 已提交
207 208
}

V
Vasundhara Volam 已提交
209 210
static void be_txq_notify(struct be_adapter *adapter, struct be_tx_obj *txo,
			  u16 posted)
S
Sathya Perla 已提交
211 212
{
	u32 val = 0;
213

214 215 216
	if (be_check_error(adapter, BE_ERROR_HW))
		return;

V
Vasundhara Volam 已提交
217
	val |= txo->q.id & DB_TXULP_RING_ID_MASK;
S
Sathya Perla 已提交
218
	val |= (posted & DB_TXULP_NUM_POSTED_MASK) << DB_TXULP_NUM_POSTED_SHIFT;
219 220

	wmb();
V
Vasundhara Volam 已提交
221
	iowrite32(val, adapter->db + txo->db_offset);
S
Sathya Perla 已提交
222 223
}

224
static void be_eq_notify(struct be_adapter *adapter, u16 qid,
225 226
			 bool arm, bool clear_int, u16 num_popped,
			 u32 eq_delay_mult_enc)
S
Sathya Perla 已提交
227 228
{
	u32 val = 0;
229

S
Sathya Perla 已提交
230
	val |= qid & DB_EQ_RING_ID_MASK;
231
	val |= ((qid & DB_EQ_RING_ID_EXT_MASK) << DB_EQ_RING_ID_EXT_MASK_SHIFT);
232

233
	if (be_check_error(adapter, BE_ERROR_HW))
234 235
		return;

S
Sathya Perla 已提交
236 237 238 239 240 241
	if (arm)
		val |= 1 << DB_EQ_REARM_SHIFT;
	if (clear_int)
		val |= 1 << DB_EQ_CLR_SHIFT;
	val |= 1 << DB_EQ_EVNT_SHIFT;
	val |= num_popped << DB_EQ_NUM_POPPED_SHIFT;
242
	val |= eq_delay_mult_enc << DB_EQ_R2I_DLY_SHIFT;
243
	iowrite32(val, adapter->db + DB_EQ_OFFSET);
S
Sathya Perla 已提交
244 245
}

246
void be_cq_notify(struct be_adapter *adapter, u16 qid, bool arm, u16 num_popped)
S
Sathya Perla 已提交
247 248
{
	u32 val = 0;
249

S
Sathya Perla 已提交
250
	val |= qid & DB_CQ_RING_ID_MASK;
251 252
	val |= ((qid & DB_CQ_RING_ID_EXT_MASK) <<
			DB_CQ_RING_ID_EXT_MASK_SHIFT);
253

254
	if (be_check_error(adapter, BE_ERROR_HW))
255 256
		return;

S
Sathya Perla 已提交
257 258 259
	if (arm)
		val |= 1 << DB_CQ_REARM_SHIFT;
	val |= num_popped << DB_CQ_NUM_POPPED_SHIFT;
260
	iowrite32(val, adapter->db + DB_CQ_OFFSET);
S
Sathya Perla 已提交
261 262 263 264 265
}

static int be_mac_addr_set(struct net_device *netdev, void *p)
{
	struct be_adapter *adapter = netdev_priv(netdev);
266
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
267
	struct sockaddr *addr = p;
268 269 270
	int status;
	u8 mac[ETH_ALEN];
	u32 old_pmac_id = adapter->pmac_id[0], curr_pmac_id = 0;
S
Sathya Perla 已提交
271

272 273 274
	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

275 276 277 278 279 280
	/* Proceed further only if, User provided MAC is different
	 * from active MAC
	 */
	if (ether_addr_equal(addr->sa_data, netdev->dev_addr))
		return 0;

281 282 283 284
	/* if device is not running, copy MAC to netdev->dev_addr */
	if (!netif_running(netdev))
		goto done;

285 286 287 288 289
	/* The PMAC_ADD cmd may fail if the VF doesn't have FILTMGMT
	 * privilege or if PF did not provision the new MAC address.
	 * On BE3, this cmd will always fail if the VF doesn't have the
	 * FILTMGMT privilege. This failure is OK, only if the PF programmed
	 * the MAC for the VF.
290
	 */
291 292 293 294 295 296 297 298 299 300 301
	status = be_cmd_pmac_add(adapter, (u8 *)addr->sa_data,
				 adapter->if_handle, &adapter->pmac_id[0], 0);
	if (!status) {
		curr_pmac_id = adapter->pmac_id[0];

		/* Delete the old programmed MAC. This call may fail if the
		 * old MAC was already deleted by the PF driver.
		 */
		if (adapter->pmac_id[0] != old_pmac_id)
			be_cmd_pmac_del(adapter, adapter->if_handle,
					old_pmac_id, 0);
302 303
	}

304 305
	/* Decide if the new MAC is successfully activated only after
	 * querying the FW
306
	 */
307 308
	status = be_cmd_get_active_mac(adapter, curr_pmac_id, mac,
				       adapter->if_handle, true, 0);
309
	if (status)
310
		goto err;
S
Sathya Perla 已提交
311

312 313 314
	/* The MAC change did not happen, either due to lack of privilege
	 * or PF didn't pre-provision.
	 */
315
	if (!ether_addr_equal(addr->sa_data, mac)) {
316 317 318
		status = -EPERM;
		goto err;
	}
319 320 321
done:
	ether_addr_copy(netdev->dev_addr, addr->sa_data);
	dev_info(dev, "MAC address changed to %pM\n", addr->sa_data);
322 323
	return 0;
err:
324
	dev_warn(dev, "MAC address change to %pM failed\n", addr->sa_data);
S
Sathya Perla 已提交
325 326 327
	return status;
}

328 329 330 331 332 333 334
/* BE2 supports only v0 cmd */
static void *hw_stats_from_cmd(struct be_adapter *adapter)
{
	if (BE2_chip(adapter)) {
		struct be_cmd_resp_get_stats_v0 *cmd = adapter->stats_cmd.va;

		return &cmd->hw_stats;
335
	} else if (BE3_chip(adapter)) {
336 337
		struct be_cmd_resp_get_stats_v1 *cmd = adapter->stats_cmd.va;

338 339 340 341
		return &cmd->hw_stats;
	} else {
		struct be_cmd_resp_get_stats_v2 *cmd = adapter->stats_cmd.va;

342 343 344 345 346 347 348 349 350 351 352
		return &cmd->hw_stats;
	}
}

/* BE2 supports only v0 cmd */
static void *be_erx_stats_from_cmd(struct be_adapter *adapter)
{
	if (BE2_chip(adapter)) {
		struct be_hw_stats_v0 *hw_stats = hw_stats_from_cmd(adapter);

		return &hw_stats->erx;
353
	} else if (BE3_chip(adapter)) {
354 355
		struct be_hw_stats_v1 *hw_stats = hw_stats_from_cmd(adapter);

356 357 358 359
		return &hw_stats->erx;
	} else {
		struct be_hw_stats_v2 *hw_stats = hw_stats_from_cmd(adapter);

360 361 362 363 364
		return &hw_stats->erx;
	}
}

static void populate_be_v0_stats(struct be_adapter *adapter)
365
{
366 367 368
	struct be_hw_stats_v0 *hw_stats = hw_stats_from_cmd(adapter);
	struct be_pmem_stats *pmem_sts = &hw_stats->pmem;
	struct be_rxf_stats_v0 *rxf_stats = &hw_stats->rxf;
369
	struct be_port_rxf_stats_v0 *port_stats =
370 371
					&rxf_stats->port[adapter->port_num];
	struct be_drv_stats *drvs = &adapter->drv_stats;
372

373
	be_dws_le_to_cpu(hw_stats, sizeof(*hw_stats));
374 375 376 377 378 379 380 381 382 383 384 385 386 387
	drvs->rx_pause_frames = port_stats->rx_pause_frames;
	drvs->rx_crc_errors = port_stats->rx_crc_errors;
	drvs->rx_control_frames = port_stats->rx_control_frames;
	drvs->rx_in_range_errors = port_stats->rx_in_range_errors;
	drvs->rx_frame_too_long = port_stats->rx_frame_too_long;
	drvs->rx_dropped_runt = port_stats->rx_dropped_runt;
	drvs->rx_ip_checksum_errs = port_stats->rx_ip_checksum_errs;
	drvs->rx_tcp_checksum_errs = port_stats->rx_tcp_checksum_errs;
	drvs->rx_udp_checksum_errs = port_stats->rx_udp_checksum_errs;
	drvs->rxpp_fifo_overflow_drop = port_stats->rx_fifo_overflow;
	drvs->rx_dropped_tcp_length = port_stats->rx_dropped_tcp_length;
	drvs->rx_dropped_too_small = port_stats->rx_dropped_too_small;
	drvs->rx_dropped_too_short = port_stats->rx_dropped_too_short;
	drvs->rx_out_range_errors = port_stats->rx_out_range_errors;
388
	drvs->rx_input_fifo_overflow_drop = port_stats->rx_input_fifo_overflow;
389 390
	drvs->rx_dropped_header_too_small =
		port_stats->rx_dropped_header_too_small;
391 392 393
	drvs->rx_address_filtered =
					port_stats->rx_address_filtered +
					port_stats->rx_vlan_filtered;
394 395 396 397 398 399 400
	drvs->rx_alignment_symbol_errors =
		port_stats->rx_alignment_symbol_errors;

	drvs->tx_pauseframes = port_stats->tx_pauseframes;
	drvs->tx_controlframes = port_stats->tx_controlframes;

	if (adapter->port_num)
401
		drvs->jabber_events = rxf_stats->port1_jabber_events;
402
	else
403
		drvs->jabber_events = rxf_stats->port0_jabber_events;
404 405 406 407
	drvs->rx_drops_no_pbuf = rxf_stats->rx_drops_no_pbuf;
	drvs->rx_drops_no_erx_descr = rxf_stats->rx_drops_no_erx_descr;
	drvs->forwarded_packets = rxf_stats->forwarded_packets;
	drvs->rx_drops_mtu = rxf_stats->rx_drops_mtu;
408 409
	drvs->rx_drops_no_tpre_descr = rxf_stats->rx_drops_no_tpre_descr;
	drvs->rx_drops_too_many_frags = rxf_stats->rx_drops_too_many_frags;
410 411 412
	adapter->drv_stats.eth_red_drops = pmem_sts->eth_red_drops;
}

413
static void populate_be_v1_stats(struct be_adapter *adapter)
414
{
415 416 417
	struct be_hw_stats_v1 *hw_stats = hw_stats_from_cmd(adapter);
	struct be_pmem_stats *pmem_sts = &hw_stats->pmem;
	struct be_rxf_stats_v1 *rxf_stats = &hw_stats->rxf;
418
	struct be_port_rxf_stats_v1 *port_stats =
419 420
					&rxf_stats->port[adapter->port_num];
	struct be_drv_stats *drvs = &adapter->drv_stats;
421

422
	be_dws_le_to_cpu(hw_stats, sizeof(*hw_stats));
423 424
	drvs->pmem_fifo_overflow_drop = port_stats->pmem_fifo_overflow_drop;
	drvs->rx_priority_pause_frames = port_stats->rx_priority_pause_frames;
425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441
	drvs->rx_pause_frames = port_stats->rx_pause_frames;
	drvs->rx_crc_errors = port_stats->rx_crc_errors;
	drvs->rx_control_frames = port_stats->rx_control_frames;
	drvs->rx_in_range_errors = port_stats->rx_in_range_errors;
	drvs->rx_frame_too_long = port_stats->rx_frame_too_long;
	drvs->rx_dropped_runt = port_stats->rx_dropped_runt;
	drvs->rx_ip_checksum_errs = port_stats->rx_ip_checksum_errs;
	drvs->rx_tcp_checksum_errs = port_stats->rx_tcp_checksum_errs;
	drvs->rx_udp_checksum_errs = port_stats->rx_udp_checksum_errs;
	drvs->rx_dropped_tcp_length = port_stats->rx_dropped_tcp_length;
	drvs->rx_dropped_too_small = port_stats->rx_dropped_too_small;
	drvs->rx_dropped_too_short = port_stats->rx_dropped_too_short;
	drvs->rx_out_range_errors = port_stats->rx_out_range_errors;
	drvs->rx_dropped_header_too_small =
		port_stats->rx_dropped_header_too_small;
	drvs->rx_input_fifo_overflow_drop =
		port_stats->rx_input_fifo_overflow_drop;
442
	drvs->rx_address_filtered = port_stats->rx_address_filtered;
443 444
	drvs->rx_alignment_symbol_errors =
		port_stats->rx_alignment_symbol_errors;
445
	drvs->rxpp_fifo_overflow_drop = port_stats->rxpp_fifo_overflow_drop;
446 447
	drvs->tx_pauseframes = port_stats->tx_pauseframes;
	drvs->tx_controlframes = port_stats->tx_controlframes;
448
	drvs->tx_priority_pauseframes = port_stats->tx_priority_pauseframes;
449 450 451 452 453
	drvs->jabber_events = port_stats->jabber_events;
	drvs->rx_drops_no_pbuf = rxf_stats->rx_drops_no_pbuf;
	drvs->rx_drops_no_erx_descr = rxf_stats->rx_drops_no_erx_descr;
	drvs->forwarded_packets = rxf_stats->forwarded_packets;
	drvs->rx_drops_mtu = rxf_stats->rx_drops_mtu;
454 455
	drvs->rx_drops_no_tpre_descr = rxf_stats->rx_drops_no_tpre_descr;
	drvs->rx_drops_too_many_frags = rxf_stats->rx_drops_too_many_frags;
456 457 458
	adapter->drv_stats.eth_red_drops = pmem_sts->eth_red_drops;
}

459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502
static void populate_be_v2_stats(struct be_adapter *adapter)
{
	struct be_hw_stats_v2 *hw_stats = hw_stats_from_cmd(adapter);
	struct be_pmem_stats *pmem_sts = &hw_stats->pmem;
	struct be_rxf_stats_v2 *rxf_stats = &hw_stats->rxf;
	struct be_port_rxf_stats_v2 *port_stats =
					&rxf_stats->port[adapter->port_num];
	struct be_drv_stats *drvs = &adapter->drv_stats;

	be_dws_le_to_cpu(hw_stats, sizeof(*hw_stats));
	drvs->pmem_fifo_overflow_drop = port_stats->pmem_fifo_overflow_drop;
	drvs->rx_priority_pause_frames = port_stats->rx_priority_pause_frames;
	drvs->rx_pause_frames = port_stats->rx_pause_frames;
	drvs->rx_crc_errors = port_stats->rx_crc_errors;
	drvs->rx_control_frames = port_stats->rx_control_frames;
	drvs->rx_in_range_errors = port_stats->rx_in_range_errors;
	drvs->rx_frame_too_long = port_stats->rx_frame_too_long;
	drvs->rx_dropped_runt = port_stats->rx_dropped_runt;
	drvs->rx_ip_checksum_errs = port_stats->rx_ip_checksum_errs;
	drvs->rx_tcp_checksum_errs = port_stats->rx_tcp_checksum_errs;
	drvs->rx_udp_checksum_errs = port_stats->rx_udp_checksum_errs;
	drvs->rx_dropped_tcp_length = port_stats->rx_dropped_tcp_length;
	drvs->rx_dropped_too_small = port_stats->rx_dropped_too_small;
	drvs->rx_dropped_too_short = port_stats->rx_dropped_too_short;
	drvs->rx_out_range_errors = port_stats->rx_out_range_errors;
	drvs->rx_dropped_header_too_small =
		port_stats->rx_dropped_header_too_small;
	drvs->rx_input_fifo_overflow_drop =
		port_stats->rx_input_fifo_overflow_drop;
	drvs->rx_address_filtered = port_stats->rx_address_filtered;
	drvs->rx_alignment_symbol_errors =
		port_stats->rx_alignment_symbol_errors;
	drvs->rxpp_fifo_overflow_drop = port_stats->rxpp_fifo_overflow_drop;
	drvs->tx_pauseframes = port_stats->tx_pauseframes;
	drvs->tx_controlframes = port_stats->tx_controlframes;
	drvs->tx_priority_pauseframes = port_stats->tx_priority_pauseframes;
	drvs->jabber_events = port_stats->jabber_events;
	drvs->rx_drops_no_pbuf = rxf_stats->rx_drops_no_pbuf;
	drvs->rx_drops_no_erx_descr = rxf_stats->rx_drops_no_erx_descr;
	drvs->forwarded_packets = rxf_stats->forwarded_packets;
	drvs->rx_drops_mtu = rxf_stats->rx_drops_mtu;
	drvs->rx_drops_no_tpre_descr = rxf_stats->rx_drops_no_tpre_descr;
	drvs->rx_drops_too_many_frags = rxf_stats->rx_drops_too_many_frags;
	adapter->drv_stats.eth_red_drops = pmem_sts->eth_red_drops;
503
	if (be_roce_supported(adapter)) {
504 505 506 507 508 509 510
		drvs->rx_roce_bytes_lsd = port_stats->roce_bytes_received_lsd;
		drvs->rx_roce_bytes_msd = port_stats->roce_bytes_received_msd;
		drvs->rx_roce_frames = port_stats->roce_frames_received;
		drvs->roce_drops_crc = port_stats->roce_drops_crc;
		drvs->roce_drops_payload_len =
			port_stats->roce_drops_payload_len;
	}
511 512
}

S
Selvin Xavier 已提交
513 514 515
static void populate_lancer_stats(struct be_adapter *adapter)
{
	struct be_drv_stats *drvs = &adapter->drv_stats;
516
	struct lancer_pport_stats *pport_stats = pport_stats_from_cmd(adapter);
517 518 519 520 521

	be_dws_le_to_cpu(pport_stats, sizeof(*pport_stats));
	drvs->rx_pause_frames = pport_stats->rx_pause_frames_lo;
	drvs->rx_crc_errors = pport_stats->rx_crc_errors_lo;
	drvs->rx_control_frames = pport_stats->rx_control_frames_lo;
S
Selvin Xavier 已提交
522
	drvs->rx_in_range_errors = pport_stats->rx_in_range_errors;
523
	drvs->rx_frame_too_long = pport_stats->rx_frames_too_long_lo;
S
Selvin Xavier 已提交
524 525 526 527 528 529 530 531 532 533 534 535
	drvs->rx_dropped_runt = pport_stats->rx_dropped_runt;
	drvs->rx_ip_checksum_errs = pport_stats->rx_ip_checksum_errors;
	drvs->rx_tcp_checksum_errs = pport_stats->rx_tcp_checksum_errors;
	drvs->rx_udp_checksum_errs = pport_stats->rx_udp_checksum_errors;
	drvs->rx_dropped_tcp_length =
				pport_stats->rx_dropped_invalid_tcp_length;
	drvs->rx_dropped_too_small = pport_stats->rx_dropped_too_small;
	drvs->rx_dropped_too_short = pport_stats->rx_dropped_too_short;
	drvs->rx_out_range_errors = pport_stats->rx_out_of_range_errors;
	drvs->rx_dropped_header_too_small =
				pport_stats->rx_dropped_header_too_small;
	drvs->rx_input_fifo_overflow_drop = pport_stats->rx_fifo_overflow;
536 537 538
	drvs->rx_address_filtered =
					pport_stats->rx_address_filtered +
					pport_stats->rx_vlan_filtered;
539
	drvs->rx_alignment_symbol_errors = pport_stats->rx_symbol_errors_lo;
S
Selvin Xavier 已提交
540
	drvs->rxpp_fifo_overflow_drop = pport_stats->rx_fifo_overflow;
541 542
	drvs->tx_pauseframes = pport_stats->tx_pause_frames_lo;
	drvs->tx_controlframes = pport_stats->tx_control_frames_lo;
S
Selvin Xavier 已提交
543
	drvs->jabber_events = pport_stats->rx_jabbers;
544 545
	drvs->forwarded_packets = pport_stats->num_forwards_lo;
	drvs->rx_drops_mtu = pport_stats->rx_drops_mtu_lo;
S
Selvin Xavier 已提交
546
	drvs->rx_drops_too_many_frags =
547
				pport_stats->rx_drops_too_many_frags_lo;
S
Selvin Xavier 已提交
548
}
549

550 551 552 553 554 555 556 557 558 559 560 561
static void accumulate_16bit_val(u32 *acc, u16 val)
{
#define lo(x)			(x & 0xFFFF)
#define hi(x)			(x & 0xFFFF0000)
	bool wrapped = val < lo(*acc);
	u32 newacc = hi(*acc) + val;

	if (wrapped)
		newacc += 65536;
	ACCESS_ONCE(*acc) = newacc;
}

J
Jingoo Han 已提交
562
static void populate_erx_stats(struct be_adapter *adapter,
563
			       struct be_rx_obj *rxo, u32 erx_stat)
564 565 566 567 568 569 570 571 572 573 574
{
	if (!BEx_chip(adapter))
		rx_stats(rxo)->rx_drops_no_frags = erx_stat;
	else
		/* below erx HW counter can actually wrap around after
		 * 65535. Driver accumulates a 32-bit value
		 */
		accumulate_16bit_val(&rx_stats(rxo)->rx_drops_no_frags,
				     (u16)erx_stat);
}

575 576
void be_parse_stats(struct be_adapter *adapter)
{
577
	struct be_erx_stats_v2 *erx = be_erx_stats_from_cmd(adapter);
578 579
	struct be_rx_obj *rxo;
	int i;
580
	u32 erx_stat;
581

582 583
	if (lancer_chip(adapter)) {
		populate_lancer_stats(adapter);
S
Selvin Xavier 已提交
584
	} else {
585 586
		if (BE2_chip(adapter))
			populate_be_v0_stats(adapter);
587 588
		else if (BE3_chip(adapter))
			/* for BE3 */
589
			populate_be_v1_stats(adapter);
590 591
		else
			populate_be_v2_stats(adapter);
592

593
		/* erx_v2 is longer than v0, v1. use v2 for v0, v1 access */
594
		for_all_rx_queues(adapter, rxo, i) {
595 596
			erx_stat = erx->rx_drops_no_fragments[rxo->q.id];
			populate_erx_stats(adapter, rxo, erx_stat);
597
		}
598
	}
599 600
}

601
static struct rtnl_link_stats64 *be_get_stats64(struct net_device *netdev,
602
						struct rtnl_link_stats64 *stats)
S
Sathya Perla 已提交
603
{
604
	struct be_adapter *adapter = netdev_priv(netdev);
605
	struct be_drv_stats *drvs = &adapter->drv_stats;
606
	struct be_rx_obj *rxo;
607
	struct be_tx_obj *txo;
608 609
	u64 pkts, bytes;
	unsigned int start;
610
	int i;
S
Sathya Perla 已提交
611

612
	for_all_rx_queues(adapter, rxo, i) {
613
		const struct be_rx_stats *rx_stats = rx_stats(rxo);
614

615
		do {
616
			start = u64_stats_fetch_begin_irq(&rx_stats->sync);
617 618
			pkts = rx_stats(rxo)->rx_pkts;
			bytes = rx_stats(rxo)->rx_bytes;
619
		} while (u64_stats_fetch_retry_irq(&rx_stats->sync, start));
620 621 622 623 624
		stats->rx_packets += pkts;
		stats->rx_bytes += bytes;
		stats->multicast += rx_stats(rxo)->rx_mcast_pkts;
		stats->rx_dropped += rx_stats(rxo)->rx_drops_no_skbs +
					rx_stats(rxo)->rx_drops_no_frags;
625 626
	}

627
	for_all_tx_queues(adapter, txo, i) {
628
		const struct be_tx_stats *tx_stats = tx_stats(txo);
629

630
		do {
631
			start = u64_stats_fetch_begin_irq(&tx_stats->sync);
632 633
			pkts = tx_stats(txo)->tx_pkts;
			bytes = tx_stats(txo)->tx_bytes;
634
		} while (u64_stats_fetch_retry_irq(&tx_stats->sync, start));
635 636
		stats->tx_packets += pkts;
		stats->tx_bytes += bytes;
637
	}
S
Sathya Perla 已提交
638 639

	/* bad pkts received */
640
	stats->rx_errors = drvs->rx_crc_errors +
641 642 643 644 645 646 647 648
		drvs->rx_alignment_symbol_errors +
		drvs->rx_in_range_errors +
		drvs->rx_out_range_errors +
		drvs->rx_frame_too_long +
		drvs->rx_dropped_too_small +
		drvs->rx_dropped_too_short +
		drvs->rx_dropped_header_too_small +
		drvs->rx_dropped_tcp_length +
649
		drvs->rx_dropped_runt;
650

S
Sathya Perla 已提交
651
	/* detailed rx errors */
652
	stats->rx_length_errors = drvs->rx_in_range_errors +
653 654
		drvs->rx_out_range_errors +
		drvs->rx_frame_too_long;
655

656
	stats->rx_crc_errors = drvs->rx_crc_errors;
S
Sathya Perla 已提交
657 658

	/* frame alignment errors */
659
	stats->rx_frame_errors = drvs->rx_alignment_symbol_errors;
660

S
Sathya Perla 已提交
661 662
	/* receiver fifo overrun */
	/* drops_no_pbuf is no per i/f, it's per BE card */
663
	stats->rx_fifo_errors = drvs->rxpp_fifo_overflow_drop +
664 665
				drvs->rx_input_fifo_overflow_drop +
				drvs->rx_drops_no_pbuf;
666
	return stats;
S
Sathya Perla 已提交
667 668
}

669
void be_link_status_update(struct be_adapter *adapter, u8 link_status)
S
Sathya Perla 已提交
670 671 672
{
	struct net_device *netdev = adapter->netdev;

673
	if (!(adapter->flags & BE_FLAGS_LINK_STATUS_INIT)) {
674
		netif_carrier_off(netdev);
675
		adapter->flags |= BE_FLAGS_LINK_STATUS_INIT;
S
Sathya Perla 已提交
676
	}
677

678
	if (link_status)
679 680 681
		netif_carrier_on(netdev);
	else
		netif_carrier_off(netdev);
I
Ivan Vecera 已提交
682 683

	netdev_info(netdev, "Link is %s\n", link_status ? "Up" : "Down");
S
Sathya Perla 已提交
684 685
}

686
static void be_tx_stats_update(struct be_tx_obj *txo, struct sk_buff *skb)
S
Sathya Perla 已提交
687
{
688
	struct be_tx_stats *stats = tx_stats(txo);
689
	u64 tx_pkts = skb_shinfo(skb)->gso_segs ? : 1;
690

691
	u64_stats_update_begin(&stats->sync);
692
	stats->tx_reqs++;
693
	stats->tx_bytes += skb->len;
694 695 696
	stats->tx_pkts += tx_pkts;
	if (skb->encapsulation && skb->ip_summed == CHECKSUM_PARTIAL)
		stats->tx_vxlan_offload_pkts += tx_pkts;
697
	u64_stats_update_end(&stats->sync);
S
Sathya Perla 已提交
698 699
}

700 701
/* Returns number of WRBs needed for the skb */
static u32 skb_wrb_cnt(struct sk_buff *skb)
S
Sathya Perla 已提交
702
{
703 704
	/* +1 for the header wrb */
	return 1 + (skb_headlen(skb) ? 1 : 0) + skb_shinfo(skb)->nr_frags;
S
Sathya Perla 已提交
705 706 707 708
}

static inline void wrb_fill(struct be_eth_wrb *wrb, u64 addr, int len)
{
709 710 711 712 713 714 715 716 717 718 719 720 721 722
	wrb->frag_pa_hi = cpu_to_le32(upper_32_bits(addr));
	wrb->frag_pa_lo = cpu_to_le32(lower_32_bits(addr));
	wrb->frag_len = cpu_to_le32(len & ETH_WRB_FRAG_LEN_MASK);
	wrb->rsvd0 = 0;
}

/* A dummy wrb is just all zeros. Using a separate routine for dummy-wrb
 * to avoid the swap and shift/mask operations in wrb_fill().
 */
static inline void wrb_fill_dummy(struct be_eth_wrb *wrb)
{
	wrb->frag_pa_hi = 0;
	wrb->frag_pa_lo = 0;
	wrb->frag_len = 0;
723
	wrb->rsvd0 = 0;
S
Sathya Perla 已提交
724 725
}

726
static inline u16 be_get_tx_vlan_tag(struct be_adapter *adapter,
727
				     struct sk_buff *skb)
728 729 730 731
{
	u8 vlan_prio;
	u16 vlan_tag;

732
	vlan_tag = skb_vlan_tag_get(skb);
733 734 735 736
	vlan_prio = (vlan_tag & VLAN_PRIO_MASK) >> VLAN_PRIO_SHIFT;
	/* If vlan priority provided by OS is NOT in available bmap */
	if (!(adapter->vlan_prio_bmap & (1 << vlan_prio)))
		vlan_tag = (vlan_tag & ~VLAN_PRIO_MASK) |
737
				adapter->recommended_prio_bits;
738 739 740 741

	return vlan_tag;
}

742 743 744 745 746 747 748 749 750 751 752 753 754
/* Used only for IP tunnel packets */
static u16 skb_inner_ip_proto(struct sk_buff *skb)
{
	return (inner_ip_hdr(skb)->version == 4) ?
		inner_ip_hdr(skb)->protocol : inner_ipv6_hdr(skb)->nexthdr;
}

static u16 skb_ip_proto(struct sk_buff *skb)
{
	return (ip_hdr(skb)->version == 4) ?
		ip_hdr(skb)->protocol : ipv6_hdr(skb)->nexthdr;
}

755 756 757 758 759 760 761 762 763 764 765 766 767 768 769
static inline bool be_is_txq_full(struct be_tx_obj *txo)
{
	return atomic_read(&txo->q.used) + BE_MAX_TX_FRAG_COUNT >= txo->q.len;
}

static inline bool be_can_txq_wake(struct be_tx_obj *txo)
{
	return atomic_read(&txo->q.used) < txo->q.len / 2;
}

static inline bool be_is_tx_compl_pending(struct be_tx_obj *txo)
{
	return atomic_read(&txo->q.used) > txo->pend_wrb_cnt;
}

770 771 772
static void be_get_wrb_params_from_skb(struct be_adapter *adapter,
				       struct sk_buff *skb,
				       struct be_wrb_params *wrb_params)
S
Sathya Perla 已提交
773
{
774
	u16 proto;
S
Sathya Perla 已提交
775

A
Ajit Khaparde 已提交
776
	if (skb_is_gso(skb)) {
777 778
		BE_WRB_F_SET(wrb_params->features, LSO, 1);
		wrb_params->lso_mss = skb_shinfo(skb)->gso_size;
779
		if (skb_is_gso_v6(skb) && !lancer_chip(adapter))
780
			BE_WRB_F_SET(wrb_params->features, LSO6, 1);
S
Sathya Perla 已提交
781
	} else if (skb->ip_summed == CHECKSUM_PARTIAL) {
782
		if (skb->encapsulation) {
783
			BE_WRB_F_SET(wrb_params->features, IPCS, 1);
784 785 786 787 788
			proto = skb_inner_ip_proto(skb);
		} else {
			proto = skb_ip_proto(skb);
		}
		if (proto == IPPROTO_TCP)
789
			BE_WRB_F_SET(wrb_params->features, TCPCS, 1);
790
		else if (proto == IPPROTO_UDP)
791
			BE_WRB_F_SET(wrb_params->features, UDPCS, 1);
S
Sathya Perla 已提交
792 793
	}

794
	if (skb_vlan_tag_present(skb)) {
795 796
		BE_WRB_F_SET(wrb_params->features, VLAN, 1);
		wrb_params->vlan_tag = be_get_tx_vlan_tag(adapter, skb);
S
Sathya Perla 已提交
797 798
	}

799 800
	BE_WRB_F_SET(wrb_params->features, CRC, 1);
}
801

802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825
static void wrb_fill_hdr(struct be_adapter *adapter,
			 struct be_eth_hdr_wrb *hdr,
			 struct be_wrb_params *wrb_params,
			 struct sk_buff *skb)
{
	memset(hdr, 0, sizeof(*hdr));

	SET_TX_WRB_HDR_BITS(crc, hdr,
			    BE_WRB_F_GET(wrb_params->features, CRC));
	SET_TX_WRB_HDR_BITS(ipcs, hdr,
			    BE_WRB_F_GET(wrb_params->features, IPCS));
	SET_TX_WRB_HDR_BITS(tcpcs, hdr,
			    BE_WRB_F_GET(wrb_params->features, TCPCS));
	SET_TX_WRB_HDR_BITS(udpcs, hdr,
			    BE_WRB_F_GET(wrb_params->features, UDPCS));

	SET_TX_WRB_HDR_BITS(lso, hdr,
			    BE_WRB_F_GET(wrb_params->features, LSO));
	SET_TX_WRB_HDR_BITS(lso6, hdr,
			    BE_WRB_F_GET(wrb_params->features, LSO6));
	SET_TX_WRB_HDR_BITS(lso_mss, hdr, wrb_params->lso_mss);

	/* Hack to skip HW VLAN tagging needs evt = 1, compl = 0. When this
	 * hack is not needed, the evt bit is set while ringing DB.
826
	 */
827 828 829 830 831 832 833 834
	SET_TX_WRB_HDR_BITS(event, hdr,
			    BE_WRB_F_GET(wrb_params->features, VLAN_SKIP_HW));
	SET_TX_WRB_HDR_BITS(vlan, hdr,
			    BE_WRB_F_GET(wrb_params->features, VLAN));
	SET_TX_WRB_HDR_BITS(vlan_tag, hdr, wrb_params->vlan_tag);

	SET_TX_WRB_HDR_BITS(num_wrb, hdr, skb_wrb_cnt(skb));
	SET_TX_WRB_HDR_BITS(len, hdr, skb->len);
V
Venkata Duvvuru 已提交
835 836
	SET_TX_WRB_HDR_BITS(mgmt, hdr,
			    BE_WRB_F_GET(wrb_params->features, OS2BMC));
S
Sathya Perla 已提交
837 838
}

I
Ivan Vecera 已提交
839
static void unmap_tx_frag(struct device *dev, struct be_eth_wrb *wrb,
840
			  bool unmap_single)
841 842
{
	dma_addr_t dma;
843
	u32 frag_len = le32_to_cpu(wrb->frag_len);
844 845


846 847 848
	dma = (u64)le32_to_cpu(wrb->frag_pa_hi) << 32 |
		(u64)le32_to_cpu(wrb->frag_pa_lo);
	if (frag_len) {
849
		if (unmap_single)
850
			dma_unmap_single(dev, dma, frag_len, DMA_TO_DEVICE);
851
		else
852
			dma_unmap_page(dev, dma, frag_len, DMA_TO_DEVICE);
853 854
	}
}
S
Sathya Perla 已提交
855

856
/* Grab a WRB header for xmit */
857
static u32 be_tx_get_wrb_hdr(struct be_tx_obj *txo)
858
{
859
	u32 head = txo->q.head;
860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902

	queue_head_inc(&txo->q);
	return head;
}

/* Set up the WRB header for xmit */
static void be_tx_setup_wrb_hdr(struct be_adapter *adapter,
				struct be_tx_obj *txo,
				struct be_wrb_params *wrb_params,
				struct sk_buff *skb, u16 head)
{
	u32 num_frags = skb_wrb_cnt(skb);
	struct be_queue_info *txq = &txo->q;
	struct be_eth_hdr_wrb *hdr = queue_index_node(txq, head);

	wrb_fill_hdr(adapter, hdr, wrb_params, skb);
	be_dws_cpu_to_le(hdr, sizeof(*hdr));

	BUG_ON(txo->sent_skb_list[head]);
	txo->sent_skb_list[head] = skb;
	txo->last_req_hdr = head;
	atomic_add(num_frags, &txq->used);
	txo->last_req_wrb_cnt = num_frags;
	txo->pend_wrb_cnt += num_frags;
}

/* Setup a WRB fragment (buffer descriptor) for xmit */
static void be_tx_setup_wrb_frag(struct be_tx_obj *txo, dma_addr_t busaddr,
				 int len)
{
	struct be_eth_wrb *wrb;
	struct be_queue_info *txq = &txo->q;

	wrb = queue_head_node(txq);
	wrb_fill(wrb, busaddr, len);
	queue_head_inc(txq);
}

/* Bring the queue back to the state it was in before be_xmit_enqueue() routine
 * was invoked. The producer index is restored to the previous packet and the
 * WRBs of the current packet are unmapped. Invoked to handle tx setup errors.
 */
static void be_xmit_restore(struct be_adapter *adapter,
903
			    struct be_tx_obj *txo, u32 head, bool map_single,
904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929
			    u32 copied)
{
	struct device *dev;
	struct be_eth_wrb *wrb;
	struct be_queue_info *txq = &txo->q;

	dev = &adapter->pdev->dev;
	txq->head = head;

	/* skip the first wrb (hdr); it's not mapped */
	queue_head_inc(txq);
	while (copied) {
		wrb = queue_head_node(txq);
		unmap_tx_frag(dev, wrb, map_single);
		map_single = false;
		copied -= le32_to_cpu(wrb->frag_len);
		queue_head_inc(txq);
	}

	txq->head = head;
}

/* Enqueue the given packet for transmit. This routine allocates WRBs for the
 * packet, dma maps the packet buffers and sets up the WRBs. Returns the number
 * of WRBs used up by the packet.
 */
930
static u32 be_xmit_enqueue(struct be_adapter *adapter, struct be_tx_obj *txo,
931 932
			   struct sk_buff *skb,
			   struct be_wrb_params *wrb_params)
S
Sathya Perla 已提交
933
{
934
	u32 i, copied = 0, wrb_cnt = skb_wrb_cnt(skb);
I
Ivan Vecera 已提交
935
	struct device *dev = &adapter->pdev->dev;
936
	struct be_queue_info *txq = &txo->q;
937
	bool map_single = false;
938
	u32 head = txq->head;
939 940
	dma_addr_t busaddr;
	int len;
S
Sathya Perla 已提交
941

942
	head = be_tx_get_wrb_hdr(txo);
S
Sathya Perla 已提交
943

944
	if (skb->len > skb->data_len) {
945
		len = skb_headlen(skb);
946

I
Ivan Vecera 已提交
947 948
		busaddr = dma_map_single(dev, skb->data, len, DMA_TO_DEVICE);
		if (dma_mapping_error(dev, busaddr))
949 950
			goto dma_err;
		map_single = true;
951
		be_tx_setup_wrb_frag(txo, busaddr, len);
952 953
		copied += len;
	}
S
Sathya Perla 已提交
954

955
	for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
956
		const struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[i];
957
		len = skb_frag_size(frag);
958

959
		busaddr = skb_frag_dma_map(dev, frag, 0, len, DMA_TO_DEVICE);
I
Ivan Vecera 已提交
960
		if (dma_mapping_error(dev, busaddr))
961
			goto dma_err;
962 963
		be_tx_setup_wrb_frag(txo, busaddr, len);
		copied += len;
S
Sathya Perla 已提交
964 965
	}

966
	be_tx_setup_wrb_hdr(adapter, txo, wrb_params, skb, head);
S
Sathya Perla 已提交
967

968 969
	be_tx_stats_update(txo, skb);
	return wrb_cnt;
S
Sathya Perla 已提交
970

971
dma_err:
972 973
	adapter->drv_stats.dma_map_errors++;
	be_xmit_restore(adapter, txo, head, map_single, copied);
974
	return 0;
S
Sathya Perla 已提交
975 976
}

977 978 979 980 981
static inline int qnq_async_evt_rcvd(struct be_adapter *adapter)
{
	return adapter->flags & BE_FLAGS_QNQ_ASYNC_EVT_RCVD;
}

982
static struct sk_buff *be_insert_vlan_in_pkt(struct be_adapter *adapter,
983
					     struct sk_buff *skb,
984 985
					     struct be_wrb_params
					     *wrb_params)
986 987 988 989 990 991 992
{
	u16 vlan_tag = 0;

	skb = skb_share_check(skb, GFP_ATOMIC);
	if (unlikely(!skb))
		return skb;

993
	if (skb_vlan_tag_present(skb))
994
		vlan_tag = be_get_tx_vlan_tag(adapter, skb);
995 996 997 998 999 1000 1001

	if (qnq_async_evt_rcvd(adapter) && adapter->pvid) {
		if (!vlan_tag)
			vlan_tag = adapter->pvid;
		/* f/w workaround to set skip_hw_vlan = 1, informs the F/W to
		 * skip VLAN insertion
		 */
1002
		BE_WRB_F_SET(wrb_params->features, VLAN_SKIP_HW, 1);
1003
	}
1004 1005

	if (vlan_tag) {
1006 1007
		skb = vlan_insert_tag_set_proto(skb, htons(ETH_P_8021Q),
						vlan_tag);
1008 1009 1010 1011 1012 1013 1014 1015
		if (unlikely(!skb))
			return skb;
		skb->vlan_tci = 0;
	}

	/* Insert the outer VLAN, if any */
	if (adapter->qnq_vid) {
		vlan_tag = adapter->qnq_vid;
1016 1017
		skb = vlan_insert_tag_set_proto(skb, htons(ETH_P_8021Q),
						vlan_tag);
1018 1019
		if (unlikely(!skb))
			return skb;
1020
		BE_WRB_F_SET(wrb_params->features, VLAN_SKIP_HW, 1);
1021 1022
	}

1023 1024 1025
	return skb;
}

1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037
static bool be_ipv6_exthdr_check(struct sk_buff *skb)
{
	struct ethhdr *eh = (struct ethhdr *)skb->data;
	u16 offset = ETH_HLEN;

	if (eh->h_proto == htons(ETH_P_IPV6)) {
		struct ipv6hdr *ip6h = (struct ipv6hdr *)(skb->data + offset);

		offset += sizeof(struct ipv6hdr);
		if (ip6h->nexthdr != NEXTHDR_TCP &&
		    ip6h->nexthdr != NEXTHDR_UDP) {
			struct ipv6_opt_hdr *ehdr =
K
Kalesh AP 已提交
1038
				(struct ipv6_opt_hdr *)(skb->data + offset);
1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049

			/* offending pkt: 2nd byte following IPv6 hdr is 0xff */
			if (ehdr->hdrlen == 0xff)
				return true;
		}
	}
	return false;
}

static int be_vlan_tag_tx_chk(struct be_adapter *adapter, struct sk_buff *skb)
{
1050
	return skb_vlan_tag_present(skb) || adapter->pvid || adapter->qnq_vid;
1051 1052
}

1053
static int be_ipv6_tx_stall_chk(struct be_adapter *adapter, struct sk_buff *skb)
1054
{
1055
	return BE3_chip(adapter) && be_ipv6_exthdr_check(skb);
1056 1057
}

1058 1059
static struct sk_buff *be_lancer_xmit_workarounds(struct be_adapter *adapter,
						  struct sk_buff *skb,
1060 1061
						  struct be_wrb_params
						  *wrb_params)
S
Sathya Perla 已提交
1062
{
1063
	struct vlan_ethhdr *veh = (struct vlan_ethhdr *)skb->data;
1064 1065
	unsigned int eth_hdr_len;
	struct iphdr *ip;
1066

1067 1068
	/* For padded packets, BE HW modifies tot_len field in IP header
	 * incorrecly when VLAN tag is inserted by HW.
1069
	 * For padded packets, Lancer computes incorrect checksum.
1070
	 */
1071 1072
	eth_hdr_len = ntohs(skb->protocol) == ETH_P_8021Q ?
						VLAN_ETH_HLEN : ETH_HLEN;
1073
	if (skb->len <= 60 &&
1074
	    (lancer_chip(adapter) || skb_vlan_tag_present(skb)) &&
1075
	    is_ipv4_pkt(skb)) {
1076 1077 1078
		ip = (struct iphdr *)ip_hdr(skb);
		pskb_trim(skb, eth_hdr_len + ntohs(ip->tot_len));
	}
1079

1080
	/* If vlan tag is already inlined in the packet, skip HW VLAN
1081
	 * tagging in pvid-tagging mode
1082
	 */
1083
	if (be_pvid_tagging_enabled(adapter) &&
1084
	    veh->h_vlan_proto == htons(ETH_P_8021Q))
1085
		BE_WRB_F_SET(wrb_params->features, VLAN_SKIP_HW, 1);
1086

1087 1088 1089 1090 1091
	/* HW has a bug wherein it will calculate CSUM for VLAN
	 * pkts even though it is disabled.
	 * Manually insert VLAN in pkt.
	 */
	if (skb->ip_summed != CHECKSUM_PARTIAL &&
1092
	    skb_vlan_tag_present(skb)) {
1093
		skb = be_insert_vlan_in_pkt(adapter, skb, wrb_params);
1094
		if (unlikely(!skb))
1095
			goto err;
1096 1097 1098 1099 1100 1101 1102
	}

	/* HW may lockup when VLAN HW tagging is requested on
	 * certain ipv6 packets. Drop such pkts if the HW workaround to
	 * skip HW tagging is not enabled by FW.
	 */
	if (unlikely(be_ipv6_tx_stall_chk(adapter, skb) &&
K
Kalesh AP 已提交
1103 1104
		     (adapter->pvid || adapter->qnq_vid) &&
		     !qnq_async_evt_rcvd(adapter)))
1105 1106 1107 1108 1109 1110 1111 1112 1113 1114
		goto tx_drop;

	/* Manual VLAN tag insertion to prevent:
	 * ASIC lockup when the ASIC inserts VLAN tag into
	 * certain ipv6 packets. Insert VLAN tags in driver,
	 * and set event, completion, vlan bits accordingly
	 * in the Tx WRB.
	 */
	if (be_ipv6_tx_stall_chk(adapter, skb) &&
	    be_vlan_tag_tx_chk(adapter, skb)) {
1115
		skb = be_insert_vlan_in_pkt(adapter, skb, wrb_params);
1116
		if (unlikely(!skb))
1117
			goto err;
1118 1119
	}

1120 1121 1122
	return skb;
tx_drop:
	dev_kfree_skb_any(skb);
1123
err:
1124 1125 1126
	return NULL;
}

1127 1128
static struct sk_buff *be_xmit_workarounds(struct be_adapter *adapter,
					   struct sk_buff *skb,
1129
					   struct be_wrb_params *wrb_params)
1130
{
1131 1132
	int err;

1133 1134 1135 1136
	/* Lancer, SH and BE3 in SRIOV mode have a bug wherein
	 * packets that are 32b or less may cause a transmit stall
	 * on that port. The workaround is to pad such packets
	 * (len <= 32 bytes) to a minimum length of 36b.
1137
	 */
1138
	if (skb->len <= 32) {
1139
		if (skb_put_padto(skb, 36))
1140 1141 1142 1143
			return NULL;
	}

	if (BEx_chip(adapter) || lancer_chip(adapter)) {
1144
		skb = be_lancer_xmit_workarounds(adapter, skb, wrb_params);
1145 1146 1147 1148
		if (!skb)
			return NULL;
	}

1149 1150 1151 1152 1153 1154 1155
	/* The stack can send us skbs with length greater than
	 * what the HW can handle. Trim the extra bytes.
	 */
	WARN_ON_ONCE(skb->len > BE_MAX_GSO_SIZE);
	err = pskb_trim(skb, BE_MAX_GSO_SIZE);
	WARN_ON(err);

1156 1157 1158
	return skb;
}

1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169
static void be_xmit_flush(struct be_adapter *adapter, struct be_tx_obj *txo)
{
	struct be_queue_info *txq = &txo->q;
	struct be_eth_hdr_wrb *hdr = queue_index_node(txq, txo->last_req_hdr);

	/* Mark the last request eventable if it hasn't been marked already */
	if (!(hdr->dw[2] & cpu_to_le32(TX_HDR_WRB_EVT)))
		hdr->dw[2] |= cpu_to_le32(TX_HDR_WRB_EVT | TX_HDR_WRB_COMPL);

	/* compose a dummy wrb if there are odd set of wrbs to notify */
	if (!lancer_chip(adapter) && (txo->pend_wrb_cnt & 1)) {
1170
		wrb_fill_dummy(queue_head_node(txq));
1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182
		queue_head_inc(txq);
		atomic_inc(&txq->used);
		txo->pend_wrb_cnt++;
		hdr->dw[2] &= ~cpu_to_le32(TX_HDR_WRB_NUM_MASK <<
					   TX_HDR_WRB_NUM_SHIFT);
		hdr->dw[2] |= cpu_to_le32((txo->last_req_wrb_cnt + 1) <<
					  TX_HDR_WRB_NUM_SHIFT);
	}
	be_txq_notify(adapter, txo, txo->pend_wrb_cnt);
	txo->pend_wrb_cnt = 0;
}

V
Venkata Duvvuru 已提交
1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278
/* OS2BMC related */

#define DHCP_CLIENT_PORT	68
#define DHCP_SERVER_PORT	67
#define NET_BIOS_PORT1		137
#define NET_BIOS_PORT2		138
#define DHCPV6_RAS_PORT		547

#define is_mc_allowed_on_bmc(adapter, eh)	\
	(!is_multicast_filt_enabled(adapter) &&	\
	 is_multicast_ether_addr(eh->h_dest) &&	\
	 !is_broadcast_ether_addr(eh->h_dest))

#define is_bc_allowed_on_bmc(adapter, eh)	\
	(!is_broadcast_filt_enabled(adapter) &&	\
	 is_broadcast_ether_addr(eh->h_dest))

#define is_arp_allowed_on_bmc(adapter, skb)	\
	(is_arp(skb) && is_arp_filt_enabled(adapter))

#define is_broadcast_packet(eh, adapter)	\
		(is_multicast_ether_addr(eh->h_dest) && \
		!compare_ether_addr(eh->h_dest, adapter->netdev->broadcast))

#define is_arp(skb)	(skb->protocol == htons(ETH_P_ARP))

#define is_arp_filt_enabled(adapter)	\
		(adapter->bmc_filt_mask & (BMC_FILT_BROADCAST_ARP))

#define is_dhcp_client_filt_enabled(adapter)	\
		(adapter->bmc_filt_mask & BMC_FILT_BROADCAST_DHCP_CLIENT)

#define is_dhcp_srvr_filt_enabled(adapter)	\
		(adapter->bmc_filt_mask & BMC_FILT_BROADCAST_DHCP_SERVER)

#define is_nbios_filt_enabled(adapter)	\
		(adapter->bmc_filt_mask & BMC_FILT_BROADCAST_NET_BIOS)

#define is_ipv6_na_filt_enabled(adapter)	\
		(adapter->bmc_filt_mask &	\
			BMC_FILT_MULTICAST_IPV6_NEIGH_ADVER)

#define is_ipv6_ra_filt_enabled(adapter)	\
		(adapter->bmc_filt_mask & BMC_FILT_MULTICAST_IPV6_RA)

#define is_ipv6_ras_filt_enabled(adapter)	\
		(adapter->bmc_filt_mask & BMC_FILT_MULTICAST_IPV6_RAS)

#define is_broadcast_filt_enabled(adapter)	\
		(adapter->bmc_filt_mask & BMC_FILT_BROADCAST)

#define is_multicast_filt_enabled(adapter)	\
		(adapter->bmc_filt_mask & BMC_FILT_MULTICAST)

static bool be_send_pkt_to_bmc(struct be_adapter *adapter,
			       struct sk_buff **skb)
{
	struct ethhdr *eh = (struct ethhdr *)(*skb)->data;
	bool os2bmc = false;

	if (!be_is_os2bmc_enabled(adapter))
		goto done;

	if (!is_multicast_ether_addr(eh->h_dest))
		goto done;

	if (is_mc_allowed_on_bmc(adapter, eh) ||
	    is_bc_allowed_on_bmc(adapter, eh) ||
	    is_arp_allowed_on_bmc(adapter, (*skb))) {
		os2bmc = true;
		goto done;
	}

	if ((*skb)->protocol == htons(ETH_P_IPV6)) {
		struct ipv6hdr *hdr = ipv6_hdr((*skb));
		u8 nexthdr = hdr->nexthdr;

		if (nexthdr == IPPROTO_ICMPV6) {
			struct icmp6hdr *icmp6 = icmp6_hdr((*skb));

			switch (icmp6->icmp6_type) {
			case NDISC_ROUTER_ADVERTISEMENT:
				os2bmc = is_ipv6_ra_filt_enabled(adapter);
				goto done;
			case NDISC_NEIGHBOUR_ADVERTISEMENT:
				os2bmc = is_ipv6_na_filt_enabled(adapter);
				goto done;
			default:
				break;
			}
		}
	}

	if (is_udp_pkt((*skb))) {
		struct udphdr *udp = udp_hdr((*skb));

1279
		switch (ntohs(udp->dest)) {
V
Venkata Duvvuru 已提交
1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306
		case DHCP_CLIENT_PORT:
			os2bmc = is_dhcp_client_filt_enabled(adapter);
			goto done;
		case DHCP_SERVER_PORT:
			os2bmc = is_dhcp_srvr_filt_enabled(adapter);
			goto done;
		case NET_BIOS_PORT1:
		case NET_BIOS_PORT2:
			os2bmc = is_nbios_filt_enabled(adapter);
			goto done;
		case DHCPV6_RAS_PORT:
			os2bmc = is_ipv6_ras_filt_enabled(adapter);
			goto done;
		default:
			break;
		}
	}
done:
	/* For packets over a vlan, which are destined
	 * to BMC, asic expects the vlan to be inline in the packet.
	 */
	if (os2bmc)
		*skb = be_insert_vlan_in_pkt(adapter, *skb, NULL);

	return os2bmc;
}

1307 1308 1309
static netdev_tx_t be_xmit(struct sk_buff *skb, struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
1310 1311
	u16 q_idx = skb_get_queue_mapping(skb);
	struct be_tx_obj *txo = &adapter->tx_obj[q_idx];
1312 1313
	struct be_wrb_params wrb_params = { 0 };
	bool flush = !skb->xmit_more;
1314
	u16 wrb_cnt;
1315

1316
	skb = be_xmit_workarounds(adapter, skb, &wrb_params);
1317 1318
	if (unlikely(!skb))
		goto drop;
S
Sathya Perla 已提交
1319

1320 1321 1322
	be_get_wrb_params_from_skb(adapter, skb, &wrb_params);

	wrb_cnt = be_xmit_enqueue(adapter, txo, skb, &wrb_params);
1323 1324 1325 1326
	if (unlikely(!wrb_cnt)) {
		dev_kfree_skb_any(skb);
		goto drop;
	}
E
Eric Dumazet 已提交
1327

V
Venkata Duvvuru 已提交
1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339
	/* if os2bmc is enabled and if the pkt is destined to bmc,
	 * enqueue the pkt a 2nd time with mgmt bit set.
	 */
	if (be_send_pkt_to_bmc(adapter, &skb)) {
		BE_WRB_F_SET(wrb_params.features, OS2BMC, 1);
		wrb_cnt = be_xmit_enqueue(adapter, txo, skb, &wrb_params);
		if (unlikely(!wrb_cnt))
			goto drop;
		else
			skb_get(skb);
	}

1340
	if (be_is_txq_full(txo)) {
1341 1342 1343
		netif_stop_subqueue(netdev, q_idx);
		tx_stats(txo)->tx_stops++;
	}
1344

1345 1346
	if (flush || __netif_subqueue_stopped(netdev, q_idx))
		be_xmit_flush(adapter, txo);
S
Sathya Perla 已提交
1347

1348 1349 1350 1351 1352 1353
	return NETDEV_TX_OK;
drop:
	tx_stats(txo)->tx_drv_drops++;
	/* Flush the already enqueued tx requests */
	if (flush && txo->pend_wrb_cnt)
		be_xmit_flush(adapter, txo);
S
Sathya Perla 已提交
1354 1355 1356 1357 1358 1359 1360

	return NETDEV_TX_OK;
}

static int be_change_mtu(struct net_device *netdev, int new_mtu)
{
	struct be_adapter *adapter = netdev_priv(netdev);
K
Kalesh AP 已提交
1361 1362 1363 1364 1365
	struct device *dev = &adapter->pdev->dev;

	if (new_mtu < BE_MIN_MTU || new_mtu > BE_MAX_MTU) {
		dev_info(dev, "MTU must be between %d and %d bytes\n",
			 BE_MIN_MTU, BE_MAX_MTU);
S
Sathya Perla 已提交
1366 1367
		return -EINVAL;
	}
K
Kalesh AP 已提交
1368 1369

	dev_info(dev, "MTU changed from %d to %d bytes\n",
1370
		 netdev->mtu, new_mtu);
S
Sathya Perla 已提交
1371 1372 1373 1374
	netdev->mtu = new_mtu;
	return 0;
}

1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411
static inline bool be_in_all_promisc(struct be_adapter *adapter)
{
	return (adapter->if_flags & BE_IF_FLAGS_ALL_PROMISCUOUS) ==
			BE_IF_FLAGS_ALL_PROMISCUOUS;
}

static int be_set_vlan_promisc(struct be_adapter *adapter)
{
	struct device *dev = &adapter->pdev->dev;
	int status;

	if (adapter->if_flags & BE_IF_FLAGS_VLAN_PROMISCUOUS)
		return 0;

	status = be_cmd_rx_filter(adapter, BE_IF_FLAGS_VLAN_PROMISCUOUS, ON);
	if (!status) {
		dev_info(dev, "Enabled VLAN promiscuous mode\n");
		adapter->if_flags |= BE_IF_FLAGS_VLAN_PROMISCUOUS;
	} else {
		dev_err(dev, "Failed to enable VLAN promiscuous mode\n");
	}
	return status;
}

static int be_clear_vlan_promisc(struct be_adapter *adapter)
{
	struct device *dev = &adapter->pdev->dev;
	int status;

	status = be_cmd_rx_filter(adapter, BE_IF_FLAGS_VLAN_PROMISCUOUS, OFF);
	if (!status) {
		dev_info(dev, "Disabling VLAN promiscuous mode\n");
		adapter->if_flags &= ~BE_IF_FLAGS_VLAN_PROMISCUOUS;
	}
	return status;
}

S
Sathya Perla 已提交
1412
/*
1413 1414
 * A max of 64 (BE_NUM_VLANS_SUPPORTED) vlans can be configured in BE.
 * If the user configures more, place BE in vlan promiscuous mode.
S
Sathya Perla 已提交
1415
 */
S
Sathya Perla 已提交
1416
static int be_vid_config(struct be_adapter *adapter)
S
Sathya Perla 已提交
1417
{
V
Vasundhara Volam 已提交
1418
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
1419
	u16 vids[BE_NUM_VLANS_SUPPORTED];
1420
	u16 num = 0, i = 0;
1421
	int status = 0;
1422

1423
	/* No need to further configure vids if in promiscuous mode */
1424
	if (be_in_all_promisc(adapter))
1425 1426
		return 0;

1427
	if (adapter->vlans_added > be_max_vlans(adapter))
1428
		return be_set_vlan_promisc(adapter);
1429 1430

	/* Construct VLAN Table to give to HW */
1431 1432
	for_each_set_bit(i, adapter->vids, VLAN_N_VID)
		vids[num++] = cpu_to_le16(i);
1433

1434
	status = be_cmd_vlan_config(adapter, adapter->if_handle, vids, num, 0);
1435
	if (status) {
1436
		dev_err(dev, "Setting HW VLAN filtering failed\n");
1437
		/* Set to VLAN promisc mode as setting VLAN filter failed */
1438 1439
		if (addl_status(status) == MCC_ADDL_STATUS_INSUFFICIENT_VLANS ||
		    addl_status(status) ==
1440
				MCC_ADDL_STATUS_INSUFFICIENT_RESOURCES)
1441 1442 1443
			return be_set_vlan_promisc(adapter);
	} else if (adapter->if_flags & BE_IF_FLAGS_VLAN_PROMISCUOUS) {
		status = be_clear_vlan_promisc(adapter);
S
Sathya Perla 已提交
1444
	}
1445
	return status;
S
Sathya Perla 已提交
1446 1447
}

1448
static int be_vlan_add_vid(struct net_device *netdev, __be16 proto, u16 vid)
S
Sathya Perla 已提交
1449 1450
{
	struct be_adapter *adapter = netdev_priv(netdev);
A
Ajit Khaparde 已提交
1451
	int status = 0;
S
Sathya Perla 已提交
1452

1453 1454
	/* Packets with VID 0 are always received by Lancer by default */
	if (lancer_chip(adapter) && vid == 0)
1455 1456
		return status;

1457
	if (test_bit(vid, adapter->vids))
1458
		return status;
1459

1460
	set_bit(vid, adapter->vids);
1461
	adapter->vlans_added++;
1462

1463 1464 1465
	status = be_vid_config(adapter);
	if (status) {
		adapter->vlans_added--;
1466
		clear_bit(vid, adapter->vids);
1467
	}
1468

A
Ajit Khaparde 已提交
1469
	return status;
S
Sathya Perla 已提交
1470 1471
}

1472
static int be_vlan_rem_vid(struct net_device *netdev, __be16 proto, u16 vid)
S
Sathya Perla 已提交
1473 1474 1475
{
	struct be_adapter *adapter = netdev_priv(netdev);

1476 1477
	/* Packets with VID 0 are always received by Lancer by default */
	if (lancer_chip(adapter) && vid == 0)
1478
		return 0;
1479

1480 1481 1482
	if (!test_bit(vid, adapter->vids))
		return 0;

1483
	clear_bit(vid, adapter->vids);
1484 1485 1486
	adapter->vlans_added--;

	return be_vid_config(adapter);
S
Sathya Perla 已提交
1487 1488
}

1489
static void be_clear_all_promisc(struct be_adapter *adapter)
1490
{
1491
	be_cmd_rx_filter(adapter, BE_IF_FLAGS_ALL_PROMISCUOUS, OFF);
1492
	adapter->if_flags &= ~BE_IF_FLAGS_ALL_PROMISCUOUS;
1493 1494
}

1495 1496 1497 1498 1499 1500 1501
static void be_set_all_promisc(struct be_adapter *adapter)
{
	be_cmd_rx_filter(adapter, BE_IF_FLAGS_ALL_PROMISCUOUS, ON);
	adapter->if_flags |= BE_IF_FLAGS_ALL_PROMISCUOUS;
}

static void be_set_mc_promisc(struct be_adapter *adapter)
S
Sathya Perla 已提交
1502
{
1503
	int status;
S
Sathya Perla 已提交
1504

1505 1506
	if (adapter->if_flags & BE_IF_FLAGS_MCAST_PROMISCUOUS)
		return;
S
Sathya Perla 已提交
1507

1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535
	status = be_cmd_rx_filter(adapter, BE_IF_FLAGS_MCAST_PROMISCUOUS, ON);
	if (!status)
		adapter->if_flags |= BE_IF_FLAGS_MCAST_PROMISCUOUS;
}

static void be_set_mc_list(struct be_adapter *adapter)
{
	int status;

	status = be_cmd_rx_filter(adapter, BE_IF_FLAGS_MULTICAST, ON);
	if (!status)
		adapter->if_flags &= ~BE_IF_FLAGS_MCAST_PROMISCUOUS;
	else
		be_set_mc_promisc(adapter);
}

static void be_set_uc_list(struct be_adapter *adapter)
{
	struct netdev_hw_addr *ha;
	int i = 1; /* First slot is claimed by the Primary MAC */

	for (; adapter->uc_macs > 0; adapter->uc_macs--, i++)
		be_cmd_pmac_del(adapter, adapter->if_handle,
				adapter->pmac_id[i], 0);

	if (netdev_uc_count(adapter->netdev) > be_max_uc(adapter)) {
		be_set_all_promisc(adapter);
		return;
S
Sathya Perla 已提交
1536 1537
	}

1538 1539 1540 1541 1542 1543
	netdev_for_each_uc_addr(ha, adapter->netdev) {
		adapter->uc_macs++; /* First slot is for Primary MAC */
		be_cmd_pmac_add(adapter, (u8 *)ha->addr, adapter->if_handle,
				&adapter->pmac_id[adapter->uc_macs], 0);
	}
}
S
Sathya Perla 已提交
1544

1545 1546 1547
static void be_clear_uc_list(struct be_adapter *adapter)
{
	int i;
1548

1549 1550 1551 1552 1553
	for (i = 1; i < (adapter->uc_macs + 1); i++)
		be_cmd_pmac_del(adapter, adapter->if_handle,
				adapter->pmac_id[i], 0);
	adapter->uc_macs = 0;
}
1554

1555 1556 1557
static void be_set_rx_mode(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
1558

1559 1560 1561
	if (netdev->flags & IFF_PROMISC) {
		be_set_all_promisc(adapter);
		return;
1562 1563
	}

1564 1565 1566 1567 1568
	/* Interface was previously in promiscuous mode; disable it */
	if (be_in_all_promisc(adapter)) {
		be_clear_all_promisc(adapter);
		if (adapter->vlans_added)
			be_vid_config(adapter);
1569
	}
1570

1571 1572 1573 1574
	/* Enable multicast promisc if num configured exceeds what we support */
	if (netdev->flags & IFF_ALLMULTI ||
	    netdev_mc_count(netdev) > be_max_mc(adapter)) {
		be_set_mc_promisc(adapter);
1575
		return;
1576
	}
1577

1578 1579 1580 1581
	if (netdev_uc_count(netdev) != adapter->uc_macs)
		be_set_uc_list(adapter);

	be_set_mc_list(adapter);
S
Sathya Perla 已提交
1582 1583
}

1584 1585 1586
static int be_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
{
	struct be_adapter *adapter = netdev_priv(netdev);
1587
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
1588 1589
	int status;

1590
	if (!sriov_enabled(adapter))
1591 1592
		return -EPERM;

1593
	if (!is_valid_ether_addr(mac) || vf >= adapter->num_vfs)
1594 1595
		return -EINVAL;

1596 1597 1598 1599 1600 1601
	/* Proceed further only if user provided MAC is different
	 * from active MAC
	 */
	if (ether_addr_equal(mac, vf_cfg->mac_addr))
		return 0;

1602 1603 1604
	if (BEx_chip(adapter)) {
		be_cmd_pmac_del(adapter, vf_cfg->if_handle, vf_cfg->pmac_id,
				vf + 1);
1605

1606 1607
		status = be_cmd_pmac_add(adapter, mac, vf_cfg->if_handle,
					 &vf_cfg->pmac_id, vf + 1);
1608 1609 1610
	} else {
		status = be_cmd_set_mac(adapter, mac, vf_cfg->if_handle,
					vf + 1);
1611 1612
	}

1613 1614 1615 1616 1617
	if (status) {
		dev_err(&adapter->pdev->dev, "MAC %pM set on VF %d Failed: %#x",
			mac, vf, status);
		return be_cmd_status(status);
	}
1618

1619 1620 1621
	ether_addr_copy(vf_cfg->mac_addr, mac);

	return 0;
1622 1623
}

1624
static int be_get_vf_config(struct net_device *netdev, int vf,
1625
			    struct ifla_vf_info *vi)
1626 1627
{
	struct be_adapter *adapter = netdev_priv(netdev);
1628
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
1629

1630
	if (!sriov_enabled(adapter))
1631 1632
		return -EPERM;

1633
	if (vf >= adapter->num_vfs)
1634 1635 1636
		return -EINVAL;

	vi->vf = vf;
1637 1638
	vi->max_tx_rate = vf_cfg->tx_rate;
	vi->min_tx_rate = 0;
1639 1640
	vi->vlan = vf_cfg->vlan_tag & VLAN_VID_MASK;
	vi->qos = vf_cfg->vlan_tag >> VLAN_PRIO_SHIFT;
1641
	memcpy(&vi->mac, vf_cfg->mac_addr, ETH_ALEN);
1642
	vi->linkstate = adapter->vf_cfg[vf].plink_tracking;
1643
	vi->spoofchk = adapter->vf_cfg[vf].spoofchk;
1644 1645 1646 1647

	return 0;
}

1648 1649 1650 1651 1652 1653 1654 1655
static int be_set_vf_tvt(struct be_adapter *adapter, int vf, u16 vlan)
{
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
	u16 vids[BE_NUM_VLANS_SUPPORTED];
	int vf_if_id = vf_cfg->if_handle;
	int status;

	/* Enable Transparent VLAN Tagging */
1656
	status = be_cmd_set_hsw_config(adapter, vlan, vf + 1, vf_if_id, 0, 0);
1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684
	if (status)
		return status;

	/* Clear pre-programmed VLAN filters on VF if any, if TVT is enabled */
	vids[0] = 0;
	status = be_cmd_vlan_config(adapter, vf_if_id, vids, 1, vf + 1);
	if (!status)
		dev_info(&adapter->pdev->dev,
			 "Cleared guest VLANs on VF%d", vf);

	/* After TVT is enabled, disallow VFs to program VLAN filters */
	if (vf_cfg->privileges & BE_PRIV_FILTMGMT) {
		status = be_cmd_set_fn_privileges(adapter, vf_cfg->privileges &
						  ~BE_PRIV_FILTMGMT, vf + 1);
		if (!status)
			vf_cfg->privileges &= ~BE_PRIV_FILTMGMT;
	}
	return 0;
}

static int be_clear_vf_tvt(struct be_adapter *adapter, int vf)
{
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
	struct device *dev = &adapter->pdev->dev;
	int status;

	/* Reset Transparent VLAN Tagging. */
	status = be_cmd_set_hsw_config(adapter, BE_RESET_VLAN_TAG_ID, vf + 1,
1685
				       vf_cfg->if_handle, 0, 0);
1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703
	if (status)
		return status;

	/* Allow VFs to program VLAN filtering */
	if (!(vf_cfg->privileges & BE_PRIV_FILTMGMT)) {
		status = be_cmd_set_fn_privileges(adapter, vf_cfg->privileges |
						  BE_PRIV_FILTMGMT, vf + 1);
		if (!status) {
			vf_cfg->privileges |= BE_PRIV_FILTMGMT;
			dev_info(dev, "VF%d: FILTMGMT priv enabled", vf);
		}
	}

	dev_info(dev,
		 "Disable/re-enable i/f in VM to clear Transparent VLAN tag");
	return 0;
}

1704
static int be_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan, u8 qos)
1705 1706
{
	struct be_adapter *adapter = netdev_priv(netdev);
1707
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
1708
	int status;
1709

1710
	if (!sriov_enabled(adapter))
1711 1712
		return -EPERM;

1713
	if (vf >= adapter->num_vfs || vlan > 4095 || qos > 7)
1714 1715
		return -EINVAL;

1716 1717
	if (vlan || qos) {
		vlan |= qos << VLAN_PRIO_SHIFT;
1718
		status = be_set_vf_tvt(adapter, vf, vlan);
1719
	} else {
1720
		status = be_clear_vf_tvt(adapter, vf);
1721 1722
	}

1723 1724
	if (status) {
		dev_err(&adapter->pdev->dev,
1725 1726
			"VLAN %d config on VF %d failed : %#x\n", vlan, vf,
			status);
1727 1728 1729 1730 1731
		return be_cmd_status(status);
	}

	vf_cfg->vlan_tag = vlan;
	return 0;
1732 1733
}

1734 1735
static int be_set_vf_tx_rate(struct net_device *netdev, int vf,
			     int min_tx_rate, int max_tx_rate)
1736 1737
{
	struct be_adapter *adapter = netdev_priv(netdev);
1738 1739 1740 1741
	struct device *dev = &adapter->pdev->dev;
	int percent_rate, status = 0;
	u16 link_speed = 0;
	u8 link_status;
1742

1743
	if (!sriov_enabled(adapter))
1744 1745
		return -EPERM;

1746
	if (vf >= adapter->num_vfs)
1747 1748
		return -EINVAL;

1749 1750 1751
	if (min_tx_rate)
		return -EINVAL;

1752 1753 1754 1755 1756 1757 1758 1759 1760 1761
	if (!max_tx_rate)
		goto config_qos;

	status = be_cmd_link_status_query(adapter, &link_speed,
					  &link_status, 0);
	if (status)
		goto err;

	if (!link_status) {
		dev_err(dev, "TX-rate setting not allowed when link is down\n");
1762
		status = -ENETDOWN;
1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779
		goto err;
	}

	if (max_tx_rate < 100 || max_tx_rate > link_speed) {
		dev_err(dev, "TX-rate must be between 100 and %d Mbps\n",
			link_speed);
		status = -EINVAL;
		goto err;
	}

	/* On Skyhawk the QOS setting must be done only as a % value */
	percent_rate = link_speed / 100;
	if (skyhawk_chip(adapter) && (max_tx_rate % percent_rate)) {
		dev_err(dev, "TX-rate must be a multiple of %d Mbps\n",
			percent_rate);
		status = -EINVAL;
		goto err;
1780
	}
1781

1782 1783
config_qos:
	status = be_cmd_config_qos(adapter, max_tx_rate, link_speed, vf + 1);
1784
	if (status)
1785 1786 1787 1788 1789 1790 1791 1792
		goto err;

	adapter->vf_cfg[vf].tx_rate = max_tx_rate;
	return 0;

err:
	dev_err(dev, "TX-rate setting of %dMbps on VF%d failed\n",
		max_tx_rate, vf);
1793
	return be_cmd_status(status);
1794
}
1795

1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808
static int be_set_vf_link_state(struct net_device *netdev, int vf,
				int link_state)
{
	struct be_adapter *adapter = netdev_priv(netdev);
	int status;

	if (!sriov_enabled(adapter))
		return -EPERM;

	if (vf >= adapter->num_vfs)
		return -EINVAL;

	status = be_cmd_set_logical_link_config(adapter, link_state, vf+1);
1809 1810 1811 1812 1813
	if (status) {
		dev_err(&adapter->pdev->dev,
			"Link state change on VF %d failed: %#x\n", vf, status);
		return be_cmd_status(status);
	}
1814

1815 1816 1817
	adapter->vf_cfg[vf].plink_tracking = link_state;

	return 0;
1818
}
1819

1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852
static int be_set_vf_spoofchk(struct net_device *netdev, int vf, bool enable)
{
	struct be_adapter *adapter = netdev_priv(netdev);
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
	u8 spoofchk;
	int status;

	if (!sriov_enabled(adapter))
		return -EPERM;

	if (vf >= adapter->num_vfs)
		return -EINVAL;

	if (BEx_chip(adapter))
		return -EOPNOTSUPP;

	if (enable == vf_cfg->spoofchk)
		return 0;

	spoofchk = enable ? ENABLE_MAC_SPOOFCHK : DISABLE_MAC_SPOOFCHK;

	status = be_cmd_set_hsw_config(adapter, 0, vf + 1, vf_cfg->if_handle,
				       0, spoofchk);
	if (status) {
		dev_err(&adapter->pdev->dev,
			"Spoofchk change on VF %d failed: %#x\n", vf, status);
		return be_cmd_status(status);
	}

	vf_cfg->spoofchk = enable;
	return 0;
}

1853 1854
static void be_aic_update(struct be_aic_obj *aic, u64 rx_pkts, u64 tx_pkts,
			  ulong now)
S
Sathya Perla 已提交
1855
{
1856 1857 1858 1859
	aic->rx_pkts_prev = rx_pkts;
	aic->tx_reqs_prev = tx_pkts;
	aic->jiffies = now;
}
1860

1861
static int be_get_new_eqd(struct be_eq_obj *eqo)
1862
{
1863 1864
	struct be_adapter *adapter = eqo->adapter;
	int eqd, start;
1865 1866 1867
	struct be_aic_obj *aic;
	struct be_rx_obj *rxo;
	struct be_tx_obj *txo;
1868
	u64 rx_pkts = 0, tx_pkts = 0;
1869 1870
	ulong now;
	u32 pps, delta;
1871
	int i;
S
Sathya Perla 已提交
1872

1873 1874 1875 1876 1877 1878 1879
	aic = &adapter->aic_obj[eqo->idx];
	if (!aic->enable) {
		if (aic->jiffies)
			aic->jiffies = 0;
		eqd = aic->et_eqd;
		return eqd;
	}
S
Sathya Perla 已提交
1880

1881
	for_all_rx_queues_on_eq(adapter, eqo, rxo, i) {
1882
		do {
1883
			start = u64_stats_fetch_begin_irq(&rxo->stats.sync);
1884
			rx_pkts += rxo->stats.rx_pkts;
1885
		} while (u64_stats_fetch_retry_irq(&rxo->stats.sync, start));
1886
	}
S
Sathya Perla 已提交
1887

1888
	for_all_tx_queues_on_eq(adapter, eqo, txo, i) {
1889
		do {
1890
			start = u64_stats_fetch_begin_irq(&txo->stats.sync);
1891
			tx_pkts += txo->stats.tx_reqs;
1892
		} while (u64_stats_fetch_retry_irq(&txo->stats.sync, start));
1893
	}
S
Sathya Perla 已提交
1894

1895 1896 1897 1898 1899 1900 1901 1902
	/* Skip, if wrapped around or first calculation */
	now = jiffies;
	if (!aic->jiffies || time_before(now, aic->jiffies) ||
	    rx_pkts < aic->rx_pkts_prev ||
	    tx_pkts < aic->tx_reqs_prev) {
		be_aic_update(aic, rx_pkts, tx_pkts, now);
		return aic->prev_eqd;
	}
1903

1904 1905 1906
	delta = jiffies_to_msecs(now - aic->jiffies);
	if (delta == 0)
		return aic->prev_eqd;
S
Sathya Perla 已提交
1907

1908 1909 1910
	pps = (((u32)(rx_pkts - aic->rx_pkts_prev) * 1000) / delta) +
		(((u32)(tx_pkts - aic->tx_reqs_prev) * 1000) / delta);
	eqd = (pps / 15000) << 2;
1911

1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933
	if (eqd < 8)
		eqd = 0;
	eqd = min_t(u32, eqd, aic->max_eqd);
	eqd = max_t(u32, eqd, aic->min_eqd);

	be_aic_update(aic, rx_pkts, tx_pkts, now);

	return eqd;
}

/* For Skyhawk-R only */
static u32 be_get_eq_delay_mult_enc(struct be_eq_obj *eqo)
{
	struct be_adapter *adapter = eqo->adapter;
	struct be_aic_obj *aic = &adapter->aic_obj[eqo->idx];
	ulong now = jiffies;
	int eqd;
	u32 mult_enc;

	if (!aic->enable)
		return 0;

1934
	if (jiffies_to_msecs(now - aic->jiffies) < 1)
1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963
		eqd = aic->prev_eqd;
	else
		eqd = be_get_new_eqd(eqo);

	if (eqd > 100)
		mult_enc = R2I_DLY_ENC_1;
	else if (eqd > 60)
		mult_enc = R2I_DLY_ENC_2;
	else if (eqd > 20)
		mult_enc = R2I_DLY_ENC_3;
	else
		mult_enc = R2I_DLY_ENC_0;

	aic->prev_eqd = eqd;

	return mult_enc;
}

void be_eqd_update(struct be_adapter *adapter, bool force_update)
{
	struct be_set_eqd set_eqd[MAX_EVT_QS];
	struct be_aic_obj *aic;
	struct be_eq_obj *eqo;
	int i, num = 0, eqd;

	for_all_evt_queues(adapter, eqo, i) {
		aic = &adapter->aic_obj[eqo->idx];
		eqd = be_get_new_eqd(eqo);
		if (force_update || eqd != aic->prev_eqd) {
1964 1965 1966 1967 1968
			set_eqd[num].delay_multiplier = (eqd * 65)/100;
			set_eqd[num].eq_id = eqo->q.id;
			aic->prev_eqd = eqd;
			num++;
		}
1969
	}
1970 1971 1972

	if (num)
		be_cmd_modify_eqd(adapter, set_eqd, num);
S
Sathya Perla 已提交
1973 1974
}

1975
static void be_rx_stats_update(struct be_rx_obj *rxo,
1976
			       struct be_rx_compl_info *rxcp)
1977
{
1978
	struct be_rx_stats *stats = rx_stats(rxo);
1979

1980
	u64_stats_update_begin(&stats->sync);
1981
	stats->rx_compl++;
1982
	stats->rx_bytes += rxcp->pkt_size;
1983
	stats->rx_pkts++;
1984 1985
	if (rxcp->tunneled)
		stats->rx_vxlan_offload_pkts++;
1986
	if (rxcp->pkt_type == BE_MULTICAST_PACKET)
1987
		stats->rx_mcast_pkts++;
1988
	if (rxcp->err)
1989
		stats->rx_compl_err++;
1990
	u64_stats_update_end(&stats->sync);
1991 1992
}

1993
static inline bool csum_passed(struct be_rx_compl_info *rxcp)
1994
{
1995
	/* L4 checksum is not reliable for non TCP/UDP packets.
1996 1997
	 * Also ignore ipcksm for ipv6 pkts
	 */
1998
	return (rxcp->tcpf || rxcp->udpf) && rxcp->l4_csum &&
1999
		(rxcp->ip_csum || rxcp->ipv6) && !rxcp->err;
2000 2001
}

2002
static struct be_rx_page_info *get_rx_page_info(struct be_rx_obj *rxo)
S
Sathya Perla 已提交
2003
{
S
Sathya Perla 已提交
2004
	struct be_adapter *adapter = rxo->adapter;
S
Sathya Perla 已提交
2005
	struct be_rx_page_info *rx_page_info;
2006
	struct be_queue_info *rxq = &rxo->q;
2007
	u32 frag_idx = rxq->tail;
S
Sathya Perla 已提交
2008

2009
	rx_page_info = &rxo->page_info_tbl[frag_idx];
S
Sathya Perla 已提交
2010 2011
	BUG_ON(!rx_page_info->page);

2012
	if (rx_page_info->last_frag) {
I
Ivan Vecera 已提交
2013 2014 2015
		dma_unmap_page(&adapter->pdev->dev,
			       dma_unmap_addr(rx_page_info, bus),
			       adapter->big_page_size, DMA_FROM_DEVICE);
2016 2017 2018 2019 2020
		rx_page_info->last_frag = false;
	} else {
		dma_sync_single_for_cpu(&adapter->pdev->dev,
					dma_unmap_addr(rx_page_info, bus),
					rx_frag_size, DMA_FROM_DEVICE);
A
Ajit Khaparde 已提交
2021
	}
S
Sathya Perla 已提交
2022

2023
	queue_tail_inc(rxq);
S
Sathya Perla 已提交
2024 2025 2026 2027 2028
	atomic_dec(&rxq->used);
	return rx_page_info;
}

/* Throwaway the data in the Rx completion */
S
Sathya Perla 已提交
2029 2030
static void be_rx_compl_discard(struct be_rx_obj *rxo,
				struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
2031 2032
{
	struct be_rx_page_info *page_info;
2033
	u16 i, num_rcvd = rxcp->num_rcvd;
S
Sathya Perla 已提交
2034

2035
	for (i = 0; i < num_rcvd; i++) {
2036
		page_info = get_rx_page_info(rxo);
2037 2038
		put_page(page_info->page);
		memset(page_info, 0, sizeof(*page_info));
S
Sathya Perla 已提交
2039 2040 2041 2042 2043 2044 2045
	}
}

/*
 * skb_fill_rx_data forms a complete skb for an ether frame
 * indicated by rxcp.
 */
S
Sathya Perla 已提交
2046 2047
static void skb_fill_rx_data(struct be_rx_obj *rxo, struct sk_buff *skb,
			     struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
2048 2049
{
	struct be_rx_page_info *page_info;
2050 2051
	u16 i, j;
	u16 hdr_len, curr_frag_len, remaining;
S
Sathya Perla 已提交
2052 2053
	u8 *start;

2054
	page_info = get_rx_page_info(rxo);
S
Sathya Perla 已提交
2055 2056 2057 2058
	start = page_address(page_info->page) + page_info->page_offset;
	prefetch(start);

	/* Copy data in the first descriptor of this completion */
2059
	curr_frag_len = min(rxcp->pkt_size, rx_frag_size);
S
Sathya Perla 已提交
2060 2061 2062

	skb->len = curr_frag_len;
	if (curr_frag_len <= BE_HDR_LEN) { /* tiny packet */
2063
		memcpy(skb->data, start, curr_frag_len);
S
Sathya Perla 已提交
2064 2065 2066 2067 2068
		/* Complete packet has now been moved to data */
		put_page(page_info->page);
		skb->data_len = 0;
		skb->tail += curr_frag_len;
	} else {
2069 2070
		hdr_len = ETH_HLEN;
		memcpy(skb->data, start, hdr_len);
S
Sathya Perla 已提交
2071
		skb_shinfo(skb)->nr_frags = 1;
2072
		skb_frag_set_page(skb, 0, page_info->page);
S
Sathya Perla 已提交
2073 2074
		skb_shinfo(skb)->frags[0].page_offset =
					page_info->page_offset + hdr_len;
2075 2076
		skb_frag_size_set(&skb_shinfo(skb)->frags[0],
				  curr_frag_len - hdr_len);
S
Sathya Perla 已提交
2077
		skb->data_len = curr_frag_len - hdr_len;
E
Eric Dumazet 已提交
2078
		skb->truesize += rx_frag_size;
S
Sathya Perla 已提交
2079 2080
		skb->tail += hdr_len;
	}
A
Ajit Khaparde 已提交
2081
	page_info->page = NULL;
S
Sathya Perla 已提交
2082

2083 2084 2085
	if (rxcp->pkt_size <= rx_frag_size) {
		BUG_ON(rxcp->num_rcvd != 1);
		return;
S
Sathya Perla 已提交
2086 2087 2088
	}

	/* More frags present for this completion */
2089 2090
	remaining = rxcp->pkt_size - curr_frag_len;
	for (i = 1, j = 0; i < rxcp->num_rcvd; i++) {
2091
		page_info = get_rx_page_info(rxo);
2092
		curr_frag_len = min(remaining, rx_frag_size);
S
Sathya Perla 已提交
2093

2094 2095 2096 2097
		/* Coalesce all frags from the same physical page in one slot */
		if (page_info->page_offset == 0) {
			/* Fresh page */
			j++;
2098
			skb_frag_set_page(skb, j, page_info->page);
2099 2100
			skb_shinfo(skb)->frags[j].page_offset =
							page_info->page_offset;
E
Eric Dumazet 已提交
2101
			skb_frag_size_set(&skb_shinfo(skb)->frags[j], 0);
2102 2103 2104 2105 2106
			skb_shinfo(skb)->nr_frags++;
		} else {
			put_page(page_info->page);
		}

E
Eric Dumazet 已提交
2107
		skb_frag_size_add(&skb_shinfo(skb)->frags[j], curr_frag_len);
S
Sathya Perla 已提交
2108 2109
		skb->len += curr_frag_len;
		skb->data_len += curr_frag_len;
E
Eric Dumazet 已提交
2110
		skb->truesize += rx_frag_size;
2111
		remaining -= curr_frag_len;
A
Ajit Khaparde 已提交
2112
		page_info->page = NULL;
S
Sathya Perla 已提交
2113
	}
2114
	BUG_ON(j > MAX_SKB_FRAGS);
S
Sathya Perla 已提交
2115 2116
}

2117
/* Process the RX completion indicated by rxcp when GRO is disabled */
2118
static void be_rx_compl_process(struct be_rx_obj *rxo, struct napi_struct *napi,
S
Sathya Perla 已提交
2119
				struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
2120
{
S
Sathya Perla 已提交
2121
	struct be_adapter *adapter = rxo->adapter;
2122
	struct net_device *netdev = adapter->netdev;
S
Sathya Perla 已提交
2123
	struct sk_buff *skb;
2124

2125
	skb = netdev_alloc_skb_ip_align(netdev, BE_RX_SKB_ALLOC_SIZE);
2126
	if (unlikely(!skb)) {
2127
		rx_stats(rxo)->rx_drops_no_skbs++;
S
Sathya Perla 已提交
2128
		be_rx_compl_discard(rxo, rxcp);
S
Sathya Perla 已提交
2129 2130 2131
		return;
	}

S
Sathya Perla 已提交
2132
	skb_fill_rx_data(rxo, skb, rxcp);
S
Sathya Perla 已提交
2133

2134
	if (likely((netdev->features & NETIF_F_RXCSUM) && csum_passed(rxcp)))
2135
		skb->ip_summed = CHECKSUM_UNNECESSARY;
S
Somnath Kotur 已提交
2136 2137
	else
		skb_checksum_none_assert(skb);
S
Sathya Perla 已提交
2138

2139
	skb->protocol = eth_type_trans(skb, netdev);
2140
	skb_record_rx_queue(skb, rxo - &adapter->rx_obj[0]);
S
Sathya Perla 已提交
2141
	if (netdev->features & NETIF_F_RXHASH)
T
Tom Herbert 已提交
2142
		skb_set_hash(skb, rxcp->rss_hash, PKT_HASH_TYPE_L3);
2143

2144
	skb->csum_level = rxcp->tunneled;
2145
	skb_mark_napi_id(skb, napi);
S
Sathya Perla 已提交
2146

2147
	if (rxcp->vlanf)
2148
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), rxcp->vlan_tag);
A
Ajit Khaparde 已提交
2149 2150

	netif_receive_skb(skb);
S
Sathya Perla 已提交
2151 2152
}

2153
/* Process the RX completion indicated by rxcp when GRO is enabled */
J
Jingoo Han 已提交
2154 2155 2156
static void be_rx_compl_process_gro(struct be_rx_obj *rxo,
				    struct napi_struct *napi,
				    struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
2157
{
S
Sathya Perla 已提交
2158
	struct be_adapter *adapter = rxo->adapter;
S
Sathya Perla 已提交
2159
	struct be_rx_page_info *page_info;
2160
	struct sk_buff *skb = NULL;
2161 2162
	u16 remaining, curr_frag_len;
	u16 i, j;
2163

S
Sathya Perla 已提交
2164
	skb = napi_get_frags(napi);
2165
	if (!skb) {
S
Sathya Perla 已提交
2166
		be_rx_compl_discard(rxo, rxcp);
2167 2168 2169
		return;
	}

2170 2171
	remaining = rxcp->pkt_size;
	for (i = 0, j = -1; i < rxcp->num_rcvd; i++) {
2172
		page_info = get_rx_page_info(rxo);
S
Sathya Perla 已提交
2173 2174 2175

		curr_frag_len = min(remaining, rx_frag_size);

2176 2177 2178 2179
		/* Coalesce all frags from the same physical page in one slot */
		if (i == 0 || page_info->page_offset == 0) {
			/* First frag or Fresh page */
			j++;
2180
			skb_frag_set_page(skb, j, page_info->page);
2181 2182
			skb_shinfo(skb)->frags[j].page_offset =
							page_info->page_offset;
E
Eric Dumazet 已提交
2183
			skb_frag_size_set(&skb_shinfo(skb)->frags[j], 0);
2184 2185 2186
		} else {
			put_page(page_info->page);
		}
E
Eric Dumazet 已提交
2187
		skb_frag_size_add(&skb_shinfo(skb)->frags[j], curr_frag_len);
E
Eric Dumazet 已提交
2188
		skb->truesize += rx_frag_size;
2189
		remaining -= curr_frag_len;
S
Sathya Perla 已提交
2190 2191
		memset(page_info, 0, sizeof(*page_info));
	}
2192
	BUG_ON(j > MAX_SKB_FRAGS);
S
Sathya Perla 已提交
2193

2194
	skb_shinfo(skb)->nr_frags = j + 1;
2195 2196
	skb->len = rxcp->pkt_size;
	skb->data_len = rxcp->pkt_size;
2197
	skb->ip_summed = CHECKSUM_UNNECESSARY;
2198
	skb_record_rx_queue(skb, rxo - &adapter->rx_obj[0]);
A
Ajit Khaparde 已提交
2199
	if (adapter->netdev->features & NETIF_F_RXHASH)
T
Tom Herbert 已提交
2200
		skb_set_hash(skb, rxcp->rss_hash, PKT_HASH_TYPE_L3);
2201

2202
	skb->csum_level = rxcp->tunneled;
2203

2204
	if (rxcp->vlanf)
2205
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), rxcp->vlan_tag);
A
Ajit Khaparde 已提交
2206

S
Sathya Perla 已提交
2207
	napi_gro_frags(napi);
2208 2209
}

S
Sathya Perla 已提交
2210 2211
static void be_parse_rx_compl_v1(struct be_eth_rx_compl *compl,
				 struct be_rx_compl_info *rxcp)
2212
{
2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223
	rxcp->pkt_size = GET_RX_COMPL_V1_BITS(pktsize, compl);
	rxcp->vlanf = GET_RX_COMPL_V1_BITS(vtp, compl);
	rxcp->err = GET_RX_COMPL_V1_BITS(err, compl);
	rxcp->tcpf = GET_RX_COMPL_V1_BITS(tcpf, compl);
	rxcp->udpf = GET_RX_COMPL_V1_BITS(udpf, compl);
	rxcp->ip_csum = GET_RX_COMPL_V1_BITS(ipcksm, compl);
	rxcp->l4_csum = GET_RX_COMPL_V1_BITS(l4_cksm, compl);
	rxcp->ipv6 = GET_RX_COMPL_V1_BITS(ip_version, compl);
	rxcp->num_rcvd = GET_RX_COMPL_V1_BITS(numfrags, compl);
	rxcp->pkt_type = GET_RX_COMPL_V1_BITS(cast_enc, compl);
	rxcp->rss_hash = GET_RX_COMPL_V1_BITS(rsshash, compl);
2224
	if (rxcp->vlanf) {
2225 2226
		rxcp->qnq = GET_RX_COMPL_V1_BITS(qnq, compl);
		rxcp->vlan_tag = GET_RX_COMPL_V1_BITS(vlan_tag, compl);
2227
	}
2228
	rxcp->port = GET_RX_COMPL_V1_BITS(port, compl);
2229
	rxcp->tunneled =
2230
		GET_RX_COMPL_V1_BITS(tunneled, compl);
2231 2232
}

S
Sathya Perla 已提交
2233 2234
static void be_parse_rx_compl_v0(struct be_eth_rx_compl *compl,
				 struct be_rx_compl_info *rxcp)
2235
{
2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246
	rxcp->pkt_size = GET_RX_COMPL_V0_BITS(pktsize, compl);
	rxcp->vlanf = GET_RX_COMPL_V0_BITS(vtp, compl);
	rxcp->err = GET_RX_COMPL_V0_BITS(err, compl);
	rxcp->tcpf = GET_RX_COMPL_V0_BITS(tcpf, compl);
	rxcp->udpf = GET_RX_COMPL_V0_BITS(udpf, compl);
	rxcp->ip_csum = GET_RX_COMPL_V0_BITS(ipcksm, compl);
	rxcp->l4_csum = GET_RX_COMPL_V0_BITS(l4_cksm, compl);
	rxcp->ipv6 = GET_RX_COMPL_V0_BITS(ip_version, compl);
	rxcp->num_rcvd = GET_RX_COMPL_V0_BITS(numfrags, compl);
	rxcp->pkt_type = GET_RX_COMPL_V0_BITS(cast_enc, compl);
	rxcp->rss_hash = GET_RX_COMPL_V0_BITS(rsshash, compl);
2247
	if (rxcp->vlanf) {
2248 2249
		rxcp->qnq = GET_RX_COMPL_V0_BITS(qnq, compl);
		rxcp->vlan_tag = GET_RX_COMPL_V0_BITS(vlan_tag, compl);
2250
	}
2251 2252
	rxcp->port = GET_RX_COMPL_V0_BITS(port, compl);
	rxcp->ip_frag = GET_RX_COMPL_V0_BITS(ip_frag, compl);
2253 2254 2255 2256 2257 2258 2259
}

static struct be_rx_compl_info *be_rx_compl_get(struct be_rx_obj *rxo)
{
	struct be_eth_rx_compl *compl = queue_tail_node(&rxo->cq);
	struct be_rx_compl_info *rxcp = &rxo->rxcp;
	struct be_adapter *adapter = rxo->adapter;
S
Sathya Perla 已提交
2260

2261 2262 2263 2264
	/* For checking the valid bit it is Ok to use either definition as the
	 * valid bit is at the same position in both v0 and v1 Rx compl */
	if (compl->dw[offsetof(struct amap_eth_rx_compl_v1, valid) / 32] == 0)
		return NULL;
S
Sathya Perla 已提交
2265

2266 2267
	rmb();
	be_dws_le_to_cpu(compl, sizeof(*compl));
S
Sathya Perla 已提交
2268

2269
	if (adapter->be3_native)
S
Sathya Perla 已提交
2270
		be_parse_rx_compl_v1(compl, rxcp);
2271
	else
S
Sathya Perla 已提交
2272
		be_parse_rx_compl_v0(compl, rxcp);
S
Sathya Perla 已提交
2273

2274 2275 2276
	if (rxcp->ip_frag)
		rxcp->l4_csum = 0;

2277
	if (rxcp->vlanf) {
2278 2279 2280 2281 2282
		/* In QNQ modes, if qnq bit is not set, then the packet was
		 * tagged only with the transparent outer vlan-tag and must
		 * not be treated as a vlan packet by host
		 */
		if (be_is_qnq_mode(adapter) && !rxcp->qnq)
2283
			rxcp->vlanf = 0;
S
Sathya Perla 已提交
2284

2285
		if (!lancer_chip(adapter))
2286
			rxcp->vlan_tag = swab16(rxcp->vlan_tag);
S
Sathya Perla 已提交
2287

2288
		if (adapter->pvid == (rxcp->vlan_tag & VLAN_VID_MASK) &&
2289
		    !test_bit(rxcp->vlan_tag, adapter->vids))
2290 2291
			rxcp->vlanf = 0;
	}
2292 2293 2294

	/* As the compl has been parsed, reset it; we wont touch it again */
	compl->dw[offsetof(struct amap_eth_rx_compl_v1, valid) / 32] = 0;
S
Sathya Perla 已提交
2295

2296
	queue_tail_inc(&rxo->cq);
S
Sathya Perla 已提交
2297 2298 2299
	return rxcp;
}

2300
static inline struct page *be_alloc_pages(u32 size, gfp_t gfp)
S
Sathya Perla 已提交
2301 2302
{
	u32 order = get_order(size);
2303

S
Sathya Perla 已提交
2304
	if (order > 0)
2305 2306
		gfp |= __GFP_COMP;
	return  alloc_pages(gfp, order);
S
Sathya Perla 已提交
2307 2308 2309 2310 2311 2312
}

/*
 * Allocate a page, split it to fragments of size rx_frag_size and post as
 * receive buffers to BE
 */
2313
static void be_post_rx_frags(struct be_rx_obj *rxo, gfp_t gfp, u32 frags_needed)
S
Sathya Perla 已提交
2314
{
2315
	struct be_adapter *adapter = rxo->adapter;
2316
	struct be_rx_page_info *page_info = NULL, *prev_page_info = NULL;
2317
	struct be_queue_info *rxq = &rxo->q;
S
Sathya Perla 已提交
2318
	struct page *pagep = NULL;
2319
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
2320 2321
	struct be_eth_rx_d *rxd;
	u64 page_dmaaddr = 0, frag_dmaaddr;
2322
	u32 posted, page_offset = 0, notify = 0;
S
Sathya Perla 已提交
2323

2324
	page_info = &rxo->page_info_tbl[rxq->head];
2325
	for (posted = 0; posted < frags_needed && !page_info->page; posted++) {
S
Sathya Perla 已提交
2326
		if (!pagep) {
2327
			pagep = be_alloc_pages(adapter->big_page_size, gfp);
S
Sathya Perla 已提交
2328
			if (unlikely(!pagep)) {
2329
				rx_stats(rxo)->rx_post_fail++;
S
Sathya Perla 已提交
2330 2331
				break;
			}
2332 2333
			page_dmaaddr = dma_map_page(dev, pagep, 0,
						    adapter->big_page_size,
I
Ivan Vecera 已提交
2334
						    DMA_FROM_DEVICE);
2335 2336 2337
			if (dma_mapping_error(dev, page_dmaaddr)) {
				put_page(pagep);
				pagep = NULL;
2338
				adapter->drv_stats.dma_map_errors++;
2339 2340
				break;
			}
2341
			page_offset = 0;
S
Sathya Perla 已提交
2342 2343
		} else {
			get_page(pagep);
2344
			page_offset += rx_frag_size;
S
Sathya Perla 已提交
2345
		}
2346
		page_info->page_offset = page_offset;
S
Sathya Perla 已提交
2347 2348 2349
		page_info->page = pagep;

		rxd = queue_head_node(rxq);
2350
		frag_dmaaddr = page_dmaaddr + page_info->page_offset;
S
Sathya Perla 已提交
2351 2352 2353 2354 2355 2356 2357
		rxd->fragpa_lo = cpu_to_le32(frag_dmaaddr & 0xFFFFFFFF);
		rxd->fragpa_hi = cpu_to_le32(upper_32_bits(frag_dmaaddr));

		/* Any space left in the current big page for another frag? */
		if ((page_offset + rx_frag_size + rx_frag_size) >
					adapter->big_page_size) {
			pagep = NULL;
2358 2359 2360 2361
			page_info->last_frag = true;
			dma_unmap_addr_set(page_info, bus, page_dmaaddr);
		} else {
			dma_unmap_addr_set(page_info, bus, frag_dmaaddr);
S
Sathya Perla 已提交
2362
		}
2363 2364 2365

		prev_page_info = page_info;
		queue_head_inc(rxq);
S
Sathya Perla 已提交
2366
		page_info = &rxo->page_info_tbl[rxq->head];
S
Sathya Perla 已提交
2367
	}
2368 2369 2370 2371 2372 2373 2374 2375

	/* Mark the last frag of a page when we break out of the above loop
	 * with no more slots available in the RXQ
	 */
	if (pagep) {
		prev_page_info->last_frag = true;
		dma_unmap_addr_set(prev_page_info, bus, page_dmaaddr);
	}
S
Sathya Perla 已提交
2376 2377 2378

	if (posted) {
		atomic_add(posted, &rxq->used);
2379 2380
		if (rxo->rx_post_starved)
			rxo->rx_post_starved = false;
2381
		do {
2382
			notify = min(MAX_NUM_POST_ERX_DB, posted);
2383 2384 2385
			be_rxq_notify(adapter, rxq->id, notify);
			posted -= notify;
		} while (posted);
2386 2387
	} else if (atomic_read(&rxq->used) == 0) {
		/* Let be_worker replenish when memory is available */
2388
		rxo->rx_post_starved = true;
S
Sathya Perla 已提交
2389 2390 2391
	}
}

2392
static struct be_tx_compl_info *be_tx_compl_get(struct be_tx_obj *txo)
S
Sathya Perla 已提交
2393
{
2394 2395 2396
	struct be_queue_info *tx_cq = &txo->cq;
	struct be_tx_compl_info *txcp = &txo->txcp;
	struct be_eth_tx_compl *compl = queue_tail_node(tx_cq);
S
Sathya Perla 已提交
2397

2398
	if (compl->dw[offsetof(struct amap_eth_tx_compl, valid) / 32] == 0)
S
Sathya Perla 已提交
2399 2400
		return NULL;

2401
	/* Ensure load ordering of valid bit dword and other dwords below */
2402
	rmb();
2403
	be_dws_le_to_cpu(compl, sizeof(*compl));
S
Sathya Perla 已提交
2404

2405 2406
	txcp->status = GET_TX_COMPL_BITS(status, compl);
	txcp->end_index = GET_TX_COMPL_BITS(wrb_index, compl);
S
Sathya Perla 已提交
2407

2408
	compl->dw[offsetof(struct amap_eth_tx_compl, valid) / 32] = 0;
S
Sathya Perla 已提交
2409 2410 2411 2412
	queue_tail_inc(tx_cq);
	return txcp;
}

2413
static u16 be_tx_compl_process(struct be_adapter *adapter,
2414
			       struct be_tx_obj *txo, u16 last_index)
S
Sathya Perla 已提交
2415
{
2416
	struct sk_buff **sent_skbs = txo->sent_skb_list;
2417
	struct be_queue_info *txq = &txo->q;
2418 2419
	struct sk_buff *skb = NULL;
	bool unmap_skb_hdr = false;
2420
	struct be_eth_wrb *wrb;
2421 2422
	u16 num_wrbs = 0;
	u32 frag_index;
S
Sathya Perla 已提交
2423

2424
	do {
2425 2426 2427 2428 2429 2430 2431 2432 2433 2434
		if (sent_skbs[txq->tail]) {
			/* Free skb from prev req */
			if (skb)
				dev_consume_skb_any(skb);
			skb = sent_skbs[txq->tail];
			sent_skbs[txq->tail] = NULL;
			queue_tail_inc(txq);  /* skip hdr wrb */
			num_wrbs++;
			unmap_skb_hdr = true;
		}
2435
		wrb = queue_tail_node(txq);
2436
		frag_index = txq->tail;
I
Ivan Vecera 已提交
2437
		unmap_tx_frag(&adapter->pdev->dev, wrb,
2438
			      (unmap_skb_hdr && skb_headlen(skb)));
2439
		unmap_skb_hdr = false;
S
Sathya Perla 已提交
2440
		queue_tail_inc(txq);
2441 2442 2443
		num_wrbs++;
	} while (frag_index != last_index);
	dev_consume_skb_any(skb);
S
Sathya Perla 已提交
2444

2445
	return num_wrbs;
S
Sathya Perla 已提交
2446 2447
}

S
Sathya Perla 已提交
2448 2449
/* Return the number of events in the event queue */
static inline int events_get(struct be_eq_obj *eqo)
2450
{
S
Sathya Perla 已提交
2451 2452
	struct be_eq_entry *eqe;
	int num = 0;
2453

S
Sathya Perla 已提交
2454 2455 2456 2457
	do {
		eqe = queue_tail_node(&eqo->q);
		if (eqe->evt == 0)
			break;
2458

S
Sathya Perla 已提交
2459 2460 2461 2462 2463 2464 2465
		rmb();
		eqe->evt = 0;
		num++;
		queue_tail_inc(&eqo->q);
	} while (true);

	return num;
2466 2467
}

S
Sathya Perla 已提交
2468 2469
/* Leaves the EQ is disarmed state */
static void be_eq_clean(struct be_eq_obj *eqo)
2470
{
S
Sathya Perla 已提交
2471
	int num = events_get(eqo);
2472

2473
	be_eq_notify(eqo->adapter, eqo->q.id, false, true, num, 0);
2474 2475
}

2476 2477
/* Free posted rx buffers that were not used */
static void be_rxq_clean(struct be_rx_obj *rxo)
S
Sathya Perla 已提交
2478
{
2479
	struct be_queue_info *rxq = &rxo->q;
2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493
	struct be_rx_page_info *page_info;

	while (atomic_read(&rxq->used) > 0) {
		page_info = get_rx_page_info(rxo);
		put_page(page_info->page);
		memset(page_info, 0, sizeof(*page_info));
	}
	BUG_ON(atomic_read(&rxq->used));
	rxq->tail = 0;
	rxq->head = 0;
}

static void be_rx_cq_clean(struct be_rx_obj *rxo)
{
2494
	struct be_queue_info *rx_cq = &rxo->cq;
2495
	struct be_rx_compl_info *rxcp;
2496 2497
	struct be_adapter *adapter = rxo->adapter;
	int flush_wait = 0;
S
Sathya Perla 已提交
2498

2499 2500 2501 2502 2503 2504 2505 2506
	/* Consume pending rx completions.
	 * Wait for the flush completion (identified by zero num_rcvd)
	 * to arrive. Notify CQ even when there are no more CQ entries
	 * for HW to flush partially coalesced CQ entries.
	 * In Lancer, there is no need to wait for flush compl.
	 */
	for (;;) {
		rxcp = be_rx_compl_get(rxo);
K
Kalesh AP 已提交
2507
		if (!rxcp) {
2508 2509 2510
			if (lancer_chip(adapter))
				break;

2511 2512 2513
			if (flush_wait++ > 50 ||
			    be_check_error(adapter,
					   BE_ERROR_HW)) {
2514 2515 2516 2517 2518 2519 2520 2521
				dev_warn(&adapter->pdev->dev,
					 "did not receive flush compl\n");
				break;
			}
			be_cq_notify(adapter, rx_cq->id, true, 0);
			mdelay(1);
		} else {
			be_rx_compl_discard(rxo, rxcp);
2522
			be_cq_notify(adapter, rx_cq->id, false, 1);
2523 2524 2525
			if (rxcp->num_rcvd == 0)
				break;
		}
S
Sathya Perla 已提交
2526 2527
	}

2528 2529
	/* After cleanup, leave the CQ in unarmed state */
	be_cq_notify(adapter, rx_cq->id, false, 0);
S
Sathya Perla 已提交
2530 2531
}

S
Sathya Perla 已提交
2532
static void be_tx_compl_clean(struct be_adapter *adapter)
S
Sathya Perla 已提交
2533
{
2534
	struct device *dev = &adapter->pdev->dev;
2535
	u16 cmpl = 0, timeo = 0, num_wrbs = 0;
2536
	struct be_tx_compl_info *txcp;
S
Sathya Perla 已提交
2537
	struct be_queue_info *txq;
2538
	u32 end_idx, notified_idx;
2539
	struct be_tx_obj *txo;
S
Sathya Perla 已提交
2540
	int i, pending_txqs;
2541

2542
	/* Stop polling for compls when HW has been silent for 10ms */
2543
	do {
S
Sathya Perla 已提交
2544 2545 2546
		pending_txqs = adapter->num_tx_qs;

		for_all_tx_queues(adapter, txo, i) {
2547 2548
			cmpl = 0;
			num_wrbs = 0;
S
Sathya Perla 已提交
2549
			txq = &txo->q;
2550 2551 2552 2553
			while ((txcp = be_tx_compl_get(txo))) {
				num_wrbs +=
					be_tx_compl_process(adapter, txo,
							    txcp->end_index);
S
Sathya Perla 已提交
2554 2555 2556 2557 2558
				cmpl++;
			}
			if (cmpl) {
				be_cq_notify(adapter, txo->cq.id, false, cmpl);
				atomic_sub(num_wrbs, &txq->used);
2559
				timeo = 0;
S
Sathya Perla 已提交
2560
			}
2561
			if (!be_is_tx_compl_pending(txo))
S
Sathya Perla 已提交
2562
				pending_txqs--;
2563 2564
		}

2565 2566
		if (pending_txqs == 0 || ++timeo > 10 ||
		    be_check_error(adapter, BE_ERROR_HW))
2567 2568 2569 2570 2571
			break;

		mdelay(1);
	} while (true);

2572
	/* Free enqueued TX that was never notified to HW */
S
Sathya Perla 已提交
2573 2574 2575
	for_all_tx_queues(adapter, txo, i) {
		txq = &txo->q;

2576 2577 2578 2579
		if (atomic_read(&txq->used)) {
			dev_info(dev, "txq%d: cleaning %d pending tx-wrbs\n",
				 i, atomic_read(&txq->used));
			notified_idx = txq->tail;
S
Sathya Perla 已提交
2580
			end_idx = txq->tail;
2581 2582 2583 2584 2585
			index_adv(&end_idx, atomic_read(&txq->used) - 1,
				  txq->len);
			/* Use the tx-compl process logic to handle requests
			 * that were not sent to the HW.
			 */
S
Sathya Perla 已提交
2586 2587
			num_wrbs = be_tx_compl_process(adapter, txo, end_idx);
			atomic_sub(num_wrbs, &txq->used);
2588 2589 2590 2591 2592 2593 2594
			BUG_ON(atomic_read(&txq->used));
			txo->pend_wrb_cnt = 0;
			/* Since hw was never notified of these requests,
			 * reset TXQ indices
			 */
			txq->head = notified_idx;
			txq->tail = notified_idx;
S
Sathya Perla 已提交
2595
		}
2596
	}
S
Sathya Perla 已提交
2597 2598
}

S
Sathya Perla 已提交
2599 2600 2601 2602 2603 2604
static void be_evt_queues_destroy(struct be_adapter *adapter)
{
	struct be_eq_obj *eqo;
	int i;

	for_all_evt_queues(adapter, eqo, i) {
2605 2606
		if (eqo->q.created) {
			be_eq_clean(eqo);
S
Sathya Perla 已提交
2607
			be_cmd_q_destroy(adapter, &eqo->q, QTYPE_EQ);
2608
			napi_hash_del(&eqo->napi);
2609
			netif_napi_del(&eqo->napi);
2610
			free_cpumask_var(eqo->affinity_mask);
2611
		}
S
Sathya Perla 已提交
2612 2613 2614 2615 2616 2617 2618 2619
		be_queue_free(adapter, &eqo->q);
	}
}

static int be_evt_queues_create(struct be_adapter *adapter)
{
	struct be_queue_info *eq;
	struct be_eq_obj *eqo;
2620
	struct be_aic_obj *aic;
S
Sathya Perla 已提交
2621 2622
	int i, rc;

2623 2624
	adapter->num_evt_qs = min_t(u16, num_irqs(adapter),
				    adapter->cfg_num_qs);
S
Sathya Perla 已提交
2625 2626

	for_all_evt_queues(adapter, eqo, i) {
2627
		int numa_node = dev_to_node(&adapter->pdev->dev);
2628

2629
		aic = &adapter->aic_obj[i];
S
Sathya Perla 已提交
2630 2631
		eqo->adapter = adapter;
		eqo->idx = i;
2632 2633
		aic->max_eqd = BE_MAX_EQD;
		aic->enable = true;
S
Sathya Perla 已提交
2634 2635 2636

		eq = &eqo->q;
		rc = be_queue_alloc(adapter, eq, EVNT_Q_LEN,
2637
				    sizeof(struct be_eq_entry));
S
Sathya Perla 已提交
2638 2639 2640
		if (rc)
			return rc;

S
Sathya Perla 已提交
2641
		rc = be_cmd_eq_create(adapter, eqo);
S
Sathya Perla 已提交
2642 2643
		if (rc)
			return rc;
2644 2645 2646 2647 2648 2649 2650

		if (!zalloc_cpumask_var(&eqo->affinity_mask, GFP_KERNEL))
			return -ENOMEM;
		cpumask_set_cpu(cpumask_local_spread(i, numa_node),
				eqo->affinity_mask);
		netif_napi_add(adapter->netdev, &eqo->napi, be_poll,
			       BE_NAPI_WEIGHT);
S
Sathya Perla 已提交
2651
	}
2652
	return 0;
S
Sathya Perla 已提交
2653 2654
}

2655 2656 2657 2658
static void be_mcc_queues_destroy(struct be_adapter *adapter)
{
	struct be_queue_info *q;

2659
	q = &adapter->mcc_obj.q;
2660
	if (q->created)
2661
		be_cmd_q_destroy(adapter, q, QTYPE_MCCQ);
2662 2663
	be_queue_free(adapter, q);

2664
	q = &adapter->mcc_obj.cq;
2665
	if (q->created)
2666
		be_cmd_q_destroy(adapter, q, QTYPE_CQ);
2667 2668 2669 2670 2671 2672 2673 2674
	be_queue_free(adapter, q);
}

/* Must be called only after TX qs are created as MCC shares TX EQ */
static int be_mcc_queues_create(struct be_adapter *adapter)
{
	struct be_queue_info *q, *cq;

2675
	cq = &adapter->mcc_obj.cq;
2676
	if (be_queue_alloc(adapter, cq, MCC_CQ_LEN,
2677
			   sizeof(struct be_mcc_compl)))
2678 2679
		goto err;

S
Sathya Perla 已提交
2680 2681
	/* Use the default EQ for MCC completions */
	if (be_cmd_cq_create(adapter, cq, &mcc_eqo(adapter)->q, true, 0))
2682 2683
		goto mcc_cq_free;

2684
	q = &adapter->mcc_obj.q;
2685 2686 2687
	if (be_queue_alloc(adapter, q, MCC_Q_LEN, sizeof(struct be_mcc_wrb)))
		goto mcc_cq_destroy;

2688
	if (be_cmd_mccq_create(adapter, q, cq))
2689 2690 2691 2692 2693 2694 2695
		goto mcc_q_free;

	return 0;

mcc_q_free:
	be_queue_free(adapter, q);
mcc_cq_destroy:
2696
	be_cmd_q_destroy(adapter, cq, QTYPE_CQ);
2697 2698 2699 2700 2701 2702
mcc_cq_free:
	be_queue_free(adapter, cq);
err:
	return -1;
}

S
Sathya Perla 已提交
2703 2704 2705
static void be_tx_queues_destroy(struct be_adapter *adapter)
{
	struct be_queue_info *q;
2706 2707
	struct be_tx_obj *txo;
	u8 i;
S
Sathya Perla 已提交
2708

2709 2710 2711 2712 2713
	for_all_tx_queues(adapter, txo, i) {
		q = &txo->q;
		if (q->created)
			be_cmd_q_destroy(adapter, q, QTYPE_TXQ);
		be_queue_free(adapter, q);
S
Sathya Perla 已提交
2714

2715 2716 2717 2718 2719
		q = &txo->cq;
		if (q->created)
			be_cmd_q_destroy(adapter, q, QTYPE_CQ);
		be_queue_free(adapter, q);
	}
S
Sathya Perla 已提交
2720 2721
}

2722
static int be_tx_qs_create(struct be_adapter *adapter)
S
Sathya Perla 已提交
2723
{
S
Sathya Perla 已提交
2724
	struct be_queue_info *cq;
2725
	struct be_tx_obj *txo;
S
Sathya Perla 已提交
2726
	struct be_eq_obj *eqo;
2727
	int status, i;
S
Sathya Perla 已提交
2728

2729
	adapter->num_tx_qs = min(adapter->num_evt_qs, be_max_txqs(adapter));
2730

S
Sathya Perla 已提交
2731 2732 2733 2734 2735 2736
	for_all_tx_queues(adapter, txo, i) {
		cq = &txo->cq;
		status = be_queue_alloc(adapter, cq, TX_CQ_LEN,
					sizeof(struct be_eth_tx_compl));
		if (status)
			return status;
2737

2738 2739 2740
		u64_stats_init(&txo->stats.sync);
		u64_stats_init(&txo->stats.sync_compl);

S
Sathya Perla 已提交
2741 2742 2743
		/* If num_evt_qs is less than num_tx_qs, then more than
		 * one txq share an eq
		 */
S
Sathya Perla 已提交
2744 2745
		eqo = &adapter->eq_obj[i % adapter->num_evt_qs];
		status = be_cmd_cq_create(adapter, cq, &eqo->q, false, 3);
S
Sathya Perla 已提交
2746 2747
		if (status)
			return status;
S
Sathya Perla 已提交
2748

S
Sathya Perla 已提交
2749 2750 2751 2752
		status = be_queue_alloc(adapter, &txo->q, TX_Q_LEN,
					sizeof(struct be_eth_wrb));
		if (status)
			return status;
S
Sathya Perla 已提交
2753

V
Vasundhara Volam 已提交
2754
		status = be_cmd_txq_create(adapter, txo);
S
Sathya Perla 已提交
2755 2756
		if (status)
			return status;
S
Sathya Perla 已提交
2757 2758 2759

		netif_set_xps_queue(adapter->netdev, eqo->affinity_mask,
				    eqo->idx);
2760
	}
S
Sathya Perla 已提交
2761

S
Sathya Perla 已提交
2762 2763
	dev_info(&adapter->pdev->dev, "created %d TX queue(s)\n",
		 adapter->num_tx_qs);
S
Sathya Perla 已提交
2764
	return 0;
S
Sathya Perla 已提交
2765 2766
}

S
Sathya Perla 已提交
2767
static void be_rx_cqs_destroy(struct be_adapter *adapter)
S
Sathya Perla 已提交
2768 2769
{
	struct be_queue_info *q;
2770 2771 2772 2773 2774 2775 2776 2777
	struct be_rx_obj *rxo;
	int i;

	for_all_rx_queues(adapter, rxo, i) {
		q = &rxo->cq;
		if (q->created)
			be_cmd_q_destroy(adapter, q, QTYPE_CQ);
		be_queue_free(adapter, q);
2778 2779 2780
	}
}

S
Sathya Perla 已提交
2781
static int be_rx_cqs_create(struct be_adapter *adapter)
S
Sathya Perla 已提交
2782
{
S
Sathya Perla 已提交
2783
	struct be_queue_info *eq, *cq;
2784 2785
	struct be_rx_obj *rxo;
	int rc, i;
S
Sathya Perla 已提交
2786

2787
	/* We can create as many RSS rings as there are EQs. */
2788
	adapter->num_rss_qs = adapter->num_evt_qs;
2789

2790 2791 2792 2793 2794 2795 2796 2797
	/* We'll use RSS only if atleast 2 RSS rings are supported. */
	if (adapter->num_rss_qs <= 1)
		adapter->num_rss_qs = 0;

	adapter->num_rx_qs = adapter->num_rss_qs + adapter->need_def_rxq;

	/* When the interface is not capable of RSS rings (and there is no
	 * need to create a default RXQ) we'll still need one RXQ
S
Sathya Perla 已提交
2798
	 */
2799 2800
	if (adapter->num_rx_qs == 0)
		adapter->num_rx_qs = 1;
2801

S
Sathya Perla 已提交
2802
	adapter->big_page_size = (1 << get_order(rx_frag_size)) * PAGE_SIZE;
2803 2804 2805 2806
	for_all_rx_queues(adapter, rxo, i) {
		rxo->adapter = adapter;
		cq = &rxo->cq;
		rc = be_queue_alloc(adapter, cq, RX_CQ_LEN,
2807
				    sizeof(struct be_eth_rx_compl));
2808
		if (rc)
S
Sathya Perla 已提交
2809
			return rc;
2810

2811
		u64_stats_init(&rxo->stats.sync);
S
Sathya Perla 已提交
2812 2813
		eq = &adapter->eq_obj[i % adapter->num_evt_qs].q;
		rc = be_cmd_cq_create(adapter, cq, eq, false, 3);
2814
		if (rc)
S
Sathya Perla 已提交
2815
			return rc;
2816
	}
S
Sathya Perla 已提交
2817

S
Sathya Perla 已提交
2818
	dev_info(&adapter->pdev->dev,
2819
		 "created %d RX queue(s)\n", adapter->num_rx_qs);
S
Sathya Perla 已提交
2820
	return 0;
2821 2822
}

S
Sathya Perla 已提交
2823 2824
static irqreturn_t be_intx(int irq, void *dev)
{
2825 2826 2827
	struct be_eq_obj *eqo = dev;
	struct be_adapter *adapter = eqo->adapter;
	int num_evts = 0;
S
Sathya Perla 已提交
2828

2829 2830 2831 2832 2833 2834 2835
	/* IRQ is not expected when NAPI is scheduled as the EQ
	 * will not be armed.
	 * But, this can happen on Lancer INTx where it takes
	 * a while to de-assert INTx or in BE2 where occasionaly
	 * an interrupt may be raised even when EQ is unarmed.
	 * If NAPI is already scheduled, then counting & notifying
	 * events will orphan them.
2836
	 */
2837
	if (napi_schedule_prep(&eqo->napi)) {
2838
		num_evts = events_get(eqo);
2839 2840 2841 2842
		__napi_schedule(&eqo->napi);
		if (num_evts)
			eqo->spurious_intr = 0;
	}
2843
	be_eq_notify(adapter, eqo->q.id, false, true, num_evts, 0);
2844

2845 2846 2847
	/* Return IRQ_HANDLED only for the the first spurious intr
	 * after a valid intr to stop the kernel from branding
	 * this irq as a bad one!
2848
	 */
2849 2850 2851 2852
	if (num_evts || eqo->spurious_intr++ == 0)
		return IRQ_HANDLED;
	else
		return IRQ_NONE;
S
Sathya Perla 已提交
2853 2854
}

S
Sathya Perla 已提交
2855
static irqreturn_t be_msix(int irq, void *dev)
S
Sathya Perla 已提交
2856
{
S
Sathya Perla 已提交
2857
	struct be_eq_obj *eqo = dev;
S
Sathya Perla 已提交
2858

2859
	be_eq_notify(eqo->adapter, eqo->q.id, false, true, 0, 0);
2860
	napi_schedule(&eqo->napi);
S
Sathya Perla 已提交
2861 2862 2863
	return IRQ_HANDLED;
}

2864
static inline bool do_gro(struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
2865
{
2866
	return (rxcp->tcpf && !rxcp->err && rxcp->l4_csum) ? true : false;
S
Sathya Perla 已提交
2867 2868
}

S
Sathya Perla 已提交
2869
static int be_process_rx(struct be_rx_obj *rxo, struct napi_struct *napi,
2870
			 int budget, int polling)
S
Sathya Perla 已提交
2871
{
2872 2873
	struct be_adapter *adapter = rxo->adapter;
	struct be_queue_info *rx_cq = &rxo->cq;
2874
	struct be_rx_compl_info *rxcp;
S
Sathya Perla 已提交
2875
	u32 work_done;
2876
	u32 frags_consumed = 0;
S
Sathya Perla 已提交
2877 2878

	for (work_done = 0; work_done < budget; work_done++) {
2879
		rxcp = be_rx_compl_get(rxo);
S
Sathya Perla 已提交
2880 2881 2882
		if (!rxcp)
			break;

2883 2884 2885 2886 2887 2888
		/* Is it a flush compl that has no data */
		if (unlikely(rxcp->num_rcvd == 0))
			goto loop_continue;

		/* Discard compl with partial DMA Lancer B0 */
		if (unlikely(!rxcp->pkt_size)) {
S
Sathya Perla 已提交
2889
			be_rx_compl_discard(rxo, rxcp);
2890 2891 2892 2893 2894 2895 2896
			goto loop_continue;
		}

		/* On BE drop pkts that arrive due to imperfect filtering in
		 * promiscuous mode on some skews
		 */
		if (unlikely(rxcp->port != adapter->port_num &&
2897
			     !lancer_chip(adapter))) {
S
Sathya Perla 已提交
2898
			be_rx_compl_discard(rxo, rxcp);
2899
			goto loop_continue;
2900
		}
2901

2902 2903
		/* Don't do gro when we're busy_polling */
		if (do_gro(rxcp) && polling != BUSY_POLLING)
S
Sathya Perla 已提交
2904
			be_rx_compl_process_gro(rxo, napi, rxcp);
2905
		else
2906 2907
			be_rx_compl_process(rxo, napi, rxcp);

2908
loop_continue:
2909
		frags_consumed += rxcp->num_rcvd;
2910
		be_rx_stats_update(rxo, rxcp);
S
Sathya Perla 已提交
2911 2912
	}

S
Sathya Perla 已提交
2913 2914
	if (work_done) {
		be_cq_notify(adapter, rx_cq->id, true, work_done);
2915

2916 2917 2918 2919 2920
		/* When an rx-obj gets into post_starved state, just
		 * let be_worker do the posting.
		 */
		if (atomic_read(&rxo->q.used) < RX_FRAGS_REFILL_WM &&
		    !rxo->rx_post_starved)
2921 2922 2923
			be_post_rx_frags(rxo, GFP_ATOMIC,
					 max_t(u32, MAX_RX_POST,
					       frags_consumed));
S
Sathya Perla 已提交
2924
	}
S
Sathya Perla 已提交
2925

S
Sathya Perla 已提交
2926 2927 2928
	return work_done;
}

2929
static inline void be_update_tx_err(struct be_tx_obj *txo, u8 status)
2930 2931 2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943
{
	switch (status) {
	case BE_TX_COMP_HDR_PARSE_ERR:
		tx_stats(txo)->tx_hdr_parse_err++;
		break;
	case BE_TX_COMP_NDMA_ERR:
		tx_stats(txo)->tx_dma_err++;
		break;
	case BE_TX_COMP_ACL_ERR:
		tx_stats(txo)->tx_spoof_check_err++;
		break;
	}
}

2944
static inline void lancer_update_tx_err(struct be_tx_obj *txo, u8 status)
2945 2946 2947 2948 2949 2950 2951 2952 2953 2954 2955 2956 2957 2958 2959 2960 2961 2962 2963 2964 2965
{
	switch (status) {
	case LANCER_TX_COMP_LSO_ERR:
		tx_stats(txo)->tx_tso_err++;
		break;
	case LANCER_TX_COMP_HSW_DROP_MAC_ERR:
	case LANCER_TX_COMP_HSW_DROP_VLAN_ERR:
		tx_stats(txo)->tx_spoof_check_err++;
		break;
	case LANCER_TX_COMP_QINQ_ERR:
		tx_stats(txo)->tx_qinq_err++;
		break;
	case LANCER_TX_COMP_PARITY_ERR:
		tx_stats(txo)->tx_internal_parity_err++;
		break;
	case LANCER_TX_COMP_DMA_ERR:
		tx_stats(txo)->tx_dma_err++;
		break;
	}
}

S
Sathya Perla 已提交
2966 2967
static void be_process_tx(struct be_adapter *adapter, struct be_tx_obj *txo,
			  int idx)
S
Sathya Perla 已提交
2968
{
S
Sathya Perla 已提交
2969
	int num_wrbs = 0, work_done = 0;
2970
	struct be_tx_compl_info *txcp;
S
Sathya Perla 已提交
2971

2972 2973
	while ((txcp = be_tx_compl_get(txo))) {
		num_wrbs += be_tx_compl_process(adapter, txo, txcp->end_index);
S
Sathya Perla 已提交
2974
		work_done++;
2975

2976
		if (txcp->status) {
2977
			if (lancer_chip(adapter))
2978
				lancer_update_tx_err(txo, txcp->status);
2979
			else
2980
				be_update_tx_err(txo, txcp->status);
2981
		}
S
Sathya Perla 已提交
2982
	}
S
Sathya Perla 已提交
2983

S
Sathya Perla 已提交
2984 2985 2986
	if (work_done) {
		be_cq_notify(adapter, txo->cq.id, true, work_done);
		atomic_sub(num_wrbs, &txo->q.used);
2987

S
Sathya Perla 已提交
2988 2989 2990
		/* As Tx wrbs have been freed up, wake up netdev queue
		 * if it was stopped due to lack of tx wrbs.  */
		if (__netif_subqueue_stopped(adapter->netdev, idx) &&
2991
		    be_can_txq_wake(txo)) {
S
Sathya Perla 已提交
2992
			netif_wake_subqueue(adapter->netdev, idx);
2993
		}
S
Sathya Perla 已提交
2994 2995 2996 2997

		u64_stats_update_begin(&tx_stats(txo)->sync_compl);
		tx_stats(txo)->tx_compl += work_done;
		u64_stats_update_end(&tx_stats(txo)->sync_compl);
S
Sathya Perla 已提交
2998
	}
S
Sathya Perla 已提交
2999
}
S
Sathya Perla 已提交
3000

3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037 3038 3039 3040 3041 3042 3043 3044 3045 3046 3047 3048 3049 3050 3051 3052 3053 3054 3055 3056 3057 3058 3059 3060 3061 3062 3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073 3074 3075 3076 3077 3078 3079 3080 3081 3082 3083 3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100
#ifdef CONFIG_NET_RX_BUSY_POLL
static inline bool be_lock_napi(struct be_eq_obj *eqo)
{
	bool status = true;

	spin_lock(&eqo->lock); /* BH is already disabled */
	if (eqo->state & BE_EQ_LOCKED) {
		WARN_ON(eqo->state & BE_EQ_NAPI);
		eqo->state |= BE_EQ_NAPI_YIELD;
		status = false;
	} else {
		eqo->state = BE_EQ_NAPI;
	}
	spin_unlock(&eqo->lock);
	return status;
}

static inline void be_unlock_napi(struct be_eq_obj *eqo)
{
	spin_lock(&eqo->lock); /* BH is already disabled */

	WARN_ON(eqo->state & (BE_EQ_POLL | BE_EQ_NAPI_YIELD));
	eqo->state = BE_EQ_IDLE;

	spin_unlock(&eqo->lock);
}

static inline bool be_lock_busy_poll(struct be_eq_obj *eqo)
{
	bool status = true;

	spin_lock_bh(&eqo->lock);
	if (eqo->state & BE_EQ_LOCKED) {
		eqo->state |= BE_EQ_POLL_YIELD;
		status = false;
	} else {
		eqo->state |= BE_EQ_POLL;
	}
	spin_unlock_bh(&eqo->lock);
	return status;
}

static inline void be_unlock_busy_poll(struct be_eq_obj *eqo)
{
	spin_lock_bh(&eqo->lock);

	WARN_ON(eqo->state & (BE_EQ_NAPI));
	eqo->state = BE_EQ_IDLE;

	spin_unlock_bh(&eqo->lock);
}

static inline void be_enable_busy_poll(struct be_eq_obj *eqo)
{
	spin_lock_init(&eqo->lock);
	eqo->state = BE_EQ_IDLE;
}

static inline void be_disable_busy_poll(struct be_eq_obj *eqo)
{
	local_bh_disable();

	/* It's enough to just acquire napi lock on the eqo to stop
	 * be_busy_poll() from processing any queueus.
	 */
	while (!be_lock_napi(eqo))
		mdelay(1);

	local_bh_enable();
}

#else /* CONFIG_NET_RX_BUSY_POLL */

static inline bool be_lock_napi(struct be_eq_obj *eqo)
{
	return true;
}

static inline void be_unlock_napi(struct be_eq_obj *eqo)
{
}

static inline bool be_lock_busy_poll(struct be_eq_obj *eqo)
{
	return false;
}

static inline void be_unlock_busy_poll(struct be_eq_obj *eqo)
{
}

static inline void be_enable_busy_poll(struct be_eq_obj *eqo)
{
}

static inline void be_disable_busy_poll(struct be_eq_obj *eqo)
{
}
#endif /* CONFIG_NET_RX_BUSY_POLL */

3101
int be_poll(struct napi_struct *napi, int budget)
S
Sathya Perla 已提交
3102 3103 3104
{
	struct be_eq_obj *eqo = container_of(napi, struct be_eq_obj, napi);
	struct be_adapter *adapter = eqo->adapter;
3105
	int max_work = 0, work, i, num_evts;
3106
	struct be_rx_obj *rxo;
3107
	struct be_tx_obj *txo;
3108
	u32 mult_enc = 0;
S
Sathya Perla 已提交
3109

3110 3111
	num_evts = events_get(eqo);

3112 3113
	for_all_tx_queues_on_eq(adapter, eqo, txo, i)
		be_process_tx(adapter, txo, i);
S
Sathya Perla 已提交
3114

3115 3116 3117 3118 3119 3120 3121 3122 3123 3124 3125 3126
	if (be_lock_napi(eqo)) {
		/* This loop will iterate twice for EQ0 in which
		 * completions of the last RXQ (default one) are also processed
		 * For other EQs the loop iterates only once
		 */
		for_all_rx_queues_on_eq(adapter, eqo, rxo, i) {
			work = be_process_rx(rxo, napi, budget, NAPI_POLLING);
			max_work = max(work, max_work);
		}
		be_unlock_napi(eqo);
	} else {
		max_work = budget;
S
Sathya Perla 已提交
3127
	}
S
Sathya Perla 已提交
3128

S
Sathya Perla 已提交
3129 3130
	if (is_mcc_eqo(eqo))
		be_process_mcc(adapter);
3131

S
Sathya Perla 已提交
3132 3133
	if (max_work < budget) {
		napi_complete(napi);
3134 3135 3136 3137 3138 3139 3140 3141 3142

		/* Skyhawk EQ_DB has a provision to set the rearm to interrupt
		 * delay via a delay multiplier encoding value
		 */
		if (skyhawk_chip(adapter))
			mult_enc = be_get_eq_delay_mult_enc(eqo);

		be_eq_notify(adapter, eqo->q.id, true, false, num_evts,
			     mult_enc);
S
Sathya Perla 已提交
3143 3144
	} else {
		/* As we'll continue in polling mode, count and clear events */
3145
		be_eq_notify(adapter, eqo->q.id, false, false, num_evts, 0);
3146
	}
S
Sathya Perla 已提交
3147
	return max_work;
S
Sathya Perla 已提交
3148 3149
}

3150 3151 3152 3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163 3164 3165 3166 3167 3168 3169 3170 3171
#ifdef CONFIG_NET_RX_BUSY_POLL
static int be_busy_poll(struct napi_struct *napi)
{
	struct be_eq_obj *eqo = container_of(napi, struct be_eq_obj, napi);
	struct be_adapter *adapter = eqo->adapter;
	struct be_rx_obj *rxo;
	int i, work = 0;

	if (!be_lock_busy_poll(eqo))
		return LL_FLUSH_BUSY;

	for_all_rx_queues_on_eq(adapter, eqo, rxo, i) {
		work = be_process_rx(rxo, napi, 4, BUSY_POLLING);
		if (work)
			break;
	}

	be_unlock_busy_poll(eqo);
	return work;
}
#endif

3172
void be_detect_error(struct be_adapter *adapter)
3173
{
3174 3175
	u32 ue_lo = 0, ue_hi = 0, ue_lo_mask = 0, ue_hi_mask = 0;
	u32 sliport_status = 0, sliport_err1 = 0, sliport_err2 = 0;
3176
	u32 i;
3177
	struct device *dev = &adapter->pdev->dev;
3178

3179
	if (be_check_error(adapter, BE_ERROR_HW))
3180 3181
		return;

3182 3183 3184
	if (lancer_chip(adapter)) {
		sliport_status = ioread32(adapter->db + SLIPORT_STATUS_OFFSET);
		if (sliport_status & SLIPORT_STATUS_ERR_MASK) {
3185
			be_set_error(adapter, BE_ERROR_UE);
3186
			sliport_err1 = ioread32(adapter->db +
3187
						SLIPORT_ERROR1_OFFSET);
3188
			sliport_err2 = ioread32(adapter->db +
3189
						SLIPORT_ERROR2_OFFSET);
3190 3191 3192 3193 3194 3195 3196 3197 3198 3199 3200 3201 3202
			/* Do not log error messages if its a FW reset */
			if (sliport_err1 == SLIPORT_ERROR_FW_RESET1 &&
			    sliport_err2 == SLIPORT_ERROR_FW_RESET2) {
				dev_info(dev, "Firmware update in progress\n");
			} else {
				dev_err(dev, "Error detected in the card\n");
				dev_err(dev, "ERR: sliport status 0x%x\n",
					sliport_status);
				dev_err(dev, "ERR: sliport error1 0x%x\n",
					sliport_err1);
				dev_err(dev, "ERR: sliport error2 0x%x\n",
					sliport_err2);
			}
3203 3204
		}
	} else {
3205 3206 3207 3208 3209 3210
		ue_lo = ioread32(adapter->pcicfg + PCICFG_UE_STATUS_LOW);
		ue_hi = ioread32(adapter->pcicfg + PCICFG_UE_STATUS_HIGH);
		ue_lo_mask = ioread32(adapter->pcicfg +
				      PCICFG_UE_STATUS_LOW_MASK);
		ue_hi_mask = ioread32(adapter->pcicfg +
				      PCICFG_UE_STATUS_HI_MASK);
3211

3212 3213
		ue_lo = (ue_lo & ~ue_lo_mask);
		ue_hi = (ue_hi & ~ue_hi_mask);
3214

3215 3216 3217 3218
		/* On certain platforms BE hardware can indicate spurious UEs.
		 * Allow HW to stop working completely in case of a real UE.
		 * Hence not setting the hw_error for UE detection.
		 */
3219

3220 3221 3222 3223 3224
		if (ue_lo || ue_hi) {
			dev_err(dev,
				"Unrecoverable Error detected in the adapter");
			dev_err(dev, "Please reboot server to recover");
			if (skyhawk_chip(adapter))
3225 3226
				be_set_error(adapter, BE_ERROR_UE);

3227 3228 3229 3230 3231 3232 3233 3234 3235 3236
			for (i = 0; ue_lo; ue_lo >>= 1, i++) {
				if (ue_lo & 1)
					dev_err(dev, "UE: %s bit set\n",
						ue_status_low_desc[i]);
			}
			for (i = 0; ue_hi; ue_hi >>= 1, i++) {
				if (ue_hi & 1)
					dev_err(dev, "UE: %s bit set\n",
						ue_status_hi_desc[i]);
			}
3237 3238 3239 3240
		}
	}
}

3241 3242
static void be_msix_disable(struct be_adapter *adapter)
{
3243
	if (msix_enabled(adapter)) {
3244
		pci_disable_msix(adapter->pdev);
3245
		adapter->num_msix_vec = 0;
3246
		adapter->num_msix_roce_vec = 0;
3247 3248 3249
	}
}

3250
static int be_msix_enable(struct be_adapter *adapter)
S
Sathya Perla 已提交
3251
{
3252
	int i, num_vec;
S
Sathya Perla 已提交
3253
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
3254

3255 3256 3257 3258 3259 3260 3261 3262 3263
	/* If RoCE is supported, program the max number of NIC vectors that
	 * may be configured via set-channels, along with vectors needed for
	 * RoCe. Else, just program the number we'll use initially.
	 */
	if (be_roce_supported(adapter))
		num_vec = min_t(int, 2 * be_max_eqs(adapter),
				2 * num_online_cpus());
	else
		num_vec = adapter->cfg_num_qs;
3264

3265
	for (i = 0; i < num_vec; i++)
S
Sathya Perla 已提交
3266 3267
		adapter->msix_entries[i].entry = i;

3268 3269 3270 3271
	num_vec = pci_enable_msix_range(adapter->pdev, adapter->msix_entries,
					MIN_MSIX_VECTORS, num_vec);
	if (num_vec < 0)
		goto fail;
3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282

	if (be_roce_supported(adapter) && num_vec > MIN_MSIX_VECTORS) {
		adapter->num_msix_roce_vec = num_vec / 2;
		dev_info(dev, "enabled %d MSI-x vector(s) for RoCE\n",
			 adapter->num_msix_roce_vec);
	}

	adapter->num_msix_vec = num_vec - adapter->num_msix_roce_vec;

	dev_info(dev, "enabled %d MSI-x vector(s) for NIC\n",
		 adapter->num_msix_vec);
3283
	return 0;
3284 3285 3286 3287 3288

fail:
	dev_warn(dev, "MSIx enable failed\n");

	/* INTx is not supported in VFs, so fail probe if enable_msix fails */
3289
	if (be_virtfn(adapter))
3290 3291
		return num_vec;
	return 0;
S
Sathya Perla 已提交
3292 3293
}

3294
static inline int be_msix_vec_get(struct be_adapter *adapter,
3295
				  struct be_eq_obj *eqo)
3296
{
S
Sathya Perla 已提交
3297
	return adapter->msix_entries[eqo->msix_idx].vector;
3298
}
S
Sathya Perla 已提交
3299

3300 3301
static int be_msix_register(struct be_adapter *adapter)
{
S
Sathya Perla 已提交
3302 3303 3304
	struct net_device *netdev = adapter->netdev;
	struct be_eq_obj *eqo;
	int status, i, vec;
S
Sathya Perla 已提交
3305

S
Sathya Perla 已提交
3306 3307 3308 3309
	for_all_evt_queues(adapter, eqo, i) {
		sprintf(eqo->desc, "%s-q%d", netdev->name, i);
		vec = be_msix_vec_get(adapter, eqo);
		status = request_irq(vec, be_msix, 0, eqo->desc, eqo);
3310 3311
		if (status)
			goto err_msix;
3312 3313

		irq_set_affinity_hint(vec, eqo->affinity_mask);
3314
	}
3315

S
Sathya Perla 已提交
3316
	return 0;
3317
err_msix:
3318 3319
	for (i--; i >= 0; i--) {
		eqo = &adapter->eq_obj[i];
S
Sathya Perla 已提交
3320
		free_irq(be_msix_vec_get(adapter, eqo), eqo);
3321
	}
S
Sathya Perla 已提交
3322
	dev_warn(&adapter->pdev->dev, "MSIX Request IRQ failed - err %d\n",
3323
		 status);
3324
	be_msix_disable(adapter);
S
Sathya Perla 已提交
3325 3326 3327 3328 3329 3330 3331 3332
	return status;
}

static int be_irq_register(struct be_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	int status;

3333
	if (msix_enabled(adapter)) {
S
Sathya Perla 已提交
3334 3335 3336
		status = be_msix_register(adapter);
		if (status == 0)
			goto done;
3337
		/* INTx is not supported for VF */
3338
		if (be_virtfn(adapter))
3339
			return status;
S
Sathya Perla 已提交
3340 3341
	}

3342
	/* INTx: only the first EQ is used */
S
Sathya Perla 已提交
3343 3344
	netdev->irq = adapter->pdev->irq;
	status = request_irq(netdev->irq, be_intx, IRQF_SHARED, netdev->name,
3345
			     &adapter->eq_obj[0]);
S
Sathya Perla 已提交
3346 3347 3348 3349 3350 3351 3352 3353 3354 3355 3356 3357 3358
	if (status) {
		dev_err(&adapter->pdev->dev,
			"INTx request IRQ failed - err %d\n", status);
		return status;
	}
done:
	adapter->isr_registered = true;
	return 0;
}

static void be_irq_unregister(struct be_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
S
Sathya Perla 已提交
3359
	struct be_eq_obj *eqo;
3360
	int i, vec;
S
Sathya Perla 已提交
3361 3362 3363 3364 3365

	if (!adapter->isr_registered)
		return;

	/* INTx */
3366
	if (!msix_enabled(adapter)) {
3367
		free_irq(netdev->irq, &adapter->eq_obj[0]);
S
Sathya Perla 已提交
3368 3369 3370 3371
		goto done;
	}

	/* MSIx */
3372 3373 3374 3375 3376
	for_all_evt_queues(adapter, eqo, i) {
		vec = be_msix_vec_get(adapter, eqo);
		irq_set_affinity_hint(vec, NULL);
		free_irq(vec, eqo);
	}
3377

S
Sathya Perla 已提交
3378 3379 3380 3381
done:
	adapter->isr_registered = false;
}

S
Sathya Perla 已提交
3382
static void be_rx_qs_destroy(struct be_adapter *adapter)
3383
{
3384
	struct rss_info *rss = &adapter->rss_info;
3385 3386 3387 3388 3389 3390 3391
	struct be_queue_info *q;
	struct be_rx_obj *rxo;
	int i;

	for_all_rx_queues(adapter, rxo, i) {
		q = &rxo->q;
		if (q->created) {
3392 3393 3394 3395 3396 3397 3398 3399 3400 3401 3402 3403 3404
			/* If RXQs are destroyed while in an "out of buffer"
			 * state, there is a possibility of an HW stall on
			 * Lancer. So, post 64 buffers to each queue to relieve
			 * the "out of buffer" condition.
			 * Make sure there's space in the RXQ before posting.
			 */
			if (lancer_chip(adapter)) {
				be_rx_cq_clean(rxo);
				if (atomic_read(&q->used) == 0)
					be_post_rx_frags(rxo, GFP_KERNEL,
							 MAX_RX_POST);
			}

3405
			be_cmd_rxq_destroy(adapter, q);
S
Sathya Perla 已提交
3406
			be_rx_cq_clean(rxo);
3407
			be_rxq_clean(rxo);
3408
		}
S
Sathya Perla 已提交
3409
		be_queue_free(adapter, q);
3410
	}
3411 3412 3413 3414 3415 3416

	if (rss->rss_flags) {
		rss->rss_flags = RSS_ENABLE_NONE;
		be_cmd_rss_config(adapter, rss->rsstable, rss->rss_flags,
				  128, rss->rss_hkey);
	}
3417 3418
}

3419 3420 3421 3422 3423 3424 3425 3426 3427 3428 3429 3430 3431 3432 3433 3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445
static void be_disable_if_filters(struct be_adapter *adapter)
{
	be_cmd_pmac_del(adapter, adapter->if_handle,
			adapter->pmac_id[0], 0);

	be_clear_uc_list(adapter);

	/* The IFACE flags are enabled in the open path and cleared
	 * in the close path. When a VF gets detached from the host and
	 * assigned to a VM the following happens:
	 *	- VF's IFACE flags get cleared in the detach path
	 *	- IFACE create is issued by the VF in the attach path
	 * Due to a bug in the BE3/Skyhawk-R FW
	 * (Lancer FW doesn't have the bug), the IFACE capability flags
	 * specified along with the IFACE create cmd issued by a VF are not
	 * honoured by FW.  As a consequence, if a *new* driver
	 * (that enables/disables IFACE flags in open/close)
	 * is loaded in the host and an *old* driver is * used by a VM/VF,
	 * the IFACE gets created *without* the needed flags.
	 * To avoid this, disable RX-filter flags only for Lancer.
	 */
	if (lancer_chip(adapter)) {
		be_cmd_rx_filter(adapter, BE_IF_ALL_FILT_FLAGS, OFF);
		adapter->if_flags &= ~BE_IF_ALL_FILT_FLAGS;
	}
}

3446 3447 3448
static int be_close(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
3449 3450
	struct be_eq_obj *eqo;
	int i;
3451

3452 3453 3454 3455 3456 3457
	/* This protection is needed as be_close() may be called even when the
	 * adapter is in cleared state (after eeh perm failure)
	 */
	if (!(adapter->flags & BE_FLAGS_SETUP_DONE))
		return 0;

3458 3459
	be_disable_if_filters(adapter);

3460 3461
	if (adapter->flags & BE_FLAGS_NAPI_ENABLED) {
		for_all_evt_queues(adapter, eqo, i) {
3462
			napi_disable(&eqo->napi);
3463 3464
			be_disable_busy_poll(eqo);
		}
3465
		adapter->flags &= ~BE_FLAGS_NAPI_ENABLED;
3466
	}
3467 3468 3469 3470 3471 3472

	be_async_mcc_disable(adapter);

	/* Wait for all pending tx completions to arrive so that
	 * all tx skbs are freed.
	 */
S
Sathya Perla 已提交
3473
	netif_tx_disable(netdev);
3474
	be_tx_compl_clean(adapter);
3475 3476

	be_rx_qs_destroy(adapter);
3477

3478
	for_all_evt_queues(adapter, eqo, i) {
S
Sathya Perla 已提交
3479 3480 3481 3482 3483
		if (msix_enabled(adapter))
			synchronize_irq(be_msix_vec_get(adapter, eqo));
		else
			synchronize_irq(netdev->irq);
		be_eq_clean(eqo);
3484 3485
	}

3486 3487
	be_irq_unregister(adapter);

3488 3489 3490
	return 0;
}

S
Sathya Perla 已提交
3491
static int be_rx_qs_create(struct be_adapter *adapter)
3492
{
3493 3494
	struct rss_info *rss = &adapter->rss_info;
	u8 rss_key[RSS_HASH_KEY_LEN];
3495
	struct be_rx_obj *rxo;
3496
	int rc, i, j;
3497 3498

	for_all_rx_queues(adapter, rxo, i) {
S
Sathya Perla 已提交
3499 3500 3501 3502 3503 3504
		rc = be_queue_alloc(adapter, &rxo->q, RX_Q_LEN,
				    sizeof(struct be_eth_rx_d));
		if (rc)
			return rc;
	}

3505 3506 3507 3508 3509 3510 3511 3512
	if (adapter->need_def_rxq || !adapter->num_rss_qs) {
		rxo = default_rxo(adapter);
		rc = be_cmd_rxq_create(adapter, &rxo->q, rxo->cq.id,
				       rx_frag_size, adapter->if_handle,
				       false, &rxo->rss_id);
		if (rc)
			return rc;
	}
S
Sathya Perla 已提交
3513 3514

	for_all_rss_queues(adapter, rxo, i) {
3515
		rc = be_cmd_rxq_create(adapter, &rxo->q, rxo->cq.id,
S
Sathya Perla 已提交
3516 3517
				       rx_frag_size, adapter->if_handle,
				       true, &rxo->rss_id);
3518 3519 3520 3521 3522
		if (rc)
			return rc;
	}

	if (be_multi_rxq(adapter)) {
3523
		for (j = 0; j < RSS_INDIR_TABLE_LEN; j += adapter->num_rss_qs) {
3524
			for_all_rss_queues(adapter, rxo, i) {
3525
				if ((j + i) >= RSS_INDIR_TABLE_LEN)
3526
					break;
3527 3528
				rss->rsstable[j + i] = rxo->rss_id;
				rss->rss_queue[j + i] = i;
3529 3530
			}
		}
3531 3532
		rss->rss_flags = RSS_ENABLE_TCP_IPV4 | RSS_ENABLE_IPV4 |
			RSS_ENABLE_TCP_IPV6 | RSS_ENABLE_IPV6;
3533 3534

		if (!BEx_chip(adapter))
3535 3536
			rss->rss_flags |= RSS_ENABLE_UDP_IPV4 |
				RSS_ENABLE_UDP_IPV6;
3537 3538 3539 3540 3541 3542 3543 3544 3545 3546

		netdev_rss_key_fill(rss_key, RSS_HASH_KEY_LEN);
		rc = be_cmd_rss_config(adapter, rss->rsstable, rss->rss_flags,
				       RSS_INDIR_TABLE_LEN, rss_key);
		if (rc) {
			rss->rss_flags = RSS_ENABLE_NONE;
			return rc;
		}

		memcpy(rss->rss_hkey, rss_key, RSS_HASH_KEY_LEN);
3547 3548
	} else {
		/* Disable RSS, if only default RX Q is created */
3549
		rss->rss_flags = RSS_ENABLE_NONE;
3550
	}
3551

3552

3553 3554 3555
	/* Post 1 less than RXQ-len to avoid head being equal to tail,
	 * which is a queue empty condition
	 */
S
Sathya Perla 已提交
3556
	for_all_rx_queues(adapter, rxo, i)
3557 3558
		be_post_rx_frags(rxo, GFP_KERNEL, RX_Q_LEN - 1);

3559 3560 3561
	return 0;
}

3562 3563 3564 3565
static int be_enable_if_filters(struct be_adapter *adapter)
{
	int status;

3566
	status = be_cmd_rx_filter(adapter, BE_IF_FILT_FLAGS_BASIC, ON);
3567 3568 3569 3570 3571 3572 3573 3574 3575 3576 3577 3578 3579 3580 3581 3582 3583 3584 3585 3586
	if (status)
		return status;

	/* For BE3 VFs, the PF programs the initial MAC address */
	if (!(BEx_chip(adapter) && be_virtfn(adapter))) {
		status = be_cmd_pmac_add(adapter, adapter->netdev->dev_addr,
					 adapter->if_handle,
					 &adapter->pmac_id[0], 0);
		if (status)
			return status;
	}

	if (adapter->vlans_added)
		be_vid_config(adapter);

	be_set_rx_mode(adapter->netdev);

	return 0;
}

S
Sathya Perla 已提交
3587 3588 3589
static int be_open(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
3590
	struct be_eq_obj *eqo;
3591
	struct be_rx_obj *rxo;
S
Sathya Perla 已提交
3592
	struct be_tx_obj *txo;
3593
	u8 link_status;
3594
	int status, i;
3595

S
Sathya Perla 已提交
3596
	status = be_rx_qs_create(adapter);
3597 3598 3599
	if (status)
		goto err;

3600 3601 3602 3603
	status = be_enable_if_filters(adapter);
	if (status)
		goto err;

3604 3605 3606
	status = be_irq_register(adapter);
	if (status)
		goto err;
3607

S
Sathya Perla 已提交
3608
	for_all_rx_queues(adapter, rxo, i)
3609
		be_cq_notify(adapter, rxo->cq.id, true, 0);
3610

S
Sathya Perla 已提交
3611 3612 3613
	for_all_tx_queues(adapter, txo, i)
		be_cq_notify(adapter, txo->cq.id, true, 0);

3614 3615
	be_async_mcc_enable(adapter);

S
Sathya Perla 已提交
3616 3617
	for_all_evt_queues(adapter, eqo, i) {
		napi_enable(&eqo->napi);
3618
		be_enable_busy_poll(eqo);
3619
		be_eq_notify(adapter, eqo->q.id, true, true, 0, 0);
S
Sathya Perla 已提交
3620
	}
3621
	adapter->flags |= BE_FLAGS_NAPI_ENABLED;
S
Sathya Perla 已提交
3622

3623
	status = be_cmd_link_status_query(adapter, NULL, &link_status, 0);
3624 3625 3626
	if (!status)
		be_link_status_update(adapter, link_status);

S
Sathya Perla 已提交
3627
	netif_tx_start_all_queues(netdev);
3628
#ifdef CONFIG_BE2NET_VXLAN
3629 3630
	if (skyhawk_chip(adapter))
		vxlan_get_rx_port(netdev);
3631 3632
#endif

3633 3634 3635 3636
	return 0;
err:
	be_close(adapter->netdev);
	return -EIO;
3637 3638
}

3639 3640
static int be_setup_wol(struct be_adapter *adapter, bool enable)
{
3641
	struct device *dev = &adapter->pdev->dev;
3642 3643
	struct be_dma_mem cmd;
	u8 mac[ETH_ALEN];
3644
	int status;
3645

3646
	eth_zero_addr(mac);
3647 3648

	cmd.size = sizeof(struct be_cmd_req_acpi_wol_magic_config);
3649
	cmd.va = dma_zalloc_coherent(dev, cmd.size, &cmd.dma, GFP_KERNEL);
K
Kalesh AP 已提交
3650
	if (!cmd.va)
3651
		return -ENOMEM;
3652 3653 3654

	if (enable) {
		status = pci_write_config_dword(adapter->pdev,
3655 3656
						PCICFG_PM_CONTROL_OFFSET,
						PCICFG_PM_CONTROL_MASK);
3657
		if (status) {
3658 3659
			dev_err(dev, "Could not enable Wake-on-lan\n");
			goto err;
3660 3661
		}
	} else {
3662
		ether_addr_copy(mac, adapter->netdev->dev_addr);
3663 3664
	}

3665 3666 3667 3668 3669
	status = be_cmd_enable_magic_wol(adapter, mac, &cmd);
	pci_enable_wake(adapter->pdev, PCI_D3hot, enable);
	pci_enable_wake(adapter->pdev, PCI_D3cold, enable);
err:
	dma_free_coherent(dev, cmd.size, cmd.va, cmd.dma);
3670 3671 3672
	return status;
}

3673 3674 3675 3676 3677 3678 3679 3680 3681 3682 3683 3684 3685
static void be_vf_eth_addr_generate(struct be_adapter *adapter, u8 *mac)
{
	u32 addr;

	addr = jhash(adapter->netdev->dev_addr, ETH_ALEN, 0);

	mac[5] = (u8)(addr & 0xFF);
	mac[4] = (u8)((addr >> 8) & 0xFF);
	mac[3] = (u8)((addr >> 16) & 0xFF);
	/* Use the OUI from the current MAC address */
	memcpy(mac, adapter->netdev->dev_addr, 3);
}

3686 3687 3688 3689 3690 3691
/*
 * Generate a seed MAC address from the PF MAC Address using jhash.
 * MAC Address for VFs are assigned incrementally starting from the seed.
 * These addresses are programmed in the ASIC by the PF and the VF driver
 * queries for the MAC address during its probe.
 */
3692
static int be_vf_eth_addr_config(struct be_adapter *adapter)
3693
{
3694
	u32 vf;
3695
	int status = 0;
3696
	u8 mac[ETH_ALEN];
3697
	struct be_vf_cfg *vf_cfg;
3698 3699 3700

	be_vf_eth_addr_generate(adapter, mac);

3701
	for_all_vfs(adapter, vf_cfg, vf) {
3702
		if (BEx_chip(adapter))
3703
			status = be_cmd_pmac_add(adapter, mac,
3704 3705
						 vf_cfg->if_handle,
						 &vf_cfg->pmac_id, vf + 1);
3706 3707 3708
		else
			status = be_cmd_set_mac(adapter, mac, vf_cfg->if_handle,
						vf + 1);
3709

3710 3711
		if (status)
			dev_err(&adapter->pdev->dev,
3712 3713
				"Mac address assignment failed for VF %d\n",
				vf);
3714
		else
3715
			memcpy(vf_cfg->mac_addr, mac, ETH_ALEN);
3716 3717 3718 3719 3720 3721

		mac[5] += 1;
	}
	return status;
}

3722 3723 3724 3725 3726 3727 3728
static int be_vfs_mac_query(struct be_adapter *adapter)
{
	int status, vf;
	u8 mac[ETH_ALEN];
	struct be_vf_cfg *vf_cfg;

	for_all_vfs(adapter, vf_cfg, vf) {
3729 3730 3731
		status = be_cmd_get_active_mac(adapter, vf_cfg->pmac_id,
					       mac, vf_cfg->if_handle,
					       false, vf+1);
3732 3733 3734 3735 3736 3737 3738
		if (status)
			return status;
		memcpy(vf_cfg->mac_addr, mac, ETH_ALEN);
	}
	return 0;
}

3739
static void be_vf_clear(struct be_adapter *adapter)
3740
{
3741
	struct be_vf_cfg *vf_cfg;
3742 3743
	u32 vf;

3744
	if (pci_vfs_assigned(adapter->pdev)) {
3745 3746
		dev_warn(&adapter->pdev->dev,
			 "VFs are assigned to VMs: not disabling VFs\n");
3747 3748 3749
		goto done;
	}

3750 3751
	pci_disable_sriov(adapter->pdev);

3752
	for_all_vfs(adapter, vf_cfg, vf) {
3753
		if (BEx_chip(adapter))
3754 3755
			be_cmd_pmac_del(adapter, vf_cfg->if_handle,
					vf_cfg->pmac_id, vf + 1);
3756 3757 3758
		else
			be_cmd_set_mac(adapter, NULL, vf_cfg->if_handle,
				       vf + 1);
3759

3760 3761
		be_cmd_if_destroy(adapter, vf_cfg->if_handle, vf + 1);
	}
3762 3763 3764
done:
	kfree(adapter->vf_cfg);
	adapter->num_vfs = 0;
3765
	adapter->flags &= ~BE_FLAGS_SRIOV_ENABLED;
3766 3767
}

3768 3769 3770 3771 3772 3773 3774 3775
static void be_clear_queues(struct be_adapter *adapter)
{
	be_mcc_queues_destroy(adapter);
	be_rx_cqs_destroy(adapter);
	be_tx_queues_destroy(adapter);
	be_evt_queues_destroy(adapter);
}

3776
static void be_cancel_worker(struct be_adapter *adapter)
3777
{
3778 3779 3780 3781
	if (adapter->flags & BE_FLAGS_WORKER_SCHEDULED) {
		cancel_delayed_work_sync(&adapter->work);
		adapter->flags &= ~BE_FLAGS_WORKER_SCHEDULED;
	}
3782 3783
}

3784 3785 3786 3787 3788 3789 3790 3791
static void be_cancel_err_detection(struct be_adapter *adapter)
{
	if (adapter->flags & BE_FLAGS_ERR_DETECTION_SCHEDULED) {
		cancel_delayed_work_sync(&adapter->be_err_detection_work);
		adapter->flags &= ~BE_FLAGS_ERR_DETECTION_SCHEDULED;
	}
}

3792
#ifdef CONFIG_BE2NET_VXLAN
3793 3794
static void be_disable_vxlan_offloads(struct be_adapter *adapter)
{
3795 3796
	struct net_device *netdev = adapter->netdev;

3797 3798 3799 3800 3801 3802 3803 3804 3805
	if (adapter->flags & BE_FLAGS_VXLAN_OFFLOADS)
		be_cmd_manage_iface(adapter, adapter->if_handle,
				    OP_CONVERT_TUNNEL_TO_NORMAL);

	if (adapter->vxlan_port)
		be_cmd_set_vxlan_port(adapter, 0);

	adapter->flags &= ~BE_FLAGS_VXLAN_OFFLOADS;
	adapter->vxlan_port = 0;
3806 3807 3808

	netdev->hw_enc_features = 0;
	netdev->hw_features &= ~(NETIF_F_GSO_UDP_TUNNEL);
3809
	netdev->features &= ~(NETIF_F_GSO_UDP_TUNNEL);
3810
}
3811
#endif
3812

3813 3814 3815 3816 3817
static u16 be_calculate_vf_qs(struct be_adapter *adapter, u16 num_vfs)
{
	struct be_resources res = adapter->pool_res;
	u16 num_vf_qs = 1;

3818
	/* Distribute the queue resources among the PF and it's VFs
3819 3820 3821
	 * Do not distribute queue resources in multi-channel configuration.
	 */
	if (num_vfs && !be_is_mc(adapter)) {
3822 3823 3824 3825 3826
		 /* Divide the qpairs evenly among the VFs and the PF, capped
		  * at VF-EQ-count. Any remainder qpairs belong to the PF.
		  */
		num_vf_qs = min(SH_VF_MAX_NIC_EQS,
				res.max_rss_qs / (num_vfs + 1));
3827 3828 3829 3830 3831 3832 3833 3834 3835 3836 3837

		/* Skyhawk-R chip supports only MAX_RSS_IFACES RSS capable
		 * interfaces per port. Provide RSS on VFs, only if number
		 * of VFs requested is less than MAX_RSS_IFACES limit.
		 */
		if (num_vfs >= MAX_RSS_IFACES)
			num_vf_qs = 1;
	}
	return num_vf_qs;
}

3838 3839
static int be_clear(struct be_adapter *adapter)
{
3840 3841 3842
	struct pci_dev *pdev = adapter->pdev;
	u16 num_vf_qs;

3843
	be_cancel_worker(adapter);
3844

3845
	if (sriov_enabled(adapter))
3846 3847
		be_vf_clear(adapter);

3848 3849 3850
	/* Re-configure FW to distribute resources evenly across max-supported
	 * number of VFs, only when VFs are not already enabled.
	 */
3851 3852
	if (skyhawk_chip(adapter) && be_physfn(adapter) &&
	    !pci_vfs_assigned(pdev)) {
3853 3854
		num_vf_qs = be_calculate_vf_qs(adapter,
					       pci_sriov_get_totalvfs(pdev));
3855
		be_cmd_set_sriov_config(adapter, adapter->pool_res,
3856 3857 3858
					pci_sriov_get_totalvfs(pdev),
					num_vf_qs);
	}
3859

3860
#ifdef CONFIG_BE2NET_VXLAN
3861
	be_disable_vxlan_offloads(adapter);
3862
#endif
3863 3864
	kfree(adapter->pmac_id);
	adapter->pmac_id = NULL;
3865

3866
	be_cmd_if_destroy(adapter, adapter->if_handle,  0);
3867

3868
	be_clear_queues(adapter);
3869

S
Sathya Perla 已提交
3870
	be_msix_disable(adapter);
3871
	adapter->flags &= ~BE_FLAGS_SETUP_DONE;
3872 3873 3874
	return 0;
}

3875
static int be_vfs_if_create(struct be_adapter *adapter)
3876
{
3877
	struct be_resources res = {0};
3878
	u32 cap_flags, en_flags, vf;
3879
	struct be_vf_cfg *vf_cfg;
3880
	int status;
3881

3882
	/* If a FW profile exists, then cap_flags are updated */
3883
	cap_flags = BE_VF_IF_EN_FLAGS;
3884

3885
	for_all_vfs(adapter, vf_cfg, vf) {
3886 3887
		if (!BE3_chip(adapter)) {
			status = be_cmd_get_profile_config(adapter, &res,
3888
							   RESOURCE_LIMITS,
3889
							   vf + 1);
3890
			if (!status) {
3891
				cap_flags = res.if_cap_flags;
3892 3893 3894 3895 3896
				/* Prevent VFs from enabling VLAN promiscuous
				 * mode
				 */
				cap_flags &= ~BE_IF_FLAGS_VLAN_PROMISCUOUS;
			}
3897
		}
3898

3899 3900
		/* PF should enable IF flags during proxy if_create call */
		en_flags = cap_flags & BE_VF_IF_EN_FLAGS;
3901 3902
		status = be_cmd_if_create(adapter, cap_flags, en_flags,
					  &vf_cfg->if_handle, vf + 1);
3903
		if (status)
3904
			return status;
3905
	}
3906 3907

	return 0;
3908 3909
}

3910
static int be_vf_setup_init(struct be_adapter *adapter)
3911
{
3912
	struct be_vf_cfg *vf_cfg;
3913 3914
	int vf;

3915 3916 3917 3918 3919
	adapter->vf_cfg = kcalloc(adapter->num_vfs, sizeof(*vf_cfg),
				  GFP_KERNEL);
	if (!adapter->vf_cfg)
		return -ENOMEM;

3920 3921 3922
	for_all_vfs(adapter, vf_cfg, vf) {
		vf_cfg->if_handle = -1;
		vf_cfg->pmac_id = -1;
3923
	}
3924
	return 0;
3925 3926
}

3927 3928
static int be_vf_setup(struct be_adapter *adapter)
{
3929
	struct device *dev = &adapter->pdev->dev;
3930
	struct be_vf_cfg *vf_cfg;
3931
	int status, old_vfs, vf;
3932
	bool spoofchk;
3933

3934
	old_vfs = pci_num_vf(adapter->pdev);
3935 3936 3937 3938

	status = be_vf_setup_init(adapter);
	if (status)
		goto err;
3939

3940 3941 3942 3943 3944 3945
	if (old_vfs) {
		for_all_vfs(adapter, vf_cfg, vf) {
			status = be_cmd_get_if_id(adapter, vf_cfg, vf);
			if (status)
				goto err;
		}
3946

3947 3948 3949 3950
		status = be_vfs_mac_query(adapter);
		if (status)
			goto err;
	} else {
3951 3952 3953 3954
		status = be_vfs_if_create(adapter);
		if (status)
			goto err;

3955 3956 3957 3958
		status = be_vf_eth_addr_config(adapter);
		if (status)
			goto err;
	}
3959

3960
	for_all_vfs(adapter, vf_cfg, vf) {
3961
		/* Allow VFs to programs MAC/VLAN filters */
3962 3963 3964
		status = be_cmd_get_fn_privileges(adapter, &vf_cfg->privileges,
						  vf + 1);
		if (!status && !(vf_cfg->privileges & BE_PRIV_FILTMGMT)) {
3965
			status = be_cmd_set_fn_privileges(adapter,
3966
							  vf_cfg->privileges |
3967 3968
							  BE_PRIV_FILTMGMT,
							  vf + 1);
3969 3970
			if (!status) {
				vf_cfg->privileges |= BE_PRIV_FILTMGMT;
3971 3972
				dev_info(dev, "VF%d has FILTMGMT privilege\n",
					 vf);
3973
			}
3974 3975
		}

3976 3977 3978
		/* Allow full available bandwidth */
		if (!old_vfs)
			be_cmd_config_qos(adapter, 0, 0, vf + 1);
3979

3980 3981 3982 3983 3984 3985
		status = be_cmd_get_hsw_config(adapter, NULL, vf + 1,
					       vf_cfg->if_handle, NULL,
					       &spoofchk);
		if (!status)
			vf_cfg->spoofchk = spoofchk;

3986
		if (!old_vfs) {
3987
			be_cmd_enable_vf(adapter, vf + 1);
3988 3989 3990 3991
			be_cmd_set_logical_link_config(adapter,
						       IFLA_VF_LINK_STATE_AUTO,
						       vf+1);
		}
3992
	}
3993 3994 3995 3996 3997 3998 3999 4000 4001

	if (!old_vfs) {
		status = pci_enable_sriov(adapter->pdev, adapter->num_vfs);
		if (status) {
			dev_err(dev, "SRIOV enable failed\n");
			adapter->num_vfs = 0;
			goto err;
		}
	}
4002 4003

	adapter->flags |= BE_FLAGS_SRIOV_ENABLED;
4004 4005
	return 0;
err:
4006 4007
	dev_err(dev, "VF setup failed\n");
	be_vf_clear(adapter);
4008 4009 4010
	return status;
}

4011 4012 4013 4014
/* Converting function_mode bits on BE3 to SH mc_type enums */

static u8 be_convert_mc_type(u32 function_mode)
{
4015
	if (function_mode & VNIC_MODE && function_mode & QNQ_MODE)
4016
		return vNIC1;
4017
	else if (function_mode & QNQ_MODE)
4018 4019 4020 4021 4022 4023 4024 4025 4026
		return FLEX10;
	else if (function_mode & VNIC_MODE)
		return vNIC2;
	else if (function_mode & UMC_ENABLED)
		return UMC;
	else
		return MC_NONE;
}

4027 4028 4029 4030
/* On BE2/BE3 FW does not suggest the supported limits */
static void BEx_get_resources(struct be_adapter *adapter,
			      struct be_resources *res)
{
4031
	bool use_sriov = adapter->num_vfs ? 1 : 0;
4032 4033 4034 4035 4036 4037

	if (be_physfn(adapter))
		res->max_uc_mac = BE_UC_PMAC_COUNT;
	else
		res->max_uc_mac = BE_VF_UC_PMAC_COUNT;

4038 4039 4040 4041 4042 4043 4044 4045 4046 4047 4048 4049 4050 4051
	adapter->mc_type = be_convert_mc_type(adapter->function_mode);

	if (be_is_mc(adapter)) {
		/* Assuming that there are 4 channels per port,
		 * when multi-channel is enabled
		 */
		if (be_is_qnq_mode(adapter))
			res->max_vlans = BE_NUM_VLANS_SUPPORTED/8;
		else
			/* In a non-qnq multichannel mode, the pvid
			 * takes up one vlan entry
			 */
			res->max_vlans = (BE_NUM_VLANS_SUPPORTED / 4) - 1;
	} else {
4052
		res->max_vlans = BE_NUM_VLANS_SUPPORTED;
4053 4054
	}

4055 4056
	res->max_mcast_mac = BE_MAX_MC;

4057 4058 4059 4060 4061
	/* 1) For BE3 1Gb ports, FW does not support multiple TXQs
	 * 2) Create multiple TX rings on a BE3-R multi-channel interface
	 *    *only* if it is RSS-capable.
	 */
	if (BE2_chip(adapter) || use_sriov ||  (adapter->port_num > 1) ||
4062 4063 4064
	    be_virtfn(adapter) ||
	    (be_is_mc(adapter) &&
	     !(adapter->function_caps & BE_FUNCTION_CAPS_RSS))) {
4065
		res->max_tx_qs = 1;
4066 4067 4068 4069 4070 4071
	} else if (adapter->function_caps & BE_FUNCTION_CAPS_SUPER_NIC) {
		struct be_resources super_nic_res = {0};

		/* On a SuperNIC profile, the driver needs to use the
		 * GET_PROFILE_CONFIG cmd to query the per-function TXQ limits
		 */
4072 4073
		be_cmd_get_profile_config(adapter, &super_nic_res,
					  RESOURCE_LIMITS, 0);
4074 4075 4076
		/* Some old versions of BE3 FW don't report max_tx_qs value */
		res->max_tx_qs = super_nic_res.max_tx_qs ? : BE3_MAX_TX_QS;
	} else {
4077
		res->max_tx_qs = BE3_MAX_TX_QS;
4078
	}
4079 4080 4081 4082 4083 4084 4085

	if ((adapter->function_caps & BE_FUNCTION_CAPS_RSS) &&
	    !use_sriov && be_physfn(adapter))
		res->max_rss_qs = (adapter->be3_native) ?
					   BE3_MAX_RSS_QS : BE2_MAX_RSS_QS;
	res->max_rx_qs = res->max_rss_qs + 1;

4086
	if (be_physfn(adapter))
4087
		res->max_evt_qs = (be_max_vfs(adapter) > 0) ?
4088 4089 4090
					BE3_SRIOV_MAX_EVT_QS : BE3_MAX_EVT_QS;
	else
		res->max_evt_qs = 1;
4091 4092

	res->if_cap_flags = BE_IF_CAP_FLAGS_WANT;
4093
	res->if_cap_flags &= ~BE_IF_FLAGS_DEFQ_RSS;
4094 4095 4096 4097
	if (!(adapter->function_caps & BE_FUNCTION_CAPS_RSS))
		res->if_cap_flags &= ~BE_IF_FLAGS_RSS;
}

4098 4099 4100
static void be_setup_init(struct be_adapter *adapter)
{
	adapter->vlan_prio_bmap = 0xff;
A
Ajit Khaparde 已提交
4101
	adapter->phy.link_speed = -1;
4102 4103
	adapter->if_handle = -1;
	adapter->be3_native = false;
4104
	adapter->if_flags = 0;
4105
	adapter->phy_state = BE_UNKNOWN_PHY_STATE;
4106 4107 4108 4109
	if (be_physfn(adapter))
		adapter->cmd_privileges = MAX_PRIVILEGES;
	else
		adapter->cmd_privileges = MIN_PRIVILEGES;
4110 4111
}

4112 4113 4114
static int be_get_sriov_config(struct be_adapter *adapter)
{
	struct be_resources res = {0};
4115
	int max_vfs, old_vfs;
4116

4117
	be_cmd_get_profile_config(adapter, &res, RESOURCE_LIMITS, 0);
4118

4119
	/* Some old versions of BE3 FW don't report max_vfs value */
4120 4121 4122 4123 4124
	if (BE3_chip(adapter) && !res.max_vfs) {
		max_vfs = pci_sriov_get_totalvfs(adapter->pdev);
		res.max_vfs = max_vfs > 0 ? min(MAX_VFS, max_vfs) : 0;
	}

4125
	adapter->pool_res = res;
4126

4127 4128 4129 4130
	/* If during previous unload of the driver, the VFs were not disabled,
	 * then we cannot rely on the PF POOL limits for the TotalVFs value.
	 * Instead use the TotalVFs value stored in the pci-dev struct.
	 */
4131 4132
	old_vfs = pci_num_vf(adapter->pdev);
	if (old_vfs) {
4133 4134 4135 4136 4137
		dev_info(&adapter->pdev->dev, "%d VFs are already enabled\n",
			 old_vfs);

		adapter->pool_res.max_vfs =
			pci_sriov_get_totalvfs(adapter->pdev);
4138 4139 4140 4141 4142 4143
		adapter->num_vfs = old_vfs;
	}

	return 0;
}

4144 4145 4146 4147 4148 4149 4150 4151 4152 4153 4154 4155 4156 4157 4158 4159 4160 4161 4162 4163 4164 4165 4166 4167 4168 4169
static void be_alloc_sriov_res(struct be_adapter *adapter)
{
	int old_vfs = pci_num_vf(adapter->pdev);
	u16 num_vf_qs;
	int status;

	be_get_sriov_config(adapter);

	if (!old_vfs)
		pci_sriov_set_totalvfs(adapter->pdev, be_max_vfs(adapter));

	/* When the HW is in SRIOV capable configuration, the PF-pool
	 * resources are given to PF during driver load, if there are no
	 * old VFs. This facility is not available in BE3 FW.
	 * Also, this is done by FW in Lancer chip.
	 */
	if (skyhawk_chip(adapter) && be_max_vfs(adapter) && !old_vfs) {
		num_vf_qs = be_calculate_vf_qs(adapter, 0);
		status = be_cmd_set_sriov_config(adapter, adapter->pool_res, 0,
						 num_vf_qs);
		if (status)
			dev_err(&adapter->pdev->dev,
				"Failed to optimize SRIOV resources\n");
	}
}

4170
static int be_get_resources(struct be_adapter *adapter)
4171
{
4172 4173 4174
	struct device *dev = &adapter->pdev->dev;
	struct be_resources res = {0};
	int status;
4175

4176 4177 4178
	if (BEx_chip(adapter)) {
		BEx_get_resources(adapter, &res);
		adapter->res = res;
4179 4180
	}

4181 4182 4183 4184 4185 4186 4187 4188
	/* For Lancer, SH etc read per-function resource limits from FW.
	 * GET_FUNC_CONFIG returns per function guaranteed limits.
	 * GET_PROFILE_CONFIG returns PCI-E related limits PF-pool limits
	 */
	if (!BEx_chip(adapter)) {
		status = be_cmd_get_func_config(adapter, &res);
		if (status)
			return status;
4189

4190 4191 4192 4193 4194
		/* If a deafault RXQ must be created, we'll use up one RSSQ*/
		if (res.max_rss_qs && res.max_rss_qs == res.max_rx_qs &&
		    !(res.if_cap_flags & BE_IF_FLAGS_DEFQ_RSS))
			res.max_rss_qs -= 1;

4195 4196 4197 4198
		/* If RoCE may be enabled stash away half the EQs for RoCE */
		if (be_roce_supported(adapter))
			res.max_evt_qs /= 2;
		adapter->res = res;
4199
	}
4200

4201 4202 4203 4204 4205 4206
	/* If FW supports RSS default queue, then skip creating non-RSS
	 * queue for non-IP traffic.
	 */
	adapter->need_def_rxq = (be_if_cap_flags(adapter) &
				 BE_IF_FLAGS_DEFQ_RSS) ? 0 : 1;

S
Sathya Perla 已提交
4207 4208 4209 4210 4211 4212 4213 4214
	dev_info(dev, "Max: txqs %d, rxqs %d, rss %d, eqs %d, vfs %d\n",
		 be_max_txqs(adapter), be_max_rxqs(adapter),
		 be_max_rss(adapter), be_max_eqs(adapter),
		 be_max_vfs(adapter));
	dev_info(dev, "Max: uc-macs %d, mc-macs %d, vlans %d\n",
		 be_max_uc(adapter), be_max_mc(adapter),
		 be_max_vlans(adapter));

4215 4216 4217
	/* Sanitize cfg_num_qs based on HW and platform limits */
	adapter->cfg_num_qs = min_t(u16, netif_get_num_default_rss_queues(),
				    be_max_qs(adapter));
4218
	return 0;
4219 4220
}

4221 4222
static int be_get_config(struct be_adapter *adapter)
{
4223
	int status, level;
4224
	u16 profile_id;
4225

4226 4227 4228 4229
	status = be_cmd_get_cntl_attributes(adapter);
	if (status)
		return status;

4230
	status = be_cmd_query_fw_cfg(adapter);
4231
	if (status)
4232
		return status;
4233

4234 4235 4236
	if (!lancer_chip(adapter) && be_physfn(adapter))
		be_cmd_get_fat_dump_len(adapter, &adapter->fat_dump_len);

4237 4238 4239 4240 4241 4242 4243 4244
	if (BEx_chip(adapter)) {
		level = be_cmd_get_fw_log_level(adapter);
		adapter->msg_enable =
			level <= FW_LOG_LEVEL_DEFAULT ? NETIF_MSG_HW : 0;
	}

	be_cmd_get_acpi_wol_cap(adapter);

4245 4246 4247
	be_cmd_query_port_name(adapter);

	if (be_physfn(adapter)) {
4248 4249 4250 4251
		status = be_cmd_get_active_profile(adapter, &profile_id);
		if (!status)
			dev_info(&adapter->pdev->dev,
				 "Using profile 0x%x\n", profile_id);
4252
	}
4253

4254 4255 4256
	status = be_get_resources(adapter);
	if (status)
		return status;
4257

4258 4259
	adapter->pmac_id = kcalloc(be_max_uc(adapter),
				   sizeof(*adapter->pmac_id), GFP_KERNEL);
4260 4261
	if (!adapter->pmac_id)
		return -ENOMEM;
4262

4263
	return 0;
4264 4265
}

4266 4267 4268 4269 4270 4271 4272 4273 4274 4275 4276 4277 4278 4279 4280 4281 4282
static int be_mac_setup(struct be_adapter *adapter)
{
	u8 mac[ETH_ALEN];
	int status;

	if (is_zero_ether_addr(adapter->netdev->dev_addr)) {
		status = be_cmd_get_perm_mac(adapter, mac);
		if (status)
			return status;

		memcpy(adapter->netdev->dev_addr, mac, ETH_ALEN);
		memcpy(adapter->netdev->perm_addr, mac, ETH_ALEN);
	}

	return 0;
}

4283 4284 4285 4286 4287 4288
static void be_schedule_worker(struct be_adapter *adapter)
{
	schedule_delayed_work(&adapter->work, msecs_to_jiffies(1000));
	adapter->flags |= BE_FLAGS_WORKER_SCHEDULED;
}

4289
static void be_schedule_err_detection(struct be_adapter *adapter, u32 delay)
4290 4291
{
	schedule_delayed_work(&adapter->be_err_detection_work,
4292
			      msecs_to_jiffies(delay));
4293 4294 4295
	adapter->flags |= BE_FLAGS_ERR_DETECTION_SCHEDULED;
}

4296
static int be_setup_queues(struct be_adapter *adapter)
4297
{
4298
	struct net_device *netdev = adapter->netdev;
S
Sathya Perla 已提交
4299
	int status;
4300

4301
	status = be_evt_queues_create(adapter);
4302 4303
	if (status)
		goto err;
4304

4305
	status = be_tx_qs_create(adapter);
4306 4307
	if (status)
		goto err;
S
Sathya Perla 已提交
4308

4309
	status = be_rx_cqs_create(adapter);
S
Sathya Perla 已提交
4310
	if (status)
4311
		goto err;
S
Sathya Perla 已提交
4312

4313
	status = be_mcc_queues_create(adapter);
S
Sathya Perla 已提交
4314 4315 4316
	if (status)
		goto err;

4317 4318 4319 4320 4321 4322 4323 4324
	status = netif_set_real_num_rx_queues(netdev, adapter->num_rx_qs);
	if (status)
		goto err;

	status = netif_set_real_num_tx_queues(netdev, adapter->num_tx_qs);
	if (status)
		goto err;

4325 4326 4327 4328 4329 4330
	return 0;
err:
	dev_err(&adapter->pdev->dev, "queue_setup failed\n");
	return status;
}

4331 4332 4333 4334 4335 4336 4337 4338 4339 4340 4341 4342 4343 4344 4345 4346 4347
static int be_if_create(struct be_adapter *adapter)
{
	u32 en_flags = BE_IF_FLAGS_RSS | BE_IF_FLAGS_DEFQ_RSS;
	u32 cap_flags = be_if_cap_flags(adapter);
	int status;

	if (adapter->cfg_num_qs == 1)
		cap_flags &= ~(BE_IF_FLAGS_DEFQ_RSS | BE_IF_FLAGS_RSS);

	en_flags &= cap_flags;
	/* will enable all the needed filter flags in be_open() */
	status = be_cmd_if_create(adapter, be_if_cap_flags(adapter), en_flags,
				  &adapter->if_handle, 0);

	return status;
}

4348 4349 4350 4351 4352 4353 4354 4355 4356 4357 4358 4359 4360 4361 4362 4363 4364
int be_update_queues(struct be_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	int status;

	if (netif_running(netdev))
		be_close(netdev);

	be_cancel_worker(adapter);

	/* If any vectors have been shared with RoCE we cannot re-program
	 * the MSIx table.
	 */
	if (!adapter->num_msix_roce_vec)
		be_msix_disable(adapter);

	be_clear_queues(adapter);
4365 4366 4367
	status = be_cmd_if_destroy(adapter, adapter->if_handle,  0);
	if (status)
		return status;
4368 4369 4370 4371 4372 4373 4374

	if (!msix_enabled(adapter)) {
		status = be_msix_enable(adapter);
		if (status)
			return status;
	}

4375 4376 4377 4378
	status = be_if_create(adapter);
	if (status)
		return status;

4379 4380 4381 4382 4383 4384 4385 4386 4387 4388 4389 4390
	status = be_setup_queues(adapter);
	if (status)
		return status;

	be_schedule_worker(adapter);

	if (netif_running(netdev))
		status = be_open(netdev);

	return status;
}

4391 4392 4393 4394 4395 4396 4397 4398 4399 4400 4401
static inline int fw_major_num(const char *fw_ver)
{
	int fw_major = 0, i;

	i = sscanf(fw_ver, "%d.", &fw_major);
	if (i != 1)
		return 0;

	return fw_major;
}

4402 4403 4404 4405 4406 4407 4408 4409 4410 4411 4412 4413 4414 4415 4416 4417 4418 4419 4420 4421 4422 4423 4424 4425
/* If any VFs are already enabled don't FLR the PF */
static bool be_reset_required(struct be_adapter *adapter)
{
	return pci_num_vf(adapter->pdev) ? false : true;
}

/* Wait for the FW to be ready and perform the required initialization */
static int be_func_init(struct be_adapter *adapter)
{
	int status;

	status = be_fw_wait_ready(adapter);
	if (status)
		return status;

	if (be_reset_required(adapter)) {
		status = be_cmd_reset_function(adapter);
		if (status)
			return status;

		/* Wait for interrupts to quiesce after an FLR */
		msleep(100);

		/* We can clear all errors when function reset succeeds */
4426
		be_clear_error(adapter, BE_CLEAR_ALL);
4427 4428 4429 4430 4431 4432 4433 4434 4435 4436 4437 4438 4439
	}

	/* Tell FW we're ready to fire cmds */
	status = be_cmd_fw_init(adapter);
	if (status)
		return status;

	/* Allow interrupts for other ULPs running on NIC function */
	be_intr_set(adapter, true);

	return 0;
}

4440 4441 4442 4443 4444
static int be_setup(struct be_adapter *adapter)
{
	struct device *dev = &adapter->pdev->dev;
	int status;

4445 4446 4447 4448
	status = be_func_init(adapter);
	if (status)
		return status;

4449 4450 4451 4452 4453
	be_setup_init(adapter);

	if (!lancer_chip(adapter))
		be_cmd_req_native_mode(adapter);

4454 4455 4456 4457 4458 4459 4460 4461
	/* invoke this cmd first to get pf_num and vf_num which are needed
	 * for issuing profile related cmds
	 */
	if (!BEx_chip(adapter)) {
		status = be_cmd_get_func_config(adapter, NULL);
		if (status)
			return status;
	}
4462

4463 4464 4465
	if (!BE2_chip(adapter) && be_physfn(adapter))
		be_alloc_sriov_res(adapter);

4466
	status = be_get_config(adapter);
S
Sathya Perla 已提交
4467
	if (status)
4468
		goto err;
S
Sathya Perla 已提交
4469

4470
	status = be_msix_enable(adapter);
S
Sathya Perla 已提交
4471
	if (status)
4472
		goto err;
S
Sathya Perla 已提交
4473

4474
	/* will enable all the needed filter flags in be_open() */
4475
	status = be_if_create(adapter);
4476
	if (status)
4477
		goto err;
S
Sathya Perla 已提交
4478

4479 4480
	/* Updating real_num_tx/rx_queues() requires rtnl_lock() */
	rtnl_lock();
4481
	status = be_setup_queues(adapter);
4482
	rtnl_unlock();
4483
	if (status)
4484 4485
		goto err;

4486 4487 4488
	be_cmd_get_fn_privileges(adapter, &adapter->cmd_privileges, 0);

	status = be_mac_setup(adapter);
S
Sathya Perla 已提交
4489 4490 4491
	if (status)
		goto err;

4492
	be_cmd_get_fw_ver(adapter);
S
Sathya Perla 已提交
4493
	dev_info(dev, "FW version is %s\n", adapter->fw_ver);
4494

4495
	if (BE2_chip(adapter) && fw_major_num(adapter->fw_ver) < 4) {
V
Vasundhara Volam 已提交
4496
		dev_err(dev, "Firmware on card is old(%s), IRQs may not work",
4497 4498 4499 4500
			adapter->fw_ver);
		dev_err(dev, "Please upgrade firmware to version >= 4.0\n");
	}

4501 4502 4503 4504 4505
	status = be_cmd_set_flow_control(adapter, adapter->tx_fc,
					 adapter->rx_fc);
	if (status)
		be_cmd_get_flow_control(adapter, &adapter->tx_fc,
					&adapter->rx_fc);
4506

4507 4508
	dev_info(&adapter->pdev->dev, "HW Flow control - TX:%d RX:%d\n",
		 adapter->tx_fc, adapter->rx_fc);
4509

4510 4511 4512 4513
	if (be_physfn(adapter))
		be_cmd_set_logical_link_config(adapter,
					       IFLA_VF_LINK_STATE_AUTO, 0);

4514 4515
	if (adapter->num_vfs)
		be_vf_setup(adapter);
4516

4517 4518
	status = be_cmd_get_phy_info(adapter);
	if (!status && be_pause_supported(adapter))
A
Ajit Khaparde 已提交
4519 4520
		adapter->phy.fc_autoneg = 1;

4521
	be_schedule_worker(adapter);
4522
	adapter->flags |= BE_FLAGS_SETUP_DONE;
4523
	return 0;
4524 4525 4526 4527
err:
	be_clear(adapter);
	return status;
}
S
Sathya Perla 已提交
4528

I
Ivan Vecera 已提交
4529 4530 4531 4532
#ifdef CONFIG_NET_POLL_CONTROLLER
static void be_netpoll(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
4533
	struct be_eq_obj *eqo;
I
Ivan Vecera 已提交
4534 4535
	int i;

4536
	for_all_evt_queues(adapter, eqo, i) {
4537
		be_eq_notify(eqo->adapter, eqo->q.id, false, true, 0, 0);
4538 4539
		napi_schedule(&eqo->napi);
	}
I
Ivan Vecera 已提交
4540 4541 4542
}
#endif

4543 4544 4545 4546 4547 4548 4549 4550
int be_load_fw(struct be_adapter *adapter, u8 *fw_file)
{
	const struct firmware *fw;
	int status;

	if (!netif_running(adapter->netdev)) {
		dev_err(&adapter->pdev->dev,
			"Firmware load not allowed (interface is down)\n");
4551
		return -ENETDOWN;
4552 4553 4554 4555 4556 4557 4558 4559 4560 4561 4562 4563 4564
	}

	status = request_firmware(&fw, fw_file, &adapter->pdev->dev);
	if (status)
		goto fw_exit;

	dev_info(&adapter->pdev->dev, "Flashing firmware file %s\n", fw_file);

	if (lancer_chip(adapter))
		status = lancer_fw_download(adapter, fw);
	else
		status = be_fw_download(adapter, fw);

S
Somnath Kotur 已提交
4565
	if (!status)
4566
		be_cmd_get_fw_ver(adapter);
S
Somnath Kotur 已提交
4567

4568 4569 4570 4571 4572
fw_exit:
	release_firmware(fw);
	return status;
}

4573 4574
static int be_ndo_bridge_setlink(struct net_device *dev, struct nlmsghdr *nlh,
				 u16 flags)
4575 4576 4577 4578 4579 4580 4581 4582 4583 4584 4585
{
	struct be_adapter *adapter = netdev_priv(dev);
	struct nlattr *attr, *br_spec;
	int rem;
	int status = 0;
	u16 mode = 0;

	if (!sriov_enabled(adapter))
		return -EOPNOTSUPP;

	br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
4586 4587
	if (!br_spec)
		return -EINVAL;
4588 4589 4590 4591 4592

	nla_for_each_nested(attr, br_spec, rem) {
		if (nla_type(attr) != IFLA_BRIDGE_MODE)
			continue;

4593 4594 4595
		if (nla_len(attr) < sizeof(mode))
			return -EINVAL;

4596
		mode = nla_get_u16(attr);
4597 4598 4599
		if (BE3_chip(adapter) && mode == BRIDGE_MODE_VEPA)
			return -EOPNOTSUPP;

4600 4601 4602 4603 4604 4605 4606
		if (mode != BRIDGE_MODE_VEPA && mode != BRIDGE_MODE_VEB)
			return -EINVAL;

		status = be_cmd_set_hsw_config(adapter, 0, 0,
					       adapter->if_handle,
					       mode == BRIDGE_MODE_VEPA ?
					       PORT_FWD_TYPE_VEPA :
4607
					       PORT_FWD_TYPE_VEB, 0);
4608 4609 4610 4611 4612 4613 4614 4615 4616 4617 4618 4619 4620 4621 4622 4623
		if (status)
			goto err;

		dev_info(&adapter->pdev->dev, "enabled switch mode: %s\n",
			 mode == BRIDGE_MODE_VEPA ? "VEPA" : "VEB");

		return status;
	}
err:
	dev_err(&adapter->pdev->dev, "Failed to set switch mode %s\n",
		mode == BRIDGE_MODE_VEPA ? "VEPA" : "VEB");

	return status;
}

static int be_ndo_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq,
4624 4625
				 struct net_device *dev, u32 filter_mask,
				 int nlflags)
4626 4627 4628 4629 4630 4631 4632
{
	struct be_adapter *adapter = netdev_priv(dev);
	int status = 0;
	u8 hsw_mode;

	/* BE and Lancer chips support VEB mode only */
	if (BEx_chip(adapter) || lancer_chip(adapter)) {
4633 4634 4635
		/* VEB is disabled in non-SR-IOV profiles on BE3/Lancer */
		if (!pci_sriov_get_totalvfs(adapter->pdev))
			return 0;
4636 4637 4638
		hsw_mode = PORT_FWD_TYPE_VEB;
	} else {
		status = be_cmd_get_hsw_config(adapter, NULL, 0,
4639 4640
					       adapter->if_handle, &hsw_mode,
					       NULL);
4641 4642
		if (status)
			return 0;
4643 4644 4645

		if (hsw_mode == PORT_FWD_TYPE_PASSTHRU)
			return 0;
4646 4647 4648 4649
	}

	return ndo_dflt_bridge_getlink(skb, pid, seq, dev,
				       hsw_mode == PORT_FWD_TYPE_VEPA ?
4650
				       BRIDGE_MODE_VEPA : BRIDGE_MODE_VEB,
4651
				       0, 0, nlflags, filter_mask, NULL);
4652 4653
}

4654
#ifdef CONFIG_BE2NET_VXLAN
4655 4656 4657 4658 4659 4660
/* VxLAN offload Notes:
 *
 * The stack defines tunnel offload flags (hw_enc_features) for IP and doesn't
 * distinguish various types of transports (VxLAN, GRE, NVGRE ..). So, offload
 * is expected to work across all types of IP tunnels once exported. Skyhawk
 * supports offloads for either VxLAN or NVGRE, exclusively. So we export VxLAN
4661 4662 4663
 * offloads in hw_enc_features only when a VxLAN port is added. If other (non
 * VxLAN) tunnels are configured while VxLAN offloads are enabled, offloads for
 * those other tunnels are unexported on the fly through ndo_features_check().
4664 4665 4666 4667 4668
 *
 * Skyhawk supports VxLAN offloads only for one UDP dport. So, if the stack
 * adds more than one port, disable offloads and don't re-enable them again
 * until after all the tunnels are removed.
 */
4669 4670 4671 4672 4673 4674 4675
static void be_add_vxlan_port(struct net_device *netdev, sa_family_t sa_family,
			      __be16 port)
{
	struct be_adapter *adapter = netdev_priv(netdev);
	struct device *dev = &adapter->pdev->dev;
	int status;

4676
	if (lancer_chip(adapter) || BEx_chip(adapter) || be_is_mc(adapter))
4677 4678
		return;

4679 4680 4681 4682 4683
	if (adapter->vxlan_port == port && adapter->vxlan_port_count) {
		adapter->vxlan_port_aliases++;
		return;
	}

4684 4685 4686
	if (adapter->flags & BE_FLAGS_VXLAN_OFFLOADS) {
		dev_info(dev,
			 "Only one UDP port supported for VxLAN offloads\n");
4687 4688 4689
		dev_info(dev, "Disabling VxLAN offloads\n");
		adapter->vxlan_port_count++;
		goto err;
4690 4691
	}

4692 4693 4694
	if (adapter->vxlan_port_count++ >= 1)
		return;

4695 4696 4697 4698 4699 4700 4701 4702 4703 4704 4705 4706 4707 4708 4709
	status = be_cmd_manage_iface(adapter, adapter->if_handle,
				     OP_CONVERT_NORMAL_TO_TUNNEL);
	if (status) {
		dev_warn(dev, "Failed to convert normal interface to tunnel\n");
		goto err;
	}

	status = be_cmd_set_vxlan_port(adapter, port);
	if (status) {
		dev_warn(dev, "Failed to add VxLAN port\n");
		goto err;
	}
	adapter->flags |= BE_FLAGS_VXLAN_OFFLOADS;
	adapter->vxlan_port = port;

4710 4711 4712 4713
	netdev->hw_enc_features |= NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
				   NETIF_F_TSO | NETIF_F_TSO6 |
				   NETIF_F_GSO_UDP_TUNNEL;
	netdev->hw_features |= NETIF_F_GSO_UDP_TUNNEL;
4714
	netdev->features |= NETIF_F_GSO_UDP_TUNNEL;
4715

4716 4717 4718 4719 4720 4721 4722 4723 4724 4725 4726 4727
	dev_info(dev, "Enabled VxLAN offloads for UDP port %d\n",
		 be16_to_cpu(port));
	return;
err:
	be_disable_vxlan_offloads(adapter);
}

static void be_del_vxlan_port(struct net_device *netdev, sa_family_t sa_family,
			      __be16 port)
{
	struct be_adapter *adapter = netdev_priv(netdev);

4728
	if (lancer_chip(adapter) || BEx_chip(adapter) || be_is_mc(adapter))
4729 4730 4731
		return;

	if (adapter->vxlan_port != port)
4732
		goto done;
4733

4734 4735 4736 4737 4738
	if (adapter->vxlan_port_aliases) {
		adapter->vxlan_port_aliases--;
		return;
	}

4739 4740 4741 4742 4743
	be_disable_vxlan_offloads(adapter);

	dev_info(&adapter->pdev->dev,
		 "Disabled VxLAN offloads for UDP port %d\n",
		 be16_to_cpu(port));
4744 4745
done:
	adapter->vxlan_port_count--;
4746
}
J
Joe Stringer 已提交
4747

4748 4749 4750
static netdev_features_t be_features_check(struct sk_buff *skb,
					   struct net_device *dev,
					   netdev_features_t features)
J
Joe Stringer 已提交
4751
{
4752 4753 4754 4755 4756 4757 4758 4759 4760 4761 4762 4763 4764 4765 4766 4767 4768 4769 4770 4771 4772 4773 4774 4775 4776 4777 4778 4779 4780 4781 4782 4783
	struct be_adapter *adapter = netdev_priv(dev);
	u8 l4_hdr = 0;

	/* The code below restricts offload features for some tunneled packets.
	 * Offload features for normal (non tunnel) packets are unchanged.
	 */
	if (!skb->encapsulation ||
	    !(adapter->flags & BE_FLAGS_VXLAN_OFFLOADS))
		return features;

	/* It's an encapsulated packet and VxLAN offloads are enabled. We
	 * should disable tunnel offload features if it's not a VxLAN packet,
	 * as tunnel offloads have been enabled only for VxLAN. This is done to
	 * allow other tunneled traffic like GRE work fine while VxLAN
	 * offloads are configured in Skyhawk-R.
	 */
	switch (vlan_get_protocol(skb)) {
	case htons(ETH_P_IP):
		l4_hdr = ip_hdr(skb)->protocol;
		break;
	case htons(ETH_P_IPV6):
		l4_hdr = ipv6_hdr(skb)->nexthdr;
		break;
	default:
		return features;
	}

	if (l4_hdr != IPPROTO_UDP ||
	    skb->inner_protocol_type != ENCAP_TYPE_ETHER ||
	    skb->inner_protocol != htons(ETH_P_TEB) ||
	    skb_inner_mac_header(skb) - skb_transport_header(skb) !=
	    sizeof(struct udphdr) + sizeof(struct vxlanhdr))
4784
		return features & ~(NETIF_F_CSUM_MASK | NETIF_F_GSO_MASK);
4785 4786

	return features;
J
Joe Stringer 已提交
4787
}
4788
#endif
4789

4790 4791 4792 4793 4794 4795 4796 4797 4798 4799 4800 4801 4802 4803 4804 4805 4806 4807 4808 4809 4810
static int be_get_phys_port_id(struct net_device *dev,
			       struct netdev_phys_item_id *ppid)
{
	int i, id_len = CNTL_SERIAL_NUM_WORDS * CNTL_SERIAL_NUM_WORD_SZ + 1;
	struct be_adapter *adapter = netdev_priv(dev);
	u8 *id;

	if (MAX_PHYS_ITEM_ID_LEN < id_len)
		return -ENOSPC;

	ppid->id[0] = adapter->hba_port_num + 1;
	id = &ppid->id[1];
	for (i = CNTL_SERIAL_NUM_WORDS - 1; i >= 0;
	     i--, id += CNTL_SERIAL_NUM_WORD_SZ)
		memcpy(id, &adapter->serial_num[i], CNTL_SERIAL_NUM_WORD_SZ);

	ppid->id_len = id_len;

	return 0;
}

4811
static const struct net_device_ops be_netdev_ops = {
S
Sathya Perla 已提交
4812 4813 4814
	.ndo_open		= be_open,
	.ndo_stop		= be_close,
	.ndo_start_xmit		= be_xmit,
4815
	.ndo_set_rx_mode	= be_set_rx_mode,
S
Sathya Perla 已提交
4816 4817
	.ndo_set_mac_address	= be_mac_addr_set,
	.ndo_change_mtu		= be_change_mtu,
4818
	.ndo_get_stats64	= be_get_stats64,
S
Sathya Perla 已提交
4819 4820 4821
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_vlan_rx_add_vid	= be_vlan_add_vid,
	.ndo_vlan_rx_kill_vid	= be_vlan_rem_vid,
4822
	.ndo_set_vf_mac		= be_set_vf_mac,
4823
	.ndo_set_vf_vlan	= be_set_vf_vlan,
4824
	.ndo_set_vf_rate	= be_set_vf_tx_rate,
I
Ivan Vecera 已提交
4825
	.ndo_get_vf_config	= be_get_vf_config,
4826
	.ndo_set_vf_link_state  = be_set_vf_link_state,
4827
	.ndo_set_vf_spoofchk    = be_set_vf_spoofchk,
I
Ivan Vecera 已提交
4828 4829 4830
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= be_netpoll,
#endif
4831 4832
	.ndo_bridge_setlink	= be_ndo_bridge_setlink,
	.ndo_bridge_getlink	= be_ndo_bridge_getlink,
4833
#ifdef CONFIG_NET_RX_BUSY_POLL
4834
	.ndo_busy_poll		= be_busy_poll,
4835
#endif
4836
#ifdef CONFIG_BE2NET_VXLAN
4837 4838
	.ndo_add_vxlan_port	= be_add_vxlan_port,
	.ndo_del_vxlan_port	= be_del_vxlan_port,
4839
	.ndo_features_check	= be_features_check,
4840
#endif
4841
	.ndo_get_phys_port_id   = be_get_phys_port_id,
S
Sathya Perla 已提交
4842 4843 4844 4845 4846 4847
};

static void be_netdev_init(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);

4848
	netdev->hw_features |= NETIF_F_SG | NETIF_F_TSO | NETIF_F_TSO6 |
4849
		NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM | NETIF_F_RXCSUM |
4850
		NETIF_F_HW_VLAN_CTAG_TX;
4851
	if ((be_if_cap_flags(adapter) & BE_IF_FLAGS_RSS))
4852
		netdev->hw_features |= NETIF_F_RXHASH;
4853 4854

	netdev->features |= netdev->hw_features |
4855
		NETIF_F_HW_VLAN_CTAG_RX | NETIF_F_HW_VLAN_CTAG_FILTER;
A
Ajit Khaparde 已提交
4856

4857
	netdev->vlan_features |= NETIF_F_SG | NETIF_F_TSO | NETIF_F_TSO6 |
4858
		NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM;
4859

4860 4861
	netdev->priv_flags |= IFF_UNICAST_FLT;

S
Sathya Perla 已提交
4862 4863
	netdev->flags |= IFF_MULTICAST;

4864
	netif_set_gso_max_size(netdev, BE_MAX_GSO_SIZE - ETH_HLEN);
4865

S
Sathya Perla 已提交
4866
	netdev->netdev_ops = &be_netdev_ops;
S
Sathya Perla 已提交
4867

4868
	netdev->ethtool_ops = &be_ethtool_ops;
S
Sathya Perla 已提交
4869 4870
}

4871 4872 4873 4874 4875 4876 4877 4878 4879 4880 4881 4882 4883
static void be_cleanup(struct be_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;

	rtnl_lock();
	netif_device_detach(netdev);
	if (netif_running(netdev))
		be_close(netdev);
	rtnl_unlock();

	be_clear(adapter);
}

4884
static int be_resume(struct be_adapter *adapter)
4885
{
4886
	struct net_device *netdev = adapter->netdev;
4887 4888 4889 4890
	int status;

	status = be_setup(adapter);
	if (status)
4891
		return status;
4892

4893 4894
	rtnl_lock();
	if (netif_running(netdev))
4895
		status = be_open(netdev);
4896 4897 4898 4899
	rtnl_unlock();

	if (status)
		return status;
4900

4901 4902
	netif_device_attach(netdev);

4903 4904 4905 4906 4907 4908 4909
	return 0;
}

static int be_err_recover(struct be_adapter *adapter)
{
	int status;

4910 4911 4912 4913 4914 4915 4916 4917 4918 4919 4920 4921 4922
	/* Error recovery is supported only Lancer as of now */
	if (!lancer_chip(adapter))
		return -EIO;

	/* Wait for adapter to reach quiescent state before
	 * destroying queues
	 */
	status = be_fw_wait_ready(adapter);
	if (status)
		goto err;

	be_cleanup(adapter);

4923 4924 4925 4926
	status = be_resume(adapter);
	if (status)
		goto err;

4927 4928 4929 4930 4931
	return 0;
err:
	return status;
}

4932
static void be_err_detection_task(struct work_struct *work)
4933 4934
{
	struct be_adapter *adapter =
4935 4936
				container_of(work, struct be_adapter,
					     be_err_detection_work.work);
4937 4938
	struct device *dev = &adapter->pdev->dev;
	int recovery_status;
4939
	int delay = ERR_DETECTION_DELAY;
4940 4941 4942

	be_detect_error(adapter);

4943 4944 4945 4946 4947 4948
	if (be_check_error(adapter, BE_ERROR_HW))
		recovery_status = be_err_recover(adapter);
	else
		goto reschedule_task;

	if (!recovery_status) {
4949
		adapter->recovery_retries = 0;
4950 4951 4952 4953 4954 4955 4956 4957
		dev_info(dev, "Adapter recovery successful\n");
		goto reschedule_task;
	} else if (be_virtfn(adapter)) {
		/* For VFs, check if PF have allocated resources
		 * every second.
		 */
		dev_err(dev, "Re-trying adapter recovery\n");
		goto reschedule_task;
4958 4959 4960 4961 4962 4963 4964 4965 4966
	} else if (adapter->recovery_retries++ <
		   MAX_ERR_RECOVERY_RETRY_COUNT) {
		/* In case of another error during recovery, it takes 30 sec
		 * for adapter to come out of error. Retry error recovery after
		 * this time interval.
		 */
		dev_err(&adapter->pdev->dev, "Re-trying adapter recovery\n");
		delay = ERR_RECOVERY_RETRY_DELAY;
		goto reschedule_task;
4967 4968
	} else {
		dev_err(dev, "Adapter recovery failed\n");
4969 4970
	}

4971 4972
	return;
reschedule_task:
4973
	be_schedule_err_detection(adapter, delay);
4974 4975 4976 4977 4978 4979 4980 4981 4982
}

static void be_log_sfp_info(struct be_adapter *adapter)
{
	int status;

	status = be_cmd_query_sfp_info(adapter);
	if (!status) {
		dev_err(&adapter->pdev->dev,
4983 4984 4985 4986
			"Port %c: %s Vendor: %s part no: %s",
			adapter->port_name,
			be_misconfig_evt_port_state[adapter->phy_state],
			adapter->phy.vendor_name,
4987 4988
			adapter->phy.vendor_pn);
	}
4989
	adapter->flags &= ~BE_FLAGS_PHY_MISCONFIGURED;
4990 4991 4992 4993 4994 4995 4996 4997 4998 4999 5000 5001 5002 5003 5004 5005 5006 5007 5008 5009 5010 5011 5012 5013 5014 5015 5016 5017 5018 5019 5020 5021 5022 5023 5024 5025 5026 5027 5028
}

static void be_worker(struct work_struct *work)
{
	struct be_adapter *adapter =
		container_of(work, struct be_adapter, work.work);
	struct be_rx_obj *rxo;
	int i;

	/* when interrupts are not yet enabled, just reap any pending
	 * mcc completions
	 */
	if (!netif_running(adapter->netdev)) {
		local_bh_disable();
		be_process_mcc(adapter);
		local_bh_enable();
		goto reschedule;
	}

	if (!adapter->stats_cmd_sent) {
		if (lancer_chip(adapter))
			lancer_cmd_get_pport_stats(adapter,
						   &adapter->stats_cmd);
		else
			be_cmd_get_stats(adapter, &adapter->stats_cmd);
	}

	if (be_physfn(adapter) &&
	    MODULO(adapter->work_counter, adapter->be_get_temp_freq) == 0)
		be_cmd_get_die_temperature(adapter);

	for_all_rx_queues(adapter, rxo, i) {
		/* Replenish RX-queues starved due to memory
		 * allocation failures.
		 */
		if (rxo->rx_post_starved)
			be_post_rx_frags(rxo, GFP_KERNEL, MAX_RX_POST);
	}

5029 5030 5031
	/* EQ-delay update for Skyhawk is done while notifying EQ */
	if (!skyhawk_chip(adapter))
		be_eqd_update(adapter, false);
5032

5033
	if (adapter->flags & BE_FLAGS_PHY_MISCONFIGURED)
5034 5035 5036 5037 5038 5039 5040
		be_log_sfp_info(adapter);

reschedule:
	adapter->work_counter++;
	schedule_delayed_work(&adapter->work, msecs_to_jiffies(1000));
}

S
Sathya Perla 已提交
5041 5042
static void be_unmap_pci_bars(struct be_adapter *adapter)
{
5043 5044
	if (adapter->csr)
		pci_iounmap(adapter->pdev, adapter->csr);
5045
	if (adapter->db)
S
Sathya Perla 已提交
5046
		pci_iounmap(adapter->pdev, adapter->db);
5047 5048
	if (adapter->pcicfg && adapter->pcicfg_mapped)
		pci_iounmap(adapter->pdev, adapter->pcicfg);
5049 5050
}

S
Sathya Perla 已提交
5051 5052
static int db_bar(struct be_adapter *adapter)
{
5053
	if (lancer_chip(adapter) || be_virtfn(adapter))
S
Sathya Perla 已提交
5054 5055 5056 5057 5058 5059
		return 0;
	else
		return 4;
}

static int be_roce_map_pci_bars(struct be_adapter *adapter)
5060
{
S
Sathya Perla 已提交
5061
	if (skyhawk_chip(adapter)) {
S
Sathya Perla 已提交
5062 5063 5064 5065 5066 5067
		adapter->roce_db.size = 4096;
		adapter->roce_db.io_addr = pci_resource_start(adapter->pdev,
							      db_bar(adapter));
		adapter->roce_db.total_size = pci_resource_len(adapter->pdev,
							       db_bar(adapter));
	}
5068
	return 0;
S
Sathya Perla 已提交
5069 5070 5071 5072
}

static int be_map_pci_bars(struct be_adapter *adapter)
{
5073
	struct pci_dev *pdev = adapter->pdev;
S
Sathya Perla 已提交
5074
	u8 __iomem *addr;
5075 5076 5077 5078 5079 5080
	u32 sli_intf;

	pci_read_config_dword(adapter->pdev, SLI_INTF_REG_OFFSET, &sli_intf);
	adapter->sli_family = (sli_intf & SLI_INTF_FAMILY_MASK) >>
				SLI_INTF_FAMILY_SHIFT;
	adapter->virtfn = (sli_intf & SLI_INTF_FT_MASK) ? 1 : 0;
5081

5082
	if (BEx_chip(adapter) && be_physfn(adapter)) {
5083
		adapter->csr = pci_iomap(pdev, 2, 0);
K
Kalesh AP 已提交
5084
		if (!adapter->csr)
5085 5086 5087
			return -ENOMEM;
	}

5088
	addr = pci_iomap(pdev, db_bar(adapter), 0);
K
Kalesh AP 已提交
5089
	if (!addr)
S
Sathya Perla 已提交
5090
		goto pci_map_err;
5091
	adapter->db = addr;
S
Sathya Perla 已提交
5092

5093 5094 5095 5096 5097 5098 5099
	if (skyhawk_chip(adapter) || BEx_chip(adapter)) {
		if (be_physfn(adapter)) {
			/* PCICFG is the 2nd BAR in BE2 */
			addr = pci_iomap(pdev, BE2_chip(adapter) ? 1 : 0, 0);
			if (!addr)
				goto pci_map_err;
			adapter->pcicfg = addr;
5100
			adapter->pcicfg_mapped = true;
5101 5102
		} else {
			adapter->pcicfg = adapter->db + SRIOV_VF_PCICFG_OFFSET;
5103
			adapter->pcicfg_mapped = false;
5104 5105 5106
		}
	}

S
Sathya Perla 已提交
5107
	be_roce_map_pci_bars(adapter);
S
Sathya Perla 已提交
5108
	return 0;
S
Sathya Perla 已提交
5109

S
Sathya Perla 已提交
5110
pci_map_err:
5111
	dev_err(&pdev->dev, "Error in mapping PCI BARs\n");
S
Sathya Perla 已提交
5112 5113 5114 5115
	be_unmap_pci_bars(adapter);
	return -ENOMEM;
}

5116
static void be_drv_cleanup(struct be_adapter *adapter)
S
Sathya Perla 已提交
5117
{
5118
	struct be_dma_mem *mem = &adapter->mbox_mem_alloced;
5119
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
5120 5121

	if (mem->va)
5122
		dma_free_coherent(dev, mem->size, mem->va, mem->dma);
5123

5124
	mem = &adapter->rx_filter;
5125
	if (mem->va)
5126 5127 5128 5129 5130
		dma_free_coherent(dev, mem->size, mem->va, mem->dma);

	mem = &adapter->stats_cmd;
	if (mem->va)
		dma_free_coherent(dev, mem->size, mem->va, mem->dma);
S
Sathya Perla 已提交
5131 5132
}

5133 5134
/* Allocate and initialize various fields in be_adapter struct */
static int be_drv_init(struct be_adapter *adapter)
S
Sathya Perla 已提交
5135
{
5136 5137
	struct be_dma_mem *mbox_mem_alloc = &adapter->mbox_mem_alloced;
	struct be_dma_mem *mbox_mem_align = &adapter->mbox_mem;
5138
	struct be_dma_mem *rx_filter = &adapter->rx_filter;
5139 5140 5141
	struct be_dma_mem *stats_cmd = &adapter->stats_cmd;
	struct device *dev = &adapter->pdev->dev;
	int status = 0;
S
Sathya Perla 已提交
5142 5143

	mbox_mem_alloc->size = sizeof(struct be_mcc_mailbox) + 16;
5144 5145 5146
	mbox_mem_alloc->va = dma_zalloc_coherent(dev, mbox_mem_alloc->size,
						 &mbox_mem_alloc->dma,
						 GFP_KERNEL);
5147 5148 5149
	if (!mbox_mem_alloc->va)
		return -ENOMEM;

S
Sathya Perla 已提交
5150 5151 5152
	mbox_mem_align->size = sizeof(struct be_mcc_mailbox);
	mbox_mem_align->va = PTR_ALIGN(mbox_mem_alloc->va, 16);
	mbox_mem_align->dma = PTR_ALIGN(mbox_mem_alloc->dma, 16);
5153

5154
	rx_filter->size = sizeof(struct be_cmd_req_rx_filter);
5155 5156
	rx_filter->va = dma_zalloc_coherent(dev, rx_filter->size,
					    &rx_filter->dma, GFP_KERNEL);
K
Kalesh AP 已提交
5157
	if (!rx_filter->va) {
5158 5159 5160
		status = -ENOMEM;
		goto free_mbox;
	}
5161

5162 5163 5164 5165 5166 5167 5168 5169 5170 5171 5172 5173 5174 5175 5176
	if (lancer_chip(adapter))
		stats_cmd->size = sizeof(struct lancer_cmd_req_pport_stats);
	else if (BE2_chip(adapter))
		stats_cmd->size = sizeof(struct be_cmd_req_get_stats_v0);
	else if (BE3_chip(adapter))
		stats_cmd->size = sizeof(struct be_cmd_req_get_stats_v1);
	else
		stats_cmd->size = sizeof(struct be_cmd_req_get_stats_v2);
	stats_cmd->va = dma_zalloc_coherent(dev, stats_cmd->size,
					    &stats_cmd->dma, GFP_KERNEL);
	if (!stats_cmd->va) {
		status = -ENOMEM;
		goto free_rx_filter;
	}

5177
	mutex_init(&adapter->mbox_lock);
5178 5179
	spin_lock_init(&adapter->mcc_lock);
	spin_lock_init(&adapter->mcc_cq_lock);
5180
	init_completion(&adapter->et_cmd_compl);
5181

5182
	pci_save_state(adapter->pdev);
S
Sathya Perla 已提交
5183

5184
	INIT_DELAYED_WORK(&adapter->work, be_worker);
5185 5186
	INIT_DELAYED_WORK(&adapter->be_err_detection_work,
			  be_err_detection_task);
S
Sathya Perla 已提交
5187

5188 5189
	adapter->rx_fc = true;
	adapter->tx_fc = true;
S
Sathya Perla 已提交
5190

5191 5192
	/* Must be a power of 2 or else MODULO will BUG_ON */
	adapter->be_get_temp_freq = 64;
5193

S
Sathya Perla 已提交
5194
	return 0;
5195 5196 5197 5198 5199 5200 5201

free_rx_filter:
	dma_free_coherent(dev, rx_filter->size, rx_filter->va, rx_filter->dma);
free_mbox:
	dma_free_coherent(dev, mbox_mem_alloc->size, mbox_mem_alloc->va,
			  mbox_mem_alloc->dma);
	return status;
S
Sathya Perla 已提交
5202 5203
}

B
Bill Pemberton 已提交
5204
static void be_remove(struct pci_dev *pdev)
S
Sathya Perla 已提交
5205 5206
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);
5207

S
Sathya Perla 已提交
5208 5209 5210
	if (!adapter)
		return;

5211
	be_roce_dev_remove(adapter);
5212
	be_intr_set(adapter, false);
5213

5214
	be_cancel_err_detection(adapter);
5215

S
Sathya Perla 已提交
5216 5217
	unregister_netdev(adapter->netdev);

5218 5219
	be_clear(adapter);

5220 5221 5222
	/* tell fw we're done with firing cmds */
	be_cmd_fw_clean(adapter);

5223 5224
	be_unmap_pci_bars(adapter);
	be_drv_cleanup(adapter);
S
Sathya Perla 已提交
5225

S
Sathya Perla 已提交
5226 5227
	pci_disable_pcie_error_reporting(pdev);

S
Sathya Perla 已提交
5228 5229 5230 5231 5232 5233
	pci_release_regions(pdev);
	pci_disable_device(pdev);

	free_netdev(adapter->netdev);
}

5234 5235 5236
static ssize_t be_hwmon_show_temp(struct device *dev,
				  struct device_attribute *dev_attr,
				  char *buf)
5237 5238 5239 5240 5241 5242 5243 5244 5245 5246 5247 5248 5249 5250 5251 5252 5253 5254 5255 5256 5257
{
	struct be_adapter *adapter = dev_get_drvdata(dev);

	/* Unit: millidegree Celsius */
	if (adapter->hwmon_info.be_on_die_temp == BE_INVALID_DIE_TEMP)
		return -EIO;
	else
		return sprintf(buf, "%u\n",
			       adapter->hwmon_info.be_on_die_temp * 1000);
}

static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO,
			  be_hwmon_show_temp, NULL, 1);

static struct attribute *be_hwmon_attrs[] = {
	&sensor_dev_attr_temp1_input.dev_attr.attr,
	NULL
};

ATTRIBUTE_GROUPS(be_hwmon);

S
Sathya Perla 已提交
5258 5259
static char *mc_name(struct be_adapter *adapter)
{
5260 5261 5262 5263 5264 5265 5266 5267 5268 5269 5270 5271 5272 5273 5274 5275 5276 5277 5278 5279 5280 5281 5282 5283 5284 5285
	char *str = "";	/* default */

	switch (adapter->mc_type) {
	case UMC:
		str = "UMC";
		break;
	case FLEX10:
		str = "FLEX10";
		break;
	case vNIC1:
		str = "vNIC-1";
		break;
	case nPAR:
		str = "nPAR";
		break;
	case UFP:
		str = "UFP";
		break;
	case vNIC2:
		str = "vNIC-2";
		break;
	default:
		str = "";
	}

	return str;
S
Sathya Perla 已提交
5286 5287 5288 5289 5290 5291 5292
}

static inline char *func_name(struct be_adapter *adapter)
{
	return be_physfn(adapter) ? "PF" : "VF";
}

5293 5294 5295 5296 5297 5298 5299 5300 5301 5302 5303 5304 5305 5306 5307 5308 5309 5310 5311 5312
static inline char *nic_name(struct pci_dev *pdev)
{
	switch (pdev->device) {
	case OC_DEVICE_ID1:
		return OC_NAME;
	case OC_DEVICE_ID2:
		return OC_NAME_BE;
	case OC_DEVICE_ID3:
	case OC_DEVICE_ID4:
		return OC_NAME_LANCER;
	case BE_DEVICE_ID2:
		return BE3_NAME;
	case OC_DEVICE_ID5:
	case OC_DEVICE_ID6:
		return OC_NAME_SH;
	default:
		return BE_NAME;
	}
}

5313
static int be_probe(struct pci_dev *pdev, const struct pci_device_id *pdev_id)
S
Sathya Perla 已提交
5314 5315 5316
{
	struct be_adapter *adapter;
	struct net_device *netdev;
5317
	int status = 0;
S
Sathya Perla 已提交
5318

S
Sathya Perla 已提交
5319 5320
	dev_info(&pdev->dev, "%s version is %s\n", DRV_NAME, DRV_VER);

S
Sathya Perla 已提交
5321 5322 5323 5324 5325 5326 5327 5328 5329
	status = pci_enable_device(pdev);
	if (status)
		goto do_none;

	status = pci_request_regions(pdev, DRV_NAME);
	if (status)
		goto disable_dev;
	pci_set_master(pdev);

5330
	netdev = alloc_etherdev_mqs(sizeof(*adapter), MAX_TX_QS, MAX_RX_QS);
K
Kalesh AP 已提交
5331
	if (!netdev) {
S
Sathya Perla 已提交
5332 5333 5334 5335 5336 5337 5338
		status = -ENOMEM;
		goto rel_reg;
	}
	adapter = netdev_priv(netdev);
	adapter->pdev = pdev;
	pci_set_drvdata(pdev, adapter);
	adapter->netdev = netdev;
5339
	SET_NETDEV_DEV(netdev, &pdev->dev);
S
Sathya Perla 已提交
5340

5341
	status = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
S
Sathya Perla 已提交
5342 5343 5344
	if (!status) {
		netdev->features |= NETIF_F_HIGHDMA;
	} else {
5345
		status = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
S
Sathya Perla 已提交
5346 5347 5348 5349 5350 5351
		if (status) {
			dev_err(&pdev->dev, "Could not set PCI DMA Mask\n");
			goto free_netdev;
		}
	}

5352 5353 5354
	status = pci_enable_pcie_error_reporting(pdev);
	if (!status)
		dev_info(&pdev->dev, "PCIe error reporting enabled\n");
S
Sathya Perla 已提交
5355

5356
	status = be_map_pci_bars(adapter);
S
Sathya Perla 已提交
5357
	if (status)
5358
		goto free_netdev;
S
Sathya Perla 已提交
5359

5360 5361 5362 5363
	status = be_drv_init(adapter);
	if (status)
		goto unmap_bars;

5364 5365
	status = be_setup(adapter);
	if (status)
5366
		goto drv_cleanup;
5367

5368
	be_netdev_init(netdev);
S
Sathya Perla 已提交
5369 5370
	status = register_netdev(netdev);
	if (status != 0)
5371
		goto unsetup;
S
Sathya Perla 已提交
5372

5373 5374
	be_roce_dev_add(adapter);

5375
	be_schedule_err_detection(adapter, ERR_DETECTION_DELAY);
5376

5377
	/* On Die temperature not supported for VF. */
5378
	if (be_physfn(adapter) && IS_ENABLED(CONFIG_BE2NET_HWMON)) {
5379 5380 5381 5382 5383 5384 5385 5386
		adapter->hwmon_info.hwmon_dev =
			devm_hwmon_device_register_with_groups(&pdev->dev,
							       DRV_NAME,
							       adapter,
							       be_hwmon_groups);
		adapter->hwmon_info.be_on_die_temp = BE_INVALID_DIE_TEMP;
	}

S
Sathya Perla 已提交
5387
	dev_info(&pdev->dev, "%s: %s %s port %c\n", nic_name(pdev),
5388
		 func_name(adapter), mc_name(adapter), adapter->port_name);
5389

S
Sathya Perla 已提交
5390 5391
	return 0;

5392 5393
unsetup:
	be_clear(adapter);
5394 5395 5396 5397
drv_cleanup:
	be_drv_cleanup(adapter);
unmap_bars:
	be_unmap_pci_bars(adapter);
5398
free_netdev:
5399
	free_netdev(netdev);
S
Sathya Perla 已提交
5400 5401 5402 5403 5404
rel_reg:
	pci_release_regions(pdev);
disable_dev:
	pci_disable_device(pdev);
do_none:
5405
	dev_err(&pdev->dev, "%s initialization failed\n", nic_name(pdev));
S
Sathya Perla 已提交
5406 5407 5408 5409 5410 5411 5412
	return status;
}

static int be_suspend(struct pci_dev *pdev, pm_message_t state)
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);

S
Suresh Reddy 已提交
5413
	if (adapter->wol_en)
5414 5415
		be_setup_wol(adapter, true);

5416
	be_intr_set(adapter, false);
5417
	be_cancel_err_detection(adapter);
5418

5419
	be_cleanup(adapter);
S
Sathya Perla 已提交
5420 5421 5422 5423 5424 5425 5426

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

5427
static int be_pci_resume(struct pci_dev *pdev)
S
Sathya Perla 已提交
5428 5429
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);
5430
	int status = 0;
S
Sathya Perla 已提交
5431 5432 5433 5434 5435 5436 5437

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

	pci_restore_state(pdev);

5438
	status = be_resume(adapter);
5439 5440 5441
	if (status)
		return status;

5442
	be_schedule_err_detection(adapter, ERR_DETECTION_DELAY);
5443

S
Suresh Reddy 已提交
5444
	if (adapter->wol_en)
5445
		be_setup_wol(adapter, false);
5446

S
Sathya Perla 已提交
5447 5448 5449
	return 0;
}

5450 5451 5452 5453 5454 5455 5456
/*
 * An FLR will stop BE from DMAing any data.
 */
static void be_shutdown(struct pci_dev *pdev)
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);

5457 5458
	if (!adapter)
		return;
5459

5460
	be_roce_dev_shutdown(adapter);
5461
	cancel_delayed_work_sync(&adapter->work);
5462
	be_cancel_err_detection(adapter);
5463

5464
	netif_device_detach(adapter->netdev);
5465

5466 5467
	be_cmd_reset_function(adapter);

5468 5469 5470
	pci_disable_device(pdev);
}

5471
static pci_ers_result_t be_eeh_err_detected(struct pci_dev *pdev,
5472
					    pci_channel_state_t state)
5473 5474 5475 5476 5477
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);

	dev_err(&adapter->pdev->dev, "EEH error detected\n");

5478 5479
	be_roce_dev_remove(adapter);

5480 5481
	if (!be_check_error(adapter, BE_ERROR_EEH)) {
		be_set_error(adapter, BE_ERROR_EEH);
5482

5483
		be_cancel_err_detection(adapter);
5484

5485
		be_cleanup(adapter);
5486 5487 5488 5489 5490 5491 5492
	}

	if (state == pci_channel_io_perm_failure)
		return PCI_ERS_RESULT_DISCONNECT;

	pci_disable_device(pdev);

5493 5494
	/* The error could cause the FW to trigger a flash debug dump.
	 * Resetting the card while flash dump is in progress
5495 5496 5497
	 * can cause it not to recover; wait for it to finish.
	 * Wait only for first function as it is needed only once per
	 * adapter.
5498
	 */
5499 5500 5501
	if (pdev->devfn == 0)
		ssleep(30);

5502 5503 5504 5505 5506 5507 5508 5509 5510 5511 5512 5513 5514 5515 5516 5517 5518 5519
	return PCI_ERS_RESULT_NEED_RESET;
}

static pci_ers_result_t be_eeh_reset(struct pci_dev *pdev)
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);
	int status;

	dev_info(&adapter->pdev->dev, "EEH reset\n");

	status = pci_enable_device(pdev);
	if (status)
		return PCI_ERS_RESULT_DISCONNECT;

	pci_set_master(pdev);
	pci_restore_state(pdev);

	/* Check if card is ok and fw is ready */
5520 5521
	dev_info(&adapter->pdev->dev,
		 "Waiting for FW to be ready after EEH reset\n");
5522
	status = be_fw_wait_ready(adapter);
5523 5524 5525
	if (status)
		return PCI_ERS_RESULT_DISCONNECT;

S
Sathya Perla 已提交
5526
	pci_cleanup_aer_uncorrect_error_status(pdev);
5527
	be_clear_error(adapter, BE_CLEAR_ALL);
5528 5529 5530 5531 5532 5533 5534 5535 5536 5537 5538 5539
	return PCI_ERS_RESULT_RECOVERED;
}

static void be_eeh_resume(struct pci_dev *pdev)
{
	int status = 0;
	struct be_adapter *adapter = pci_get_drvdata(pdev);

	dev_info(&adapter->pdev->dev, "EEH resume\n");

	pci_save_state(pdev);

5540
	status = be_resume(adapter);
5541 5542 5543
	if (status)
		goto err;

5544 5545
	be_roce_dev_add(adapter);

5546
	be_schedule_err_detection(adapter, ERR_DETECTION_DELAY);
5547 5548 5549 5550 5551
	return;
err:
	dev_err(&adapter->pdev->dev, "EEH resume failed\n");
}

5552 5553 5554 5555 5556 5557 5558 5559 5560 5561 5562 5563 5564 5565 5566 5567 5568 5569 5570 5571 5572 5573 5574 5575 5576 5577 5578 5579 5580 5581 5582 5583 5584 5585 5586 5587 5588 5589 5590 5591 5592 5593 5594 5595 5596 5597 5598 5599 5600 5601 5602 5603 5604 5605
static int be_pci_sriov_configure(struct pci_dev *pdev, int num_vfs)
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);
	u16 num_vf_qs;
	int status;

	if (!num_vfs)
		be_vf_clear(adapter);

	adapter->num_vfs = num_vfs;

	if (adapter->num_vfs == 0 && pci_vfs_assigned(pdev)) {
		dev_warn(&pdev->dev,
			 "Cannot disable VFs while they are assigned\n");
		return -EBUSY;
	}

	/* When the HW is in SRIOV capable configuration, the PF-pool resources
	 * are equally distributed across the max-number of VFs. The user may
	 * request only a subset of the max-vfs to be enabled.
	 * Based on num_vfs, redistribute the resources across num_vfs so that
	 * each VF will have access to more number of resources.
	 * This facility is not available in BE3 FW.
	 * Also, this is done by FW in Lancer chip.
	 */
	if (skyhawk_chip(adapter) && !pci_num_vf(pdev)) {
		num_vf_qs = be_calculate_vf_qs(adapter, adapter->num_vfs);
		status = be_cmd_set_sriov_config(adapter, adapter->pool_res,
						 adapter->num_vfs, num_vf_qs);
		if (status)
			dev_err(&pdev->dev,
				"Failed to optimize SR-IOV resources\n");
	}

	status = be_get_resources(adapter);
	if (status)
		return be_cmd_status(status);

	/* Updating real_num_tx/rx_queues() requires rtnl_lock() */
	rtnl_lock();
	status = be_update_queues(adapter);
	rtnl_unlock();
	if (status)
		return be_cmd_status(status);

	if (adapter->num_vfs)
		status = be_vf_setup(adapter);

	if (!status)
		return adapter->num_vfs;

	return 0;
}

5606
static const struct pci_error_handlers be_eeh_handlers = {
5607 5608 5609 5610 5611
	.error_detected = be_eeh_err_detected,
	.slot_reset = be_eeh_reset,
	.resume = be_eeh_resume,
};

S
Sathya Perla 已提交
5612 5613 5614 5615 5616 5617
static struct pci_driver be_driver = {
	.name = DRV_NAME,
	.id_table = be_dev_ids,
	.probe = be_probe,
	.remove = be_remove,
	.suspend = be_suspend,
5618
	.resume = be_pci_resume,
5619
	.shutdown = be_shutdown,
5620
	.sriov_configure = be_pci_sriov_configure,
5621
	.err_handler = &be_eeh_handlers
S
Sathya Perla 已提交
5622 5623 5624 5625
};

static int __init be_init_module(void)
{
5626 5627
	if (rx_frag_size != 8192 && rx_frag_size != 4096 &&
	    rx_frag_size != 2048) {
S
Sathya Perla 已提交
5628 5629 5630 5631 5632 5633
		printk(KERN_WARNING DRV_NAME
			" : Module param rx_frag_size must be 2048/4096/8192."
			" Using 2048\n");
		rx_frag_size = 2048;
	}

5634 5635 5636 5637 5638
	if (num_vfs > 0) {
		pr_info(DRV_NAME " : Module param num_vfs is obsolete.");
		pr_info(DRV_NAME " : Use sysfs method to enable VFs\n");
	}

S
Sathya Perla 已提交
5639 5640 5641 5642 5643 5644 5645 5646 5647
	return pci_register_driver(&be_driver);
}
module_init(be_init_module);

static void __exit be_exit_module(void)
{
	pci_unregister_driver(&be_driver);
}
module_exit(be_exit_module);