be_main.c 149.9 KB
Newer Older
S
Sathya Perla 已提交
1
/*
2
 * Copyright (C) 2005 - 2016 Broadcom
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 1424
	/* No need to change the VLAN state if the I/F is in promiscuous */
	if (adapter->netdev->flags & IFF_PROMISC)
1425 1426
		return 0;

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

1430 1431 1432 1433 1434
	if (adapter->if_flags & BE_IF_FLAGS_VLAN_PROMISCUOUS) {
		status = be_clear_vlan_promisc(adapter);
		if (status)
			return status;
	}
1435
	/* Construct VLAN Table to give to HW */
1436 1437
	for_each_set_bit(i, adapter->vids, VLAN_N_VID)
		vids[num++] = cpu_to_le16(i);
1438

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

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

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

1460
	if (test_bit(vid, adapter->vids))
1461
		return status;
1462

1463
	set_bit(vid, adapter->vids);
1464
	adapter->vlans_added++;
1465

1466
	return be_vid_config(adapter);
S
Sathya Perla 已提交
1467 1468
}

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

1473 1474
	/* Packets with VID 0 are always received by Lancer by default */
	if (lancer_chip(adapter) && vid == 0)
1475
		return 0;
1476

1477 1478 1479
	if (!test_bit(vid, adapter->vids))
		return 0;

1480
	clear_bit(vid, adapter->vids);
1481 1482 1483
	adapter->vlans_added--;

	return be_vid_config(adapter);
S
Sathya Perla 已提交
1484 1485
}

1486 1487 1488 1489 1490 1491 1492
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 已提交
1493
{
1494
	int status;
S
Sathya Perla 已提交
1495

1496 1497
	if (adapter->if_flags & BE_IF_FLAGS_MCAST_PROMISCUOUS)
		return;
S
Sathya Perla 已提交
1498

1499 1500 1501 1502 1503
	status = be_cmd_rx_filter(adapter, BE_IF_FLAGS_MCAST_PROMISCUOUS, ON);
	if (!status)
		adapter->if_flags |= BE_IF_FLAGS_MCAST_PROMISCUOUS;
}

1504
static void be_set_uc_promisc(struct be_adapter *adapter)
1505 1506 1507
{
	int status;

1508 1509 1510 1511
	if (adapter->if_flags & BE_IF_FLAGS_PROMISCUOUS)
		return;

	status = be_cmd_rx_filter(adapter, BE_IF_FLAGS_PROMISCUOUS, ON);
1512
	if (!status)
1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575
		adapter->if_flags |= BE_IF_FLAGS_PROMISCUOUS;
}

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

	if (!(adapter->if_flags & BE_IF_FLAGS_PROMISCUOUS))
		return;

	status = be_cmd_rx_filter(adapter, BE_IF_FLAGS_PROMISCUOUS, OFF);
	if (!status)
		adapter->if_flags &= ~BE_IF_FLAGS_PROMISCUOUS;
}

/* The below 2 functions are the callback args for __dev_mc_sync/dev_uc_sync().
 * We use a single callback function for both sync and unsync. We really don't
 * add/remove addresses through this callback. But, we use it to detect changes
 * to the uc/mc lists. The entire uc/mc list is programmed in be_set_rx_mode().
 */
static int be_uc_list_update(struct net_device *netdev,
			     const unsigned char *addr)
{
	struct be_adapter *adapter = netdev_priv(netdev);

	adapter->update_uc_list = true;
	return 0;
}

static int be_mc_list_update(struct net_device *netdev,
			     const unsigned char *addr)
{
	struct be_adapter *adapter = netdev_priv(netdev);

	adapter->update_mc_list = true;
	return 0;
}

static void be_set_mc_list(struct be_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	bool mc_promisc = false;
	int status;

	__dev_mc_sync(netdev, be_mc_list_update, be_mc_list_update);

	if (netdev->flags & IFF_PROMISC) {
		adapter->update_mc_list = false;
	} else if (netdev->flags & IFF_ALLMULTI ||
		   netdev_mc_count(netdev) > be_max_mc(adapter)) {
		/* Enable multicast promisc if num configured exceeds
		 * what we support
		 */
		mc_promisc = true;
		adapter->update_mc_list = false;
	} else if (adapter->if_flags & BE_IF_FLAGS_MCAST_PROMISCUOUS) {
		/* Update mc-list unconditionally if the iface was previously
		 * in mc-promisc mode and now is out of that mode.
		 */
		adapter->update_mc_list = true;
	}

	if (mc_promisc) {
1576
		be_set_mc_promisc(adapter);
1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593
	} else if (adapter->update_mc_list) {
		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);

		adapter->update_mc_list = false;
	}
}

static void be_clear_mc_list(struct be_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;

	__dev_mc_unsync(netdev, NULL);
	be_cmd_rx_filter(adapter, BE_IF_FLAGS_MULTICAST, OFF);
1594 1595 1596 1597
}

static void be_set_uc_list(struct be_adapter *adapter)
{
1598
	struct net_device *netdev = adapter->netdev;
1599
	struct netdev_hw_addr *ha;
1600
	bool uc_promisc = false;
1601 1602
	int i = 1; /* First slot is claimed by the Primary MAC */

1603
	__dev_uc_sync(netdev, be_uc_list_update, be_uc_list_update);
1604

1605 1606 1607 1608 1609 1610 1611 1612 1613 1614
	if (netdev->flags & IFF_PROMISC) {
		adapter->update_uc_list = false;
	} else if (netdev_uc_count(netdev) > (be_max_uc(adapter) - 1)) {
		uc_promisc = true;
		adapter->update_uc_list = false;
	}  else if (adapter->if_flags & BE_IF_FLAGS_PROMISCUOUS) {
		/* Update uc-list unconditionally if the iface was previously
		 * in uc-promisc mode and now is out of that mode.
		 */
		adapter->update_uc_list = true;
S
Sathya Perla 已提交
1615 1616
	}

1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632
	if (uc_promisc) {
		be_set_uc_promisc(adapter);
	} else if (adapter->update_uc_list) {
		be_clear_uc_promisc(adapter);

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

		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);
		}
		adapter->update_uc_list = false;
1633 1634
	}
}
S
Sathya Perla 已提交
1635

1636 1637
static void be_clear_uc_list(struct be_adapter *adapter)
{
1638
	struct net_device *netdev = adapter->netdev;
1639
	int i;
1640

1641
	__dev_uc_unsync(netdev, NULL);
1642 1643 1644 1645 1646
	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;
}
1647

1648 1649 1650
static void be_set_rx_mode(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
1651

1652
	if (netdev->flags & IFF_PROMISC) {
1653 1654 1655 1656 1657 1658 1659 1660
		if (!be_in_all_promisc(adapter))
			be_set_all_promisc(adapter);
	} else if (be_in_all_promisc(adapter)) {
		/* We need to re-program the vlan-list or clear
		 * vlan-promisc mode (if needed) when the interface
		 * comes out of promisc mode.
		 */
		be_vid_config(adapter);
1661
	}
1662

1663
	be_set_uc_list(adapter);
1664
	be_set_mc_list(adapter);
S
Sathya Perla 已提交
1665 1666
}

1667 1668 1669
static int be_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
{
	struct be_adapter *adapter = netdev_priv(netdev);
1670
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
1671 1672
	int status;

1673
	if (!sriov_enabled(adapter))
1674 1675
		return -EPERM;

1676
	if (!is_valid_ether_addr(mac) || vf >= adapter->num_vfs)
1677 1678
		return -EINVAL;

1679 1680 1681 1682 1683 1684
	/* Proceed further only if user provided MAC is different
	 * from active MAC
	 */
	if (ether_addr_equal(mac, vf_cfg->mac_addr))
		return 0;

1685 1686 1687
	if (BEx_chip(adapter)) {
		be_cmd_pmac_del(adapter, vf_cfg->if_handle, vf_cfg->pmac_id,
				vf + 1);
1688

1689 1690
		status = be_cmd_pmac_add(adapter, mac, vf_cfg->if_handle,
					 &vf_cfg->pmac_id, vf + 1);
1691 1692 1693
	} else {
		status = be_cmd_set_mac(adapter, mac, vf_cfg->if_handle,
					vf + 1);
1694 1695
	}

1696 1697 1698 1699 1700
	if (status) {
		dev_err(&adapter->pdev->dev, "MAC %pM set on VF %d Failed: %#x",
			mac, vf, status);
		return be_cmd_status(status);
	}
1701

1702 1703 1704
	ether_addr_copy(vf_cfg->mac_addr, mac);

	return 0;
1705 1706
}

1707
static int be_get_vf_config(struct net_device *netdev, int vf,
1708
			    struct ifla_vf_info *vi)
1709 1710
{
	struct be_adapter *adapter = netdev_priv(netdev);
1711
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
1712

1713
	if (!sriov_enabled(adapter))
1714 1715
		return -EPERM;

1716
	if (vf >= adapter->num_vfs)
1717 1718 1719
		return -EINVAL;

	vi->vf = vf;
1720 1721
	vi->max_tx_rate = vf_cfg->tx_rate;
	vi->min_tx_rate = 0;
1722 1723
	vi->vlan = vf_cfg->vlan_tag & VLAN_VID_MASK;
	vi->qos = vf_cfg->vlan_tag >> VLAN_PRIO_SHIFT;
1724
	memcpy(&vi->mac, vf_cfg->mac_addr, ETH_ALEN);
1725
	vi->linkstate = adapter->vf_cfg[vf].plink_tracking;
1726
	vi->spoofchk = adapter->vf_cfg[vf].spoofchk;
1727 1728 1729 1730

	return 0;
}

1731 1732 1733 1734 1735 1736 1737 1738
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 */
1739
	status = be_cmd_set_hsw_config(adapter, vlan, vf + 1, vf_if_id, 0, 0);
1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767
	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,
1768
				       vf_cfg->if_handle, 0, 0);
1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786
	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;
}

1787
static int be_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan, u8 qos)
1788 1789
{
	struct be_adapter *adapter = netdev_priv(netdev);
1790
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
1791
	int status;
1792

1793
	if (!sriov_enabled(adapter))
1794 1795
		return -EPERM;

1796
	if (vf >= adapter->num_vfs || vlan > 4095 || qos > 7)
1797 1798
		return -EINVAL;

1799 1800
	if (vlan || qos) {
		vlan |= qos << VLAN_PRIO_SHIFT;
1801
		status = be_set_vf_tvt(adapter, vf, vlan);
1802
	} else {
1803
		status = be_clear_vf_tvt(adapter, vf);
1804 1805
	}

1806 1807
	if (status) {
		dev_err(&adapter->pdev->dev,
1808 1809
			"VLAN %d config on VF %d failed : %#x\n", vlan, vf,
			status);
1810 1811 1812 1813 1814
		return be_cmd_status(status);
	}

	vf_cfg->vlan_tag = vlan;
	return 0;
1815 1816
}

1817 1818
static int be_set_vf_tx_rate(struct net_device *netdev, int vf,
			     int min_tx_rate, int max_tx_rate)
1819 1820
{
	struct be_adapter *adapter = netdev_priv(netdev);
1821 1822 1823 1824
	struct device *dev = &adapter->pdev->dev;
	int percent_rate, status = 0;
	u16 link_speed = 0;
	u8 link_status;
1825

1826
	if (!sriov_enabled(adapter))
1827 1828
		return -EPERM;

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

1832 1833 1834
	if (min_tx_rate)
		return -EINVAL;

1835 1836 1837 1838 1839 1840 1841 1842 1843 1844
	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");
1845
		status = -ENETDOWN;
1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862
		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;
1863
	}
1864

1865 1866
config_qos:
	status = be_cmd_config_qos(adapter, max_tx_rate, link_speed, vf + 1);
1867
	if (status)
1868 1869 1870 1871 1872 1873 1874 1875
		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);
1876
	return be_cmd_status(status);
1877
}
1878

1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891
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);
1892 1893 1894 1895 1896
	if (status) {
		dev_err(&adapter->pdev->dev,
			"Link state change on VF %d failed: %#x\n", vf, status);
		return be_cmd_status(status);
	}
1897

1898 1899 1900
	adapter->vf_cfg[vf].plink_tracking = link_state;

	return 0;
1901
}
1902

1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935
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;
}

1936 1937
static void be_aic_update(struct be_aic_obj *aic, u64 rx_pkts, u64 tx_pkts,
			  ulong now)
S
Sathya Perla 已提交
1938
{
1939 1940 1941 1942
	aic->rx_pkts_prev = rx_pkts;
	aic->tx_reqs_prev = tx_pkts;
	aic->jiffies = now;
}
1943

1944
static int be_get_new_eqd(struct be_eq_obj *eqo)
1945
{
1946 1947
	struct be_adapter *adapter = eqo->adapter;
	int eqd, start;
1948 1949 1950
	struct be_aic_obj *aic;
	struct be_rx_obj *rxo;
	struct be_tx_obj *txo;
1951
	u64 rx_pkts = 0, tx_pkts = 0;
1952 1953
	ulong now;
	u32 pps, delta;
1954
	int i;
S
Sathya Perla 已提交
1955

1956 1957 1958 1959 1960 1961 1962
	aic = &adapter->aic_obj[eqo->idx];
	if (!aic->enable) {
		if (aic->jiffies)
			aic->jiffies = 0;
		eqd = aic->et_eqd;
		return eqd;
	}
S
Sathya Perla 已提交
1963

1964
	for_all_rx_queues_on_eq(adapter, eqo, rxo, i) {
1965
		do {
1966
			start = u64_stats_fetch_begin_irq(&rxo->stats.sync);
1967
			rx_pkts += rxo->stats.rx_pkts;
1968
		} while (u64_stats_fetch_retry_irq(&rxo->stats.sync, start));
1969
	}
S
Sathya Perla 已提交
1970

1971
	for_all_tx_queues_on_eq(adapter, eqo, txo, i) {
1972
		do {
1973
			start = u64_stats_fetch_begin_irq(&txo->stats.sync);
1974
			tx_pkts += txo->stats.tx_reqs;
1975
		} while (u64_stats_fetch_retry_irq(&txo->stats.sync, start));
1976
	}
S
Sathya Perla 已提交
1977

1978 1979 1980 1981 1982 1983 1984 1985
	/* 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;
	}
1986

1987 1988 1989
	delta = jiffies_to_msecs(now - aic->jiffies);
	if (delta == 0)
		return aic->prev_eqd;
S
Sathya Perla 已提交
1990

1991 1992 1993
	pps = (((u32)(rx_pkts - aic->rx_pkts_prev) * 1000) / delta) +
		(((u32)(tx_pkts - aic->tx_reqs_prev) * 1000) / delta);
	eqd = (pps / 15000) << 2;
1994

1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016
	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;

2017
	if (jiffies_to_msecs(now - aic->jiffies) < 1)
2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046
		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) {
2047 2048 2049 2050 2051
			set_eqd[num].delay_multiplier = (eqd * 65)/100;
			set_eqd[num].eq_id = eqo->q.id;
			aic->prev_eqd = eqd;
			num++;
		}
2052
	}
2053 2054 2055

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

2058
static void be_rx_stats_update(struct be_rx_obj *rxo,
2059
			       struct be_rx_compl_info *rxcp)
2060
{
2061
	struct be_rx_stats *stats = rx_stats(rxo);
2062

2063
	u64_stats_update_begin(&stats->sync);
2064
	stats->rx_compl++;
2065
	stats->rx_bytes += rxcp->pkt_size;
2066
	stats->rx_pkts++;
2067 2068
	if (rxcp->tunneled)
		stats->rx_vxlan_offload_pkts++;
2069
	if (rxcp->pkt_type == BE_MULTICAST_PACKET)
2070
		stats->rx_mcast_pkts++;
2071
	if (rxcp->err)
2072
		stats->rx_compl_err++;
2073
	u64_stats_update_end(&stats->sync);
2074 2075
}

2076
static inline bool csum_passed(struct be_rx_compl_info *rxcp)
2077
{
2078
	/* L4 checksum is not reliable for non TCP/UDP packets.
2079 2080
	 * Also ignore ipcksm for ipv6 pkts
	 */
2081
	return (rxcp->tcpf || rxcp->udpf) && rxcp->l4_csum &&
2082
		(rxcp->ip_csum || rxcp->ipv6) && !rxcp->err;
2083 2084
}

2085
static struct be_rx_page_info *get_rx_page_info(struct be_rx_obj *rxo)
S
Sathya Perla 已提交
2086
{
S
Sathya Perla 已提交
2087
	struct be_adapter *adapter = rxo->adapter;
S
Sathya Perla 已提交
2088
	struct be_rx_page_info *rx_page_info;
2089
	struct be_queue_info *rxq = &rxo->q;
2090
	u32 frag_idx = rxq->tail;
S
Sathya Perla 已提交
2091

2092
	rx_page_info = &rxo->page_info_tbl[frag_idx];
S
Sathya Perla 已提交
2093 2094
	BUG_ON(!rx_page_info->page);

2095
	if (rx_page_info->last_frag) {
I
Ivan Vecera 已提交
2096 2097 2098
		dma_unmap_page(&adapter->pdev->dev,
			       dma_unmap_addr(rx_page_info, bus),
			       adapter->big_page_size, DMA_FROM_DEVICE);
2099 2100 2101 2102 2103
		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 已提交
2104
	}
S
Sathya Perla 已提交
2105

2106
	queue_tail_inc(rxq);
S
Sathya Perla 已提交
2107 2108 2109 2110 2111
	atomic_dec(&rxq->used);
	return rx_page_info;
}

/* Throwaway the data in the Rx completion */
S
Sathya Perla 已提交
2112 2113
static void be_rx_compl_discard(struct be_rx_obj *rxo,
				struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
2114 2115
{
	struct be_rx_page_info *page_info;
2116
	u16 i, num_rcvd = rxcp->num_rcvd;
S
Sathya Perla 已提交
2117

2118
	for (i = 0; i < num_rcvd; i++) {
2119
		page_info = get_rx_page_info(rxo);
2120 2121
		put_page(page_info->page);
		memset(page_info, 0, sizeof(*page_info));
S
Sathya Perla 已提交
2122 2123 2124 2125 2126 2127 2128
	}
}

/*
 * skb_fill_rx_data forms a complete skb for an ether frame
 * indicated by rxcp.
 */
S
Sathya Perla 已提交
2129 2130
static void skb_fill_rx_data(struct be_rx_obj *rxo, struct sk_buff *skb,
			     struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
2131 2132
{
	struct be_rx_page_info *page_info;
2133 2134
	u16 i, j;
	u16 hdr_len, curr_frag_len, remaining;
S
Sathya Perla 已提交
2135 2136
	u8 *start;

2137
	page_info = get_rx_page_info(rxo);
S
Sathya Perla 已提交
2138 2139 2140 2141
	start = page_address(page_info->page) + page_info->page_offset;
	prefetch(start);

	/* Copy data in the first descriptor of this completion */
2142
	curr_frag_len = min(rxcp->pkt_size, rx_frag_size);
S
Sathya Perla 已提交
2143 2144 2145

	skb->len = curr_frag_len;
	if (curr_frag_len <= BE_HDR_LEN) { /* tiny packet */
2146
		memcpy(skb->data, start, curr_frag_len);
S
Sathya Perla 已提交
2147 2148 2149 2150 2151
		/* Complete packet has now been moved to data */
		put_page(page_info->page);
		skb->data_len = 0;
		skb->tail += curr_frag_len;
	} else {
2152 2153
		hdr_len = ETH_HLEN;
		memcpy(skb->data, start, hdr_len);
S
Sathya Perla 已提交
2154
		skb_shinfo(skb)->nr_frags = 1;
2155
		skb_frag_set_page(skb, 0, page_info->page);
S
Sathya Perla 已提交
2156 2157
		skb_shinfo(skb)->frags[0].page_offset =
					page_info->page_offset + hdr_len;
2158 2159
		skb_frag_size_set(&skb_shinfo(skb)->frags[0],
				  curr_frag_len - hdr_len);
S
Sathya Perla 已提交
2160
		skb->data_len = curr_frag_len - hdr_len;
E
Eric Dumazet 已提交
2161
		skb->truesize += rx_frag_size;
S
Sathya Perla 已提交
2162 2163
		skb->tail += hdr_len;
	}
A
Ajit Khaparde 已提交
2164
	page_info->page = NULL;
S
Sathya Perla 已提交
2165

2166 2167 2168
	if (rxcp->pkt_size <= rx_frag_size) {
		BUG_ON(rxcp->num_rcvd != 1);
		return;
S
Sathya Perla 已提交
2169 2170 2171
	}

	/* More frags present for this completion */
2172 2173
	remaining = rxcp->pkt_size - curr_frag_len;
	for (i = 1, j = 0; i < rxcp->num_rcvd; i++) {
2174
		page_info = get_rx_page_info(rxo);
2175
		curr_frag_len = min(remaining, rx_frag_size);
S
Sathya Perla 已提交
2176

2177 2178 2179 2180
		/* Coalesce all frags from the same physical page in one slot */
		if (page_info->page_offset == 0) {
			/* Fresh page */
			j++;
2181
			skb_frag_set_page(skb, j, page_info->page);
2182 2183
			skb_shinfo(skb)->frags[j].page_offset =
							page_info->page_offset;
E
Eric Dumazet 已提交
2184
			skb_frag_size_set(&skb_shinfo(skb)->frags[j], 0);
2185 2186 2187 2188 2189
			skb_shinfo(skb)->nr_frags++;
		} else {
			put_page(page_info->page);
		}

E
Eric Dumazet 已提交
2190
		skb_frag_size_add(&skb_shinfo(skb)->frags[j], curr_frag_len);
S
Sathya Perla 已提交
2191 2192
		skb->len += curr_frag_len;
		skb->data_len += curr_frag_len;
E
Eric Dumazet 已提交
2193
		skb->truesize += rx_frag_size;
2194
		remaining -= curr_frag_len;
A
Ajit Khaparde 已提交
2195
		page_info->page = NULL;
S
Sathya Perla 已提交
2196
	}
2197
	BUG_ON(j > MAX_SKB_FRAGS);
S
Sathya Perla 已提交
2198 2199
}

2200
/* Process the RX completion indicated by rxcp when GRO is disabled */
2201
static void be_rx_compl_process(struct be_rx_obj *rxo, struct napi_struct *napi,
S
Sathya Perla 已提交
2202
				struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
2203
{
S
Sathya Perla 已提交
2204
	struct be_adapter *adapter = rxo->adapter;
2205
	struct net_device *netdev = adapter->netdev;
S
Sathya Perla 已提交
2206
	struct sk_buff *skb;
2207

2208
	skb = netdev_alloc_skb_ip_align(netdev, BE_RX_SKB_ALLOC_SIZE);
2209
	if (unlikely(!skb)) {
2210
		rx_stats(rxo)->rx_drops_no_skbs++;
S
Sathya Perla 已提交
2211
		be_rx_compl_discard(rxo, rxcp);
S
Sathya Perla 已提交
2212 2213 2214
		return;
	}

S
Sathya Perla 已提交
2215
	skb_fill_rx_data(rxo, skb, rxcp);
S
Sathya Perla 已提交
2216

2217
	if (likely((netdev->features & NETIF_F_RXCSUM) && csum_passed(rxcp)))
2218
		skb->ip_summed = CHECKSUM_UNNECESSARY;
S
Somnath Kotur 已提交
2219 2220
	else
		skb_checksum_none_assert(skb);
S
Sathya Perla 已提交
2221

2222
	skb->protocol = eth_type_trans(skb, netdev);
2223
	skb_record_rx_queue(skb, rxo - &adapter->rx_obj[0]);
S
Sathya Perla 已提交
2224
	if (netdev->features & NETIF_F_RXHASH)
T
Tom Herbert 已提交
2225
		skb_set_hash(skb, rxcp->rss_hash, PKT_HASH_TYPE_L3);
2226

2227
	skb->csum_level = rxcp->tunneled;
2228
	skb_mark_napi_id(skb, napi);
S
Sathya Perla 已提交
2229

2230
	if (rxcp->vlanf)
2231
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), rxcp->vlan_tag);
A
Ajit Khaparde 已提交
2232 2233

	netif_receive_skb(skb);
S
Sathya Perla 已提交
2234 2235
}

2236
/* Process the RX completion indicated by rxcp when GRO is enabled */
J
Jingoo Han 已提交
2237 2238 2239
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 已提交
2240
{
S
Sathya Perla 已提交
2241
	struct be_adapter *adapter = rxo->adapter;
S
Sathya Perla 已提交
2242
	struct be_rx_page_info *page_info;
2243
	struct sk_buff *skb = NULL;
2244 2245
	u16 remaining, curr_frag_len;
	u16 i, j;
2246

S
Sathya Perla 已提交
2247
	skb = napi_get_frags(napi);
2248
	if (!skb) {
S
Sathya Perla 已提交
2249
		be_rx_compl_discard(rxo, rxcp);
2250 2251 2252
		return;
	}

2253 2254
	remaining = rxcp->pkt_size;
	for (i = 0, j = -1; i < rxcp->num_rcvd; i++) {
2255
		page_info = get_rx_page_info(rxo);
S
Sathya Perla 已提交
2256 2257 2258

		curr_frag_len = min(remaining, rx_frag_size);

2259 2260 2261 2262
		/* 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++;
2263
			skb_frag_set_page(skb, j, page_info->page);
2264 2265
			skb_shinfo(skb)->frags[j].page_offset =
							page_info->page_offset;
E
Eric Dumazet 已提交
2266
			skb_frag_size_set(&skb_shinfo(skb)->frags[j], 0);
2267 2268 2269
		} else {
			put_page(page_info->page);
		}
E
Eric Dumazet 已提交
2270
		skb_frag_size_add(&skb_shinfo(skb)->frags[j], curr_frag_len);
E
Eric Dumazet 已提交
2271
		skb->truesize += rx_frag_size;
2272
		remaining -= curr_frag_len;
S
Sathya Perla 已提交
2273 2274
		memset(page_info, 0, sizeof(*page_info));
	}
2275
	BUG_ON(j > MAX_SKB_FRAGS);
S
Sathya Perla 已提交
2276

2277
	skb_shinfo(skb)->nr_frags = j + 1;
2278 2279
	skb->len = rxcp->pkt_size;
	skb->data_len = rxcp->pkt_size;
2280
	skb->ip_summed = CHECKSUM_UNNECESSARY;
2281
	skb_record_rx_queue(skb, rxo - &adapter->rx_obj[0]);
A
Ajit Khaparde 已提交
2282
	if (adapter->netdev->features & NETIF_F_RXHASH)
T
Tom Herbert 已提交
2283
		skb_set_hash(skb, rxcp->rss_hash, PKT_HASH_TYPE_L3);
2284

2285
	skb->csum_level = rxcp->tunneled;
2286

2287
	if (rxcp->vlanf)
2288
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), rxcp->vlan_tag);
A
Ajit Khaparde 已提交
2289

S
Sathya Perla 已提交
2290
	napi_gro_frags(napi);
2291 2292
}

S
Sathya Perla 已提交
2293 2294
static void be_parse_rx_compl_v1(struct be_eth_rx_compl *compl,
				 struct be_rx_compl_info *rxcp)
2295
{
2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306
	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);
2307
	if (rxcp->vlanf) {
2308 2309
		rxcp->qnq = GET_RX_COMPL_V1_BITS(qnq, compl);
		rxcp->vlan_tag = GET_RX_COMPL_V1_BITS(vlan_tag, compl);
2310
	}
2311
	rxcp->port = GET_RX_COMPL_V1_BITS(port, compl);
2312
	rxcp->tunneled =
2313
		GET_RX_COMPL_V1_BITS(tunneled, compl);
2314 2315
}

S
Sathya Perla 已提交
2316 2317
static void be_parse_rx_compl_v0(struct be_eth_rx_compl *compl,
				 struct be_rx_compl_info *rxcp)
2318
{
2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329
	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);
2330
	if (rxcp->vlanf) {
2331 2332
		rxcp->qnq = GET_RX_COMPL_V0_BITS(qnq, compl);
		rxcp->vlan_tag = GET_RX_COMPL_V0_BITS(vlan_tag, compl);
2333
	}
2334 2335
	rxcp->port = GET_RX_COMPL_V0_BITS(port, compl);
	rxcp->ip_frag = GET_RX_COMPL_V0_BITS(ip_frag, compl);
2336 2337 2338 2339 2340 2341 2342
}

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 已提交
2343

2344 2345 2346 2347
	/* 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 已提交
2348

2349 2350
	rmb();
	be_dws_le_to_cpu(compl, sizeof(*compl));
S
Sathya Perla 已提交
2351

2352
	if (adapter->be3_native)
S
Sathya Perla 已提交
2353
		be_parse_rx_compl_v1(compl, rxcp);
2354
	else
S
Sathya Perla 已提交
2355
		be_parse_rx_compl_v0(compl, rxcp);
S
Sathya Perla 已提交
2356

2357 2358 2359
	if (rxcp->ip_frag)
		rxcp->l4_csum = 0;

2360
	if (rxcp->vlanf) {
2361 2362 2363 2364 2365
		/* 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)
2366
			rxcp->vlanf = 0;
S
Sathya Perla 已提交
2367

2368
		if (!lancer_chip(adapter))
2369
			rxcp->vlan_tag = swab16(rxcp->vlan_tag);
S
Sathya Perla 已提交
2370

2371
		if (adapter->pvid == (rxcp->vlan_tag & VLAN_VID_MASK) &&
2372
		    !test_bit(rxcp->vlan_tag, adapter->vids))
2373 2374
			rxcp->vlanf = 0;
	}
2375 2376 2377

	/* 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 已提交
2378

2379
	queue_tail_inc(&rxo->cq);
S
Sathya Perla 已提交
2380 2381 2382
	return rxcp;
}

2383
static inline struct page *be_alloc_pages(u32 size, gfp_t gfp)
S
Sathya Perla 已提交
2384 2385
{
	u32 order = get_order(size);
2386

S
Sathya Perla 已提交
2387
	if (order > 0)
2388 2389
		gfp |= __GFP_COMP;
	return  alloc_pages(gfp, order);
S
Sathya Perla 已提交
2390 2391 2392 2393 2394 2395
}

/*
 * Allocate a page, split it to fragments of size rx_frag_size and post as
 * receive buffers to BE
 */
2396
static void be_post_rx_frags(struct be_rx_obj *rxo, gfp_t gfp, u32 frags_needed)
S
Sathya Perla 已提交
2397
{
2398
	struct be_adapter *adapter = rxo->adapter;
2399
	struct be_rx_page_info *page_info = NULL, *prev_page_info = NULL;
2400
	struct be_queue_info *rxq = &rxo->q;
S
Sathya Perla 已提交
2401
	struct page *pagep = NULL;
2402
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
2403 2404
	struct be_eth_rx_d *rxd;
	u64 page_dmaaddr = 0, frag_dmaaddr;
2405
	u32 posted, page_offset = 0, notify = 0;
S
Sathya Perla 已提交
2406

2407
	page_info = &rxo->page_info_tbl[rxq->head];
2408
	for (posted = 0; posted < frags_needed && !page_info->page; posted++) {
S
Sathya Perla 已提交
2409
		if (!pagep) {
2410
			pagep = be_alloc_pages(adapter->big_page_size, gfp);
S
Sathya Perla 已提交
2411
			if (unlikely(!pagep)) {
2412
				rx_stats(rxo)->rx_post_fail++;
S
Sathya Perla 已提交
2413 2414
				break;
			}
2415 2416
			page_dmaaddr = dma_map_page(dev, pagep, 0,
						    adapter->big_page_size,
I
Ivan Vecera 已提交
2417
						    DMA_FROM_DEVICE);
2418 2419 2420
			if (dma_mapping_error(dev, page_dmaaddr)) {
				put_page(pagep);
				pagep = NULL;
2421
				adapter->drv_stats.dma_map_errors++;
2422 2423
				break;
			}
2424
			page_offset = 0;
S
Sathya Perla 已提交
2425 2426
		} else {
			get_page(pagep);
2427
			page_offset += rx_frag_size;
S
Sathya Perla 已提交
2428
		}
2429
		page_info->page_offset = page_offset;
S
Sathya Perla 已提交
2430 2431 2432
		page_info->page = pagep;

		rxd = queue_head_node(rxq);
2433
		frag_dmaaddr = page_dmaaddr + page_info->page_offset;
S
Sathya Perla 已提交
2434 2435 2436 2437 2438 2439 2440
		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;
2441 2442 2443 2444
			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 已提交
2445
		}
2446 2447 2448

		prev_page_info = page_info;
		queue_head_inc(rxq);
S
Sathya Perla 已提交
2449
		page_info = &rxo->page_info_tbl[rxq->head];
S
Sathya Perla 已提交
2450
	}
2451 2452 2453 2454 2455 2456 2457 2458

	/* 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 已提交
2459 2460 2461

	if (posted) {
		atomic_add(posted, &rxq->used);
2462 2463
		if (rxo->rx_post_starved)
			rxo->rx_post_starved = false;
2464
		do {
2465
			notify = min(MAX_NUM_POST_ERX_DB, posted);
2466 2467 2468
			be_rxq_notify(adapter, rxq->id, notify);
			posted -= notify;
		} while (posted);
2469 2470
	} else if (atomic_read(&rxq->used) == 0) {
		/* Let be_worker replenish when memory is available */
2471
		rxo->rx_post_starved = true;
S
Sathya Perla 已提交
2472 2473 2474
	}
}

2475
static struct be_tx_compl_info *be_tx_compl_get(struct be_tx_obj *txo)
S
Sathya Perla 已提交
2476
{
2477 2478 2479
	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 已提交
2480

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

2484
	/* Ensure load ordering of valid bit dword and other dwords below */
2485
	rmb();
2486
	be_dws_le_to_cpu(compl, sizeof(*compl));
S
Sathya Perla 已提交
2487

2488 2489
	txcp->status = GET_TX_COMPL_BITS(status, compl);
	txcp->end_index = GET_TX_COMPL_BITS(wrb_index, compl);
S
Sathya Perla 已提交
2490

2491
	compl->dw[offsetof(struct amap_eth_tx_compl, valid) / 32] = 0;
S
Sathya Perla 已提交
2492 2493 2494 2495
	queue_tail_inc(tx_cq);
	return txcp;
}

2496
static u16 be_tx_compl_process(struct be_adapter *adapter,
2497
			       struct be_tx_obj *txo, u16 last_index)
S
Sathya Perla 已提交
2498
{
2499
	struct sk_buff **sent_skbs = txo->sent_skb_list;
2500
	struct be_queue_info *txq = &txo->q;
2501 2502
	struct sk_buff *skb = NULL;
	bool unmap_skb_hdr = false;
2503
	struct be_eth_wrb *wrb;
2504 2505
	u16 num_wrbs = 0;
	u32 frag_index;
S
Sathya Perla 已提交
2506

2507
	do {
2508 2509 2510 2511 2512 2513 2514 2515 2516 2517
		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;
		}
2518
		wrb = queue_tail_node(txq);
2519
		frag_index = txq->tail;
I
Ivan Vecera 已提交
2520
		unmap_tx_frag(&adapter->pdev->dev, wrb,
2521
			      (unmap_skb_hdr && skb_headlen(skb)));
2522
		unmap_skb_hdr = false;
S
Sathya Perla 已提交
2523
		queue_tail_inc(txq);
2524 2525 2526
		num_wrbs++;
	} while (frag_index != last_index);
	dev_consume_skb_any(skb);
S
Sathya Perla 已提交
2527

2528
	return num_wrbs;
S
Sathya Perla 已提交
2529 2530
}

S
Sathya Perla 已提交
2531 2532
/* Return the number of events in the event queue */
static inline int events_get(struct be_eq_obj *eqo)
2533
{
S
Sathya Perla 已提交
2534 2535
	struct be_eq_entry *eqe;
	int num = 0;
2536

S
Sathya Perla 已提交
2537 2538 2539 2540
	do {
		eqe = queue_tail_node(&eqo->q);
		if (eqe->evt == 0)
			break;
2541

S
Sathya Perla 已提交
2542 2543 2544 2545 2546 2547 2548
		rmb();
		eqe->evt = 0;
		num++;
		queue_tail_inc(&eqo->q);
	} while (true);

	return num;
2549 2550
}

S
Sathya Perla 已提交
2551 2552
/* Leaves the EQ is disarmed state */
static void be_eq_clean(struct be_eq_obj *eqo)
2553
{
S
Sathya Perla 已提交
2554
	int num = events_get(eqo);
2555

2556
	be_eq_notify(eqo->adapter, eqo->q.id, false, true, num, 0);
2557 2558
}

2559 2560
/* Free posted rx buffers that were not used */
static void be_rxq_clean(struct be_rx_obj *rxo)
S
Sathya Perla 已提交
2561
{
2562
	struct be_queue_info *rxq = &rxo->q;
2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576
	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)
{
2577
	struct be_queue_info *rx_cq = &rxo->cq;
2578
	struct be_rx_compl_info *rxcp;
2579 2580
	struct be_adapter *adapter = rxo->adapter;
	int flush_wait = 0;
S
Sathya Perla 已提交
2581

2582 2583 2584 2585 2586 2587 2588 2589
	/* 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 已提交
2590
		if (!rxcp) {
2591 2592 2593
			if (lancer_chip(adapter))
				break;

2594 2595 2596
			if (flush_wait++ > 50 ||
			    be_check_error(adapter,
					   BE_ERROR_HW)) {
2597 2598 2599 2600 2601 2602 2603 2604
				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);
2605
			be_cq_notify(adapter, rx_cq->id, false, 1);
2606 2607 2608
			if (rxcp->num_rcvd == 0)
				break;
		}
S
Sathya Perla 已提交
2609 2610
	}

2611 2612
	/* After cleanup, leave the CQ in unarmed state */
	be_cq_notify(adapter, rx_cq->id, false, 0);
S
Sathya Perla 已提交
2613 2614
}

S
Sathya Perla 已提交
2615
static void be_tx_compl_clean(struct be_adapter *adapter)
S
Sathya Perla 已提交
2616
{
2617
	struct device *dev = &adapter->pdev->dev;
2618
	u16 cmpl = 0, timeo = 0, num_wrbs = 0;
2619
	struct be_tx_compl_info *txcp;
S
Sathya Perla 已提交
2620
	struct be_queue_info *txq;
2621
	u32 end_idx, notified_idx;
2622
	struct be_tx_obj *txo;
S
Sathya Perla 已提交
2623
	int i, pending_txqs;
2624

2625
	/* Stop polling for compls when HW has been silent for 10ms */
2626
	do {
S
Sathya Perla 已提交
2627 2628 2629
		pending_txqs = adapter->num_tx_qs;

		for_all_tx_queues(adapter, txo, i) {
2630 2631
			cmpl = 0;
			num_wrbs = 0;
S
Sathya Perla 已提交
2632
			txq = &txo->q;
2633 2634 2635 2636
			while ((txcp = be_tx_compl_get(txo))) {
				num_wrbs +=
					be_tx_compl_process(adapter, txo,
							    txcp->end_index);
S
Sathya Perla 已提交
2637 2638 2639 2640 2641
				cmpl++;
			}
			if (cmpl) {
				be_cq_notify(adapter, txo->cq.id, false, cmpl);
				atomic_sub(num_wrbs, &txq->used);
2642
				timeo = 0;
S
Sathya Perla 已提交
2643
			}
2644
			if (!be_is_tx_compl_pending(txo))
S
Sathya Perla 已提交
2645
				pending_txqs--;
2646 2647
		}

2648 2649
		if (pending_txqs == 0 || ++timeo > 10 ||
		    be_check_error(adapter, BE_ERROR_HW))
2650 2651 2652 2653 2654
			break;

		mdelay(1);
	} while (true);

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

2659 2660 2661 2662
		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 已提交
2663
			end_idx = txq->tail;
2664 2665 2666 2667 2668
			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 已提交
2669 2670
			num_wrbs = be_tx_compl_process(adapter, txo, end_idx);
			atomic_sub(num_wrbs, &txq->used);
2671 2672 2673 2674 2675 2676 2677
			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 已提交
2678
		}
2679
	}
S
Sathya Perla 已提交
2680 2681
}

S
Sathya Perla 已提交
2682 2683 2684 2685 2686 2687
static void be_evt_queues_destroy(struct be_adapter *adapter)
{
	struct be_eq_obj *eqo;
	int i;

	for_all_evt_queues(adapter, eqo, i) {
2688 2689
		if (eqo->q.created) {
			be_eq_clean(eqo);
S
Sathya Perla 已提交
2690
			be_cmd_q_destroy(adapter, &eqo->q, QTYPE_EQ);
2691
			napi_hash_del(&eqo->napi);
2692
			netif_napi_del(&eqo->napi);
2693
			free_cpumask_var(eqo->affinity_mask);
2694
		}
S
Sathya Perla 已提交
2695 2696 2697 2698 2699 2700 2701 2702
		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;
2703
	struct be_aic_obj *aic;
S
Sathya Perla 已提交
2704 2705
	int i, rc;

2706
	/* need enough EQs to service both RX and TX queues */
2707
	adapter->num_evt_qs = min_t(u16, num_irqs(adapter),
2708 2709
				    max(adapter->cfg_num_rx_irqs,
					adapter->cfg_num_tx_irqs));
S
Sathya Perla 已提交
2710 2711

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

2714
		aic = &adapter->aic_obj[i];
S
Sathya Perla 已提交
2715 2716
		eqo->adapter = adapter;
		eqo->idx = i;
2717 2718
		aic->max_eqd = BE_MAX_EQD;
		aic->enable = true;
S
Sathya Perla 已提交
2719 2720 2721

		eq = &eqo->q;
		rc = be_queue_alloc(adapter, eq, EVNT_Q_LEN,
2722
				    sizeof(struct be_eq_entry));
S
Sathya Perla 已提交
2723 2724 2725
		if (rc)
			return rc;

S
Sathya Perla 已提交
2726
		rc = be_cmd_eq_create(adapter, eqo);
S
Sathya Perla 已提交
2727 2728
		if (rc)
			return rc;
2729 2730 2731 2732 2733 2734 2735

		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 已提交
2736
	}
2737
	return 0;
S
Sathya Perla 已提交
2738 2739
}

2740 2741 2742 2743
static void be_mcc_queues_destroy(struct be_adapter *adapter)
{
	struct be_queue_info *q;

2744
	q = &adapter->mcc_obj.q;
2745
	if (q->created)
2746
		be_cmd_q_destroy(adapter, q, QTYPE_MCCQ);
2747 2748
	be_queue_free(adapter, q);

2749
	q = &adapter->mcc_obj.cq;
2750
	if (q->created)
2751
		be_cmd_q_destroy(adapter, q, QTYPE_CQ);
2752 2753 2754 2755 2756 2757 2758 2759
	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;

2760
	cq = &adapter->mcc_obj.cq;
2761
	if (be_queue_alloc(adapter, cq, MCC_CQ_LEN,
2762
			   sizeof(struct be_mcc_compl)))
2763 2764
		goto err;

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

2769
	q = &adapter->mcc_obj.q;
2770 2771 2772
	if (be_queue_alloc(adapter, q, MCC_Q_LEN, sizeof(struct be_mcc_wrb)))
		goto mcc_cq_destroy;

2773
	if (be_cmd_mccq_create(adapter, q, cq))
2774 2775 2776 2777 2778 2779 2780
		goto mcc_q_free;

	return 0;

mcc_q_free:
	be_queue_free(adapter, q);
mcc_cq_destroy:
2781
	be_cmd_q_destroy(adapter, cq, QTYPE_CQ);
2782 2783 2784 2785 2786 2787
mcc_cq_free:
	be_queue_free(adapter, cq);
err:
	return -1;
}

S
Sathya Perla 已提交
2788 2789 2790
static void be_tx_queues_destroy(struct be_adapter *adapter)
{
	struct be_queue_info *q;
2791 2792
	struct be_tx_obj *txo;
	u8 i;
S
Sathya Perla 已提交
2793

2794 2795 2796 2797 2798
	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 已提交
2799

2800 2801 2802 2803 2804
		q = &txo->cq;
		if (q->created)
			be_cmd_q_destroy(adapter, q, QTYPE_CQ);
		be_queue_free(adapter, q);
	}
S
Sathya Perla 已提交
2805 2806
}

2807
static int be_tx_qs_create(struct be_adapter *adapter)
S
Sathya Perla 已提交
2808
{
S
Sathya Perla 已提交
2809
	struct be_queue_info *cq;
2810
	struct be_tx_obj *txo;
S
Sathya Perla 已提交
2811
	struct be_eq_obj *eqo;
2812
	int status, i;
S
Sathya Perla 已提交
2813

2814
	adapter->num_tx_qs = min(adapter->num_evt_qs, adapter->cfg_num_tx_irqs);
2815

S
Sathya Perla 已提交
2816 2817 2818 2819 2820 2821
	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;
2822

2823 2824 2825
		u64_stats_init(&txo->stats.sync);
		u64_stats_init(&txo->stats.sync_compl);

S
Sathya Perla 已提交
2826 2827 2828
		/* If num_evt_qs is less than num_tx_qs, then more than
		 * one txq share an eq
		 */
S
Sathya Perla 已提交
2829 2830
		eqo = &adapter->eq_obj[i % adapter->num_evt_qs];
		status = be_cmd_cq_create(adapter, cq, &eqo->q, false, 3);
S
Sathya Perla 已提交
2831 2832
		if (status)
			return status;
S
Sathya Perla 已提交
2833

S
Sathya Perla 已提交
2834 2835 2836 2837
		status = be_queue_alloc(adapter, &txo->q, TX_Q_LEN,
					sizeof(struct be_eth_wrb));
		if (status)
			return status;
S
Sathya Perla 已提交
2838

V
Vasundhara Volam 已提交
2839
		status = be_cmd_txq_create(adapter, txo);
S
Sathya Perla 已提交
2840 2841
		if (status)
			return status;
S
Sathya Perla 已提交
2842 2843 2844

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

S
Sathya Perla 已提交
2847 2848
	dev_info(&adapter->pdev->dev, "created %d TX queue(s)\n",
		 adapter->num_tx_qs);
S
Sathya Perla 已提交
2849
	return 0;
S
Sathya Perla 已提交
2850 2851
}

S
Sathya Perla 已提交
2852
static void be_rx_cqs_destroy(struct be_adapter *adapter)
S
Sathya Perla 已提交
2853 2854
{
	struct be_queue_info *q;
2855 2856 2857 2858 2859 2860 2861 2862
	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);
2863 2864 2865
	}
}

S
Sathya Perla 已提交
2866
static int be_rx_cqs_create(struct be_adapter *adapter)
S
Sathya Perla 已提交
2867
{
S
Sathya Perla 已提交
2868
	struct be_queue_info *eq, *cq;
2869 2870
	struct be_rx_obj *rxo;
	int rc, i;
S
Sathya Perla 已提交
2871

2872 2873
	adapter->num_rss_qs =
			min(adapter->num_evt_qs, adapter->cfg_num_rx_irqs);
2874

2875
	/* We'll use RSS only if atleast 2 RSS rings are supported. */
2876
	if (adapter->num_rss_qs < 2)
2877 2878 2879 2880 2881 2882
		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 已提交
2883
	 */
2884 2885
	if (adapter->num_rx_qs == 0)
		adapter->num_rx_qs = 1;
2886

S
Sathya Perla 已提交
2887
	adapter->big_page_size = (1 << get_order(rx_frag_size)) * PAGE_SIZE;
2888 2889 2890 2891
	for_all_rx_queues(adapter, rxo, i) {
		rxo->adapter = adapter;
		cq = &rxo->cq;
		rc = be_queue_alloc(adapter, cq, RX_CQ_LEN,
2892
				    sizeof(struct be_eth_rx_compl));
2893
		if (rc)
S
Sathya Perla 已提交
2894
			return rc;
2895

2896
		u64_stats_init(&rxo->stats.sync);
S
Sathya Perla 已提交
2897 2898
		eq = &adapter->eq_obj[i % adapter->num_evt_qs].q;
		rc = be_cmd_cq_create(adapter, cq, eq, false, 3);
2899
		if (rc)
S
Sathya Perla 已提交
2900
			return rc;
2901
	}
S
Sathya Perla 已提交
2902

S
Sathya Perla 已提交
2903
	dev_info(&adapter->pdev->dev,
2904
		 "created %d RX queue(s)\n", adapter->num_rx_qs);
S
Sathya Perla 已提交
2905
	return 0;
2906 2907
}

S
Sathya Perla 已提交
2908 2909
static irqreturn_t be_intx(int irq, void *dev)
{
2910 2911 2912
	struct be_eq_obj *eqo = dev;
	struct be_adapter *adapter = eqo->adapter;
	int num_evts = 0;
S
Sathya Perla 已提交
2913

2914 2915 2916 2917 2918 2919 2920
	/* 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.
2921
	 */
2922
	if (napi_schedule_prep(&eqo->napi)) {
2923
		num_evts = events_get(eqo);
2924 2925 2926 2927
		__napi_schedule(&eqo->napi);
		if (num_evts)
			eqo->spurious_intr = 0;
	}
2928
	be_eq_notify(adapter, eqo->q.id, false, true, num_evts, 0);
2929

2930 2931 2932
	/* 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!
2933
	 */
2934 2935 2936 2937
	if (num_evts || eqo->spurious_intr++ == 0)
		return IRQ_HANDLED;
	else
		return IRQ_NONE;
S
Sathya Perla 已提交
2938 2939
}

S
Sathya Perla 已提交
2940
static irqreturn_t be_msix(int irq, void *dev)
S
Sathya Perla 已提交
2941
{
S
Sathya Perla 已提交
2942
	struct be_eq_obj *eqo = dev;
S
Sathya Perla 已提交
2943

2944
	be_eq_notify(eqo->adapter, eqo->q.id, false, true, 0, 0);
2945
	napi_schedule(&eqo->napi);
S
Sathya Perla 已提交
2946 2947 2948
	return IRQ_HANDLED;
}

2949
static inline bool do_gro(struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
2950
{
2951
	return (rxcp->tcpf && !rxcp->err && rxcp->l4_csum) ? true : false;
S
Sathya Perla 已提交
2952 2953
}

S
Sathya Perla 已提交
2954
static int be_process_rx(struct be_rx_obj *rxo, struct napi_struct *napi,
2955
			 int budget, int polling)
S
Sathya Perla 已提交
2956
{
2957 2958
	struct be_adapter *adapter = rxo->adapter;
	struct be_queue_info *rx_cq = &rxo->cq;
2959
	struct be_rx_compl_info *rxcp;
S
Sathya Perla 已提交
2960
	u32 work_done;
2961
	u32 frags_consumed = 0;
S
Sathya Perla 已提交
2962 2963

	for (work_done = 0; work_done < budget; work_done++) {
2964
		rxcp = be_rx_compl_get(rxo);
S
Sathya Perla 已提交
2965 2966 2967
		if (!rxcp)
			break;

2968 2969 2970 2971 2972 2973
		/* 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 已提交
2974
			be_rx_compl_discard(rxo, rxcp);
2975 2976 2977 2978 2979 2980 2981
			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 &&
2982
			     !lancer_chip(adapter))) {
S
Sathya Perla 已提交
2983
			be_rx_compl_discard(rxo, rxcp);
2984
			goto loop_continue;
2985
		}
2986

2987 2988
		/* Don't do gro when we're busy_polling */
		if (do_gro(rxcp) && polling != BUSY_POLLING)
S
Sathya Perla 已提交
2989
			be_rx_compl_process_gro(rxo, napi, rxcp);
2990
		else
2991 2992
			be_rx_compl_process(rxo, napi, rxcp);

2993
loop_continue:
2994
		frags_consumed += rxcp->num_rcvd;
2995
		be_rx_stats_update(rxo, rxcp);
S
Sathya Perla 已提交
2996 2997
	}

S
Sathya Perla 已提交
2998 2999
	if (work_done) {
		be_cq_notify(adapter, rx_cq->id, true, work_done);
3000

3001 3002 3003 3004 3005
		/* 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)
3006 3007 3008
			be_post_rx_frags(rxo, GFP_ATOMIC,
					 max_t(u32, MAX_RX_POST,
					       frags_consumed));
S
Sathya Perla 已提交
3009
	}
S
Sathya Perla 已提交
3010

S
Sathya Perla 已提交
3011 3012 3013
	return work_done;
}

3014
static inline void be_update_tx_err(struct be_tx_obj *txo, u8 status)
3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026 3027 3028
{
	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;
	}
}

3029
static inline void lancer_update_tx_err(struct be_tx_obj *txo, u8 status)
3030 3031 3032 3033 3034 3035 3036 3037 3038 3039 3040 3041 3042 3043 3044 3045 3046 3047 3048 3049 3050
{
	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 已提交
3051 3052
static void be_process_tx(struct be_adapter *adapter, struct be_tx_obj *txo,
			  int idx)
S
Sathya Perla 已提交
3053
{
S
Sathya Perla 已提交
3054
	int num_wrbs = 0, work_done = 0;
3055
	struct be_tx_compl_info *txcp;
S
Sathya Perla 已提交
3056

3057 3058
	while ((txcp = be_tx_compl_get(txo))) {
		num_wrbs += be_tx_compl_process(adapter, txo, txcp->end_index);
S
Sathya Perla 已提交
3059
		work_done++;
3060

3061
		if (txcp->status) {
3062
			if (lancer_chip(adapter))
3063
				lancer_update_tx_err(txo, txcp->status);
3064
			else
3065
				be_update_tx_err(txo, txcp->status);
3066
		}
S
Sathya Perla 已提交
3067
	}
S
Sathya Perla 已提交
3068

S
Sathya Perla 已提交
3069 3070 3071
	if (work_done) {
		be_cq_notify(adapter, txo->cq.id, true, work_done);
		atomic_sub(num_wrbs, &txo->q.used);
3072

S
Sathya Perla 已提交
3073 3074 3075
		/* 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) &&
3076
		    be_can_txq_wake(txo)) {
S
Sathya Perla 已提交
3077
			netif_wake_subqueue(adapter->netdev, idx);
3078
		}
S
Sathya Perla 已提交
3079 3080 3081 3082

		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 已提交
3083
	}
S
Sathya Perla 已提交
3084
}
S
Sathya Perla 已提交
3085

3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108 3109 3110 3111 3112 3113 3114 3115 3116 3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 3130 3131 3132 3133 3134 3135 3136 3137 3138 3139 3140 3141 3142 3143 3144 3145 3146 3147 3148 3149 3150 3151 3152 3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163 3164 3165 3166 3167 3168 3169 3170 3171 3172 3173 3174 3175 3176 3177 3178 3179 3180 3181 3182 3183 3184 3185
#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 */

3186
int be_poll(struct napi_struct *napi, int budget)
S
Sathya Perla 已提交
3187 3188 3189
{
	struct be_eq_obj *eqo = container_of(napi, struct be_eq_obj, napi);
	struct be_adapter *adapter = eqo->adapter;
3190
	int max_work = 0, work, i, num_evts;
3191
	struct be_rx_obj *rxo;
3192
	struct be_tx_obj *txo;
3193
	u32 mult_enc = 0;
S
Sathya Perla 已提交
3194

3195 3196
	num_evts = events_get(eqo);

3197 3198
	for_all_tx_queues_on_eq(adapter, eqo, txo, i)
		be_process_tx(adapter, txo, i);
S
Sathya Perla 已提交
3199

3200 3201 3202 3203 3204 3205 3206 3207 3208 3209 3210 3211
	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 已提交
3212
	}
S
Sathya Perla 已提交
3213

S
Sathya Perla 已提交
3214 3215
	if (is_mcc_eqo(eqo))
		be_process_mcc(adapter);
3216

S
Sathya Perla 已提交
3217 3218
	if (max_work < budget) {
		napi_complete(napi);
3219 3220 3221 3222 3223 3224 3225 3226 3227

		/* 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 已提交
3228 3229
	} else {
		/* As we'll continue in polling mode, count and clear events */
3230
		be_eq_notify(adapter, eqo->q.id, false, false, num_evts, 0);
3231
	}
S
Sathya Perla 已提交
3232
	return max_work;
S
Sathya Perla 已提交
3233 3234
}

3235 3236 3237 3238 3239 3240 3241 3242 3243 3244 3245 3246 3247 3248 3249 3250 3251 3252 3253 3254 3255 3256
#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

3257
void be_detect_error(struct be_adapter *adapter)
3258
{
3259 3260
	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;
3261
	u32 i;
3262
	struct device *dev = &adapter->pdev->dev;
3263

3264
	if (be_check_error(adapter, BE_ERROR_HW))
3265 3266
		return;

3267 3268 3269
	if (lancer_chip(adapter)) {
		sliport_status = ioread32(adapter->db + SLIPORT_STATUS_OFFSET);
		if (sliport_status & SLIPORT_STATUS_ERR_MASK) {
3270
			be_set_error(adapter, BE_ERROR_UE);
3271
			sliport_err1 = ioread32(adapter->db +
3272
						SLIPORT_ERROR1_OFFSET);
3273
			sliport_err2 = ioread32(adapter->db +
3274
						SLIPORT_ERROR2_OFFSET);
3275 3276 3277 3278 3279 3280 3281 3282 3283 3284 3285 3286 3287
			/* 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);
			}
3288 3289
		}
	} else {
3290 3291 3292 3293 3294 3295
		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);
3296

3297 3298
		ue_lo = (ue_lo & ~ue_lo_mask);
		ue_hi = (ue_hi & ~ue_hi_mask);
3299

3300 3301 3302 3303
		/* 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.
		 */
3304

3305 3306 3307 3308 3309
		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))
3310 3311
				be_set_error(adapter, BE_ERROR_UE);

3312 3313 3314 3315 3316 3317 3318 3319 3320 3321
			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]);
			}
3322 3323 3324 3325
		}
	}
}

3326 3327
static void be_msix_disable(struct be_adapter *adapter)
{
3328
	if (msix_enabled(adapter)) {
3329
		pci_disable_msix(adapter->pdev);
3330
		adapter->num_msix_vec = 0;
3331
		adapter->num_msix_roce_vec = 0;
3332 3333 3334
	}
}

3335
static int be_msix_enable(struct be_adapter *adapter)
S
Sathya Perla 已提交
3336
{
3337
	unsigned int i, max_roce_eqs;
S
Sathya Perla 已提交
3338
	struct device *dev = &adapter->pdev->dev;
3339
	int num_vec;
S
Sathya Perla 已提交
3340

3341 3342 3343
	/* If RoCE is supported, program the max number of vectors that
	 * could be used for NIC and RoCE, else, just program the number
	 * we'll use initially.
3344
	 */
3345 3346 3347 3348 3349 3350 3351 3352 3353
	if (be_roce_supported(adapter)) {
		max_roce_eqs =
			be_max_func_eqs(adapter) - be_max_nic_eqs(adapter);
		max_roce_eqs = min(max_roce_eqs, num_online_cpus());
		num_vec = be_max_any_irqs(adapter) + max_roce_eqs;
	} else {
		num_vec = max(adapter->cfg_num_rx_irqs,
			      adapter->cfg_num_tx_irqs);
	}
3354

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

3358 3359 3360 3361
	num_vec = pci_enable_msix_range(adapter->pdev, adapter->msix_entries,
					MIN_MSIX_VECTORS, num_vec);
	if (num_vec < 0)
		goto fail;
3362 3363 3364 3365 3366 3367 3368 3369 3370 3371 3372

	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);
3373
	return 0;
3374 3375 3376 3377 3378

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

	/* INTx is not supported in VFs, so fail probe if enable_msix fails */
3379
	if (be_virtfn(adapter))
3380 3381
		return num_vec;
	return 0;
S
Sathya Perla 已提交
3382 3383
}

3384
static inline int be_msix_vec_get(struct be_adapter *adapter,
3385
				  struct be_eq_obj *eqo)
3386
{
S
Sathya Perla 已提交
3387
	return adapter->msix_entries[eqo->msix_idx].vector;
3388
}
S
Sathya Perla 已提交
3389

3390 3391
static int be_msix_register(struct be_adapter *adapter)
{
S
Sathya Perla 已提交
3392 3393 3394
	struct net_device *netdev = adapter->netdev;
	struct be_eq_obj *eqo;
	int status, i, vec;
S
Sathya Perla 已提交
3395

S
Sathya Perla 已提交
3396 3397 3398 3399
	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);
3400 3401
		if (status)
			goto err_msix;
3402 3403

		irq_set_affinity_hint(vec, eqo->affinity_mask);
3404
	}
3405

S
Sathya Perla 已提交
3406
	return 0;
3407
err_msix:
3408 3409
	for (i--; i >= 0; i--) {
		eqo = &adapter->eq_obj[i];
S
Sathya Perla 已提交
3410
		free_irq(be_msix_vec_get(adapter, eqo), eqo);
3411
	}
S
Sathya Perla 已提交
3412
	dev_warn(&adapter->pdev->dev, "MSIX Request IRQ failed - err %d\n",
3413
		 status);
3414
	be_msix_disable(adapter);
S
Sathya Perla 已提交
3415 3416 3417 3418 3419 3420 3421 3422
	return status;
}

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

3423
	if (msix_enabled(adapter)) {
S
Sathya Perla 已提交
3424 3425 3426
		status = be_msix_register(adapter);
		if (status == 0)
			goto done;
3427
		/* INTx is not supported for VF */
3428
		if (be_virtfn(adapter))
3429
			return status;
S
Sathya Perla 已提交
3430 3431
	}

3432
	/* INTx: only the first EQ is used */
S
Sathya Perla 已提交
3433 3434
	netdev->irq = adapter->pdev->irq;
	status = request_irq(netdev->irq, be_intx, IRQF_SHARED, netdev->name,
3435
			     &adapter->eq_obj[0]);
S
Sathya Perla 已提交
3436 3437 3438 3439 3440 3441 3442 3443 3444 3445 3446 3447 3448
	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 已提交
3449
	struct be_eq_obj *eqo;
3450
	int i, vec;
S
Sathya Perla 已提交
3451 3452 3453 3454 3455

	if (!adapter->isr_registered)
		return;

	/* INTx */
3456
	if (!msix_enabled(adapter)) {
3457
		free_irq(netdev->irq, &adapter->eq_obj[0]);
S
Sathya Perla 已提交
3458 3459 3460 3461
		goto done;
	}

	/* MSIx */
3462 3463 3464 3465 3466
	for_all_evt_queues(adapter, eqo, i) {
		vec = be_msix_vec_get(adapter, eqo);
		irq_set_affinity_hint(vec, NULL);
		free_irq(vec, eqo);
	}
3467

S
Sathya Perla 已提交
3468 3469 3470 3471
done:
	adapter->isr_registered = false;
}

S
Sathya Perla 已提交
3472
static void be_rx_qs_destroy(struct be_adapter *adapter)
3473
{
3474
	struct rss_info *rss = &adapter->rss_info;
3475 3476 3477 3478 3479 3480 3481
	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) {
3482 3483 3484 3485 3486 3487 3488 3489 3490 3491 3492 3493 3494
			/* 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);
			}

3495
			be_cmd_rxq_destroy(adapter, q);
S
Sathya Perla 已提交
3496
			be_rx_cq_clean(rxo);
3497
			be_rxq_clean(rxo);
3498
		}
S
Sathya Perla 已提交
3499
		be_queue_free(adapter, q);
3500
	}
3501 3502 3503 3504 3505 3506

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

3509 3510 3511 3512 3513 3514
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);
3515
	be_clear_mc_list(adapter);
3516 3517 3518 3519 3520 3521 3522 3523 3524 3525 3526 3527 3528 3529 3530 3531 3532 3533 3534 3535 3536

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

3537 3538 3539
static int be_close(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
3540 3541
	struct be_eq_obj *eqo;
	int i;
3542

3543 3544 3545 3546 3547 3548
	/* 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;

3549 3550
	be_disable_if_filters(adapter);

3551 3552
	if (adapter->flags & BE_FLAGS_NAPI_ENABLED) {
		for_all_evt_queues(adapter, eqo, i) {
3553
			napi_disable(&eqo->napi);
3554 3555
			be_disable_busy_poll(eqo);
		}
3556
		adapter->flags &= ~BE_FLAGS_NAPI_ENABLED;
3557
	}
3558 3559 3560 3561 3562 3563

	be_async_mcc_disable(adapter);

	/* Wait for all pending tx completions to arrive so that
	 * all tx skbs are freed.
	 */
S
Sathya Perla 已提交
3564
	netif_tx_disable(netdev);
3565
	be_tx_compl_clean(adapter);
3566 3567

	be_rx_qs_destroy(adapter);
3568

3569
	for_all_evt_queues(adapter, eqo, i) {
S
Sathya Perla 已提交
3570 3571 3572 3573 3574
		if (msix_enabled(adapter))
			synchronize_irq(be_msix_vec_get(adapter, eqo));
		else
			synchronize_irq(netdev->irq);
		be_eq_clean(eqo);
3575 3576
	}

3577 3578
	be_irq_unregister(adapter);

3579 3580 3581
	return 0;
}

S
Sathya Perla 已提交
3582
static int be_rx_qs_create(struct be_adapter *adapter)
3583
{
3584 3585
	struct rss_info *rss = &adapter->rss_info;
	u8 rss_key[RSS_HASH_KEY_LEN];
3586
	struct be_rx_obj *rxo;
3587
	int rc, i, j;
3588 3589

	for_all_rx_queues(adapter, rxo, i) {
S
Sathya Perla 已提交
3590 3591 3592 3593 3594 3595
		rc = be_queue_alloc(adapter, &rxo->q, RX_Q_LEN,
				    sizeof(struct be_eth_rx_d));
		if (rc)
			return rc;
	}

3596 3597 3598 3599 3600 3601 3602 3603
	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 已提交
3604 3605

	for_all_rss_queues(adapter, rxo, i) {
3606
		rc = be_cmd_rxq_create(adapter, &rxo->q, rxo->cq.id,
S
Sathya Perla 已提交
3607 3608
				       rx_frag_size, adapter->if_handle,
				       true, &rxo->rss_id);
3609 3610 3611 3612 3613
		if (rc)
			return rc;
	}

	if (be_multi_rxq(adapter)) {
3614
		for (j = 0; j < RSS_INDIR_TABLE_LEN; j += adapter->num_rss_qs) {
3615
			for_all_rss_queues(adapter, rxo, i) {
3616
				if ((j + i) >= RSS_INDIR_TABLE_LEN)
3617
					break;
3618 3619
				rss->rsstable[j + i] = rxo->rss_id;
				rss->rss_queue[j + i] = i;
3620 3621
			}
		}
3622 3623
		rss->rss_flags = RSS_ENABLE_TCP_IPV4 | RSS_ENABLE_IPV4 |
			RSS_ENABLE_TCP_IPV6 | RSS_ENABLE_IPV6;
3624 3625

		if (!BEx_chip(adapter))
3626 3627
			rss->rss_flags |= RSS_ENABLE_UDP_IPV4 |
				RSS_ENABLE_UDP_IPV6;
3628 3629 3630 3631 3632 3633 3634 3635 3636 3637

		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);
3638 3639
	} else {
		/* Disable RSS, if only default RX Q is created */
3640
		rss->rss_flags = RSS_ENABLE_NONE;
3641
	}
3642

3643

3644 3645 3646
	/* Post 1 less than RXQ-len to avoid head being equal to tail,
	 * which is a queue empty condition
	 */
S
Sathya Perla 已提交
3647
	for_all_rx_queues(adapter, rxo, i)
3648 3649
		be_post_rx_frags(rxo, GFP_KERNEL, RX_Q_LEN - 1);

3650 3651 3652
	return 0;
}

3653 3654 3655 3656
static int be_enable_if_filters(struct be_adapter *adapter)
{
	int status;

3657
	status = be_cmd_rx_filter(adapter, BE_IF_FILT_FLAGS_BASIC, ON);
3658 3659 3660 3661 3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672 3673 3674 3675 3676 3677
	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 已提交
3678 3679 3680
static int be_open(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
3681
	struct be_eq_obj *eqo;
3682
	struct be_rx_obj *rxo;
S
Sathya Perla 已提交
3683
	struct be_tx_obj *txo;
3684
	u8 link_status;
3685
	int status, i;
3686

S
Sathya Perla 已提交
3687
	status = be_rx_qs_create(adapter);
3688 3689 3690
	if (status)
		goto err;

3691 3692 3693 3694
	status = be_enable_if_filters(adapter);
	if (status)
		goto err;

3695 3696 3697
	status = be_irq_register(adapter);
	if (status)
		goto err;
3698

S
Sathya Perla 已提交
3699
	for_all_rx_queues(adapter, rxo, i)
3700
		be_cq_notify(adapter, rxo->cq.id, true, 0);
3701

S
Sathya Perla 已提交
3702 3703 3704
	for_all_tx_queues(adapter, txo, i)
		be_cq_notify(adapter, txo->cq.id, true, 0);

3705 3706
	be_async_mcc_enable(adapter);

S
Sathya Perla 已提交
3707 3708
	for_all_evt_queues(adapter, eqo, i) {
		napi_enable(&eqo->napi);
3709
		be_enable_busy_poll(eqo);
3710
		be_eq_notify(adapter, eqo->q.id, true, true, 0, 0);
S
Sathya Perla 已提交
3711
	}
3712
	adapter->flags |= BE_FLAGS_NAPI_ENABLED;
S
Sathya Perla 已提交
3713

3714
	status = be_cmd_link_status_query(adapter, NULL, &link_status, 0);
3715 3716 3717
	if (!status)
		be_link_status_update(adapter, link_status);

S
Sathya Perla 已提交
3718
	netif_tx_start_all_queues(netdev);
3719
	if (skyhawk_chip(adapter))
3720
		udp_tunnel_get_rx_info(netdev);
3721

3722 3723 3724 3725
	return 0;
err:
	be_close(adapter->netdev);
	return -EIO;
3726 3727
}

3728 3729 3730 3731 3732 3733 3734 3735 3736 3737 3738 3739 3740
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);
}

3741 3742 3743 3744 3745 3746
/*
 * 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.
 */
3747
static int be_vf_eth_addr_config(struct be_adapter *adapter)
3748
{
3749
	u32 vf;
3750
	int status = 0;
3751
	u8 mac[ETH_ALEN];
3752
	struct be_vf_cfg *vf_cfg;
3753 3754 3755

	be_vf_eth_addr_generate(adapter, mac);

3756
	for_all_vfs(adapter, vf_cfg, vf) {
3757
		if (BEx_chip(adapter))
3758
			status = be_cmd_pmac_add(adapter, mac,
3759 3760
						 vf_cfg->if_handle,
						 &vf_cfg->pmac_id, vf + 1);
3761 3762 3763
		else
			status = be_cmd_set_mac(adapter, mac, vf_cfg->if_handle,
						vf + 1);
3764

3765 3766
		if (status)
			dev_err(&adapter->pdev->dev,
3767 3768
				"Mac address assignment failed for VF %d\n",
				vf);
3769
		else
3770
			memcpy(vf_cfg->mac_addr, mac, ETH_ALEN);
3771 3772 3773 3774 3775 3776

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

3777 3778 3779 3780 3781 3782 3783
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) {
3784 3785 3786
		status = be_cmd_get_active_mac(adapter, vf_cfg->pmac_id,
					       mac, vf_cfg->if_handle,
					       false, vf+1);
3787 3788 3789 3790 3791 3792 3793
		if (status)
			return status;
		memcpy(vf_cfg->mac_addr, mac, ETH_ALEN);
	}
	return 0;
}

3794
static void be_vf_clear(struct be_adapter *adapter)
3795
{
3796
	struct be_vf_cfg *vf_cfg;
3797 3798
	u32 vf;

3799
	if (pci_vfs_assigned(adapter->pdev)) {
3800 3801
		dev_warn(&adapter->pdev->dev,
			 "VFs are assigned to VMs: not disabling VFs\n");
3802 3803 3804
		goto done;
	}

3805 3806
	pci_disable_sriov(adapter->pdev);

3807
	for_all_vfs(adapter, vf_cfg, vf) {
3808
		if (BEx_chip(adapter))
3809 3810
			be_cmd_pmac_del(adapter, vf_cfg->if_handle,
					vf_cfg->pmac_id, vf + 1);
3811 3812 3813
		else
			be_cmd_set_mac(adapter, NULL, vf_cfg->if_handle,
				       vf + 1);
3814

3815 3816
		be_cmd_if_destroy(adapter, vf_cfg->if_handle, vf + 1);
	}
3817 3818 3819 3820 3821

	if (BE3_chip(adapter))
		be_cmd_set_hsw_config(adapter, 0, 0,
				      adapter->if_handle,
				      PORT_FWD_TYPE_PASSTHRU, 0);
3822 3823 3824
done:
	kfree(adapter->vf_cfg);
	adapter->num_vfs = 0;
3825
	adapter->flags &= ~BE_FLAGS_SRIOV_ENABLED;
3826 3827
}

3828 3829 3830 3831 3832 3833 3834 3835
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);
}

3836
static void be_cancel_worker(struct be_adapter *adapter)
3837
{
3838 3839 3840 3841
	if (adapter->flags & BE_FLAGS_WORKER_SCHEDULED) {
		cancel_delayed_work_sync(&adapter->work);
		adapter->flags &= ~BE_FLAGS_WORKER_SCHEDULED;
	}
3842 3843
}

3844 3845 3846 3847 3848 3849 3850 3851
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;
	}
}

3852 3853
static void be_disable_vxlan_offloads(struct be_adapter *adapter)
{
3854 3855
	struct net_device *netdev = adapter->netdev;

3856 3857 3858 3859 3860 3861 3862 3863 3864
	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;
3865 3866 3867

	netdev->hw_enc_features = 0;
	netdev->hw_features &= ~(NETIF_F_GSO_UDP_TUNNEL);
3868
	netdev->features &= ~(NETIF_F_GSO_UDP_TUNNEL);
3869 3870
}

3871 3872
static void be_calculate_vf_res(struct be_adapter *adapter, u16 num_vfs,
				struct be_resources *vft_res)
3873 3874
{
	struct be_resources res = adapter->pool_res;
3875 3876
	u32 vf_if_cap_flags = res.vf_if_cap_flags;
	struct be_resources res_mod = {0};
3877 3878
	u16 num_vf_qs = 1;

3879 3880 3881 3882 3883
	/* Distribute the queue resources among the PF and it's VFs */
	if (num_vfs) {
		/* Divide the rx queues evenly among the VFs and the PF, capped
		 * at VF-EQ-count. Any remainder queues belong to the PF.
		 */
3884 3885
		num_vf_qs = min(SH_VF_MAX_NIC_EQS,
				res.max_rss_qs / (num_vfs + 1));
3886

3887 3888 3889
		/* Skyhawk-R chip supports only MAX_PORT_RSS_TABLES
		 * RSS Tables per port. Provide RSS on VFs, only if number of
		 * VFs requested is less than it's PF Pool's RSS Tables limit.
3890
		 */
3891
		if (num_vfs >= be_max_pf_pool_rss_tables(adapter))
3892 3893
			num_vf_qs = 1;
	}
3894 3895 3896 3897

	/* Resource with fields set to all '1's by GET_PROFILE_CONFIG cmd,
	 * which are modifiable using SET_PROFILE_CONFIG cmd.
	 */
3898 3899
	be_cmd_get_profile_config(adapter, &res_mod, NULL, ACTIVE_PROFILE_TYPE,
				  RESOURCE_MODIFIABLE, 0);
3900 3901 3902 3903 3904 3905 3906 3907 3908 3909 3910 3911 3912 3913 3914 3915 3916 3917 3918 3919 3920 3921 3922 3923 3924 3925 3926 3927 3928 3929 3930 3931 3932 3933 3934 3935 3936 3937 3938 3939 3940 3941 3942 3943 3944

	/* If RSS IFACE capability flags are modifiable for a VF, set the
	 * capability flag as valid and set RSS and DEFQ_RSS IFACE flags if
	 * more than 1 RSSQ is available for a VF.
	 * Otherwise, provision only 1 queue pair for VF.
	 */
	if (res_mod.vf_if_cap_flags & BE_IF_FLAGS_RSS) {
		vft_res->flags |= BIT(IF_CAPS_FLAGS_VALID_SHIFT);
		if (num_vf_qs > 1) {
			vf_if_cap_flags |= BE_IF_FLAGS_RSS;
			if (res.if_cap_flags & BE_IF_FLAGS_DEFQ_RSS)
				vf_if_cap_flags |= BE_IF_FLAGS_DEFQ_RSS;
		} else {
			vf_if_cap_flags &= ~(BE_IF_FLAGS_RSS |
					     BE_IF_FLAGS_DEFQ_RSS);
		}
	} else {
		num_vf_qs = 1;
	}

	if (res_mod.vf_if_cap_flags & BE_IF_FLAGS_VLAN_PROMISCUOUS) {
		vft_res->flags |= BIT(IF_CAPS_FLAGS_VALID_SHIFT);
		vf_if_cap_flags &= ~BE_IF_FLAGS_VLAN_PROMISCUOUS;
	}

	vft_res->vf_if_cap_flags = vf_if_cap_flags;
	vft_res->max_rx_qs = num_vf_qs;
	vft_res->max_rss_qs = num_vf_qs;
	vft_res->max_tx_qs = res.max_tx_qs / (num_vfs + 1);
	vft_res->max_cq_count = res.max_cq_count / (num_vfs + 1);

	/* Distribute unicast MACs, VLANs, IFACE count and MCCQ count equally
	 * among the PF and it's VFs, if the fields are changeable
	 */
	if (res_mod.max_uc_mac == FIELD_MODIFIABLE)
		vft_res->max_uc_mac = res.max_uc_mac / (num_vfs + 1);

	if (res_mod.max_vlans == FIELD_MODIFIABLE)
		vft_res->max_vlans = res.max_vlans / (num_vfs + 1);

	if (res_mod.max_iface_count == FIELD_MODIFIABLE)
		vft_res->max_iface_count = res.max_iface_count / (num_vfs + 1);

	if (res_mod.max_mcc_count == FIELD_MODIFIABLE)
		vft_res->max_mcc_count = res.max_mcc_count / (num_vfs + 1);
3945 3946
}

3947 3948
static int be_clear(struct be_adapter *adapter)
{
3949
	struct pci_dev *pdev = adapter->pdev;
3950
	struct  be_resources vft_res = {0};
3951

3952
	be_cancel_worker(adapter);
3953

3954
	if (sriov_enabled(adapter))
3955 3956
		be_vf_clear(adapter);

3957 3958 3959
	/* Re-configure FW to distribute resources evenly across max-supported
	 * number of VFs, only when VFs are not already enabled.
	 */
3960 3961
	if (skyhawk_chip(adapter) && be_physfn(adapter) &&
	    !pci_vfs_assigned(pdev)) {
3962 3963 3964
		be_calculate_vf_res(adapter,
				    pci_sriov_get_totalvfs(pdev),
				    &vft_res);
3965
		be_cmd_set_sriov_config(adapter, adapter->pool_res,
3966
					pci_sriov_get_totalvfs(pdev),
3967
					&vft_res);
3968
	}
3969

3970
	be_disable_vxlan_offloads(adapter);
3971 3972
	kfree(adapter->pmac_id);
	adapter->pmac_id = NULL;
3973

3974
	be_cmd_if_destroy(adapter, adapter->if_handle,  0);
3975

3976
	be_clear_queues(adapter);
3977

S
Sathya Perla 已提交
3978
	be_msix_disable(adapter);
3979
	adapter->flags &= ~BE_FLAGS_SETUP_DONE;
3980 3981 3982
	return 0;
}

3983
static int be_vfs_if_create(struct be_adapter *adapter)
3984
{
3985
	struct be_resources res = {0};
3986
	u32 cap_flags, en_flags, vf;
3987
	struct be_vf_cfg *vf_cfg;
3988
	int status;
3989

3990
	/* If a FW profile exists, then cap_flags are updated */
3991
	cap_flags = BE_VF_IF_EN_FLAGS;
3992

3993
	for_all_vfs(adapter, vf_cfg, vf) {
3994
		if (!BE3_chip(adapter)) {
3995 3996
			status = be_cmd_get_profile_config(adapter, &res, NULL,
							   ACTIVE_PROFILE_TYPE,
3997
							   RESOURCE_LIMITS,
3998
							   vf + 1);
3999
			if (!status) {
4000
				cap_flags = res.if_cap_flags;
4001 4002 4003 4004 4005
				/* Prevent VFs from enabling VLAN promiscuous
				 * mode
				 */
				cap_flags &= ~BE_IF_FLAGS_VLAN_PROMISCUOUS;
			}
4006
		}
4007

4008 4009
		/* PF should enable IF flags during proxy if_create call */
		en_flags = cap_flags & BE_VF_IF_EN_FLAGS;
4010 4011
		status = be_cmd_if_create(adapter, cap_flags, en_flags,
					  &vf_cfg->if_handle, vf + 1);
4012
		if (status)
4013
			return status;
4014
	}
4015 4016

	return 0;
4017 4018
}

4019
static int be_vf_setup_init(struct be_adapter *adapter)
4020
{
4021
	struct be_vf_cfg *vf_cfg;
4022 4023
	int vf;

4024 4025 4026 4027 4028
	adapter->vf_cfg = kcalloc(adapter->num_vfs, sizeof(*vf_cfg),
				  GFP_KERNEL);
	if (!adapter->vf_cfg)
		return -ENOMEM;

4029 4030 4031
	for_all_vfs(adapter, vf_cfg, vf) {
		vf_cfg->if_handle = -1;
		vf_cfg->pmac_id = -1;
4032
	}
4033
	return 0;
4034 4035
}

4036 4037
static int be_vf_setup(struct be_adapter *adapter)
{
4038
	struct device *dev = &adapter->pdev->dev;
4039
	struct be_vf_cfg *vf_cfg;
4040
	int status, old_vfs, vf;
4041
	bool spoofchk;
4042

4043
	old_vfs = pci_num_vf(adapter->pdev);
4044 4045 4046 4047

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

4049 4050 4051 4052 4053 4054
	if (old_vfs) {
		for_all_vfs(adapter, vf_cfg, vf) {
			status = be_cmd_get_if_id(adapter, vf_cfg, vf);
			if (status)
				goto err;
		}
4055

4056 4057 4058 4059
		status = be_vfs_mac_query(adapter);
		if (status)
			goto err;
	} else {
4060 4061 4062 4063
		status = be_vfs_if_create(adapter);
		if (status)
			goto err;

4064 4065 4066 4067
		status = be_vf_eth_addr_config(adapter);
		if (status)
			goto err;
	}
4068

4069
	for_all_vfs(adapter, vf_cfg, vf) {
4070
		/* Allow VFs to programs MAC/VLAN filters */
4071 4072 4073
		status = be_cmd_get_fn_privileges(adapter, &vf_cfg->privileges,
						  vf + 1);
		if (!status && !(vf_cfg->privileges & BE_PRIV_FILTMGMT)) {
4074
			status = be_cmd_set_fn_privileges(adapter,
4075
							  vf_cfg->privileges |
4076 4077
							  BE_PRIV_FILTMGMT,
							  vf + 1);
4078 4079
			if (!status) {
				vf_cfg->privileges |= BE_PRIV_FILTMGMT;
4080 4081
				dev_info(dev, "VF%d has FILTMGMT privilege\n",
					 vf);
4082
			}
4083 4084
		}

4085 4086 4087
		/* Allow full available bandwidth */
		if (!old_vfs)
			be_cmd_config_qos(adapter, 0, 0, vf + 1);
4088

4089 4090 4091 4092 4093 4094
		status = be_cmd_get_hsw_config(adapter, NULL, vf + 1,
					       vf_cfg->if_handle, NULL,
					       &spoofchk);
		if (!status)
			vf_cfg->spoofchk = spoofchk;

4095
		if (!old_vfs) {
4096
			be_cmd_enable_vf(adapter, vf + 1);
4097 4098 4099 4100
			be_cmd_set_logical_link_config(adapter,
						       IFLA_VF_LINK_STATE_AUTO,
						       vf+1);
		}
4101
	}
4102 4103 4104 4105 4106 4107 4108 4109 4110

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

4112 4113 4114 4115 4116 4117 4118 4119 4120
	if (BE3_chip(adapter)) {
		/* On BE3, enable VEB only when SRIOV is enabled */
		status = be_cmd_set_hsw_config(adapter, 0, 0,
					       adapter->if_handle,
					       PORT_FWD_TYPE_VEB, 0);
		if (status)
			goto err;
	}

4121
	adapter->flags |= BE_FLAGS_SRIOV_ENABLED;
4122 4123
	return 0;
err:
4124 4125
	dev_err(dev, "VF setup failed\n");
	be_vf_clear(adapter);
4126 4127 4128
	return status;
}

4129 4130 4131 4132
/* Converting function_mode bits on BE3 to SH mc_type enums */

static u8 be_convert_mc_type(u32 function_mode)
{
4133
	if (function_mode & VNIC_MODE && function_mode & QNQ_MODE)
4134
		return vNIC1;
4135
	else if (function_mode & QNQ_MODE)
4136 4137 4138 4139 4140 4141 4142 4143 4144
		return FLEX10;
	else if (function_mode & VNIC_MODE)
		return vNIC2;
	else if (function_mode & UMC_ENABLED)
		return UMC;
	else
		return MC_NONE;
}

4145 4146 4147 4148
/* On BE2/BE3 FW does not suggest the supported limits */
static void BEx_get_resources(struct be_adapter *adapter,
			      struct be_resources *res)
{
4149
	bool use_sriov = adapter->num_vfs ? 1 : 0;
4150 4151 4152 4153 4154 4155

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

4156 4157 4158 4159 4160 4161 4162 4163 4164 4165 4166 4167 4168 4169
	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 {
4170
		res->max_vlans = BE_NUM_VLANS_SUPPORTED;
4171 4172
	}

4173 4174
	res->max_mcast_mac = BE_MAX_MC;

4175 4176 4177 4178 4179
	/* 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) ||
4180 4181 4182
	    be_virtfn(adapter) ||
	    (be_is_mc(adapter) &&
	     !(adapter->function_caps & BE_FUNCTION_CAPS_RSS))) {
4183
		res->max_tx_qs = 1;
4184 4185 4186 4187 4188 4189
	} 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
		 */
4190 4191 4192
		be_cmd_get_profile_config(adapter, &super_nic_res, NULL,
					  ACTIVE_PROFILE_TYPE, RESOURCE_LIMITS,
					  0);
4193 4194 4195
		/* 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 {
4196
		res->max_tx_qs = BE3_MAX_TX_QS;
4197
	}
4198 4199 4200 4201 4202 4203 4204

	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;

4205
	if (be_physfn(adapter))
4206
		res->max_evt_qs = (be_max_vfs(adapter) > 0) ?
4207 4208 4209
					BE3_SRIOV_MAX_EVT_QS : BE3_MAX_EVT_QS;
	else
		res->max_evt_qs = 1;
4210 4211

	res->if_cap_flags = BE_IF_CAP_FLAGS_WANT;
4212
	res->if_cap_flags &= ~BE_IF_FLAGS_DEFQ_RSS;
4213 4214 4215 4216
	if (!(adapter->function_caps & BE_FUNCTION_CAPS_RSS))
		res->if_cap_flags &= ~BE_IF_FLAGS_RSS;
}

4217 4218 4219
static void be_setup_init(struct be_adapter *adapter)
{
	adapter->vlan_prio_bmap = 0xff;
A
Ajit Khaparde 已提交
4220
	adapter->phy.link_speed = -1;
4221 4222
	adapter->if_handle = -1;
	adapter->be3_native = false;
4223
	adapter->if_flags = 0;
4224
	adapter->phy_state = BE_UNKNOWN_PHY_STATE;
4225 4226 4227 4228
	if (be_physfn(adapter))
		adapter->cmd_privileges = MAX_PRIVILEGES;
	else
		adapter->cmd_privileges = MIN_PRIVILEGES;
4229 4230
}

4231 4232 4233 4234 4235 4236 4237 4238 4239 4240 4241 4242 4243 4244 4245 4246 4247 4248 4249 4250 4251 4252 4253 4254 4255
/* HW supports only MAX_PORT_RSS_TABLES RSS Policy Tables per port.
 * However, this HW limitation is not exposed to the host via any SLI cmd.
 * As a result, in the case of SRIOV and in particular multi-partition configs
 * the driver needs to calcuate a proportional share of RSS Tables per PF-pool
 * for distribution between the VFs. This self-imposed limit will determine the
 * no: of VFs for which RSS can be enabled.
 */
void be_calculate_pf_pool_rss_tables(struct be_adapter *adapter)
{
	struct be_port_resources port_res = {0};
	u8 rss_tables_on_port;
	u16 max_vfs = be_max_vfs(adapter);

	be_cmd_get_profile_config(adapter, NULL, &port_res, SAVED_PROFILE_TYPE,
				  RESOURCE_LIMITS, 0);

	rss_tables_on_port = MAX_PORT_RSS_TABLES - port_res.nic_pfs;

	/* Each PF Pool's RSS Tables limit =
	 * PF's Max VFs / Total_Max_VFs on Port * RSS Tables on Port
	 */
	adapter->pool_res.max_rss_tables =
		max_vfs * rss_tables_on_port / port_res.max_vfs;
}

4256 4257 4258
static int be_get_sriov_config(struct be_adapter *adapter)
{
	struct be_resources res = {0};
4259
	int max_vfs, old_vfs;
4260

4261 4262
	be_cmd_get_profile_config(adapter, &res, NULL, ACTIVE_PROFILE_TYPE,
				  RESOURCE_LIMITS, 0);
4263

4264
	/* Some old versions of BE3 FW don't report max_vfs value */
4265 4266 4267 4268 4269
	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;
	}

4270
	adapter->pool_res = res;
4271

4272 4273 4274 4275
	/* 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.
	 */
4276 4277
	old_vfs = pci_num_vf(adapter->pdev);
	if (old_vfs) {
4278 4279 4280 4281 4282
		dev_info(&adapter->pdev->dev, "%d VFs are already enabled\n",
			 old_vfs);

		adapter->pool_res.max_vfs =
			pci_sriov_get_totalvfs(adapter->pdev);
4283 4284 4285
		adapter->num_vfs = old_vfs;
	}

4286 4287 4288 4289 4290 4291
	if (skyhawk_chip(adapter) && be_max_vfs(adapter) && !old_vfs) {
		be_calculate_pf_pool_rss_tables(adapter);
		dev_info(&adapter->pdev->dev,
			 "RSS can be enabled for all VFs if num_vfs <= %d\n",
			 be_max_pf_pool_rss_tables(adapter));
	}
4292 4293 4294
	return 0;
}

4295 4296 4297
static void be_alloc_sriov_res(struct be_adapter *adapter)
{
	int old_vfs = pci_num_vf(adapter->pdev);
4298
	struct  be_resources vft_res = {0};
4299 4300 4301 4302 4303 4304 4305 4306 4307 4308 4309 4310 4311
	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) {
4312
		be_calculate_vf_res(adapter, 0, &vft_res);
4313
		status = be_cmd_set_sriov_config(adapter, adapter->pool_res, 0,
4314
						 &vft_res);
4315 4316 4317 4318 4319 4320
		if (status)
			dev_err(&adapter->pdev->dev,
				"Failed to optimize SRIOV resources\n");
	}
}

4321
static int be_get_resources(struct be_adapter *adapter)
4322
{
4323 4324 4325
	struct device *dev = &adapter->pdev->dev;
	struct be_resources res = {0};
	int status;
4326

4327 4328 4329 4330
	/* 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
	 */
4331 4332 4333
	if (BEx_chip(adapter)) {
		BEx_get_resources(adapter, &res);
	} else {
4334 4335 4336
		status = be_cmd_get_func_config(adapter, &res);
		if (status)
			return status;
4337

4338 4339 4340 4341
		/* 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;
4342
	}
4343

4344 4345 4346 4347 4348
	/* If RoCE is supported stash away half the EQs for RoCE */
	res.max_nic_evt_qs = be_roce_supported(adapter) ?
				res.max_evt_qs / 2 : res.max_evt_qs;
	adapter->res = res;

4349 4350 4351 4352 4353 4354
	/* 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 已提交
4355 4356
	dev_info(dev, "Max: txqs %d, rxqs %d, rss %d, eqs %d, vfs %d\n",
		 be_max_txqs(adapter), be_max_rxqs(adapter),
4357
		 be_max_rss(adapter), be_max_nic_eqs(adapter),
S
Sathya Perla 已提交
4358 4359 4360 4361 4362
		 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));

4363 4364 4365 4366 4367
	/* Ensure RX and TX queues are created in pairs at init time */
	adapter->cfg_num_rx_irqs =
				min_t(u16, netif_get_num_default_rss_queues(),
				      be_max_qp_irqs(adapter));
	adapter->cfg_num_tx_irqs = adapter->cfg_num_rx_irqs;
4368
	return 0;
4369 4370
}

4371 4372
static int be_get_config(struct be_adapter *adapter)
{
4373
	int status, level;
4374
	u16 profile_id;
4375

4376 4377 4378 4379
	status = be_cmd_get_cntl_attributes(adapter);
	if (status)
		return status;

4380
	status = be_cmd_query_fw_cfg(adapter);
4381
	if (status)
4382
		return status;
4383

4384 4385 4386
	if (!lancer_chip(adapter) && be_physfn(adapter))
		be_cmd_get_fat_dump_len(adapter, &adapter->fat_dump_len);

4387 4388 4389 4390 4391 4392 4393
	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);
4394 4395
	pci_enable_wake(adapter->pdev, PCI_D3hot, adapter->wol_en);
	pci_enable_wake(adapter->pdev, PCI_D3cold, adapter->wol_en);
4396

4397 4398 4399
	be_cmd_query_port_name(adapter);

	if (be_physfn(adapter)) {
4400 4401 4402 4403
		status = be_cmd_get_active_profile(adapter, &profile_id);
		if (!status)
			dev_info(&adapter->pdev->dev,
				 "Using profile 0x%x\n", profile_id);
4404
	}
4405

4406
	return 0;
4407 4408
}

4409 4410 4411 4412 4413 4414 4415 4416 4417 4418 4419 4420 4421 4422 4423 4424 4425
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;
}

4426 4427 4428 4429 4430 4431
static void be_schedule_worker(struct be_adapter *adapter)
{
	schedule_delayed_work(&adapter->work, msecs_to_jiffies(1000));
	adapter->flags |= BE_FLAGS_WORKER_SCHEDULED;
}

4432
static void be_schedule_err_detection(struct be_adapter *adapter, u32 delay)
4433 4434
{
	schedule_delayed_work(&adapter->be_err_detection_work,
4435
			      msecs_to_jiffies(delay));
4436 4437 4438
	adapter->flags |= BE_FLAGS_ERR_DETECTION_SCHEDULED;
}

4439
static int be_setup_queues(struct be_adapter *adapter)
4440
{
4441
	struct net_device *netdev = adapter->netdev;
S
Sathya Perla 已提交
4442
	int status;
4443

4444
	status = be_evt_queues_create(adapter);
4445 4446
	if (status)
		goto err;
4447

4448
	status = be_tx_qs_create(adapter);
4449 4450
	if (status)
		goto err;
S
Sathya Perla 已提交
4451

4452
	status = be_rx_cqs_create(adapter);
S
Sathya Perla 已提交
4453
	if (status)
4454
		goto err;
S
Sathya Perla 已提交
4455

4456
	status = be_mcc_queues_create(adapter);
S
Sathya Perla 已提交
4457 4458 4459
	if (status)
		goto err;

4460 4461 4462 4463 4464 4465 4466 4467
	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;

4468 4469 4470 4471 4472 4473
	return 0;
err:
	dev_err(&adapter->pdev->dev, "queue_setup failed\n");
	return status;
}

4474 4475 4476 4477 4478 4479
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;

4480
	if (adapter->cfg_num_rx_irqs == 1)
4481 4482 4483 4484 4485 4486 4487 4488 4489 4490
		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;
}

4491 4492 4493 4494 4495 4496 4497 4498 4499 4500 4501 4502 4503 4504 4505 4506 4507
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);
4508 4509 4510
	status = be_cmd_if_destroy(adapter, adapter->if_handle,  0);
	if (status)
		return status;
4511 4512 4513 4514 4515 4516 4517

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

4518 4519 4520 4521
	status = be_if_create(adapter);
	if (status)
		return status;

4522 4523 4524 4525 4526 4527 4528 4529 4530 4531 4532 4533
	status = be_setup_queues(adapter);
	if (status)
		return status;

	be_schedule_worker(adapter);

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

	return status;
}

4534 4535 4536 4537 4538 4539 4540 4541 4542 4543 4544
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;
}

4545 4546 4547 4548 4549 4550 4551 4552 4553 4554 4555 4556 4557 4558 4559 4560 4561 4562 4563 4564 4565 4566 4567 4568
/* 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 */
4569
		be_clear_error(adapter, BE_CLEAR_ALL);
4570 4571 4572 4573 4574 4575 4576 4577 4578 4579 4580 4581 4582
	}

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

4583 4584 4585 4586 4587
static int be_setup(struct be_adapter *adapter)
{
	struct device *dev = &adapter->pdev->dev;
	int status;

4588 4589 4590 4591
	status = be_func_init(adapter);
	if (status)
		return status;

4592 4593 4594 4595 4596
	be_setup_init(adapter);

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

4597 4598 4599 4600 4601 4602 4603 4604
	/* 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;
	}
4605

4606 4607 4608 4609
	status = be_get_config(adapter);
	if (status)
		goto err;

4610 4611 4612
	if (!BE2_chip(adapter) && be_physfn(adapter))
		be_alloc_sriov_res(adapter);

4613
	status = be_get_resources(adapter);
S
Sathya Perla 已提交
4614
	if (status)
4615
		goto err;
S
Sathya Perla 已提交
4616

4617 4618 4619 4620 4621
	adapter->pmac_id = kcalloc(be_max_uc(adapter),
				   sizeof(*adapter->pmac_id), GFP_KERNEL);
	if (!adapter->pmac_id)
		return -ENOMEM;

4622
	status = be_msix_enable(adapter);
S
Sathya Perla 已提交
4623
	if (status)
4624
		goto err;
S
Sathya Perla 已提交
4625

4626
	/* will enable all the needed filter flags in be_open() */
4627
	status = be_if_create(adapter);
4628
	if (status)
4629
		goto err;
S
Sathya Perla 已提交
4630

4631 4632
	/* Updating real_num_tx/rx_queues() requires rtnl_lock() */
	rtnl_lock();
4633
	status = be_setup_queues(adapter);
4634
	rtnl_unlock();
4635
	if (status)
4636 4637
		goto err;

4638 4639 4640
	be_cmd_get_fn_privileges(adapter, &adapter->cmd_privileges, 0);

	status = be_mac_setup(adapter);
S
Sathya Perla 已提交
4641 4642 4643
	if (status)
		goto err;

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

4647
	if (BE2_chip(adapter) && fw_major_num(adapter->fw_ver) < 4) {
V
Vasundhara Volam 已提交
4648
		dev_err(dev, "Firmware on card is old(%s), IRQs may not work",
4649 4650 4651 4652
			adapter->fw_ver);
		dev_err(dev, "Please upgrade firmware to version >= 4.0\n");
	}

4653 4654 4655 4656 4657
	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);
4658

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

4662 4663 4664 4665
	if (be_physfn(adapter))
		be_cmd_set_logical_link_config(adapter,
					       IFLA_VF_LINK_STATE_AUTO, 0);

4666 4667 4668 4669 4670 4671 4672 4673 4674
	/* BE3 EVB echoes broadcast/multicast packets back to PF's vport
	 * confusing a linux bridge or OVS that it might be connected to.
	 * Set the EVB to PASSTHRU mode which effectively disables the EVB
	 * when SRIOV is not enabled.
	 */
	if (BE3_chip(adapter))
		be_cmd_set_hsw_config(adapter, 0, 0, adapter->if_handle,
				      PORT_FWD_TYPE_PASSTHRU, 0);

4675 4676
	if (adapter->num_vfs)
		be_vf_setup(adapter);
4677

4678 4679
	status = be_cmd_get_phy_info(adapter);
	if (!status && be_pause_supported(adapter))
A
Ajit Khaparde 已提交
4680 4681
		adapter->phy.fc_autoneg = 1;

4682
	be_schedule_worker(adapter);
4683
	adapter->flags |= BE_FLAGS_SETUP_DONE;
4684
	return 0;
4685 4686 4687 4688
err:
	be_clear(adapter);
	return status;
}
S
Sathya Perla 已提交
4689

I
Ivan Vecera 已提交
4690 4691 4692 4693
#ifdef CONFIG_NET_POLL_CONTROLLER
static void be_netpoll(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
4694
	struct be_eq_obj *eqo;
I
Ivan Vecera 已提交
4695 4696
	int i;

4697
	for_all_evt_queues(adapter, eqo, i) {
4698
		be_eq_notify(eqo->adapter, eqo->q.id, false, true, 0, 0);
4699 4700
		napi_schedule(&eqo->napi);
	}
I
Ivan Vecera 已提交
4701 4702 4703
}
#endif

4704 4705 4706 4707 4708 4709 4710 4711
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");
4712
		return -ENETDOWN;
4713 4714 4715 4716 4717 4718 4719 4720 4721 4722 4723 4724 4725
	}

	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 已提交
4726
	if (!status)
4727
		be_cmd_get_fw_ver(adapter);
S
Somnath Kotur 已提交
4728

4729 4730 4731 4732 4733
fw_exit:
	release_firmware(fw);
	return status;
}

4734 4735
static int be_ndo_bridge_setlink(struct net_device *dev, struct nlmsghdr *nlh,
				 u16 flags)
4736 4737 4738 4739 4740 4741 4742 4743 4744 4745 4746
{
	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);
4747 4748
	if (!br_spec)
		return -EINVAL;
4749 4750 4751 4752 4753

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

4754 4755 4756
		if (nla_len(attr) < sizeof(mode))
			return -EINVAL;

4757
		mode = nla_get_u16(attr);
4758 4759 4760
		if (BE3_chip(adapter) && mode == BRIDGE_MODE_VEPA)
			return -EOPNOTSUPP;

4761 4762 4763 4764 4765 4766 4767
		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 :
4768
					       PORT_FWD_TYPE_VEB, 0);
4769 4770 4771 4772 4773 4774 4775 4776 4777 4778 4779 4780 4781 4782 4783 4784
		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,
4785 4786
				 struct net_device *dev, u32 filter_mask,
				 int nlflags)
4787 4788 4789 4790 4791 4792 4793
{
	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)) {
4794 4795 4796
		/* VEB is disabled in non-SR-IOV profiles on BE3/Lancer */
		if (!pci_sriov_get_totalvfs(adapter->pdev))
			return 0;
4797 4798 4799
		hsw_mode = PORT_FWD_TYPE_VEB;
	} else {
		status = be_cmd_get_hsw_config(adapter, NULL, 0,
4800 4801
					       adapter->if_handle, &hsw_mode,
					       NULL);
4802 4803
		if (status)
			return 0;
4804 4805 4806

		if (hsw_mode == PORT_FWD_TYPE_PASSTHRU)
			return 0;
4807 4808 4809 4810
	}

	return ndo_dflt_bridge_getlink(skb, pid, seq, dev,
				       hsw_mode == PORT_FWD_TYPE_VEPA ?
4811
				       BRIDGE_MODE_VEPA : BRIDGE_MODE_VEB,
4812
				       0, 0, nlflags, filter_mask, NULL);
4813 4814
}

4815 4816 4817 4818 4819 4820
/* 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
4821 4822 4823
 * 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().
4824 4825 4826 4827 4828
 *
 * 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.
 */
4829 4830
static void be_add_vxlan_port(struct net_device *netdev,
			      struct udp_tunnel_info *ti)
4831 4832 4833
{
	struct be_adapter *adapter = netdev_priv(netdev);
	struct device *dev = &adapter->pdev->dev;
4834
	__be16 port = ti->port;
4835 4836
	int status;

4837 4838 4839
	if (ti->type != UDP_TUNNEL_TYPE_VXLAN)
		return;

4840
	if (lancer_chip(adapter) || BEx_chip(adapter) || be_is_mc(adapter))
4841 4842
		return;

4843 4844 4845 4846 4847
	if (adapter->vxlan_port == port && adapter->vxlan_port_count) {
		adapter->vxlan_port_aliases++;
		return;
	}

4848 4849 4850
	if (adapter->flags & BE_FLAGS_VXLAN_OFFLOADS) {
		dev_info(dev,
			 "Only one UDP port supported for VxLAN offloads\n");
4851 4852 4853
		dev_info(dev, "Disabling VxLAN offloads\n");
		adapter->vxlan_port_count++;
		goto err;
4854 4855
	}

4856 4857 4858
	if (adapter->vxlan_port_count++ >= 1)
		return;

4859 4860 4861 4862 4863 4864 4865 4866 4867 4868 4869 4870 4871 4872 4873
	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;

4874 4875 4876 4877
	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;
4878
	netdev->features |= NETIF_F_GSO_UDP_TUNNEL;
4879

4880 4881 4882 4883 4884 4885 4886
	dev_info(dev, "Enabled VxLAN offloads for UDP port %d\n",
		 be16_to_cpu(port));
	return;
err:
	be_disable_vxlan_offloads(adapter);
}

4887 4888
static void be_del_vxlan_port(struct net_device *netdev,
			      struct udp_tunnel_info *ti)
4889 4890
{
	struct be_adapter *adapter = netdev_priv(netdev);
4891 4892 4893 4894
	__be16 port = ti->port;

	if (ti->type != UDP_TUNNEL_TYPE_VXLAN)
		return;
4895

4896
	if (lancer_chip(adapter) || BEx_chip(adapter) || be_is_mc(adapter))
4897 4898 4899
		return;

	if (adapter->vxlan_port != port)
4900
		goto done;
4901

4902 4903 4904 4905 4906
	if (adapter->vxlan_port_aliases) {
		adapter->vxlan_port_aliases--;
		return;
	}

4907 4908 4909 4910 4911
	be_disable_vxlan_offloads(adapter);

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

4916 4917 4918
static netdev_features_t be_features_check(struct sk_buff *skb,
					   struct net_device *dev,
					   netdev_features_t features)
J
Joe Stringer 已提交
4919
{
4920 4921 4922 4923 4924 4925 4926 4927 4928 4929 4930 4931 4932 4933 4934 4935 4936 4937 4938 4939 4940 4941 4942 4943 4944 4945 4946 4947 4948 4949 4950 4951
	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))
4952
		return features & ~(NETIF_F_CSUM_MASK | NETIF_F_GSO_MASK);
4953 4954

	return features;
J
Joe Stringer 已提交
4955
}
4956

4957 4958 4959 4960 4961 4962 4963 4964 4965 4966 4967 4968 4969 4970 4971 4972 4973 4974 4975 4976 4977
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;
}

4978
static const struct net_device_ops be_netdev_ops = {
S
Sathya Perla 已提交
4979 4980 4981
	.ndo_open		= be_open,
	.ndo_stop		= be_close,
	.ndo_start_xmit		= be_xmit,
4982
	.ndo_set_rx_mode	= be_set_rx_mode,
S
Sathya Perla 已提交
4983 4984
	.ndo_set_mac_address	= be_mac_addr_set,
	.ndo_change_mtu		= be_change_mtu,
4985
	.ndo_get_stats64	= be_get_stats64,
S
Sathya Perla 已提交
4986 4987 4988
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_vlan_rx_add_vid	= be_vlan_add_vid,
	.ndo_vlan_rx_kill_vid	= be_vlan_rem_vid,
4989
	.ndo_set_vf_mac		= be_set_vf_mac,
4990
	.ndo_set_vf_vlan	= be_set_vf_vlan,
4991
	.ndo_set_vf_rate	= be_set_vf_tx_rate,
I
Ivan Vecera 已提交
4992
	.ndo_get_vf_config	= be_get_vf_config,
4993
	.ndo_set_vf_link_state  = be_set_vf_link_state,
4994
	.ndo_set_vf_spoofchk    = be_set_vf_spoofchk,
I
Ivan Vecera 已提交
4995 4996 4997
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= be_netpoll,
#endif
4998 4999
	.ndo_bridge_setlink	= be_ndo_bridge_setlink,
	.ndo_bridge_getlink	= be_ndo_bridge_getlink,
5000
#ifdef CONFIG_NET_RX_BUSY_POLL
5001
	.ndo_busy_poll		= be_busy_poll,
5002
#endif
5003 5004
	.ndo_udp_tunnel_add	= be_add_vxlan_port,
	.ndo_udp_tunnel_del	= be_del_vxlan_port,
5005
	.ndo_features_check	= be_features_check,
5006
	.ndo_get_phys_port_id   = be_get_phys_port_id,
S
Sathya Perla 已提交
5007 5008 5009 5010 5011 5012
};

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

5013
	netdev->hw_features |= NETIF_F_SG | NETIF_F_TSO | NETIF_F_TSO6 |
5014
		NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM | NETIF_F_RXCSUM |
5015
		NETIF_F_HW_VLAN_CTAG_TX;
5016
	if ((be_if_cap_flags(adapter) & BE_IF_FLAGS_RSS))
5017
		netdev->hw_features |= NETIF_F_RXHASH;
5018 5019

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

5022
	netdev->vlan_features |= NETIF_F_SG | NETIF_F_TSO | NETIF_F_TSO6 |
5023
		NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM;
5024

5025 5026
	netdev->priv_flags |= IFF_UNICAST_FLT;

S
Sathya Perla 已提交
5027 5028
	netdev->flags |= IFF_MULTICAST;

5029
	netif_set_gso_max_size(netdev, BE_MAX_GSO_SIZE - ETH_HLEN);
5030

S
Sathya Perla 已提交
5031
	netdev->netdev_ops = &be_netdev_ops;
S
Sathya Perla 已提交
5032

5033
	netdev->ethtool_ops = &be_ethtool_ops;
S
Sathya Perla 已提交
5034 5035
}

5036 5037 5038 5039 5040 5041 5042 5043 5044 5045 5046 5047 5048
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);
}

5049
static int be_resume(struct be_adapter *adapter)
5050
{
5051
	struct net_device *netdev = adapter->netdev;
5052 5053 5054 5055
	int status;

	status = be_setup(adapter);
	if (status)
5056
		return status;
5057

5058 5059
	rtnl_lock();
	if (netif_running(netdev))
5060
		status = be_open(netdev);
5061 5062 5063 5064
	rtnl_unlock();

	if (status)
		return status;
5065

5066 5067
	netif_device_attach(netdev);

5068 5069 5070 5071 5072 5073 5074
	return 0;
}

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

5075 5076 5077 5078 5079 5080 5081 5082 5083 5084 5085 5086 5087
	/* 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);

5088 5089 5090 5091
	status = be_resume(adapter);
	if (status)
		goto err;

5092 5093 5094 5095 5096
	return 0;
err:
	return status;
}

5097
static void be_err_detection_task(struct work_struct *work)
5098 5099
{
	struct be_adapter *adapter =
5100 5101
				container_of(work, struct be_adapter,
					     be_err_detection_work.work);
5102 5103
	struct device *dev = &adapter->pdev->dev;
	int recovery_status;
5104
	int delay = ERR_DETECTION_DELAY;
5105 5106 5107

	be_detect_error(adapter);

5108 5109 5110 5111 5112 5113
	if (be_check_error(adapter, BE_ERROR_HW))
		recovery_status = be_err_recover(adapter);
	else
		goto reschedule_task;

	if (!recovery_status) {
5114
		adapter->recovery_retries = 0;
5115 5116 5117 5118 5119 5120 5121 5122
		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;
5123 5124 5125 5126 5127 5128 5129 5130 5131
	} 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;
5132 5133
	} else {
		dev_err(dev, "Adapter recovery failed\n");
5134 5135
	}

5136 5137
	return;
reschedule_task:
5138
	be_schedule_err_detection(adapter, delay);
5139 5140 5141 5142 5143 5144 5145 5146 5147
}

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,
5148 5149 5150 5151
			"Port %c: %s Vendor: %s part no: %s",
			adapter->port_name,
			be_misconfig_evt_port_state[adapter->phy_state],
			adapter->phy.vendor_name,
5152 5153
			adapter->phy.vendor_pn);
	}
5154
	adapter->flags &= ~BE_FLAGS_PHY_MISCONFIGURED;
5155 5156 5157 5158 5159 5160 5161 5162 5163
}

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;

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

5168 5169 5170 5171 5172 5173 5174 5175 5176 5177 5178 5179 5180 5181 5182 5183 5184 5185 5186 5187 5188 5189 5190 5191 5192 5193
	/* 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);
	}

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

5194 5195 5196
	/* EQ-delay update for Skyhawk is done while notifying EQ */
	if (!skyhawk_chip(adapter))
		be_eqd_update(adapter, false);
5197

5198
	if (adapter->flags & BE_FLAGS_PHY_MISCONFIGURED)
5199 5200 5201 5202 5203 5204 5205
		be_log_sfp_info(adapter);

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

S
Sathya Perla 已提交
5206 5207
static void be_unmap_pci_bars(struct be_adapter *adapter)
{
5208 5209
	if (adapter->csr)
		pci_iounmap(adapter->pdev, adapter->csr);
5210
	if (adapter->db)
S
Sathya Perla 已提交
5211
		pci_iounmap(adapter->pdev, adapter->db);
5212 5213
	if (adapter->pcicfg && adapter->pcicfg_mapped)
		pci_iounmap(adapter->pdev, adapter->pcicfg);
5214 5215
}

S
Sathya Perla 已提交
5216 5217
static int db_bar(struct be_adapter *adapter)
{
5218
	if (lancer_chip(adapter) || be_virtfn(adapter))
S
Sathya Perla 已提交
5219 5220 5221 5222 5223 5224
		return 0;
	else
		return 4;
}

static int be_roce_map_pci_bars(struct be_adapter *adapter)
5225
{
S
Sathya Perla 已提交
5226
	if (skyhawk_chip(adapter)) {
S
Sathya Perla 已提交
5227 5228 5229 5230 5231 5232
		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));
	}
5233
	return 0;
S
Sathya Perla 已提交
5234 5235 5236 5237
}

static int be_map_pci_bars(struct be_adapter *adapter)
{
5238
	struct pci_dev *pdev = adapter->pdev;
S
Sathya Perla 已提交
5239
	u8 __iomem *addr;
5240 5241 5242 5243 5244 5245
	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;
5246

5247
	if (BEx_chip(adapter) && be_physfn(adapter)) {
5248
		adapter->csr = pci_iomap(pdev, 2, 0);
K
Kalesh AP 已提交
5249
		if (!adapter->csr)
5250 5251 5252
			return -ENOMEM;
	}

5253
	addr = pci_iomap(pdev, db_bar(adapter), 0);
K
Kalesh AP 已提交
5254
	if (!addr)
S
Sathya Perla 已提交
5255
		goto pci_map_err;
5256
	adapter->db = addr;
S
Sathya Perla 已提交
5257

5258 5259 5260 5261 5262 5263 5264
	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;
5265
			adapter->pcicfg_mapped = true;
5266 5267
		} else {
			adapter->pcicfg = adapter->db + SRIOV_VF_PCICFG_OFFSET;
5268
			adapter->pcicfg_mapped = false;
5269 5270 5271
		}
	}

S
Sathya Perla 已提交
5272
	be_roce_map_pci_bars(adapter);
S
Sathya Perla 已提交
5273
	return 0;
S
Sathya Perla 已提交
5274

S
Sathya Perla 已提交
5275
pci_map_err:
5276
	dev_err(&pdev->dev, "Error in mapping PCI BARs\n");
S
Sathya Perla 已提交
5277 5278 5279 5280
	be_unmap_pci_bars(adapter);
	return -ENOMEM;
}

5281
static void be_drv_cleanup(struct be_adapter *adapter)
S
Sathya Perla 已提交
5282
{
5283
	struct be_dma_mem *mem = &adapter->mbox_mem_alloced;
5284
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
5285 5286

	if (mem->va)
5287
		dma_free_coherent(dev, mem->size, mem->va, mem->dma);
5288

5289
	mem = &adapter->rx_filter;
5290
	if (mem->va)
5291 5292 5293 5294 5295
		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 已提交
5296 5297
}

5298 5299
/* Allocate and initialize various fields in be_adapter struct */
static int be_drv_init(struct be_adapter *adapter)
S
Sathya Perla 已提交
5300
{
5301 5302
	struct be_dma_mem *mbox_mem_alloc = &adapter->mbox_mem_alloced;
	struct be_dma_mem *mbox_mem_align = &adapter->mbox_mem;
5303
	struct be_dma_mem *rx_filter = &adapter->rx_filter;
5304 5305 5306
	struct be_dma_mem *stats_cmd = &adapter->stats_cmd;
	struct device *dev = &adapter->pdev->dev;
	int status = 0;
S
Sathya Perla 已提交
5307 5308

	mbox_mem_alloc->size = sizeof(struct be_mcc_mailbox) + 16;
5309 5310 5311
	mbox_mem_alloc->va = dma_zalloc_coherent(dev, mbox_mem_alloc->size,
						 &mbox_mem_alloc->dma,
						 GFP_KERNEL);
5312 5313 5314
	if (!mbox_mem_alloc->va)
		return -ENOMEM;

S
Sathya Perla 已提交
5315 5316 5317
	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);
5318

5319
	rx_filter->size = sizeof(struct be_cmd_req_rx_filter);
5320 5321
	rx_filter->va = dma_zalloc_coherent(dev, rx_filter->size,
					    &rx_filter->dma, GFP_KERNEL);
K
Kalesh AP 已提交
5322
	if (!rx_filter->va) {
5323 5324 5325
		status = -ENOMEM;
		goto free_mbox;
	}
5326

5327 5328 5329 5330 5331 5332 5333 5334 5335 5336 5337 5338 5339 5340 5341
	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;
	}

5342
	mutex_init(&adapter->mbox_lock);
5343 5344
	spin_lock_init(&adapter->mcc_lock);
	spin_lock_init(&adapter->mcc_cq_lock);
5345
	init_completion(&adapter->et_cmd_compl);
5346

5347
	pci_save_state(adapter->pdev);
S
Sathya Perla 已提交
5348

5349
	INIT_DELAYED_WORK(&adapter->work, be_worker);
5350 5351
	INIT_DELAYED_WORK(&adapter->be_err_detection_work,
			  be_err_detection_task);
S
Sathya Perla 已提交
5352

5353 5354
	adapter->rx_fc = true;
	adapter->tx_fc = true;
S
Sathya Perla 已提交
5355

5356 5357
	/* Must be a power of 2 or else MODULO will BUG_ON */
	adapter->be_get_temp_freq = 64;
5358

S
Sathya Perla 已提交
5359
	return 0;
5360 5361 5362 5363 5364 5365 5366

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 已提交
5367 5368
}

B
Bill Pemberton 已提交
5369
static void be_remove(struct pci_dev *pdev)
S
Sathya Perla 已提交
5370 5371
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);
5372

S
Sathya Perla 已提交
5373 5374 5375
	if (!adapter)
		return;

5376
	be_roce_dev_remove(adapter);
5377
	be_intr_set(adapter, false);
5378

5379
	be_cancel_err_detection(adapter);
5380

S
Sathya Perla 已提交
5381 5382
	unregister_netdev(adapter->netdev);

5383 5384
	be_clear(adapter);

5385 5386 5387
	/* tell fw we're done with firing cmds */
	be_cmd_fw_clean(adapter);

5388 5389
	be_unmap_pci_bars(adapter);
	be_drv_cleanup(adapter);
S
Sathya Perla 已提交
5390

S
Sathya Perla 已提交
5391 5392
	pci_disable_pcie_error_reporting(pdev);

S
Sathya Perla 已提交
5393 5394 5395 5396 5397 5398
	pci_release_regions(pdev);
	pci_disable_device(pdev);

	free_netdev(adapter->netdev);
}

5399 5400 5401
static ssize_t be_hwmon_show_temp(struct device *dev,
				  struct device_attribute *dev_attr,
				  char *buf)
5402 5403 5404 5405 5406 5407 5408 5409 5410 5411 5412 5413 5414 5415 5416 5417 5418 5419 5420 5421 5422
{
	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 已提交
5423 5424
static char *mc_name(struct be_adapter *adapter)
{
5425 5426 5427 5428 5429 5430 5431 5432 5433 5434 5435 5436 5437 5438 5439 5440 5441 5442 5443 5444 5445 5446 5447 5448 5449 5450
	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 已提交
5451 5452 5453 5454 5455 5456 5457
}

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

5458 5459 5460 5461 5462 5463 5464 5465 5466 5467 5468 5469 5470 5471 5472 5473 5474 5475 5476 5477
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;
	}
}

5478
static int be_probe(struct pci_dev *pdev, const struct pci_device_id *pdev_id)
S
Sathya Perla 已提交
5479 5480 5481
{
	struct be_adapter *adapter;
	struct net_device *netdev;
5482
	int status = 0;
S
Sathya Perla 已提交
5483

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

S
Sathya Perla 已提交
5486 5487 5488 5489 5490 5491 5492 5493 5494
	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);

5495
	netdev = alloc_etherdev_mqs(sizeof(*adapter), MAX_TX_QS, MAX_RX_QS);
K
Kalesh AP 已提交
5496
	if (!netdev) {
S
Sathya Perla 已提交
5497 5498 5499 5500 5501 5502 5503
		status = -ENOMEM;
		goto rel_reg;
	}
	adapter = netdev_priv(netdev);
	adapter->pdev = pdev;
	pci_set_drvdata(pdev, adapter);
	adapter->netdev = netdev;
5504
	SET_NETDEV_DEV(netdev, &pdev->dev);
S
Sathya Perla 已提交
5505

5506
	status = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
S
Sathya Perla 已提交
5507 5508 5509
	if (!status) {
		netdev->features |= NETIF_F_HIGHDMA;
	} else {
5510
		status = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
S
Sathya Perla 已提交
5511 5512 5513 5514 5515 5516
		if (status) {
			dev_err(&pdev->dev, "Could not set PCI DMA Mask\n");
			goto free_netdev;
		}
	}

5517 5518 5519
	status = pci_enable_pcie_error_reporting(pdev);
	if (!status)
		dev_info(&pdev->dev, "PCIe error reporting enabled\n");
S
Sathya Perla 已提交
5520

5521
	status = be_map_pci_bars(adapter);
S
Sathya Perla 已提交
5522
	if (status)
5523
		goto free_netdev;
S
Sathya Perla 已提交
5524

5525 5526 5527 5528
	status = be_drv_init(adapter);
	if (status)
		goto unmap_bars;

5529 5530
	status = be_setup(adapter);
	if (status)
5531
		goto drv_cleanup;
5532

5533
	be_netdev_init(netdev);
S
Sathya Perla 已提交
5534 5535
	status = register_netdev(netdev);
	if (status != 0)
5536
		goto unsetup;
S
Sathya Perla 已提交
5537

5538 5539
	be_roce_dev_add(adapter);

5540
	be_schedule_err_detection(adapter, ERR_DETECTION_DELAY);
5541

5542
	/* On Die temperature not supported for VF. */
5543
	if (be_physfn(adapter) && IS_ENABLED(CONFIG_BE2NET_HWMON)) {
5544 5545 5546 5547 5548 5549 5550 5551
		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 已提交
5552
	dev_info(&pdev->dev, "%s: %s %s port %c\n", nic_name(pdev),
5553
		 func_name(adapter), mc_name(adapter), adapter->port_name);
5554

S
Sathya Perla 已提交
5555 5556
	return 0;

5557 5558
unsetup:
	be_clear(adapter);
5559 5560 5561 5562
drv_cleanup:
	be_drv_cleanup(adapter);
unmap_bars:
	be_unmap_pci_bars(adapter);
5563
free_netdev:
5564
	free_netdev(netdev);
S
Sathya Perla 已提交
5565 5566 5567 5568 5569
rel_reg:
	pci_release_regions(pdev);
disable_dev:
	pci_disable_device(pdev);
do_none:
5570
	dev_err(&pdev->dev, "%s initialization failed\n", nic_name(pdev));
S
Sathya Perla 已提交
5571 5572 5573 5574 5575 5576 5577
	return status;
}

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

5578
	be_intr_set(adapter, false);
5579
	be_cancel_err_detection(adapter);
5580

5581
	be_cleanup(adapter);
S
Sathya Perla 已提交
5582 5583 5584 5585 5586 5587 5588

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

5589
static int be_pci_resume(struct pci_dev *pdev)
S
Sathya Perla 已提交
5590 5591
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);
5592
	int status = 0;
S
Sathya Perla 已提交
5593 5594 5595 5596 5597 5598 5599

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

	pci_restore_state(pdev);

5600
	status = be_resume(adapter);
5601 5602 5603
	if (status)
		return status;

5604
	be_schedule_err_detection(adapter, ERR_DETECTION_DELAY);
5605

S
Sathya Perla 已提交
5606 5607 5608
	return 0;
}

5609 5610 5611 5612 5613 5614 5615
/*
 * 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);

5616 5617
	if (!adapter)
		return;
5618

5619
	be_roce_dev_shutdown(adapter);
5620
	cancel_delayed_work_sync(&adapter->work);
5621
	be_cancel_err_detection(adapter);
5622

5623
	netif_device_detach(adapter->netdev);
5624

5625 5626
	be_cmd_reset_function(adapter);

5627 5628 5629
	pci_disable_device(pdev);
}

5630
static pci_ers_result_t be_eeh_err_detected(struct pci_dev *pdev,
5631
					    pci_channel_state_t state)
5632 5633 5634 5635 5636
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);

	dev_err(&adapter->pdev->dev, "EEH error detected\n");

5637 5638
	be_roce_dev_remove(adapter);

5639 5640
	if (!be_check_error(adapter, BE_ERROR_EEH)) {
		be_set_error(adapter, BE_ERROR_EEH);
5641

5642
		be_cancel_err_detection(adapter);
5643

5644
		be_cleanup(adapter);
5645 5646 5647 5648 5649 5650 5651
	}

	if (state == pci_channel_io_perm_failure)
		return PCI_ERS_RESULT_DISCONNECT;

	pci_disable_device(pdev);

5652 5653
	/* The error could cause the FW to trigger a flash debug dump.
	 * Resetting the card while flash dump is in progress
5654 5655 5656
	 * can cause it not to recover; wait for it to finish.
	 * Wait only for first function as it is needed only once per
	 * adapter.
5657
	 */
5658 5659 5660
	if (pdev->devfn == 0)
		ssleep(30);

5661 5662 5663 5664 5665 5666 5667 5668 5669 5670 5671 5672 5673 5674 5675 5676 5677 5678
	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 */
5679 5680
	dev_info(&adapter->pdev->dev,
		 "Waiting for FW to be ready after EEH reset\n");
5681
	status = be_fw_wait_ready(adapter);
5682 5683 5684
	if (status)
		return PCI_ERS_RESULT_DISCONNECT;

S
Sathya Perla 已提交
5685
	pci_cleanup_aer_uncorrect_error_status(pdev);
5686
	be_clear_error(adapter, BE_CLEAR_ALL);
5687 5688 5689 5690 5691 5692 5693 5694 5695 5696 5697 5698
	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);

5699
	status = be_resume(adapter);
5700 5701 5702
	if (status)
		goto err;

5703 5704
	be_roce_dev_add(adapter);

5705
	be_schedule_err_detection(adapter, ERR_DETECTION_DELAY);
5706 5707 5708 5709 5710
	return;
err:
	dev_err(&adapter->pdev->dev, "EEH resume failed\n");
}

5711 5712 5713
static int be_pci_sriov_configure(struct pci_dev *pdev, int num_vfs)
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);
5714
	struct be_resources vft_res = {0};
5715 5716 5717 5718 5719 5720 5721 5722 5723 5724 5725 5726 5727 5728 5729 5730 5731 5732 5733 5734 5735 5736
	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)) {
5737 5738
		be_calculate_vf_res(adapter, adapter->num_vfs,
				    &vft_res);
5739
		status = be_cmd_set_sriov_config(adapter, adapter->pool_res,
5740
						 adapter->num_vfs, &vft_res);
5741 5742 5743 5744 5745 5746 5747 5748 5749 5750 5751 5752 5753 5754 5755 5756 5757 5758 5759 5760 5761 5762 5763 5764 5765
		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;
}

5766
static const struct pci_error_handlers be_eeh_handlers = {
5767 5768 5769 5770 5771
	.error_detected = be_eeh_err_detected,
	.slot_reset = be_eeh_reset,
	.resume = be_eeh_resume,
};

S
Sathya Perla 已提交
5772 5773 5774 5775 5776 5777
static struct pci_driver be_driver = {
	.name = DRV_NAME,
	.id_table = be_dev_ids,
	.probe = be_probe,
	.remove = be_remove,
	.suspend = be_suspend,
5778
	.resume = be_pci_resume,
5779
	.shutdown = be_shutdown,
5780
	.sriov_configure = be_pci_sriov_configure,
5781
	.err_handler = &be_eeh_handlers
S
Sathya Perla 已提交
5782 5783 5784 5785
};

static int __init be_init_module(void)
{
5786 5787
	if (rx_frag_size != 8192 && rx_frag_size != 4096 &&
	    rx_frag_size != 2048) {
S
Sathya Perla 已提交
5788 5789 5790 5791 5792 5793
		printk(KERN_WARNING DRV_NAME
			" : Module param rx_frag_size must be 2048/4096/8192."
			" Using 2048\n");
		rx_frag_size = 2048;
	}

5794 5795 5796 5797 5798
	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 已提交
5799 5800 5801 5802 5803 5804 5805 5806 5807
	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);