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

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

MODULE_VERSION(DRV_VER);
MODULE_DEVICE_TABLE(pci, be_dev_ids);
MODULE_DESCRIPTION(DRV_DESC " " DRV_VER);
31
MODULE_AUTHOR("Emulex Corporation");
S
Sathya Perla 已提交
32 33
MODULE_LICENSE("GPL");

34 35 36
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 已提交
37

38 39 40 41
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.");

42
static const struct pci_device_id be_dev_ids[] = {
43
	{ PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID1) },
44
	{ PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID2) },
45 46
	{ PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID1) },
	{ PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID2) },
47
	{ PCI_DEVICE(EMULEX_VENDOR_ID, OC_DEVICE_ID3)},
48
	{ PCI_DEVICE(EMULEX_VENDOR_ID, OC_DEVICE_ID4)},
49
	{ PCI_DEVICE(EMULEX_VENDOR_ID, OC_DEVICE_ID5)},
50
	{ PCI_DEVICE(EMULEX_VENDOR_ID, OC_DEVICE_ID6)},
S
Sathya Perla 已提交
51 52 53
	{ 0 }
};
MODULE_DEVICE_TABLE(pci, be_dev_ids);
54
/* UE Status Low CSR */
55
static const char * const ue_status_low_desc[] = {
56 57 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
	"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 ",
84 85 86 87
	"ERX2 ",
	"SPARE ",
	"JTAG ",
	"MPU_INTPEND "
88
};
89

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

static void be_queue_free(struct be_adapter *adapter, struct be_queue_info *q)
{
	struct be_dma_mem *mem = &q->dma_mem;
129

130
	if (mem->va) {
I
Ivan Vecera 已提交
131 132
		dma_free_coherent(&adapter->pdev->dev, mem->size, mem->va,
				  mem->dma);
133 134
		mem->va = NULL;
	}
S
Sathya Perla 已提交
135 136 137
}

static int be_queue_alloc(struct be_adapter *adapter, struct be_queue_info *q,
138
			  u16 len, u16 entry_size)
S
Sathya Perla 已提交
139 140 141 142 143 144 145
{
	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;
146 147
	mem->va = dma_zalloc_coherent(&adapter->pdev->dev, mem->size, &mem->dma,
				      GFP_KERNEL);
S
Sathya Perla 已提交
148
	if (!mem->va)
S
Sathya Perla 已提交
149
		return -ENOMEM;
S
Sathya Perla 已提交
150 151 152
	return 0;
}

153
static void be_reg_intr_set(struct be_adapter *adapter, bool enable)
S
Sathya Perla 已提交
154
{
155
	u32 reg, enabled;
156

157
	pci_read_config_dword(adapter->pdev, PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET,
158
			      &reg);
159 160
	enabled = reg & MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;

161
	if (!enabled && enable)
S
Sathya Perla 已提交
162
		reg |= MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
163
	else if (enabled && !enable)
S
Sathya Perla 已提交
164
		reg &= ~MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
165
	else
S
Sathya Perla 已提交
166
		return;
167

168
	pci_write_config_dword(adapter->pdev,
169
			       PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET, reg);
S
Sathya Perla 已提交
170 171
}

172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187
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;

	if (adapter->eeh_error)
		return;

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

188
static void be_rxq_notify(struct be_adapter *adapter, u16 qid, u16 posted)
S
Sathya Perla 已提交
189 190
{
	u32 val = 0;
191

S
Sathya Perla 已提交
192 193
	val |= qid & DB_RQ_RING_ID_MASK;
	val |= posted << DB_RQ_NUM_POSTED_SHIFT;
194 195

	wmb();
196
	iowrite32(val, adapter->db + DB_RQ_OFFSET);
S
Sathya Perla 已提交
197 198
}

V
Vasundhara Volam 已提交
199 200
static void be_txq_notify(struct be_adapter *adapter, struct be_tx_obj *txo,
			  u16 posted)
S
Sathya Perla 已提交
201 202
{
	u32 val = 0;
203

V
Vasundhara Volam 已提交
204
	val |= txo->q.id & DB_TXULP_RING_ID_MASK;
S
Sathya Perla 已提交
205
	val |= (posted & DB_TXULP_NUM_POSTED_MASK) << DB_TXULP_NUM_POSTED_SHIFT;
206 207

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

211
static void be_eq_notify(struct be_adapter *adapter, u16 qid,
212
			 bool arm, bool clear_int, u16 num_popped)
S
Sathya Perla 已提交
213 214
{
	u32 val = 0;
215

S
Sathya Perla 已提交
216
	val |= qid & DB_EQ_RING_ID_MASK;
217
	val |= ((qid & DB_EQ_RING_ID_EXT_MASK) << DB_EQ_RING_ID_EXT_MASK_SHIFT);
218

219
	if (adapter->eeh_error)
220 221
		return;

S
Sathya Perla 已提交
222 223 224 225 226 227
	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;
228
	iowrite32(val, adapter->db + DB_EQ_OFFSET);
S
Sathya Perla 已提交
229 230
}

231
void be_cq_notify(struct be_adapter *adapter, u16 qid, bool arm, u16 num_popped)
S
Sathya Perla 已提交
232 233
{
	u32 val = 0;
234

S
Sathya Perla 已提交
235
	val |= qid & DB_CQ_RING_ID_MASK;
236 237
	val |= ((qid & DB_CQ_RING_ID_EXT_MASK) <<
			DB_CQ_RING_ID_EXT_MASK_SHIFT);
238

239
	if (adapter->eeh_error)
240 241
		return;

S
Sathya Perla 已提交
242 243 244
	if (arm)
		val |= 1 << DB_CQ_REARM_SHIFT;
	val |= num_popped << DB_CQ_NUM_POPPED_SHIFT;
245
	iowrite32(val, adapter->db + DB_CQ_OFFSET);
S
Sathya Perla 已提交
246 247 248 249 250
}

static int be_mac_addr_set(struct net_device *netdev, void *p)
{
	struct be_adapter *adapter = netdev_priv(netdev);
251
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
252
	struct sockaddr *addr = p;
253 254 255
	int status;
	u8 mac[ETH_ALEN];
	u32 old_pmac_id = adapter->pmac_id[0], curr_pmac_id = 0;
S
Sathya Perla 已提交
256

257 258 259
	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

260 261 262 263 264 265
	/* Proceed further only if, User provided MAC is different
	 * from active MAC
	 */
	if (ether_addr_equal(addr->sa_data, netdev->dev_addr))
		return 0;

266 267 268 269 270
	/* 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.
271
	 */
272 273 274 275 276 277 278 279 280 281 282
	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);
283 284
	}

285 286
	/* Decide if the new MAC is successfully activated only after
	 * querying the FW
287
	 */
288 289
	status = be_cmd_get_active_mac(adapter, curr_pmac_id, mac,
				       adapter->if_handle, true, 0);
290
	if (status)
291
		goto err;
S
Sathya Perla 已提交
292

293 294 295
	/* The MAC change did not happen, either due to lack of privilege
	 * or PF didn't pre-provision.
	 */
296
	if (!ether_addr_equal(addr->sa_data, mac)) {
297 298 299 300
		status = -EPERM;
		goto err;
	}

301
	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
302
	dev_info(dev, "MAC address changed to %pM\n", mac);
303 304
	return 0;
err:
305
	dev_warn(dev, "MAC address change to %pM failed\n", addr->sa_data);
S
Sathya Perla 已提交
306 307 308
	return status;
}

309 310 311 312 313 314 315
/* 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;
316
	} else if (BE3_chip(adapter)) {
317 318
		struct be_cmd_resp_get_stats_v1 *cmd = adapter->stats_cmd.va;

319 320 321 322
		return &cmd->hw_stats;
	} else {
		struct be_cmd_resp_get_stats_v2 *cmd = adapter->stats_cmd.va;

323 324 325 326 327 328 329 330 331 332 333
		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;
334
	} else if (BE3_chip(adapter)) {
335 336
		struct be_hw_stats_v1 *hw_stats = hw_stats_from_cmd(adapter);

337 338 339 340
		return &hw_stats->erx;
	} else {
		struct be_hw_stats_v2 *hw_stats = hw_stats_from_cmd(adapter);

341 342 343 344 345
		return &hw_stats->erx;
	}
}

static void populate_be_v0_stats(struct be_adapter *adapter)
346
{
347 348 349
	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;
350
	struct be_port_rxf_stats_v0 *port_stats =
351 352
					&rxf_stats->port[adapter->port_num];
	struct be_drv_stats *drvs = &adapter->drv_stats;
353

354
	be_dws_le_to_cpu(hw_stats, sizeof(*hw_stats));
355 356 357 358 359 360 361 362 363 364 365 366 367 368
	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;
369
	drvs->rx_input_fifo_overflow_drop = port_stats->rx_input_fifo_overflow;
370 371
	drvs->rx_dropped_header_too_small =
		port_stats->rx_dropped_header_too_small;
372 373 374
	drvs->rx_address_filtered =
					port_stats->rx_address_filtered +
					port_stats->rx_vlan_filtered;
375 376 377 378 379 380 381
	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)
382
		drvs->jabber_events = rxf_stats->port1_jabber_events;
383
	else
384
		drvs->jabber_events = rxf_stats->port0_jabber_events;
385 386 387 388
	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;
389 390
	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;
391 392 393
	adapter->drv_stats.eth_red_drops = pmem_sts->eth_red_drops;
}

394
static void populate_be_v1_stats(struct be_adapter *adapter)
395
{
396 397 398
	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;
399
	struct be_port_rxf_stats_v1 *port_stats =
400 401
					&rxf_stats->port[adapter->port_num];
	struct be_drv_stats *drvs = &adapter->drv_stats;
402

403
	be_dws_le_to_cpu(hw_stats, sizeof(*hw_stats));
404 405
	drvs->pmem_fifo_overflow_drop = port_stats->pmem_fifo_overflow_drop;
	drvs->rx_priority_pause_frames = port_stats->rx_priority_pause_frames;
406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422
	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;
423
	drvs->rx_address_filtered = port_stats->rx_address_filtered;
424 425
	drvs->rx_alignment_symbol_errors =
		port_stats->rx_alignment_symbol_errors;
426
	drvs->rxpp_fifo_overflow_drop = port_stats->rxpp_fifo_overflow_drop;
427 428
	drvs->tx_pauseframes = port_stats->tx_pauseframes;
	drvs->tx_controlframes = port_stats->tx_controlframes;
429
	drvs->tx_priority_pauseframes = port_stats->tx_priority_pauseframes;
430 431 432 433 434
	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;
435 436
	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;
437 438 439
	adapter->drv_stats.eth_red_drops = pmem_sts->eth_red_drops;
}

440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483
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;
484
	if (be_roce_supported(adapter)) {
485 486 487 488 489 490 491
		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;
	}
492 493
}

S
Selvin Xavier 已提交
494 495 496
static void populate_lancer_stats(struct be_adapter *adapter)
{
	struct be_drv_stats *drvs = &adapter->drv_stats;
497
	struct lancer_pport_stats *pport_stats = pport_stats_from_cmd(adapter);
498 499 500 501 502

	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 已提交
503
	drvs->rx_in_range_errors = pport_stats->rx_in_range_errors;
504
	drvs->rx_frame_too_long = pport_stats->rx_frames_too_long_lo;
S
Selvin Xavier 已提交
505 506 507 508 509 510 511 512 513 514 515 516
	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;
517 518 519
	drvs->rx_address_filtered =
					pport_stats->rx_address_filtered +
					pport_stats->rx_vlan_filtered;
520
	drvs->rx_alignment_symbol_errors = pport_stats->rx_symbol_errors_lo;
S
Selvin Xavier 已提交
521
	drvs->rxpp_fifo_overflow_drop = pport_stats->rx_fifo_overflow;
522 523
	drvs->tx_pauseframes = pport_stats->tx_pause_frames_lo;
	drvs->tx_controlframes = pport_stats->tx_control_frames_lo;
S
Selvin Xavier 已提交
524
	drvs->jabber_events = pport_stats->rx_jabbers;
525 526
	drvs->forwarded_packets = pport_stats->num_forwards_lo;
	drvs->rx_drops_mtu = pport_stats->rx_drops_mtu_lo;
S
Selvin Xavier 已提交
527
	drvs->rx_drops_too_many_frags =
528
				pport_stats->rx_drops_too_many_frags_lo;
S
Selvin Xavier 已提交
529
}
530

531 532 533 534 535 536 537 538 539 540 541 542
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 已提交
543
static void populate_erx_stats(struct be_adapter *adapter,
544
			       struct be_rx_obj *rxo, u32 erx_stat)
545 546 547 548 549 550 551 552 553 554 555
{
	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);
}

556 557
void be_parse_stats(struct be_adapter *adapter)
{
558
	struct be_erx_stats_v2 *erx = be_erx_stats_from_cmd(adapter);
559 560
	struct be_rx_obj *rxo;
	int i;
561
	u32 erx_stat;
562

563 564
	if (lancer_chip(adapter)) {
		populate_lancer_stats(adapter);
S
Selvin Xavier 已提交
565
	} else {
566 567
		if (BE2_chip(adapter))
			populate_be_v0_stats(adapter);
568 569
		else if (BE3_chip(adapter))
			/* for BE3 */
570
			populate_be_v1_stats(adapter);
571 572
		else
			populate_be_v2_stats(adapter);
573

574
		/* erx_v2 is longer than v0, v1. use v2 for v0, v1 access */
575
		for_all_rx_queues(adapter, rxo, i) {
576 577
			erx_stat = erx->rx_drops_no_fragments[rxo->q.id];
			populate_erx_stats(adapter, rxo, erx_stat);
578
		}
579
	}
580 581
}

582
static struct rtnl_link_stats64 *be_get_stats64(struct net_device *netdev,
583
						struct rtnl_link_stats64 *stats)
S
Sathya Perla 已提交
584
{
585
	struct be_adapter *adapter = netdev_priv(netdev);
586
	struct be_drv_stats *drvs = &adapter->drv_stats;
587
	struct be_rx_obj *rxo;
588
	struct be_tx_obj *txo;
589 590
	u64 pkts, bytes;
	unsigned int start;
591
	int i;
S
Sathya Perla 已提交
592

593
	for_all_rx_queues(adapter, rxo, i) {
594
		const struct be_rx_stats *rx_stats = rx_stats(rxo);
595

596
		do {
597
			start = u64_stats_fetch_begin_irq(&rx_stats->sync);
598 599
			pkts = rx_stats(rxo)->rx_pkts;
			bytes = rx_stats(rxo)->rx_bytes;
600
		} while (u64_stats_fetch_retry_irq(&rx_stats->sync, start));
601 602 603 604 605
		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;
606 607
	}

608
	for_all_tx_queues(adapter, txo, i) {
609
		const struct be_tx_stats *tx_stats = tx_stats(txo);
610

611
		do {
612
			start = u64_stats_fetch_begin_irq(&tx_stats->sync);
613 614
			pkts = tx_stats(txo)->tx_pkts;
			bytes = tx_stats(txo)->tx_bytes;
615
		} while (u64_stats_fetch_retry_irq(&tx_stats->sync, start));
616 617
		stats->tx_packets += pkts;
		stats->tx_bytes += bytes;
618
	}
S
Sathya Perla 已提交
619 620

	/* bad pkts received */
621
	stats->rx_errors = drvs->rx_crc_errors +
622 623 624 625 626 627 628 629
		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 +
630
		drvs->rx_dropped_runt;
631

S
Sathya Perla 已提交
632
	/* detailed rx errors */
633
	stats->rx_length_errors = drvs->rx_in_range_errors +
634 635
		drvs->rx_out_range_errors +
		drvs->rx_frame_too_long;
636

637
	stats->rx_crc_errors = drvs->rx_crc_errors;
S
Sathya Perla 已提交
638 639

	/* frame alignment errors */
640
	stats->rx_frame_errors = drvs->rx_alignment_symbol_errors;
641

S
Sathya Perla 已提交
642 643
	/* receiver fifo overrun */
	/* drops_no_pbuf is no per i/f, it's per BE card */
644
	stats->rx_fifo_errors = drvs->rxpp_fifo_overflow_drop +
645 646
				drvs->rx_input_fifo_overflow_drop +
				drvs->rx_drops_no_pbuf;
647
	return stats;
S
Sathya Perla 已提交
648 649
}

650
void be_link_status_update(struct be_adapter *adapter, u8 link_status)
S
Sathya Perla 已提交
651 652 653
{
	struct net_device *netdev = adapter->netdev;

654
	if (!(adapter->flags & BE_FLAGS_LINK_STATUS_INIT)) {
655
		netif_carrier_off(netdev);
656
		adapter->flags |= BE_FLAGS_LINK_STATUS_INIT;
S
Sathya Perla 已提交
657
	}
658

659
	if (link_status)
660 661 662
		netif_carrier_on(netdev);
	else
		netif_carrier_off(netdev);
S
Sathya Perla 已提交
663 664
}

665
static void be_tx_stats_update(struct be_tx_obj *txo,
666 667
			       u32 wrb_cnt, u32 copied, u32 gso_segs,
			       bool stopped)
S
Sathya Perla 已提交
668
{
669 670
	struct be_tx_stats *stats = tx_stats(txo);

671
	u64_stats_update_begin(&stats->sync);
672 673 674 675
	stats->tx_reqs++;
	stats->tx_wrbs += wrb_cnt;
	stats->tx_bytes += copied;
	stats->tx_pkts += (gso_segs ? gso_segs : 1);
S
Sathya Perla 已提交
676
	if (stopped)
677
		stats->tx_stops++;
678
	u64_stats_update_end(&stats->sync);
S
Sathya Perla 已提交
679 680 681
}

/* Determine number of WRB entries needed to xmit data in an skb */
682
static u32 wrb_cnt_for_skb(struct be_adapter *adapter, struct sk_buff *skb,
683
			   bool *dummy)
S
Sathya Perla 已提交
684
{
685 686 687 688
	int cnt = (skb->len > skb->data_len);

	cnt += skb_shinfo(skb)->nr_frags;

S
Sathya Perla 已提交
689 690
	/* to account for hdr wrb */
	cnt++;
691 692 693
	if (lancer_chip(adapter) || !(cnt & 1)) {
		*dummy = false;
	} else {
S
Sathya Perla 已提交
694 695 696
		/* add a dummy to make it an even num */
		cnt++;
		*dummy = true;
697
	}
S
Sathya Perla 已提交
698 699 700 701 702 703 704 705 706
	BUG_ON(cnt > BE_MAX_TX_FRAG_COUNT);
	return cnt;
}

static inline void wrb_fill(struct be_eth_wrb *wrb, u64 addr, int len)
{
	wrb->frag_pa_hi = upper_32_bits(addr);
	wrb->frag_pa_lo = addr & 0xFFFFFFFF;
	wrb->frag_len = len & ETH_WRB_FRAG_LEN_MASK;
707
	wrb->rsvd0 = 0;
S
Sathya Perla 已提交
708 709
}

710
static inline u16 be_get_tx_vlan_tag(struct be_adapter *adapter,
711
				     struct sk_buff *skb)
712 713 714 715 716 717 718 719 720 721 722 723 724 725
{
	u8 vlan_prio;
	u16 vlan_tag;

	vlan_tag = vlan_tx_tag_get(skb);
	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) |
				adapter->recommended_prio;

	return vlan_tag;
}

726 727 728 729 730 731 732 733 734 735 736 737 738
/* 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;
}

739
static void wrb_fill_hdr(struct be_adapter *adapter, struct be_eth_hdr_wrb *hdr,
740 741
			 struct sk_buff *skb, u32 wrb_cnt, u32 len,
			 bool skip_hw_vlan)
S
Sathya Perla 已提交
742
{
743
	u16 vlan_tag, proto;
744

S
Sathya Perla 已提交
745 746
	memset(hdr, 0, sizeof(*hdr));

747
	SET_TX_WRB_HDR_BITS(crc, hdr, 1);
S
Sathya Perla 已提交
748

A
Ajit Khaparde 已提交
749
	if (skb_is_gso(skb)) {
750 751
		SET_TX_WRB_HDR_BITS(lso, hdr, 1);
		SET_TX_WRB_HDR_BITS(lso_mss, hdr, skb_shinfo(skb)->gso_size);
752
		if (skb_is_gso_v6(skb) && !lancer_chip(adapter))
753
			SET_TX_WRB_HDR_BITS(lso6, hdr, 1);
S
Sathya Perla 已提交
754
	} else if (skb->ip_summed == CHECKSUM_PARTIAL) {
755
		if (skb->encapsulation) {
756
			SET_TX_WRB_HDR_BITS(ipcs, hdr, 1);
757 758 759 760 761
			proto = skb_inner_ip_proto(skb);
		} else {
			proto = skb_ip_proto(skb);
		}
		if (proto == IPPROTO_TCP)
762
			SET_TX_WRB_HDR_BITS(tcpcs, hdr, 1);
763
		else if (proto == IPPROTO_UDP)
764
			SET_TX_WRB_HDR_BITS(udpcs, hdr, 1);
S
Sathya Perla 已提交
765 766
	}

A
Ajit Khaparde 已提交
767
	if (vlan_tx_tag_present(skb)) {
768
		SET_TX_WRB_HDR_BITS(vlan, hdr, 1);
769
		vlan_tag = be_get_tx_vlan_tag(adapter, skb);
770
		SET_TX_WRB_HDR_BITS(vlan_tag, hdr, vlan_tag);
S
Sathya Perla 已提交
771 772
	}

773
	/* To skip HW VLAN tagging: evt = 1, compl = 0 */
774 775 776 777
	SET_TX_WRB_HDR_BITS(complete, hdr, !skip_hw_vlan);
	SET_TX_WRB_HDR_BITS(event, hdr, 1);
	SET_TX_WRB_HDR_BITS(num_wrb, hdr, wrb_cnt);
	SET_TX_WRB_HDR_BITS(len, hdr, len);
S
Sathya Perla 已提交
778 779
}

I
Ivan Vecera 已提交
780
static void unmap_tx_frag(struct device *dev, struct be_eth_wrb *wrb,
781
			  bool unmap_single)
782 783 784 785 786 787
{
	dma_addr_t dma;

	be_dws_le_to_cpu(wrb, sizeof(*wrb));

	dma = (u64)wrb->frag_pa_hi << 32 | (u64)wrb->frag_pa_lo;
788
	if (wrb->frag_len) {
789
		if (unmap_single)
I
Ivan Vecera 已提交
790 791
			dma_unmap_single(dev, dma, wrb->frag_len,
					 DMA_TO_DEVICE);
792
		else
I
Ivan Vecera 已提交
793
			dma_unmap_page(dev, dma, wrb->frag_len, DMA_TO_DEVICE);
794 795
	}
}
S
Sathya Perla 已提交
796

797
static int make_tx_wrbs(struct be_adapter *adapter, struct be_queue_info *txq,
798 799
			struct sk_buff *skb, u32 wrb_cnt, bool dummy_wrb,
			bool skip_hw_vlan)
S
Sathya Perla 已提交
800
{
801 802
	dma_addr_t busaddr;
	int i, copied = 0;
I
Ivan Vecera 已提交
803
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
804 805 806
	struct sk_buff *first_skb = skb;
	struct be_eth_wrb *wrb;
	struct be_eth_hdr_wrb *hdr;
807 808
	bool map_single = false;
	u16 map_head;
S
Sathya Perla 已提交
809 810 811

	hdr = queue_head_node(txq);
	queue_head_inc(txq);
812
	map_head = txq->head;
S
Sathya Perla 已提交
813

814
	if (skb->len > skb->data_len) {
E
Eric Dumazet 已提交
815
		int len = skb_headlen(skb);
816

I
Ivan Vecera 已提交
817 818
		busaddr = dma_map_single(dev, skb->data, len, DMA_TO_DEVICE);
		if (dma_mapping_error(dev, busaddr))
819 820
			goto dma_err;
		map_single = true;
821 822 823 824 825 826
		wrb = queue_head_node(txq);
		wrb_fill(wrb, busaddr, len);
		be_dws_cpu_to_le(wrb, sizeof(*wrb));
		queue_head_inc(txq);
		copied += len;
	}
S
Sathya Perla 已提交
827

828
	for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
829
		const struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[i];
830

831
		busaddr = skb_frag_dma_map(dev, frag, 0,
E
Eric Dumazet 已提交
832
					   skb_frag_size(frag), DMA_TO_DEVICE);
I
Ivan Vecera 已提交
833
		if (dma_mapping_error(dev, busaddr))
834
			goto dma_err;
835
		wrb = queue_head_node(txq);
E
Eric Dumazet 已提交
836
		wrb_fill(wrb, busaddr, skb_frag_size(frag));
837 838
		be_dws_cpu_to_le(wrb, sizeof(*wrb));
		queue_head_inc(txq);
E
Eric Dumazet 已提交
839
		copied += skb_frag_size(frag);
S
Sathya Perla 已提交
840 841 842 843 844 845 846 847 848
	}

	if (dummy_wrb) {
		wrb = queue_head_node(txq);
		wrb_fill(wrb, 0, 0);
		be_dws_cpu_to_le(wrb, sizeof(*wrb));
		queue_head_inc(txq);
	}

849
	wrb_fill_hdr(adapter, hdr, first_skb, wrb_cnt, copied, skip_hw_vlan);
S
Sathya Perla 已提交
850 851 852
	be_dws_cpu_to_le(hdr, sizeof(*hdr));

	return copied;
853 854 855 856
dma_err:
	txq->head = map_head;
	while (copied) {
		wrb = queue_head_node(txq);
I
Ivan Vecera 已提交
857
		unmap_tx_frag(dev, wrb, map_single);
858 859
		map_single = false;
		copied -= wrb->frag_len;
860
		adapter->drv_stats.dma_map_errors++;
861 862 863
		queue_head_inc(txq);
	}
	return 0;
S
Sathya Perla 已提交
864 865
}

866
static struct sk_buff *be_insert_vlan_in_pkt(struct be_adapter *adapter,
867 868
					     struct sk_buff *skb,
					     bool *skip_hw_vlan)
869 870 871 872 873 874 875
{
	u16 vlan_tag = 0;

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

876
	if (vlan_tx_tag_present(skb))
877
		vlan_tag = be_get_tx_vlan_tag(adapter, skb);
878 879 880 881 882 883 884 885 886 887

	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
		 */
		if (skip_hw_vlan)
			*skip_hw_vlan = true;
	}
888 889

	if (vlan_tag) {
890
		skb = __vlan_put_tag(skb, htons(ETH_P_8021Q), vlan_tag);
891 892 893 894 895 896 897 898
		if (unlikely(!skb))
			return skb;
		skb->vlan_tci = 0;
	}

	/* Insert the outer VLAN, if any */
	if (adapter->qnq_vid) {
		vlan_tag = adapter->qnq_vid;
899
		skb = __vlan_put_tag(skb, htons(ETH_P_8021Q), vlan_tag);
900 901 902 903 904 905
		if (unlikely(!skb))
			return skb;
		if (skip_hw_vlan)
			*skip_hw_vlan = true;
	}

906 907 908
	return skb;
}

909 910 911 912 913 914 915 916 917 918 919 920
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 已提交
921
				(struct ipv6_opt_hdr *)(skb->data + offset);
922 923 924 925 926 927 928 929 930 931 932 933 934 935

			/* 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)
{
	return vlan_tx_tag_present(skb) || adapter->pvid || adapter->qnq_vid;
}

936
static int be_ipv6_tx_stall_chk(struct be_adapter *adapter, struct sk_buff *skb)
937
{
938
	return BE3_chip(adapter) && be_ipv6_exthdr_check(skb);
939 940
}

941 942 943
static struct sk_buff *be_lancer_xmit_workarounds(struct be_adapter *adapter,
						  struct sk_buff *skb,
						  bool *skip_hw_vlan)
S
Sathya Perla 已提交
944
{
945
	struct vlan_ethhdr *veh = (struct vlan_ethhdr *)skb->data;
946 947
	unsigned int eth_hdr_len;
	struct iphdr *ip;
948

949 950
	/* For padded packets, BE HW modifies tot_len field in IP header
	 * incorrecly when VLAN tag is inserted by HW.
951
	 * For padded packets, Lancer computes incorrect checksum.
952
	 */
953 954
	eth_hdr_len = ntohs(skb->protocol) == ETH_P_8021Q ?
						VLAN_ETH_HLEN : ETH_HLEN;
955 956
	if (skb->len <= 60 &&
	    (lancer_chip(adapter) || vlan_tx_tag_present(skb)) &&
957
	    is_ipv4_pkt(skb)) {
958 959 960
		ip = (struct iphdr *)ip_hdr(skb);
		pskb_trim(skb, eth_hdr_len + ntohs(ip->tot_len));
	}
961

962
	/* If vlan tag is already inlined in the packet, skip HW VLAN
963
	 * tagging in pvid-tagging mode
964
	 */
965
	if (be_pvid_tagging_enabled(adapter) &&
966
	    veh->h_vlan_proto == htons(ETH_P_8021Q))
967
		*skip_hw_vlan = true;
968

969 970 971 972 973
	/* 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 &&
974 975
	    vlan_tx_tag_present(skb)) {
		skb = be_insert_vlan_in_pkt(adapter, skb, skip_hw_vlan);
976
		if (unlikely(!skb))
977
			goto err;
978 979 980 981 982 983 984
	}

	/* 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 已提交
985 986
		     (adapter->pvid || adapter->qnq_vid) &&
		     !qnq_async_evt_rcvd(adapter)))
987 988 989 990 991 992 993 994 995 996
		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)) {
997
		skb = be_insert_vlan_in_pkt(adapter, skb, skip_hw_vlan);
998
		if (unlikely(!skb))
999
			goto err;
1000 1001
	}

1002 1003 1004
	return skb;
tx_drop:
	dev_kfree_skb_any(skb);
1005
err:
1006 1007 1008
	return NULL;
}

1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031
static struct sk_buff *be_xmit_workarounds(struct be_adapter *adapter,
					   struct sk_buff *skb,
					   bool *skip_hw_vlan)
{
	/* Lancer, SH-R ASICs have a bug wherein Packets that are 32 bytes or
	 * less may cause a transmit stall on that port. So the work-around is
	 * to pad short packets (<= 32 bytes) to a 36-byte length.
	 */
	if (unlikely(!BEx_chip(adapter) && skb->len <= 32)) {
		if (skb_padto(skb, 36))
			return NULL;
		skb->len = 36;
	}

	if (BEx_chip(adapter) || lancer_chip(adapter)) {
		skb = be_lancer_xmit_workarounds(adapter, skb, skip_hw_vlan);
		if (!skb)
			return NULL;
	}

	return skb;
}

1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042
static netdev_tx_t be_xmit(struct sk_buff *skb, struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
	struct be_tx_obj *txo = &adapter->tx_obj[skb_get_queue_mapping(skb)];
	struct be_queue_info *txq = &txo->q;
	bool dummy_wrb, stopped = false;
	u32 wrb_cnt = 0, copied = 0;
	bool skip_hw_vlan = false;
	u32 start = txq->head;

	skb = be_xmit_workarounds(adapter, skb, &skip_hw_vlan);
1043 1044
	if (!skb) {
		tx_stats(txo)->tx_drv_drops++;
1045
		return NETDEV_TX_OK;
1046
	}
1047

1048
	wrb_cnt = wrb_cnt_for_skb(adapter, skb, &dummy_wrb);
S
Sathya Perla 已提交
1049

1050 1051
	copied = make_tx_wrbs(adapter, txq, skb, wrb_cnt, dummy_wrb,
			      skip_hw_vlan);
1052
	if (copied) {
E
Eric Dumazet 已提交
1053 1054
		int gso_segs = skb_shinfo(skb)->gso_segs;

1055
		/* record the sent skb in the sent_skb table */
1056 1057
		BUG_ON(txo->sent_skb_list[start]);
		txo->sent_skb_list[start] = skb;
1058 1059 1060 1061 1062

		/* Ensure txq has space for the next skb; Else stop the queue
		 * *BEFORE* ringing the tx doorbell, so that we serialze the
		 * tx compls of the current transmit which'll wake up the queue
		 */
1063
		atomic_add(wrb_cnt, &txq->used);
1064 1065
		if ((BE_MAX_TX_FRAG_COUNT + atomic_read(&txq->used)) >=
								txq->len) {
1066
			netif_stop_subqueue(netdev, skb_get_queue_mapping(skb));
1067 1068
			stopped = true;
		}
S
Sathya Perla 已提交
1069

V
Vasundhara Volam 已提交
1070
		be_txq_notify(adapter, txo, wrb_cnt);
S
Sathya Perla 已提交
1071

E
Eric Dumazet 已提交
1072
		be_tx_stats_update(txo, wrb_cnt, copied, gso_segs, stopped);
1073 1074
	} else {
		txq->head = start;
1075
		tx_stats(txo)->tx_drv_drops++;
1076
		dev_kfree_skb_any(skb);
S
Sathya Perla 已提交
1077 1078 1079 1080 1081 1082 1083
	}
	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 已提交
1084 1085 1086 1087 1088
	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 已提交
1089 1090
		return -EINVAL;
	}
K
Kalesh AP 已提交
1091 1092

	dev_info(dev, "MTU changed from %d to %d bytes\n",
1093
		 netdev->mtu, new_mtu);
S
Sathya Perla 已提交
1094 1095 1096 1097 1098
	netdev->mtu = new_mtu;
	return 0;
}

/*
1099 1100
 * 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 已提交
1101
 */
S
Sathya Perla 已提交
1102
static int be_vid_config(struct be_adapter *adapter)
S
Sathya Perla 已提交
1103
{
V
Vasundhara Volam 已提交
1104
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
1105
	u16 vids[BE_NUM_VLANS_SUPPORTED];
1106
	u16 num = 0, i = 0;
1107
	int status = 0;
1108

1109 1110 1111 1112
	/* No need to further configure vids if in promiscuous mode */
	if (adapter->promiscuous)
		return 0;

1113
	if (adapter->vlans_added > be_max_vlans(adapter))
1114 1115 1116
		goto set_vlan_promisc;

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

1120
	status = be_cmd_vlan_config(adapter, adapter->if_handle, vids, num);
1121
	if (status) {
1122
		/* Set to VLAN promisc mode as setting VLAN filter failed */
1123 1124
		if (addl_status(status) ==
				MCC_ADDL_STATUS_INSUFFICIENT_RESOURCES)
1125
			goto set_vlan_promisc;
V
Vasundhara Volam 已提交
1126
		dev_err(dev, "Setting HW VLAN filtering failed\n");
1127 1128 1129 1130 1131 1132
	} else {
		if (adapter->flags & BE_FLAGS_VLAN_PROMISC) {
			/* hw VLAN filtering re-enabled. */
			status = be_cmd_rx_filter(adapter,
						  BE_FLAGS_VLAN_PROMISC, OFF);
			if (!status) {
V
Vasundhara Volam 已提交
1133 1134
				dev_info(dev,
					 "Disabling VLAN Promiscuous mode\n");
1135 1136 1137
				adapter->flags &= ~BE_FLAGS_VLAN_PROMISC;
			}
		}
S
Sathya Perla 已提交
1138
	}
1139

1140
	return status;
1141 1142

set_vlan_promisc:
1143 1144
	if (adapter->flags & BE_FLAGS_VLAN_PROMISC)
		return 0;
1145 1146 1147

	status = be_cmd_rx_filter(adapter, BE_FLAGS_VLAN_PROMISC, ON);
	if (!status) {
V
Vasundhara Volam 已提交
1148
		dev_info(dev, "Enable VLAN Promiscuous mode\n");
1149 1150
		adapter->flags |= BE_FLAGS_VLAN_PROMISC;
	} else
V
Vasundhara Volam 已提交
1151
		dev_err(dev, "Failed to enable VLAN Promiscuous mode\n");
1152
	return status;
S
Sathya Perla 已提交
1153 1154
}

1155
static int be_vlan_add_vid(struct net_device *netdev, __be16 proto, u16 vid)
S
Sathya Perla 已提交
1156 1157
{
	struct be_adapter *adapter = netdev_priv(netdev);
A
Ajit Khaparde 已提交
1158
	int status = 0;
S
Sathya Perla 已提交
1159

1160 1161
	/* Packets with VID 0 are always received by Lancer by default */
	if (lancer_chip(adapter) && vid == 0)
1162 1163
		return status;

1164
	if (test_bit(vid, adapter->vids))
1165
		return status;
1166

1167
	set_bit(vid, adapter->vids);
1168
	adapter->vlans_added++;
1169

1170 1171 1172
	status = be_vid_config(adapter);
	if (status) {
		adapter->vlans_added--;
1173
		clear_bit(vid, adapter->vids);
1174
	}
1175

A
Ajit Khaparde 已提交
1176
	return status;
S
Sathya Perla 已提交
1177 1178
}

1179
static int be_vlan_rem_vid(struct net_device *netdev, __be16 proto, u16 vid)
S
Sathya Perla 已提交
1180 1181 1182
{
	struct be_adapter *adapter = netdev_priv(netdev);

1183 1184
	/* Packets with VID 0 are always received by Lancer by default */
	if (lancer_chip(adapter) && vid == 0)
1185
		return 0;
1186

1187
	clear_bit(vid, adapter->vids);
1188 1189 1190
	adapter->vlans_added--;

	return be_vid_config(adapter);
S
Sathya Perla 已提交
1191 1192
}

1193 1194 1195
static void be_clear_promisc(struct be_adapter *adapter)
{
	adapter->promiscuous = false;
1196
	adapter->flags &= ~(BE_FLAGS_VLAN_PROMISC | BE_FLAGS_MCAST_PROMISC);
1197 1198 1199 1200

	be_cmd_rx_filter(adapter, IFF_PROMISC, OFF);
}

1201
static void be_set_rx_mode(struct net_device *netdev)
S
Sathya Perla 已提交
1202 1203
{
	struct be_adapter *adapter = netdev_priv(netdev);
1204
	int status;
S
Sathya Perla 已提交
1205

1206
	if (netdev->flags & IFF_PROMISC) {
1207
		be_cmd_rx_filter(adapter, IFF_PROMISC, ON);
1208 1209
		adapter->promiscuous = true;
		goto done;
S
Sathya Perla 已提交
1210 1211
	}

L
Lucas De Marchi 已提交
1212
	/* BE was previously in promiscuous mode; disable it */
1213
	if (adapter->promiscuous) {
1214
		be_clear_promisc(adapter);
1215
		if (adapter->vlans_added)
S
Sathya Perla 已提交
1216
			be_vid_config(adapter);
S
Sathya Perla 已提交
1217 1218
	}

1219
	/* Enable multicast promisc if num configured exceeds what we support */
1220
	if (netdev->flags & IFF_ALLMULTI ||
1221 1222
	    netdev_mc_count(netdev) > be_max_mc(adapter))
		goto set_mcast_promisc;
S
Sathya Perla 已提交
1223

1224 1225 1226 1227 1228 1229 1230 1231 1232
	if (netdev_uc_count(netdev) != adapter->uc_macs) {
		struct netdev_hw_addr *ha;
		int i = 1; /* First slot is claimed by the Primary MAC */

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

1233
		if (netdev_uc_count(netdev) > be_max_uc(adapter)) {
1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246
			be_cmd_rx_filter(adapter, IFF_PROMISC, ON);
			adapter->promiscuous = true;
			goto done;
		}

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

1247
	status = be_cmd_rx_filter(adapter, IFF_MULTICAST, ON);
1248 1249 1250 1251
	if (!status) {
		if (adapter->flags & BE_FLAGS_MCAST_PROMISC)
			adapter->flags &= ~BE_FLAGS_MCAST_PROMISC;
		goto done;
1252
	}
1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263

set_mcast_promisc:
	if (adapter->flags & BE_FLAGS_MCAST_PROMISC)
		return;

	/* Set to MCAST promisc mode if setting MULTICAST address fails
	 * or if num configured exceeds what we support
	 */
	status = be_cmd_rx_filter(adapter, IFF_ALLMULTI, ON);
	if (!status)
		adapter->flags |= BE_FLAGS_MCAST_PROMISC;
1264 1265
done:
	return;
S
Sathya Perla 已提交
1266 1267
}

1268 1269 1270
static int be_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
{
	struct be_adapter *adapter = netdev_priv(netdev);
1271
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
1272 1273
	int status;

1274
	if (!sriov_enabled(adapter))
1275 1276
		return -EPERM;

1277
	if (!is_valid_ether_addr(mac) || vf >= adapter->num_vfs)
1278 1279
		return -EINVAL;

1280 1281 1282 1283 1284 1285
	/* Proceed further only if user provided MAC is different
	 * from active MAC
	 */
	if (ether_addr_equal(mac, vf_cfg->mac_addr))
		return 0;

1286 1287 1288
	if (BEx_chip(adapter)) {
		be_cmd_pmac_del(adapter, vf_cfg->if_handle, vf_cfg->pmac_id,
				vf + 1);
1289

1290 1291
		status = be_cmd_pmac_add(adapter, mac, vf_cfg->if_handle,
					 &vf_cfg->pmac_id, vf + 1);
1292 1293 1294
	} else {
		status = be_cmd_set_mac(adapter, mac, vf_cfg->if_handle,
					vf + 1);
1295 1296
	}

1297 1298 1299 1300 1301
	if (status) {
		dev_err(&adapter->pdev->dev, "MAC %pM set on VF %d Failed: %#x",
			mac, vf, status);
		return be_cmd_status(status);
	}
1302

1303 1304 1305
	ether_addr_copy(vf_cfg->mac_addr, mac);

	return 0;
1306 1307
}

1308
static int be_get_vf_config(struct net_device *netdev, int vf,
1309
			    struct ifla_vf_info *vi)
1310 1311
{
	struct be_adapter *adapter = netdev_priv(netdev);
1312
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
1313

1314
	if (!sriov_enabled(adapter))
1315 1316
		return -EPERM;

1317
	if (vf >= adapter->num_vfs)
1318 1319 1320
		return -EINVAL;

	vi->vf = vf;
1321 1322
	vi->max_tx_rate = vf_cfg->tx_rate;
	vi->min_tx_rate = 0;
1323 1324
	vi->vlan = vf_cfg->vlan_tag & VLAN_VID_MASK;
	vi->qos = vf_cfg->vlan_tag >> VLAN_PRIO_SHIFT;
1325
	memcpy(&vi->mac, vf_cfg->mac_addr, ETH_ALEN);
1326
	vi->linkstate = adapter->vf_cfg[vf].plink_tracking;
1327 1328 1329 1330

	return 0;
}

1331
static int be_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan, u8 qos)
1332 1333
{
	struct be_adapter *adapter = netdev_priv(netdev);
1334
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
1335 1336
	int status = 0;

1337
	if (!sriov_enabled(adapter))
1338 1339
		return -EPERM;

1340
	if (vf >= adapter->num_vfs || vlan > 4095 || qos > 7)
1341 1342
		return -EINVAL;

1343 1344
	if (vlan || qos) {
		vlan |= qos << VLAN_PRIO_SHIFT;
1345
		if (vf_cfg->vlan_tag != vlan)
1346 1347
			status = be_cmd_set_hsw_config(adapter, vlan, vf + 1,
						       vf_cfg->if_handle, 0);
1348
	} else {
1349
		/* Reset Transparent Vlan Tagging. */
1350 1351
		status = be_cmd_set_hsw_config(adapter, BE_RESET_VLAN_TAG_ID,
					       vf + 1, vf_cfg->if_handle, 0);
1352 1353
	}

1354 1355 1356 1357 1358 1359 1360 1361 1362 1363
	if (status) {
		dev_err(&adapter->pdev->dev,
			"VLAN %d config on VF %d failed : %#x\n", vlan,
			vf, status);
		return be_cmd_status(status);
	}

	vf_cfg->vlan_tag = vlan;

	return 0;
1364 1365
}

1366 1367
static int be_set_vf_tx_rate(struct net_device *netdev, int vf,
			     int min_tx_rate, int max_tx_rate)
1368 1369
{
	struct be_adapter *adapter = netdev_priv(netdev);
1370 1371 1372 1373
	struct device *dev = &adapter->pdev->dev;
	int percent_rate, status = 0;
	u16 link_speed = 0;
	u8 link_status;
1374

1375
	if (!sriov_enabled(adapter))
1376 1377
		return -EPERM;

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

1381 1382 1383
	if (min_tx_rate)
		return -EINVAL;

1384 1385 1386 1387 1388 1389 1390 1391 1392 1393
	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");
1394
		status = -ENETDOWN;
1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411
		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;
1412
	}
1413

1414 1415
config_qos:
	status = be_cmd_config_qos(adapter, max_tx_rate, link_speed, vf + 1);
1416
	if (status)
1417 1418 1419 1420 1421 1422 1423 1424
		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);
1425
	return be_cmd_status(status);
1426
}
1427

1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440
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);
1441 1442 1443 1444 1445
	if (status) {
		dev_err(&adapter->pdev->dev,
			"Link state change on VF %d failed: %#x\n", vf, status);
		return be_cmd_status(status);
	}
1446

1447 1448 1449
	adapter->vf_cfg[vf].plink_tracking = link_state;

	return 0;
1450
}
1451

1452 1453
static void be_aic_update(struct be_aic_obj *aic, u64 rx_pkts, u64 tx_pkts,
			  ulong now)
S
Sathya Perla 已提交
1454
{
1455 1456 1457 1458
	aic->rx_pkts_prev = rx_pkts;
	aic->tx_reqs_prev = tx_pkts;
	aic->jiffies = now;
}
1459

1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470
static void be_eqd_update(struct be_adapter *adapter)
{
	struct be_set_eqd set_eqd[MAX_EVT_QS];
	int eqd, i, num = 0, start;
	struct be_aic_obj *aic;
	struct be_eq_obj *eqo;
	struct be_rx_obj *rxo;
	struct be_tx_obj *txo;
	u64 rx_pkts, tx_pkts;
	ulong now;
	u32 pps, delta;
S
Sathya Perla 已提交
1471

1472 1473 1474 1475 1476 1477 1478 1479
	for_all_evt_queues(adapter, eqo, i) {
		aic = &adapter->aic_obj[eqo->idx];
		if (!aic->enable) {
			if (aic->jiffies)
				aic->jiffies = 0;
			eqd = aic->et_eqd;
			goto modify_eqd;
		}
S
Sathya Perla 已提交
1480

1481 1482
		rxo = &adapter->rx_obj[eqo->idx];
		do {
1483
			start = u64_stats_fetch_begin_irq(&rxo->stats.sync);
1484
			rx_pkts = rxo->stats.rx_pkts;
1485
		} while (u64_stats_fetch_retry_irq(&rxo->stats.sync, start));
S
Sathya Perla 已提交
1486

1487 1488
		txo = &adapter->tx_obj[eqo->idx];
		do {
1489
			start = u64_stats_fetch_begin_irq(&txo->stats.sync);
1490
			tx_pkts = txo->stats.tx_reqs;
1491
		} while (u64_stats_fetch_retry_irq(&txo->stats.sync, start));
S
Sathya Perla 已提交
1492

1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505
		/* 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);
			continue;
		}

		delta = jiffies_to_msecs(now - aic->jiffies);
		pps = (((u32)(rx_pkts - aic->rx_pkts_prev) * 1000) / delta) +
			(((u32)(tx_pkts - aic->tx_reqs_prev) * 1000) / delta);
		eqd = (pps / 15000) << 2;
S
Sathya Perla 已提交
1506

1507 1508 1509 1510 1511 1512
		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);
S
Sathya Perla 已提交
1513
modify_eqd:
1514 1515 1516 1517 1518 1519
		if (eqd != aic->prev_eqd) {
			set_eqd[num].delay_multiplier = (eqd * 65)/100;
			set_eqd[num].eq_id = eqo->q.id;
			aic->prev_eqd = eqd;
			num++;
		}
1520
	}
1521 1522 1523

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

1526
static void be_rx_stats_update(struct be_rx_obj *rxo,
1527
			       struct be_rx_compl_info *rxcp)
1528
{
1529
	struct be_rx_stats *stats = rx_stats(rxo);
1530

1531
	u64_stats_update_begin(&stats->sync);
1532
	stats->rx_compl++;
1533
	stats->rx_bytes += rxcp->pkt_size;
1534
	stats->rx_pkts++;
1535
	if (rxcp->pkt_type == BE_MULTICAST_PACKET)
1536
		stats->rx_mcast_pkts++;
1537
	if (rxcp->err)
1538
		stats->rx_compl_err++;
1539
	u64_stats_update_end(&stats->sync);
1540 1541
}

1542
static inline bool csum_passed(struct be_rx_compl_info *rxcp)
1543
{
1544
	/* L4 checksum is not reliable for non TCP/UDP packets.
1545 1546
	 * Also ignore ipcksm for ipv6 pkts
	 */
1547
	return (rxcp->tcpf || rxcp->udpf) && rxcp->l4_csum &&
1548
		(rxcp->ip_csum || rxcp->ipv6) && !rxcp->err;
1549 1550
}

1551
static struct be_rx_page_info *get_rx_page_info(struct be_rx_obj *rxo)
S
Sathya Perla 已提交
1552
{
S
Sathya Perla 已提交
1553
	struct be_adapter *adapter = rxo->adapter;
S
Sathya Perla 已提交
1554
	struct be_rx_page_info *rx_page_info;
1555
	struct be_queue_info *rxq = &rxo->q;
1556
	u16 frag_idx = rxq->tail;
S
Sathya Perla 已提交
1557

1558
	rx_page_info = &rxo->page_info_tbl[frag_idx];
S
Sathya Perla 已提交
1559 1560
	BUG_ON(!rx_page_info->page);

1561
	if (rx_page_info->last_frag) {
I
Ivan Vecera 已提交
1562 1563 1564
		dma_unmap_page(&adapter->pdev->dev,
			       dma_unmap_addr(rx_page_info, bus),
			       adapter->big_page_size, DMA_FROM_DEVICE);
1565 1566 1567 1568 1569
		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 已提交
1570
	}
S
Sathya Perla 已提交
1571

1572
	queue_tail_inc(rxq);
S
Sathya Perla 已提交
1573 1574 1575 1576 1577
	atomic_dec(&rxq->used);
	return rx_page_info;
}

/* Throwaway the data in the Rx completion */
S
Sathya Perla 已提交
1578 1579
static void be_rx_compl_discard(struct be_rx_obj *rxo,
				struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
1580 1581
{
	struct be_rx_page_info *page_info;
1582
	u16 i, num_rcvd = rxcp->num_rcvd;
S
Sathya Perla 已提交
1583

1584
	for (i = 0; i < num_rcvd; i++) {
1585
		page_info = get_rx_page_info(rxo);
1586 1587
		put_page(page_info->page);
		memset(page_info, 0, sizeof(*page_info));
S
Sathya Perla 已提交
1588 1589 1590 1591 1592 1593 1594
	}
}

/*
 * skb_fill_rx_data forms a complete skb for an ether frame
 * indicated by rxcp.
 */
S
Sathya Perla 已提交
1595 1596
static void skb_fill_rx_data(struct be_rx_obj *rxo, struct sk_buff *skb,
			     struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
1597 1598
{
	struct be_rx_page_info *page_info;
1599 1600
	u16 i, j;
	u16 hdr_len, curr_frag_len, remaining;
S
Sathya Perla 已提交
1601 1602
	u8 *start;

1603
	page_info = get_rx_page_info(rxo);
S
Sathya Perla 已提交
1604 1605 1606 1607
	start = page_address(page_info->page) + page_info->page_offset;
	prefetch(start);

	/* Copy data in the first descriptor of this completion */
1608
	curr_frag_len = min(rxcp->pkt_size, rx_frag_size);
S
Sathya Perla 已提交
1609 1610 1611

	skb->len = curr_frag_len;
	if (curr_frag_len <= BE_HDR_LEN) { /* tiny packet */
1612
		memcpy(skb->data, start, curr_frag_len);
S
Sathya Perla 已提交
1613 1614 1615 1616 1617
		/* Complete packet has now been moved to data */
		put_page(page_info->page);
		skb->data_len = 0;
		skb->tail += curr_frag_len;
	} else {
1618 1619
		hdr_len = ETH_HLEN;
		memcpy(skb->data, start, hdr_len);
S
Sathya Perla 已提交
1620
		skb_shinfo(skb)->nr_frags = 1;
1621
		skb_frag_set_page(skb, 0, page_info->page);
S
Sathya Perla 已提交
1622 1623
		skb_shinfo(skb)->frags[0].page_offset =
					page_info->page_offset + hdr_len;
1624 1625
		skb_frag_size_set(&skb_shinfo(skb)->frags[0],
				  curr_frag_len - hdr_len);
S
Sathya Perla 已提交
1626
		skb->data_len = curr_frag_len - hdr_len;
E
Eric Dumazet 已提交
1627
		skb->truesize += rx_frag_size;
S
Sathya Perla 已提交
1628 1629
		skb->tail += hdr_len;
	}
A
Ajit Khaparde 已提交
1630
	page_info->page = NULL;
S
Sathya Perla 已提交
1631

1632 1633 1634
	if (rxcp->pkt_size <= rx_frag_size) {
		BUG_ON(rxcp->num_rcvd != 1);
		return;
S
Sathya Perla 已提交
1635 1636 1637
	}

	/* More frags present for this completion */
1638 1639
	remaining = rxcp->pkt_size - curr_frag_len;
	for (i = 1, j = 0; i < rxcp->num_rcvd; i++) {
1640
		page_info = get_rx_page_info(rxo);
1641
		curr_frag_len = min(remaining, rx_frag_size);
S
Sathya Perla 已提交
1642

1643 1644 1645 1646
		/* Coalesce all frags from the same physical page in one slot */
		if (page_info->page_offset == 0) {
			/* Fresh page */
			j++;
1647
			skb_frag_set_page(skb, j, page_info->page);
1648 1649
			skb_shinfo(skb)->frags[j].page_offset =
							page_info->page_offset;
E
Eric Dumazet 已提交
1650
			skb_frag_size_set(&skb_shinfo(skb)->frags[j], 0);
1651 1652 1653 1654 1655
			skb_shinfo(skb)->nr_frags++;
		} else {
			put_page(page_info->page);
		}

E
Eric Dumazet 已提交
1656
		skb_frag_size_add(&skb_shinfo(skb)->frags[j], curr_frag_len);
S
Sathya Perla 已提交
1657 1658
		skb->len += curr_frag_len;
		skb->data_len += curr_frag_len;
E
Eric Dumazet 已提交
1659
		skb->truesize += rx_frag_size;
1660
		remaining -= curr_frag_len;
A
Ajit Khaparde 已提交
1661
		page_info->page = NULL;
S
Sathya Perla 已提交
1662
	}
1663
	BUG_ON(j > MAX_SKB_FRAGS);
S
Sathya Perla 已提交
1664 1665
}

1666
/* Process the RX completion indicated by rxcp when GRO is disabled */
1667
static void be_rx_compl_process(struct be_rx_obj *rxo, struct napi_struct *napi,
S
Sathya Perla 已提交
1668
				struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
1669
{
S
Sathya Perla 已提交
1670
	struct be_adapter *adapter = rxo->adapter;
1671
	struct net_device *netdev = adapter->netdev;
S
Sathya Perla 已提交
1672
	struct sk_buff *skb;
1673

1674
	skb = netdev_alloc_skb_ip_align(netdev, BE_RX_SKB_ALLOC_SIZE);
1675
	if (unlikely(!skb)) {
1676
		rx_stats(rxo)->rx_drops_no_skbs++;
S
Sathya Perla 已提交
1677
		be_rx_compl_discard(rxo, rxcp);
S
Sathya Perla 已提交
1678 1679 1680
		return;
	}

S
Sathya Perla 已提交
1681
	skb_fill_rx_data(rxo, skb, rxcp);
S
Sathya Perla 已提交
1682

1683
	if (likely((netdev->features & NETIF_F_RXCSUM) && csum_passed(rxcp)))
1684
		skb->ip_summed = CHECKSUM_UNNECESSARY;
S
Somnath Kotur 已提交
1685 1686
	else
		skb_checksum_none_assert(skb);
S
Sathya Perla 已提交
1687

1688
	skb->protocol = eth_type_trans(skb, netdev);
1689
	skb_record_rx_queue(skb, rxo - &adapter->rx_obj[0]);
S
Sathya Perla 已提交
1690
	if (netdev->features & NETIF_F_RXHASH)
T
Tom Herbert 已提交
1691
		skb_set_hash(skb, rxcp->rss_hash, PKT_HASH_TYPE_L3);
1692

1693
	skb->csum_level = rxcp->tunneled;
1694
	skb_mark_napi_id(skb, napi);
S
Sathya Perla 已提交
1695

1696
	if (rxcp->vlanf)
1697
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), rxcp->vlan_tag);
A
Ajit Khaparde 已提交
1698 1699

	netif_receive_skb(skb);
S
Sathya Perla 已提交
1700 1701
}

1702
/* Process the RX completion indicated by rxcp when GRO is enabled */
J
Jingoo Han 已提交
1703 1704 1705
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 已提交
1706
{
S
Sathya Perla 已提交
1707
	struct be_adapter *adapter = rxo->adapter;
S
Sathya Perla 已提交
1708
	struct be_rx_page_info *page_info;
1709
	struct sk_buff *skb = NULL;
1710 1711
	u16 remaining, curr_frag_len;
	u16 i, j;
1712

S
Sathya Perla 已提交
1713
	skb = napi_get_frags(napi);
1714
	if (!skb) {
S
Sathya Perla 已提交
1715
		be_rx_compl_discard(rxo, rxcp);
1716 1717 1718
		return;
	}

1719 1720
	remaining = rxcp->pkt_size;
	for (i = 0, j = -1; i < rxcp->num_rcvd; i++) {
1721
		page_info = get_rx_page_info(rxo);
S
Sathya Perla 已提交
1722 1723 1724

		curr_frag_len = min(remaining, rx_frag_size);

1725 1726 1727 1728
		/* 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++;
1729
			skb_frag_set_page(skb, j, page_info->page);
1730 1731
			skb_shinfo(skb)->frags[j].page_offset =
							page_info->page_offset;
E
Eric Dumazet 已提交
1732
			skb_frag_size_set(&skb_shinfo(skb)->frags[j], 0);
1733 1734 1735
		} else {
			put_page(page_info->page);
		}
E
Eric Dumazet 已提交
1736
		skb_frag_size_add(&skb_shinfo(skb)->frags[j], curr_frag_len);
E
Eric Dumazet 已提交
1737
		skb->truesize += rx_frag_size;
1738
		remaining -= curr_frag_len;
S
Sathya Perla 已提交
1739 1740
		memset(page_info, 0, sizeof(*page_info));
	}
1741
	BUG_ON(j > MAX_SKB_FRAGS);
S
Sathya Perla 已提交
1742

1743
	skb_shinfo(skb)->nr_frags = j + 1;
1744 1745
	skb->len = rxcp->pkt_size;
	skb->data_len = rxcp->pkt_size;
1746
	skb->ip_summed = CHECKSUM_UNNECESSARY;
1747
	skb_record_rx_queue(skb, rxo - &adapter->rx_obj[0]);
A
Ajit Khaparde 已提交
1748
	if (adapter->netdev->features & NETIF_F_RXHASH)
T
Tom Herbert 已提交
1749
		skb_set_hash(skb, rxcp->rss_hash, PKT_HASH_TYPE_L3);
1750

1751
	skb->csum_level = rxcp->tunneled;
1752
	skb_mark_napi_id(skb, napi);
1753

1754
	if (rxcp->vlanf)
1755
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), rxcp->vlan_tag);
A
Ajit Khaparde 已提交
1756

S
Sathya Perla 已提交
1757
	napi_gro_frags(napi);
1758 1759
}

S
Sathya Perla 已提交
1760 1761
static void be_parse_rx_compl_v1(struct be_eth_rx_compl *compl,
				 struct be_rx_compl_info *rxcp)
1762
{
1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773
	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);
1774
	if (rxcp->vlanf) {
1775 1776
		rxcp->qnq = GET_RX_COMPL_V1_BITS(qnq, compl);
		rxcp->vlan_tag = GET_RX_COMPL_V1_BITS(vlan_tag, compl);
1777
	}
1778
	rxcp->port = GET_RX_COMPL_V1_BITS(port, compl);
1779
	rxcp->tunneled =
1780
		GET_RX_COMPL_V1_BITS(tunneled, compl);
1781 1782
}

S
Sathya Perla 已提交
1783 1784
static void be_parse_rx_compl_v0(struct be_eth_rx_compl *compl,
				 struct be_rx_compl_info *rxcp)
1785
{
1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796
	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);
1797
	if (rxcp->vlanf) {
1798 1799
		rxcp->qnq = GET_RX_COMPL_V0_BITS(qnq, compl);
		rxcp->vlan_tag = GET_RX_COMPL_V0_BITS(vlan_tag, compl);
1800
	}
1801 1802
	rxcp->port = GET_RX_COMPL_V0_BITS(port, compl);
	rxcp->ip_frag = GET_RX_COMPL_V0_BITS(ip_frag, compl);
1803 1804 1805 1806 1807 1808 1809
}

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

1811 1812 1813 1814
	/* 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 已提交
1815

1816 1817
	rmb();
	be_dws_le_to_cpu(compl, sizeof(*compl));
S
Sathya Perla 已提交
1818

1819
	if (adapter->be3_native)
S
Sathya Perla 已提交
1820
		be_parse_rx_compl_v1(compl, rxcp);
1821
	else
S
Sathya Perla 已提交
1822
		be_parse_rx_compl_v0(compl, rxcp);
S
Sathya Perla 已提交
1823

1824 1825 1826
	if (rxcp->ip_frag)
		rxcp->l4_csum = 0;

1827
	if (rxcp->vlanf) {
1828 1829 1830 1831 1832
		/* 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)
1833
			rxcp->vlanf = 0;
S
Sathya Perla 已提交
1834

1835
		if (!lancer_chip(adapter))
1836
			rxcp->vlan_tag = swab16(rxcp->vlan_tag);
S
Sathya Perla 已提交
1837

1838
		if (adapter->pvid == (rxcp->vlan_tag & VLAN_VID_MASK) &&
1839
		    !test_bit(rxcp->vlan_tag, adapter->vids))
1840 1841
			rxcp->vlanf = 0;
	}
1842 1843 1844

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

1846
	queue_tail_inc(&rxo->cq);
S
Sathya Perla 已提交
1847 1848 1849
	return rxcp;
}

1850
static inline struct page *be_alloc_pages(u32 size, gfp_t gfp)
S
Sathya Perla 已提交
1851 1852
{
	u32 order = get_order(size);
1853

S
Sathya Perla 已提交
1854
	if (order > 0)
1855 1856
		gfp |= __GFP_COMP;
	return  alloc_pages(gfp, order);
S
Sathya Perla 已提交
1857 1858 1859 1860 1861 1862
}

/*
 * Allocate a page, split it to fragments of size rx_frag_size and post as
 * receive buffers to BE
 */
1863
static void be_post_rx_frags(struct be_rx_obj *rxo, gfp_t gfp, u32 frags_needed)
S
Sathya Perla 已提交
1864
{
1865
	struct be_adapter *adapter = rxo->adapter;
1866
	struct be_rx_page_info *page_info = NULL, *prev_page_info = NULL;
1867
	struct be_queue_info *rxq = &rxo->q;
S
Sathya Perla 已提交
1868
	struct page *pagep = NULL;
1869
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
1870 1871
	struct be_eth_rx_d *rxd;
	u64 page_dmaaddr = 0, frag_dmaaddr;
1872
	u32 posted, page_offset = 0, notify = 0;
S
Sathya Perla 已提交
1873

1874
	page_info = &rxo->page_info_tbl[rxq->head];
1875
	for (posted = 0; posted < frags_needed && !page_info->page; posted++) {
S
Sathya Perla 已提交
1876
		if (!pagep) {
1877
			pagep = be_alloc_pages(adapter->big_page_size, gfp);
S
Sathya Perla 已提交
1878
			if (unlikely(!pagep)) {
1879
				rx_stats(rxo)->rx_post_fail++;
S
Sathya Perla 已提交
1880 1881
				break;
			}
1882 1883
			page_dmaaddr = dma_map_page(dev, pagep, 0,
						    adapter->big_page_size,
I
Ivan Vecera 已提交
1884
						    DMA_FROM_DEVICE);
1885 1886 1887
			if (dma_mapping_error(dev, page_dmaaddr)) {
				put_page(pagep);
				pagep = NULL;
1888
				adapter->drv_stats.dma_map_errors++;
1889 1890
				break;
			}
1891
			page_offset = 0;
S
Sathya Perla 已提交
1892 1893
		} else {
			get_page(pagep);
1894
			page_offset += rx_frag_size;
S
Sathya Perla 已提交
1895
		}
1896
		page_info->page_offset = page_offset;
S
Sathya Perla 已提交
1897 1898 1899
		page_info->page = pagep;

		rxd = queue_head_node(rxq);
1900
		frag_dmaaddr = page_dmaaddr + page_info->page_offset;
S
Sathya Perla 已提交
1901 1902 1903 1904 1905 1906 1907
		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;
1908 1909 1910 1911
			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 已提交
1912
		}
1913 1914 1915

		prev_page_info = page_info;
		queue_head_inc(rxq);
S
Sathya Perla 已提交
1916
		page_info = &rxo->page_info_tbl[rxq->head];
S
Sathya Perla 已提交
1917
	}
1918 1919 1920 1921 1922 1923 1924 1925

	/* 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 已提交
1926 1927 1928

	if (posted) {
		atomic_add(posted, &rxq->used);
1929 1930
		if (rxo->rx_post_starved)
			rxo->rx_post_starved = false;
1931 1932 1933 1934 1935
		do {
			notify = min(256u, posted);
			be_rxq_notify(adapter, rxq->id, notify);
			posted -= notify;
		} while (posted);
1936 1937
	} else if (atomic_read(&rxq->used) == 0) {
		/* Let be_worker replenish when memory is available */
1938
		rxo->rx_post_starved = true;
S
Sathya Perla 已提交
1939 1940 1941
	}
}

1942
static struct be_eth_tx_compl *be_tx_compl_get(struct be_queue_info *tx_cq)
S
Sathya Perla 已提交
1943 1944 1945 1946 1947 1948
{
	struct be_eth_tx_compl *txcp = queue_tail_node(tx_cq);

	if (txcp->dw[offsetof(struct amap_eth_tx_compl, valid) / 32] == 0)
		return NULL;

1949
	rmb();
S
Sathya Perla 已提交
1950 1951 1952 1953 1954 1955 1956 1957
	be_dws_le_to_cpu(txcp, sizeof(*txcp));

	txcp->dw[offsetof(struct amap_eth_tx_compl, valid) / 32] = 0;

	queue_tail_inc(tx_cq);
	return txcp;
}

1958
static u16 be_tx_compl_process(struct be_adapter *adapter,
1959
			       struct be_tx_obj *txo, u16 last_index)
S
Sathya Perla 已提交
1960
{
1961
	struct be_queue_info *txq = &txo->q;
1962
	struct be_eth_wrb *wrb;
1963
	struct sk_buff **sent_skbs = txo->sent_skb_list;
S
Sathya Perla 已提交
1964
	struct sk_buff *sent_skb;
1965 1966
	u16 cur_index, num_wrbs = 1; /* account for hdr wrb */
	bool unmap_skb_hdr = true;
S
Sathya Perla 已提交
1967

1968
	sent_skb = sent_skbs[txq->tail];
S
Sathya Perla 已提交
1969
	BUG_ON(!sent_skb);
1970 1971 1972
	sent_skbs[txq->tail] = NULL;

	/* skip header wrb */
1973
	queue_tail_inc(txq);
S
Sathya Perla 已提交
1974

1975
	do {
S
Sathya Perla 已提交
1976
		cur_index = txq->tail;
1977
		wrb = queue_tail_node(txq);
I
Ivan Vecera 已提交
1978 1979
		unmap_tx_frag(&adapter->pdev->dev, wrb,
			      (unmap_skb_hdr && skb_headlen(sent_skb)));
1980 1981
		unmap_skb_hdr = false;

S
Sathya Perla 已提交
1982 1983
		num_wrbs++;
		queue_tail_inc(txq);
1984
	} while (cur_index != last_index);
S
Sathya Perla 已提交
1985

1986
	dev_consume_skb_any(sent_skb);
1987
	return num_wrbs;
S
Sathya Perla 已提交
1988 1989
}

S
Sathya Perla 已提交
1990 1991
/* Return the number of events in the event queue */
static inline int events_get(struct be_eq_obj *eqo)
1992
{
S
Sathya Perla 已提交
1993 1994
	struct be_eq_entry *eqe;
	int num = 0;
1995

S
Sathya Perla 已提交
1996 1997 1998 1999
	do {
		eqe = queue_tail_node(&eqo->q);
		if (eqe->evt == 0)
			break;
2000

S
Sathya Perla 已提交
2001 2002 2003 2004 2005 2006 2007
		rmb();
		eqe->evt = 0;
		num++;
		queue_tail_inc(&eqo->q);
	} while (true);

	return num;
2008 2009
}

S
Sathya Perla 已提交
2010 2011
/* Leaves the EQ is disarmed state */
static void be_eq_clean(struct be_eq_obj *eqo)
2012
{
S
Sathya Perla 已提交
2013
	int num = events_get(eqo);
2014

S
Sathya Perla 已提交
2015
	be_eq_notify(eqo->adapter, eqo->q.id, false, true, num);
2016 2017
}

S
Sathya Perla 已提交
2018
static void be_rx_cq_clean(struct be_rx_obj *rxo)
S
Sathya Perla 已提交
2019 2020
{
	struct be_rx_page_info *page_info;
2021 2022
	struct be_queue_info *rxq = &rxo->q;
	struct be_queue_info *rx_cq = &rxo->cq;
2023
	struct be_rx_compl_info *rxcp;
2024 2025
	struct be_adapter *adapter = rxo->adapter;
	int flush_wait = 0;
S
Sathya Perla 已提交
2026

2027 2028 2029 2030 2031 2032 2033 2034
	/* 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 已提交
2035
		if (!rxcp) {
2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047
			if (lancer_chip(adapter))
				break;

			if (flush_wait++ > 10 || be_hw_error(adapter)) {
				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);
2048
			be_cq_notify(adapter, rx_cq->id, false, 1);
2049 2050 2051
			if (rxcp->num_rcvd == 0)
				break;
		}
S
Sathya Perla 已提交
2052 2053
	}

2054 2055 2056 2057
	/* After cleanup, leave the CQ in unarmed state */
	be_cq_notify(adapter, rx_cq->id, false, 0);

	/* Then free posted rx buffers that were not used */
2058 2059
	while (atomic_read(&rxq->used) > 0) {
		page_info = get_rx_page_info(rxo);
S
Sathya Perla 已提交
2060 2061 2062 2063
		put_page(page_info->page);
		memset(page_info, 0, sizeof(*page_info));
	}
	BUG_ON(atomic_read(&rxq->used));
2064 2065
	rxq->tail = 0;
	rxq->head = 0;
S
Sathya Perla 已提交
2066 2067
}

S
Sathya Perla 已提交
2068
static void be_tx_compl_clean(struct be_adapter *adapter)
S
Sathya Perla 已提交
2069
{
S
Sathya Perla 已提交
2070 2071
	struct be_tx_obj *txo;
	struct be_queue_info *txq;
2072
	struct be_eth_tx_compl *txcp;
2073
	u16 end_idx, cmpl = 0, timeo = 0, num_wrbs = 0;
2074 2075
	struct sk_buff *sent_skb;
	bool dummy_wrb;
S
Sathya Perla 已提交
2076
	int i, pending_txqs;
2077

2078
	/* Stop polling for compls when HW has been silent for 10ms */
2079
	do {
S
Sathya Perla 已提交
2080 2081 2082
		pending_txqs = adapter->num_tx_qs;

		for_all_tx_queues(adapter, txo, i) {
2083 2084
			cmpl = 0;
			num_wrbs = 0;
S
Sathya Perla 已提交
2085 2086
			txq = &txo->q;
			while ((txcp = be_tx_compl_get(&txo->cq))) {
2087
				end_idx = GET_TX_COMPL_BITS(wrb_index, txcp);
S
Sathya Perla 已提交
2088 2089 2090 2091 2092 2093 2094
				num_wrbs += be_tx_compl_process(adapter, txo,
								end_idx);
				cmpl++;
			}
			if (cmpl) {
				be_cq_notify(adapter, txo->cq.id, false, cmpl);
				atomic_sub(num_wrbs, &txq->used);
2095
				timeo = 0;
S
Sathya Perla 已提交
2096 2097 2098
			}
			if (atomic_read(&txq->used) == 0)
				pending_txqs--;
2099 2100
		}

2101
		if (pending_txqs == 0 || ++timeo > 10 || be_hw_error(adapter))
2102 2103 2104 2105 2106
			break;

		mdelay(1);
	} while (true);

S
Sathya Perla 已提交
2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122
	for_all_tx_queues(adapter, txo, i) {
		txq = &txo->q;
		if (atomic_read(&txq->used))
			dev_err(&adapter->pdev->dev, "%d pending tx-compls\n",
				atomic_read(&txq->used));

		/* free posted tx for which compls will never arrive */
		while (atomic_read(&txq->used)) {
			sent_skb = txo->sent_skb_list[txq->tail];
			end_idx = txq->tail;
			num_wrbs = wrb_cnt_for_skb(adapter, sent_skb,
						   &dummy_wrb);
			index_adv(&end_idx, num_wrbs - 1, txq->len);
			num_wrbs = be_tx_compl_process(adapter, txo, end_idx);
			atomic_sub(num_wrbs, &txq->used);
		}
2123
	}
S
Sathya Perla 已提交
2124 2125
}

S
Sathya Perla 已提交
2126 2127 2128 2129 2130 2131
static void be_evt_queues_destroy(struct be_adapter *adapter)
{
	struct be_eq_obj *eqo;
	int i;

	for_all_evt_queues(adapter, eqo, i) {
2132 2133
		if (eqo->q.created) {
			be_eq_clean(eqo);
S
Sathya Perla 已提交
2134
			be_cmd_q_destroy(adapter, &eqo->q, QTYPE_EQ);
2135
			napi_hash_del(&eqo->napi);
2136
			netif_napi_del(&eqo->napi);
2137
		}
S
Sathya Perla 已提交
2138 2139 2140 2141 2142 2143 2144 2145
		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;
2146
	struct be_aic_obj *aic;
S
Sathya Perla 已提交
2147 2148
	int i, rc;

2149 2150
	adapter->num_evt_qs = min_t(u16, num_irqs(adapter),
				    adapter->cfg_num_qs);
S
Sathya Perla 已提交
2151 2152

	for_all_evt_queues(adapter, eqo, i) {
2153 2154
		netif_napi_add(adapter->netdev, &eqo->napi, be_poll,
			       BE_NAPI_WEIGHT);
2155
		napi_hash_add(&eqo->napi);
2156
		aic = &adapter->aic_obj[i];
S
Sathya Perla 已提交
2157 2158
		eqo->adapter = adapter;
		eqo->idx = i;
2159 2160
		aic->max_eqd = BE_MAX_EQD;
		aic->enable = true;
S
Sathya Perla 已提交
2161 2162 2163

		eq = &eqo->q;
		rc = be_queue_alloc(adapter, eq, EVNT_Q_LEN,
2164
				    sizeof(struct be_eq_entry));
S
Sathya Perla 已提交
2165 2166 2167
		if (rc)
			return rc;

S
Sathya Perla 已提交
2168
		rc = be_cmd_eq_create(adapter, eqo);
S
Sathya Perla 已提交
2169 2170 2171
		if (rc)
			return rc;
	}
2172
	return 0;
S
Sathya Perla 已提交
2173 2174
}

2175 2176 2177 2178
static void be_mcc_queues_destroy(struct be_adapter *adapter)
{
	struct be_queue_info *q;

2179
	q = &adapter->mcc_obj.q;
2180
	if (q->created)
2181
		be_cmd_q_destroy(adapter, q, QTYPE_MCCQ);
2182 2183
	be_queue_free(adapter, q);

2184
	q = &adapter->mcc_obj.cq;
2185
	if (q->created)
2186
		be_cmd_q_destroy(adapter, q, QTYPE_CQ);
2187 2188 2189 2190 2191 2192 2193 2194
	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;

2195
	cq = &adapter->mcc_obj.cq;
2196
	if (be_queue_alloc(adapter, cq, MCC_CQ_LEN,
2197
			   sizeof(struct be_mcc_compl)))
2198 2199
		goto err;

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

2204
	q = &adapter->mcc_obj.q;
2205 2206 2207
	if (be_queue_alloc(adapter, q, MCC_Q_LEN, sizeof(struct be_mcc_wrb)))
		goto mcc_cq_destroy;

2208
	if (be_cmd_mccq_create(adapter, q, cq))
2209 2210 2211 2212 2213 2214 2215
		goto mcc_q_free;

	return 0;

mcc_q_free:
	be_queue_free(adapter, q);
mcc_cq_destroy:
2216
	be_cmd_q_destroy(adapter, cq, QTYPE_CQ);
2217 2218 2219 2220 2221 2222
mcc_cq_free:
	be_queue_free(adapter, cq);
err:
	return -1;
}

S
Sathya Perla 已提交
2223 2224 2225
static void be_tx_queues_destroy(struct be_adapter *adapter)
{
	struct be_queue_info *q;
2226 2227
	struct be_tx_obj *txo;
	u8 i;
S
Sathya Perla 已提交
2228

2229 2230 2231 2232 2233
	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 已提交
2234

2235 2236 2237 2238 2239
		q = &txo->cq;
		if (q->created)
			be_cmd_q_destroy(adapter, q, QTYPE_CQ);
		be_queue_free(adapter, q);
	}
S
Sathya Perla 已提交
2240 2241
}

2242
static int be_tx_qs_create(struct be_adapter *adapter)
S
Sathya Perla 已提交
2243
{
S
Sathya Perla 已提交
2244
	struct be_queue_info *cq, *eq;
2245
	struct be_tx_obj *txo;
2246
	int status, i;
S
Sathya Perla 已提交
2247

2248
	adapter->num_tx_qs = min(adapter->num_evt_qs, be_max_txqs(adapter));
2249

S
Sathya Perla 已提交
2250 2251 2252 2253 2254 2255
	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;
2256

2257 2258 2259
		u64_stats_init(&txo->stats.sync);
		u64_stats_init(&txo->stats.sync_compl);

S
Sathya Perla 已提交
2260 2261 2262 2263 2264 2265 2266
		/* If num_evt_qs is less than num_tx_qs, then more than
		 * one txq share an eq
		 */
		eq = &adapter->eq_obj[i % adapter->num_evt_qs].q;
		status = be_cmd_cq_create(adapter, cq, eq, false, 3);
		if (status)
			return status;
S
Sathya Perla 已提交
2267

S
Sathya Perla 已提交
2268 2269 2270 2271
		status = be_queue_alloc(adapter, &txo->q, TX_Q_LEN,
					sizeof(struct be_eth_wrb));
		if (status)
			return status;
S
Sathya Perla 已提交
2272

V
Vasundhara Volam 已提交
2273
		status = be_cmd_txq_create(adapter, txo);
S
Sathya Perla 已提交
2274 2275
		if (status)
			return status;
2276
	}
S
Sathya Perla 已提交
2277

S
Sathya Perla 已提交
2278 2279
	dev_info(&adapter->pdev->dev, "created %d TX queue(s)\n",
		 adapter->num_tx_qs);
S
Sathya Perla 已提交
2280
	return 0;
S
Sathya Perla 已提交
2281 2282
}

S
Sathya Perla 已提交
2283
static void be_rx_cqs_destroy(struct be_adapter *adapter)
S
Sathya Perla 已提交
2284 2285
{
	struct be_queue_info *q;
2286 2287 2288 2289 2290 2291 2292 2293
	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);
2294 2295 2296
	}
}

S
Sathya Perla 已提交
2297
static int be_rx_cqs_create(struct be_adapter *adapter)
S
Sathya Perla 已提交
2298
{
S
Sathya Perla 已提交
2299
	struct be_queue_info *eq, *cq;
2300 2301
	struct be_rx_obj *rxo;
	int rc, i;
S
Sathya Perla 已提交
2302

2303 2304 2305 2306 2307
	/* We can create as many RSS rings as there are EQs. */
	adapter->num_rx_qs = adapter->num_evt_qs;

	/* We'll use RSS only if atleast 2 RSS rings are supported.
	 * When RSS is used, we'll need a default RXQ for non-IP traffic.
S
Sathya Perla 已提交
2308
	 */
2309 2310 2311
	if (adapter->num_rx_qs > 1)
		adapter->num_rx_qs++;

S
Sathya Perla 已提交
2312
	adapter->big_page_size = (1 << get_order(rx_frag_size)) * PAGE_SIZE;
2313 2314 2315 2316
	for_all_rx_queues(adapter, rxo, i) {
		rxo->adapter = adapter;
		cq = &rxo->cq;
		rc = be_queue_alloc(adapter, cq, RX_CQ_LEN,
2317
				    sizeof(struct be_eth_rx_compl));
2318
		if (rc)
S
Sathya Perla 已提交
2319
			return rc;
2320

2321
		u64_stats_init(&rxo->stats.sync);
S
Sathya Perla 已提交
2322 2323
		eq = &adapter->eq_obj[i % adapter->num_evt_qs].q;
		rc = be_cmd_cq_create(adapter, cq, eq, false, 3);
2324
		if (rc)
S
Sathya Perla 已提交
2325
			return rc;
2326
	}
S
Sathya Perla 已提交
2327

S
Sathya Perla 已提交
2328 2329 2330
	dev_info(&adapter->pdev->dev,
		 "created %d RSS queue(s) and 1 default RX queue\n",
		 adapter->num_rx_qs - 1);
S
Sathya Perla 已提交
2331
	return 0;
2332 2333
}

S
Sathya Perla 已提交
2334 2335
static irqreturn_t be_intx(int irq, void *dev)
{
2336 2337 2338
	struct be_eq_obj *eqo = dev;
	struct be_adapter *adapter = eqo->adapter;
	int num_evts = 0;
S
Sathya Perla 已提交
2339

2340 2341 2342 2343 2344 2345 2346
	/* 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.
2347
	 */
2348
	if (napi_schedule_prep(&eqo->napi)) {
2349
		num_evts = events_get(eqo);
2350 2351 2352 2353 2354
		__napi_schedule(&eqo->napi);
		if (num_evts)
			eqo->spurious_intr = 0;
	}
	be_eq_notify(adapter, eqo->q.id, false, true, num_evts);
2355

2356 2357 2358
	/* 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!
2359
	 */
2360 2361 2362 2363
	if (num_evts || eqo->spurious_intr++ == 0)
		return IRQ_HANDLED;
	else
		return IRQ_NONE;
S
Sathya Perla 已提交
2364 2365
}

S
Sathya Perla 已提交
2366
static irqreturn_t be_msix(int irq, void *dev)
S
Sathya Perla 已提交
2367
{
S
Sathya Perla 已提交
2368
	struct be_eq_obj *eqo = dev;
S
Sathya Perla 已提交
2369

2370 2371
	be_eq_notify(eqo->adapter, eqo->q.id, false, true, 0);
	napi_schedule(&eqo->napi);
S
Sathya Perla 已提交
2372 2373 2374
	return IRQ_HANDLED;
}

2375
static inline bool do_gro(struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
2376
{
2377
	return (rxcp->tcpf && !rxcp->err && rxcp->l4_csum) ? true : false;
S
Sathya Perla 已提交
2378 2379
}

S
Sathya Perla 已提交
2380
static int be_process_rx(struct be_rx_obj *rxo, struct napi_struct *napi,
2381
			 int budget, int polling)
S
Sathya Perla 已提交
2382
{
2383 2384
	struct be_adapter *adapter = rxo->adapter;
	struct be_queue_info *rx_cq = &rxo->cq;
2385
	struct be_rx_compl_info *rxcp;
S
Sathya Perla 已提交
2386
	u32 work_done;
2387
	u32 frags_consumed = 0;
S
Sathya Perla 已提交
2388 2389

	for (work_done = 0; work_done < budget; work_done++) {
2390
		rxcp = be_rx_compl_get(rxo);
S
Sathya Perla 已提交
2391 2392 2393
		if (!rxcp)
			break;

2394 2395 2396 2397 2398 2399
		/* 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 已提交
2400
			be_rx_compl_discard(rxo, rxcp);
2401 2402 2403 2404 2405 2406 2407
			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 &&
2408
			     !lancer_chip(adapter))) {
S
Sathya Perla 已提交
2409
			be_rx_compl_discard(rxo, rxcp);
2410
			goto loop_continue;
2411
		}
2412

2413 2414
		/* Don't do gro when we're busy_polling */
		if (do_gro(rxcp) && polling != BUSY_POLLING)
S
Sathya Perla 已提交
2415
			be_rx_compl_process_gro(rxo, napi, rxcp);
2416
		else
2417 2418
			be_rx_compl_process(rxo, napi, rxcp);

2419
loop_continue:
2420
		frags_consumed += rxcp->num_rcvd;
2421
		be_rx_stats_update(rxo, rxcp);
S
Sathya Perla 已提交
2422 2423
	}

S
Sathya Perla 已提交
2424 2425
	if (work_done) {
		be_cq_notify(adapter, rx_cq->id, true, work_done);
2426

2427 2428 2429 2430 2431
		/* 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)
2432 2433 2434
			be_post_rx_frags(rxo, GFP_ATOMIC,
					 max_t(u32, MAX_RX_POST,
					       frags_consumed));
S
Sathya Perla 已提交
2435
	}
S
Sathya Perla 已提交
2436

S
Sathya Perla 已提交
2437 2438 2439
	return work_done;
}

2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476
static inline void be_update_tx_err(struct be_tx_obj *txo, u32 status)
{
	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;
	}
}

static inline void lancer_update_tx_err(struct be_tx_obj *txo, u32 status)
{
	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 已提交
2477 2478
static void be_process_tx(struct be_adapter *adapter, struct be_tx_obj *txo,
			  int idx)
S
Sathya Perla 已提交
2479 2480
{
	struct be_eth_tx_compl *txcp;
S
Sathya Perla 已提交
2481
	int num_wrbs = 0, work_done = 0;
2482
	u32 compl_status;
S
Sathya Perla 已提交
2483 2484 2485 2486 2487 2488
	u16 last_idx;

	while ((txcp = be_tx_compl_get(&txo->cq))) {
		last_idx = GET_TX_COMPL_BITS(wrb_index, txcp);
		num_wrbs += be_tx_compl_process(adapter, txo, last_idx);
		work_done++;
2489

2490 2491 2492 2493 2494 2495 2496
		compl_status = GET_TX_COMPL_BITS(status, txcp);
		if (compl_status) {
			if (lancer_chip(adapter))
				lancer_update_tx_err(txo, compl_status);
			else
				be_update_tx_err(txo, compl_status);
		}
S
Sathya Perla 已提交
2497
	}
S
Sathya Perla 已提交
2498

S
Sathya Perla 已提交
2499 2500 2501
	if (work_done) {
		be_cq_notify(adapter, txo->cq.id, true, work_done);
		atomic_sub(num_wrbs, &txo->q.used);
2502

S
Sathya Perla 已提交
2503 2504 2505
		/* 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) &&
2506
		    atomic_read(&txo->q.used) < txo->q.len / 2) {
S
Sathya Perla 已提交
2507
			netif_wake_subqueue(adapter->netdev, idx);
2508
		}
S
Sathya Perla 已提交
2509 2510 2511 2512

		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 已提交
2513
	}
S
Sathya Perla 已提交
2514
}
S
Sathya Perla 已提交
2515

2516
int be_poll(struct napi_struct *napi, int budget)
S
Sathya Perla 已提交
2517 2518 2519
{
	struct be_eq_obj *eqo = container_of(napi, struct be_eq_obj, napi);
	struct be_adapter *adapter = eqo->adapter;
2520
	int max_work = 0, work, i, num_evts;
2521
	struct be_rx_obj *rxo;
2522
	struct be_tx_obj *txo;
S
Sathya Perla 已提交
2523

2524 2525
	num_evts = events_get(eqo);

2526 2527
	for_all_tx_queues_on_eq(adapter, eqo, txo, i)
		be_process_tx(adapter, txo, i);
S
Sathya Perla 已提交
2528

2529 2530 2531 2532 2533 2534 2535 2536 2537 2538 2539 2540
	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 已提交
2541
	}
S
Sathya Perla 已提交
2542

S
Sathya Perla 已提交
2543 2544
	if (is_mcc_eqo(eqo))
		be_process_mcc(adapter);
2545

S
Sathya Perla 已提交
2546 2547
	if (max_work < budget) {
		napi_complete(napi);
2548
		be_eq_notify(adapter, eqo->q.id, true, false, num_evts);
S
Sathya Perla 已提交
2549 2550
	} else {
		/* As we'll continue in polling mode, count and clear events */
2551
		be_eq_notify(adapter, eqo->q.id, false, false, num_evts);
2552
	}
S
Sathya Perla 已提交
2553
	return max_work;
S
Sathya Perla 已提交
2554 2555
}

2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576 2577
#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

2578
void be_detect_error(struct be_adapter *adapter)
2579
{
2580 2581
	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;
2582
	u32 i;
2583 2584 2585
	bool error_detected = false;
	struct device *dev = &adapter->pdev->dev;
	struct net_device *netdev = adapter->netdev;
2586

2587
	if (be_hw_error(adapter))
2588 2589
		return;

2590 2591 2592 2593
	if (lancer_chip(adapter)) {
		sliport_status = ioread32(adapter->db + SLIPORT_STATUS_OFFSET);
		if (sliport_status & SLIPORT_STATUS_ERR_MASK) {
			sliport_err1 = ioread32(adapter->db +
2594
						SLIPORT_ERROR1_OFFSET);
2595
			sliport_err2 = ioread32(adapter->db +
2596
						SLIPORT_ERROR2_OFFSET);
2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611
			adapter->hw_error = true;
			/* 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 {
				error_detected = true;
				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);
			}
2612 2613 2614
		}
	} else {
		pci_read_config_dword(adapter->pdev,
2615
				      PCICFG_UE_STATUS_LOW, &ue_lo);
2616
		pci_read_config_dword(adapter->pdev,
2617
				      PCICFG_UE_STATUS_HIGH, &ue_hi);
2618
		pci_read_config_dword(adapter->pdev,
2619
				      PCICFG_UE_STATUS_LOW_MASK, &ue_lo_mask);
2620
		pci_read_config_dword(adapter->pdev,
2621
				      PCICFG_UE_STATUS_HI_MASK, &ue_hi_mask);
2622

2623 2624
		ue_lo = (ue_lo & ~ue_lo_mask);
		ue_hi = (ue_hi & ~ue_hi_mask);
2625

2626 2627 2628 2629
		/* 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.
		 */
2630

2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646 2647
		if (ue_lo || ue_hi) {
			error_detected = true;
			dev_err(dev,
				"Unrecoverable Error detected in the adapter");
			dev_err(dev, "Please reboot server to recover");
			if (skyhawk_chip(adapter))
				adapter->hw_error = true;
			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]);
			}
2648 2649
		}
	}
2650 2651
	if (error_detected)
		netif_carrier_off(netdev);
2652 2653
}

2654 2655
static void be_msix_disable(struct be_adapter *adapter)
{
2656
	if (msix_enabled(adapter)) {
2657
		pci_disable_msix(adapter->pdev);
2658
		adapter->num_msix_vec = 0;
2659
		adapter->num_msix_roce_vec = 0;
2660 2661 2662
	}
}

2663
static int be_msix_enable(struct be_adapter *adapter)
S
Sathya Perla 已提交
2664
{
2665
	int i, num_vec;
S
Sathya Perla 已提交
2666
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
2667

2668 2669 2670 2671 2672 2673 2674 2675 2676
	/* If RoCE is supported, program the max number of NIC vectors that
	 * may be configured via set-channels, along with vectors needed for
	 * RoCe. Else, just program the number we'll use initially.
	 */
	if (be_roce_supported(adapter))
		num_vec = min_t(int, 2 * be_max_eqs(adapter),
				2 * num_online_cpus());
	else
		num_vec = adapter->cfg_num_qs;
2677

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

2681 2682 2683 2684
	num_vec = pci_enable_msix_range(adapter->pdev, adapter->msix_entries,
					MIN_MSIX_VECTORS, num_vec);
	if (num_vec < 0)
		goto fail;
2685 2686 2687 2688 2689 2690 2691 2692 2693 2694 2695

	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);
2696
	return 0;
2697 2698 2699 2700 2701 2702 2703 2704

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

	/* INTx is not supported in VFs, so fail probe if enable_msix fails */
	if (!be_physfn(adapter))
		return num_vec;
	return 0;
S
Sathya Perla 已提交
2705 2706
}

2707
static inline int be_msix_vec_get(struct be_adapter *adapter,
2708
				  struct be_eq_obj *eqo)
2709
{
S
Sathya Perla 已提交
2710
	return adapter->msix_entries[eqo->msix_idx].vector;
2711
}
S
Sathya Perla 已提交
2712

2713 2714
static int be_msix_register(struct be_adapter *adapter)
{
S
Sathya Perla 已提交
2715 2716 2717
	struct net_device *netdev = adapter->netdev;
	struct be_eq_obj *eqo;
	int status, i, vec;
S
Sathya Perla 已提交
2718

S
Sathya Perla 已提交
2719 2720 2721 2722
	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);
2723 2724 2725
		if (status)
			goto err_msix;
	}
2726

S
Sathya Perla 已提交
2727
	return 0;
2728
err_msix:
S
Sathya Perla 已提交
2729 2730 2731
	for (i--, eqo = &adapter->eq_obj[i]; i >= 0; i--, eqo--)
		free_irq(be_msix_vec_get(adapter, eqo), eqo);
	dev_warn(&adapter->pdev->dev, "MSIX Request IRQ failed - err %d\n",
2732
		 status);
2733
	be_msix_disable(adapter);
S
Sathya Perla 已提交
2734 2735 2736 2737 2738 2739 2740 2741
	return status;
}

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

2742
	if (msix_enabled(adapter)) {
S
Sathya Perla 已提交
2743 2744 2745
		status = be_msix_register(adapter);
		if (status == 0)
			goto done;
2746 2747 2748
		/* INTx is not supported for VF */
		if (!be_physfn(adapter))
			return status;
S
Sathya Perla 已提交
2749 2750
	}

2751
	/* INTx: only the first EQ is used */
S
Sathya Perla 已提交
2752 2753
	netdev->irq = adapter->pdev->irq;
	status = request_irq(netdev->irq, be_intx, IRQF_SHARED, netdev->name,
2754
			     &adapter->eq_obj[0]);
S
Sathya Perla 已提交
2755 2756 2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767
	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 已提交
2768
	struct be_eq_obj *eqo;
2769
	int i;
S
Sathya Perla 已提交
2770 2771 2772 2773 2774

	if (!adapter->isr_registered)
		return;

	/* INTx */
2775
	if (!msix_enabled(adapter)) {
2776
		free_irq(netdev->irq, &adapter->eq_obj[0]);
S
Sathya Perla 已提交
2777 2778 2779 2780
		goto done;
	}

	/* MSIx */
S
Sathya Perla 已提交
2781 2782
	for_all_evt_queues(adapter, eqo, i)
		free_irq(be_msix_vec_get(adapter, eqo), eqo);
2783

S
Sathya Perla 已提交
2784 2785 2786 2787
done:
	adapter->isr_registered = false;
}

S
Sathya Perla 已提交
2788
static void be_rx_qs_destroy(struct be_adapter *adapter)
2789 2790 2791 2792 2793 2794 2795 2796 2797
{
	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) {
			be_cmd_rxq_destroy(adapter, q);
S
Sathya Perla 已提交
2798
			be_rx_cq_clean(rxo);
2799
		}
S
Sathya Perla 已提交
2800
		be_queue_free(adapter, q);
2801 2802 2803
	}
}

2804 2805 2806
static int be_close(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
2807 2808
	struct be_eq_obj *eqo;
	int i;
2809

2810 2811 2812 2813 2814 2815
	/* 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;

2816 2817
	be_roce_dev_close(adapter);

2818 2819
	if (adapter->flags & BE_FLAGS_NAPI_ENABLED) {
		for_all_evt_queues(adapter, eqo, i) {
2820
			napi_disable(&eqo->napi);
2821 2822
			be_disable_busy_poll(eqo);
		}
2823
		adapter->flags &= ~BE_FLAGS_NAPI_ENABLED;
2824
	}
2825 2826 2827 2828 2829 2830

	be_async_mcc_disable(adapter);

	/* Wait for all pending tx completions to arrive so that
	 * all tx skbs are freed.
	 */
S
Sathya Perla 已提交
2831
	netif_tx_disable(netdev);
2832
	be_tx_compl_clean(adapter);
2833 2834 2835

	be_rx_qs_destroy(adapter);

2836 2837 2838 2839 2840
	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;

2841
	for_all_evt_queues(adapter, eqo, i) {
S
Sathya Perla 已提交
2842 2843 2844 2845 2846
		if (msix_enabled(adapter))
			synchronize_irq(be_msix_vec_get(adapter, eqo));
		else
			synchronize_irq(netdev->irq);
		be_eq_clean(eqo);
2847 2848
	}

2849 2850
	be_irq_unregister(adapter);

2851 2852 2853
	return 0;
}

S
Sathya Perla 已提交
2854
static int be_rx_qs_create(struct be_adapter *adapter)
2855 2856
{
	struct be_rx_obj *rxo;
2857
	int rc, i, j;
2858 2859
	u8 rss_hkey[RSS_HASH_KEY_LEN];
	struct rss_info *rss = &adapter->rss_info;
2860 2861

	for_all_rx_queues(adapter, rxo, i) {
S
Sathya Perla 已提交
2862 2863 2864 2865 2866 2867 2868 2869 2870 2871 2872 2873 2874 2875
		rc = be_queue_alloc(adapter, &rxo->q, RX_Q_LEN,
				    sizeof(struct be_eth_rx_d));
		if (rc)
			return rc;
	}

	/* The FW would like the default RXQ to be created first */
	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;

	for_all_rss_queues(adapter, rxo, i) {
2876
		rc = be_cmd_rxq_create(adapter, &rxo->q, rxo->cq.id,
S
Sathya Perla 已提交
2877 2878
				       rx_frag_size, adapter->if_handle,
				       true, &rxo->rss_id);
2879 2880 2881 2882 2883
		if (rc)
			return rc;
	}

	if (be_multi_rxq(adapter)) {
2884 2885
		for (j = 0; j < RSS_INDIR_TABLE_LEN;
			j += adapter->num_rx_qs - 1) {
2886
			for_all_rss_queues(adapter, rxo, i) {
2887
				if ((j + i) >= RSS_INDIR_TABLE_LEN)
2888
					break;
2889 2890
				rss->rsstable[j + i] = rxo->rss_id;
				rss->rss_queue[j + i] = i;
2891 2892
			}
		}
2893 2894
		rss->rss_flags = RSS_ENABLE_TCP_IPV4 | RSS_ENABLE_IPV4 |
			RSS_ENABLE_TCP_IPV6 | RSS_ENABLE_IPV6;
2895 2896

		if (!BEx_chip(adapter))
2897 2898
			rss->rss_flags |= RSS_ENABLE_UDP_IPV4 |
				RSS_ENABLE_UDP_IPV6;
2899 2900
	} else {
		/* Disable RSS, if only default RX Q is created */
2901
		rss->rss_flags = RSS_ENABLE_NONE;
2902
	}
2903

2904
	get_random_bytes(rss_hkey, RSS_HASH_KEY_LEN);
2905
	rc = be_cmd_rss_config(adapter, rss->rsstable, rss->rss_flags,
2906
			       128, rss_hkey);
2907
	if (rc) {
2908
		rss->rss_flags = RSS_ENABLE_NONE;
2909
		return rc;
2910 2911
	}

2912 2913
	memcpy(rss->rss_hkey, rss_hkey, RSS_HASH_KEY_LEN);

2914
	/* First time posting */
S
Sathya Perla 已提交
2915
	for_all_rx_queues(adapter, rxo, i)
2916
		be_post_rx_frags(rxo, GFP_KERNEL, MAX_RX_POST);
2917 2918 2919
	return 0;
}

S
Sathya Perla 已提交
2920 2921 2922
static int be_open(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
2923
	struct be_eq_obj *eqo;
2924
	struct be_rx_obj *rxo;
S
Sathya Perla 已提交
2925
	struct be_tx_obj *txo;
2926
	u8 link_status;
2927
	int status, i;
2928

S
Sathya Perla 已提交
2929
	status = be_rx_qs_create(adapter);
2930 2931 2932
	if (status)
		goto err;

2933 2934 2935
	status = be_irq_register(adapter);
	if (status)
		goto err;
2936

S
Sathya Perla 已提交
2937
	for_all_rx_queues(adapter, rxo, i)
2938
		be_cq_notify(adapter, rxo->cq.id, true, 0);
2939

S
Sathya Perla 已提交
2940 2941 2942
	for_all_tx_queues(adapter, txo, i)
		be_cq_notify(adapter, txo->cq.id, true, 0);

2943 2944
	be_async_mcc_enable(adapter);

S
Sathya Perla 已提交
2945 2946
	for_all_evt_queues(adapter, eqo, i) {
		napi_enable(&eqo->napi);
2947
		be_enable_busy_poll(eqo);
2948
		be_eq_notify(adapter, eqo->q.id, true, true, 0);
S
Sathya Perla 已提交
2949
	}
2950
	adapter->flags |= BE_FLAGS_NAPI_ENABLED;
S
Sathya Perla 已提交
2951

2952
	status = be_cmd_link_status_query(adapter, NULL, &link_status, 0);
2953 2954 2955
	if (!status)
		be_link_status_update(adapter, link_status);

S
Sathya Perla 已提交
2956
	netif_tx_start_all_queues(netdev);
2957
	be_roce_dev_open(adapter);
2958

2959
#ifdef CONFIG_BE2NET_VXLAN
2960 2961
	if (skyhawk_chip(adapter))
		vxlan_get_rx_port(netdev);
2962 2963
#endif

2964 2965 2966 2967
	return 0;
err:
	be_close(adapter->netdev);
	return -EIO;
2968 2969
}

2970 2971 2972 2973 2974 2975 2976 2977 2978
static int be_setup_wol(struct be_adapter *adapter, bool enable)
{
	struct be_dma_mem cmd;
	int status = 0;
	u8 mac[ETH_ALEN];

	memset(mac, 0, ETH_ALEN);

	cmd.size = sizeof(struct be_cmd_req_acpi_wol_magic_config);
2979 2980
	cmd.va = dma_zalloc_coherent(&adapter->pdev->dev, cmd.size, &cmd.dma,
				     GFP_KERNEL);
K
Kalesh AP 已提交
2981
	if (!cmd.va)
2982
		return -ENOMEM;
2983 2984 2985

	if (enable) {
		status = pci_write_config_dword(adapter->pdev,
2986 2987
						PCICFG_PM_CONTROL_OFFSET,
						PCICFG_PM_CONTROL_MASK);
2988 2989
		if (status) {
			dev_err(&adapter->pdev->dev,
2990
				"Could not enable Wake-on-lan\n");
I
Ivan Vecera 已提交
2991 2992
			dma_free_coherent(&adapter->pdev->dev, cmd.size, cmd.va,
					  cmd.dma);
2993 2994 2995
			return status;
		}
		status = be_cmd_enable_magic_wol(adapter,
2996 2997
						 adapter->netdev->dev_addr,
						 &cmd);
2998 2999 3000 3001 3002 3003 3004 3005
		pci_enable_wake(adapter->pdev, PCI_D3hot, 1);
		pci_enable_wake(adapter->pdev, PCI_D3cold, 1);
	} else {
		status = be_cmd_enable_magic_wol(adapter, mac, &cmd);
		pci_enable_wake(adapter->pdev, PCI_D3hot, 0);
		pci_enable_wake(adapter->pdev, PCI_D3cold, 0);
	}

I
Ivan Vecera 已提交
3006
	dma_free_coherent(&adapter->pdev->dev, cmd.size, cmd.va, cmd.dma);
3007 3008 3009
	return status;
}

3010 3011 3012 3013 3014 3015
/*
 * 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.
 */
3016
static int be_vf_eth_addr_config(struct be_adapter *adapter)
3017
{
3018
	u32 vf;
3019
	int status = 0;
3020
	u8 mac[ETH_ALEN];
3021
	struct be_vf_cfg *vf_cfg;
3022 3023 3024

	be_vf_eth_addr_generate(adapter, mac);

3025
	for_all_vfs(adapter, vf_cfg, vf) {
3026
		if (BEx_chip(adapter))
3027
			status = be_cmd_pmac_add(adapter, mac,
3028 3029
						 vf_cfg->if_handle,
						 &vf_cfg->pmac_id, vf + 1);
3030 3031 3032
		else
			status = be_cmd_set_mac(adapter, mac, vf_cfg->if_handle,
						vf + 1);
3033

3034 3035
		if (status)
			dev_err(&adapter->pdev->dev,
3036 3037
				"Mac address assignment failed for VF %d\n",
				vf);
3038
		else
3039
			memcpy(vf_cfg->mac_addr, mac, ETH_ALEN);
3040 3041 3042 3043 3044 3045

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

3046 3047 3048 3049 3050 3051 3052
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) {
3053 3054 3055
		status = be_cmd_get_active_mac(adapter, vf_cfg->pmac_id,
					       mac, vf_cfg->if_handle,
					       false, vf+1);
3056 3057 3058 3059 3060 3061 3062
		if (status)
			return status;
		memcpy(vf_cfg->mac_addr, mac, ETH_ALEN);
	}
	return 0;
}

3063
static void be_vf_clear(struct be_adapter *adapter)
3064
{
3065
	struct be_vf_cfg *vf_cfg;
3066 3067
	u32 vf;

3068
	if (pci_vfs_assigned(adapter->pdev)) {
3069 3070
		dev_warn(&adapter->pdev->dev,
			 "VFs are assigned to VMs: not disabling VFs\n");
3071 3072 3073
		goto done;
	}

3074 3075
	pci_disable_sriov(adapter->pdev);

3076
	for_all_vfs(adapter, vf_cfg, vf) {
3077
		if (BEx_chip(adapter))
3078 3079
			be_cmd_pmac_del(adapter, vf_cfg->if_handle,
					vf_cfg->pmac_id, vf + 1);
3080 3081 3082
		else
			be_cmd_set_mac(adapter, NULL, vf_cfg->if_handle,
				       vf + 1);
3083

3084 3085
		be_cmd_if_destroy(adapter, vf_cfg->if_handle, vf + 1);
	}
3086 3087 3088
done:
	kfree(adapter->vf_cfg);
	adapter->num_vfs = 0;
3089
	adapter->flags &= ~BE_FLAGS_SRIOV_ENABLED;
3090 3091
}

3092 3093 3094 3095 3096 3097 3098 3099
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);
}

3100
static void be_cancel_worker(struct be_adapter *adapter)
3101
{
3102 3103 3104 3105
	if (adapter->flags & BE_FLAGS_WORKER_SCHEDULED) {
		cancel_delayed_work_sync(&adapter->work);
		adapter->flags &= ~BE_FLAGS_WORKER_SCHEDULED;
	}
3106 3107
}

3108
static void be_mac_clear(struct be_adapter *adapter)
3109 3110 3111
{
	int i;

3112 3113 3114 3115 3116 3117 3118 3119 3120 3121 3122
	if (adapter->pmac_id) {
		for (i = 0; i < (adapter->uc_macs + 1); i++)
			be_cmd_pmac_del(adapter, adapter->if_handle,
					adapter->pmac_id[i], 0);
		adapter->uc_macs = 0;

		kfree(adapter->pmac_id);
		adapter->pmac_id = NULL;
	}
}

3123
#ifdef CONFIG_BE2NET_VXLAN
3124 3125 3126 3127 3128 3129 3130 3131 3132 3133 3134 3135
static void be_disable_vxlan_offloads(struct be_adapter *adapter)
{
	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;
}
3136
#endif
3137

3138 3139
static int be_clear(struct be_adapter *adapter)
{
3140
	be_cancel_worker(adapter);
3141

3142
	if (sriov_enabled(adapter))
3143 3144
		be_vf_clear(adapter);

3145 3146 3147 3148 3149 3150 3151
	/* Re-configure FW to distribute resources evenly across max-supported
	 * number of VFs, only when VFs are not already enabled.
	 */
	if (be_physfn(adapter) && !pci_vfs_assigned(adapter->pdev))
		be_cmd_set_sriov_config(adapter, adapter->pool_res,
					pci_sriov_get_totalvfs(adapter->pdev));

3152
#ifdef CONFIG_BE2NET_VXLAN
3153
	be_disable_vxlan_offloads(adapter);
3154
#endif
3155
	/* delete the primary mac along with the uc-mac list */
3156
	be_mac_clear(adapter);
3157

3158
	be_cmd_if_destroy(adapter, adapter->if_handle,  0);
3159

3160
	be_clear_queues(adapter);
3161

S
Sathya Perla 已提交
3162
	be_msix_disable(adapter);
3163
	adapter->flags &= ~BE_FLAGS_SETUP_DONE;
3164 3165 3166
	return 0;
}

3167
static int be_vfs_if_create(struct be_adapter *adapter)
3168
{
3169
	struct be_resources res = {0};
3170 3171
	struct be_vf_cfg *vf_cfg;
	u32 cap_flags, en_flags, vf;
3172
	int status = 0;
3173

3174 3175
	cap_flags = BE_IF_FLAGS_UNTAGGED | BE_IF_FLAGS_BROADCAST |
		    BE_IF_FLAGS_MULTICAST;
3176

3177
	for_all_vfs(adapter, vf_cfg, vf) {
3178 3179 3180 3181 3182 3183
		if (!BE3_chip(adapter)) {
			status = be_cmd_get_profile_config(adapter, &res,
							   vf + 1);
			if (!status)
				cap_flags = res.if_cap_flags;
		}
3184 3185 3186

		/* If a FW profile exists, then cap_flags are updated */
		en_flags = cap_flags & (BE_IF_FLAGS_UNTAGGED |
3187 3188 3189 3190 3191
					BE_IF_FLAGS_BROADCAST |
					BE_IF_FLAGS_MULTICAST);
		status =
		    be_cmd_if_create(adapter, cap_flags, en_flags,
				     &vf_cfg->if_handle, vf + 1);
3192 3193 3194 3195 3196
		if (status)
			goto err;
	}
err:
	return status;
3197 3198
}

3199
static int be_vf_setup_init(struct be_adapter *adapter)
3200
{
3201
	struct be_vf_cfg *vf_cfg;
3202 3203
	int vf;

3204 3205 3206 3207 3208
	adapter->vf_cfg = kcalloc(adapter->num_vfs, sizeof(*vf_cfg),
				  GFP_KERNEL);
	if (!adapter->vf_cfg)
		return -ENOMEM;

3209 3210 3211
	for_all_vfs(adapter, vf_cfg, vf) {
		vf_cfg->if_handle = -1;
		vf_cfg->pmac_id = -1;
3212
	}
3213
	return 0;
3214 3215
}

3216 3217
static int be_vf_setup(struct be_adapter *adapter)
{
3218
	struct device *dev = &adapter->pdev->dev;
3219
	struct be_vf_cfg *vf_cfg;
3220
	int status, old_vfs, vf;
3221
	u32 privileges;
3222

3223
	old_vfs = pci_num_vf(adapter->pdev);
3224 3225 3226 3227

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

3229 3230 3231 3232 3233 3234
	if (old_vfs) {
		for_all_vfs(adapter, vf_cfg, vf) {
			status = be_cmd_get_if_id(adapter, vf_cfg, vf);
			if (status)
				goto err;
		}
3235

3236 3237 3238 3239
		status = be_vfs_mac_query(adapter);
		if (status)
			goto err;
	} else {
3240 3241 3242 3243
		status = be_vfs_if_create(adapter);
		if (status)
			goto err;

3244 3245 3246 3247
		status = be_vf_eth_addr_config(adapter);
		if (status)
			goto err;
	}
3248

3249
	for_all_vfs(adapter, vf_cfg, vf) {
3250 3251 3252 3253 3254 3255 3256 3257 3258 3259 3260 3261
		/* Allow VFs to programs MAC/VLAN filters */
		status = be_cmd_get_fn_privileges(adapter, &privileges, vf + 1);
		if (!status && !(privileges & BE_PRIV_FILTMGMT)) {
			status = be_cmd_set_fn_privileges(adapter,
							  privileges |
							  BE_PRIV_FILTMGMT,
							  vf + 1);
			if (!status)
				dev_info(dev, "VF%d has FILTMGMT privilege\n",
					 vf);
		}

3262 3263 3264
		/* Allow full available bandwidth */
		if (!old_vfs)
			be_cmd_config_qos(adapter, 0, 0, vf + 1);
3265

3266
		if (!old_vfs) {
3267
			be_cmd_enable_vf(adapter, vf + 1);
3268 3269 3270 3271
			be_cmd_set_logical_link_config(adapter,
						       IFLA_VF_LINK_STATE_AUTO,
						       vf+1);
		}
3272
	}
3273 3274 3275 3276 3277 3278 3279 3280 3281

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

	adapter->flags |= BE_FLAGS_SRIOV_ENABLED;
3284 3285
	return 0;
err:
3286 3287
	dev_err(dev, "VF setup failed\n");
	be_vf_clear(adapter);
3288 3289 3290
	return status;
}

3291 3292 3293 3294
/* Converting function_mode bits on BE3 to SH mc_type enums */

static u8 be_convert_mc_type(u32 function_mode)
{
3295
	if (function_mode & VNIC_MODE && function_mode & QNQ_MODE)
3296
		return vNIC1;
3297
	else if (function_mode & QNQ_MODE)
3298 3299 3300 3301 3302 3303 3304 3305 3306
		return FLEX10;
	else if (function_mode & VNIC_MODE)
		return vNIC2;
	else if (function_mode & UMC_ENABLED)
		return UMC;
	else
		return MC_NONE;
}

3307 3308 3309 3310
/* On BE2/BE3 FW does not suggest the supported limits */
static void BEx_get_resources(struct be_adapter *adapter,
			      struct be_resources *res)
{
3311
	bool use_sriov = adapter->num_vfs ? 1 : 0;
3312 3313 3314 3315 3316 3317

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

3318 3319 3320 3321 3322 3323 3324 3325 3326 3327 3328 3329 3330 3331
	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 {
3332
		res->max_vlans = BE_NUM_VLANS_SUPPORTED;
3333 3334
	}

3335 3336
	res->max_mcast_mac = BE_MAX_MC;

3337 3338 3339 3340 3341 3342
	/* 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) ||
	    !be_physfn(adapter) || (be_is_mc(adapter) &&
3343
	    !(adapter->function_caps & BE_FUNCTION_CAPS_RSS))) {
3344
		res->max_tx_qs = 1;
3345 3346 3347 3348 3349 3350 3351 3352 3353 3354
	} 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
		 */
		be_cmd_get_profile_config(adapter, &super_nic_res, 0);
		/* 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 {
3355
		res->max_tx_qs = BE3_MAX_TX_QS;
3356
	}
3357 3358 3359 3360 3361 3362 3363

	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;

3364
	if (be_physfn(adapter))
3365
		res->max_evt_qs = (be_max_vfs(adapter) > 0) ?
3366 3367 3368
					BE3_SRIOV_MAX_EVT_QS : BE3_MAX_EVT_QS;
	else
		res->max_evt_qs = 1;
3369 3370 3371 3372 3373 3374

	res->if_cap_flags = BE_IF_CAP_FLAGS_WANT;
	if (!(adapter->function_caps & BE_FUNCTION_CAPS_RSS))
		res->if_cap_flags &= ~BE_IF_FLAGS_RSS;
}

3375 3376 3377
static void be_setup_init(struct be_adapter *adapter)
{
	adapter->vlan_prio_bmap = 0xff;
A
Ajit Khaparde 已提交
3378
	adapter->phy.link_speed = -1;
3379 3380 3381
	adapter->if_handle = -1;
	adapter->be3_native = false;
	adapter->promiscuous = false;
3382 3383 3384 3385
	if (be_physfn(adapter))
		adapter->cmd_privileges = MAX_PRIVILEGES;
	else
		adapter->cmd_privileges = MIN_PRIVILEGES;
3386 3387
}

3388 3389 3390 3391
static int be_get_sriov_config(struct be_adapter *adapter)
{
	struct device *dev = &adapter->pdev->dev;
	struct be_resources res = {0};
3392
	int max_vfs, old_vfs;
3393 3394

	/* Some old versions of BE3 FW don't report max_vfs value */
3395 3396
	be_cmd_get_profile_config(adapter, &res, 0);

3397 3398 3399 3400 3401
	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;
	}

3402
	adapter->pool_res = res;
3403 3404 3405

	if (!be_max_vfs(adapter)) {
		if (num_vfs)
V
Vasundhara Volam 已提交
3406
			dev_warn(dev, "SRIOV is disabled. Ignoring num_vfs\n");
3407 3408 3409 3410
		adapter->num_vfs = 0;
		return 0;
	}

3411 3412
	pci_sriov_set_totalvfs(adapter->pdev, be_max_vfs(adapter));

3413 3414 3415 3416 3417 3418 3419 3420 3421 3422 3423 3424 3425 3426 3427 3428 3429 3430 3431 3432
	/* validate num_vfs module param */
	old_vfs = pci_num_vf(adapter->pdev);
	if (old_vfs) {
		dev_info(dev, "%d VFs are already enabled\n", old_vfs);
		if (old_vfs != num_vfs)
			dev_warn(dev, "Ignoring num_vfs=%d setting\n", num_vfs);
		adapter->num_vfs = old_vfs;
	} else {
		if (num_vfs > be_max_vfs(adapter)) {
			dev_info(dev, "Resources unavailable to init %d VFs\n",
				 num_vfs);
			dev_info(dev, "Limiting to %d VFs\n",
				 be_max_vfs(adapter));
		}
		adapter->num_vfs = min_t(u16, num_vfs, be_max_vfs(adapter));
	}

	return 0;
}

3433
static int be_get_resources(struct be_adapter *adapter)
3434
{
3435 3436 3437
	struct device *dev = &adapter->pdev->dev;
	struct be_resources res = {0};
	int status;
3438

3439 3440 3441
	if (BEx_chip(adapter)) {
		BEx_get_resources(adapter, &res);
		adapter->res = res;
3442 3443
	}

3444 3445 3446 3447 3448 3449 3450 3451
	/* For Lancer, SH etc read per-function resource limits from FW.
	 * GET_FUNC_CONFIG returns per function guaranteed limits.
	 * GET_PROFILE_CONFIG returns PCI-E related limits PF-pool limits
	 */
	if (!BEx_chip(adapter)) {
		status = be_cmd_get_func_config(adapter, &res);
		if (status)
			return status;
3452

3453 3454 3455 3456
		/* If RoCE may be enabled stash away half the EQs for RoCE */
		if (be_roce_supported(adapter))
			res.max_evt_qs /= 2;
		adapter->res = res;
3457
	}
3458

S
Sathya Perla 已提交
3459 3460 3461 3462 3463 3464 3465 3466
	dev_info(dev, "Max: txqs %d, rxqs %d, rss %d, eqs %d, vfs %d\n",
		 be_max_txqs(adapter), be_max_rxqs(adapter),
		 be_max_rss(adapter), be_max_eqs(adapter),
		 be_max_vfs(adapter));
	dev_info(dev, "Max: uc-macs %d, mc-macs %d, vlans %d\n",
		 be_max_uc(adapter), be_max_mc(adapter),
		 be_max_vlans(adapter));

3467
	return 0;
3468 3469
}

3470 3471 3472 3473 3474 3475 3476 3477 3478 3479 3480 3481 3482 3483 3484 3485 3486 3487 3488 3489 3490 3491 3492 3493 3494 3495 3496 3497 3498
static void be_sriov_config(struct be_adapter *adapter)
{
	struct device *dev = &adapter->pdev->dev;
	int status;

	status = be_get_sriov_config(adapter);
	if (status) {
		dev_err(dev, "Failed to query SR-IOV configuration\n");
		dev_err(dev, "SR-IOV cannot be enabled\n");
		return;
	}

	/* 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 (be_max_vfs(adapter) && !pci_num_vf(adapter->pdev)) {
		status = be_cmd_set_sriov_config(adapter,
						 adapter->pool_res,
						 adapter->num_vfs);
		if (status)
			dev_err(dev, "Failed to optimize SR-IOV resources\n");
	}
}

3499 3500
static int be_get_config(struct be_adapter *adapter)
{
3501
	u16 profile_id;
3502
	int status;
3503

3504
	status = be_cmd_query_fw_cfg(adapter);
3505
	if (status)
3506
		return status;
3507

3508 3509 3510 3511 3512
	 if (be_physfn(adapter)) {
		status = be_cmd_get_active_profile(adapter, &profile_id);
		if (!status)
			dev_info(&adapter->pdev->dev,
				 "Using profile 0x%x\n", profile_id);
3513
	}
3514

3515 3516
	if (!BE2_chip(adapter) && be_physfn(adapter))
		be_sriov_config(adapter);
3517

3518 3519 3520
	status = be_get_resources(adapter);
	if (status)
		return status;
3521

3522 3523
	adapter->pmac_id = kcalloc(be_max_uc(adapter),
				   sizeof(*adapter->pmac_id), GFP_KERNEL);
3524 3525
	if (!adapter->pmac_id)
		return -ENOMEM;
3526

3527 3528 3529 3530
	/* Sanitize cfg_num_qs based on HW and platform limits */
	adapter->cfg_num_qs = min(adapter->cfg_num_qs, be_max_qs(adapter));

	return 0;
3531 3532
}

3533 3534 3535 3536 3537 3538 3539 3540 3541 3542 3543 3544 3545 3546 3547 3548 3549
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);
	} else {
		/* Maybe the HW was reset; dev_addr must be re-programmed */
		memcpy(mac, adapter->netdev->dev_addr, ETH_ALEN);
	}

3550 3551 3552 3553
	/* For BE3-R VFs, the PF programs the initial MAC address */
	if (!(BEx_chip(adapter) && be_virtfn(adapter)))
		be_cmd_pmac_add(adapter, mac, adapter->if_handle,
				&adapter->pmac_id[0], 0);
3554 3555 3556
	return 0;
}

3557 3558 3559 3560 3561 3562
static void be_schedule_worker(struct be_adapter *adapter)
{
	schedule_delayed_work(&adapter->work, msecs_to_jiffies(1000));
	adapter->flags |= BE_FLAGS_WORKER_SCHEDULED;
}

3563
static int be_setup_queues(struct be_adapter *adapter)
3564
{
3565
	struct net_device *netdev = adapter->netdev;
S
Sathya Perla 已提交
3566
	int status;
3567

3568
	status = be_evt_queues_create(adapter);
3569 3570
	if (status)
		goto err;
3571

3572
	status = be_tx_qs_create(adapter);
3573 3574
	if (status)
		goto err;
S
Sathya Perla 已提交
3575

3576
	status = be_rx_cqs_create(adapter);
S
Sathya Perla 已提交
3577
	if (status)
3578
		goto err;
S
Sathya Perla 已提交
3579

3580
	status = be_mcc_queues_create(adapter);
S
Sathya Perla 已提交
3581 3582 3583
	if (status)
		goto err;

3584 3585 3586 3587 3588 3589 3590 3591
	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;

3592 3593 3594 3595 3596 3597
	return 0;
err:
	dev_err(&adapter->pdev->dev, "queue_setup failed\n");
	return status;
}

3598 3599 3600 3601 3602 3603 3604 3605 3606 3607 3608 3609 3610 3611 3612 3613 3614 3615 3616 3617 3618 3619 3620 3621 3622 3623 3624 3625 3626 3627 3628 3629 3630 3631 3632 3633
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);

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

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

	be_schedule_worker(adapter);

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

	return status;
}

3634 3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645
static int be_setup(struct be_adapter *adapter)
{
	struct device *dev = &adapter->pdev->dev;
	u32 tx_fc, rx_fc, en_flags;
	int status;

	be_setup_init(adapter);

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

	status = be_get_config(adapter);
S
Sathya Perla 已提交
3646
	if (status)
3647
		goto err;
S
Sathya Perla 已提交
3648

3649
	status = be_msix_enable(adapter);
S
Sathya Perla 已提交
3650
	if (status)
3651
		goto err;
S
Sathya Perla 已提交
3652

3653
	en_flags = BE_IF_FLAGS_UNTAGGED | BE_IF_FLAGS_BROADCAST |
3654
		   BE_IF_FLAGS_MULTICAST | BE_IF_FLAGS_PASS_L3L4_ERRORS;
3655
	if (adapter->function_caps & BE_FUNCTION_CAPS_RSS)
3656
		en_flags |= BE_IF_FLAGS_RSS;
3657 3658
	en_flags = en_flags & be_if_cap_flags(adapter);
	status = be_cmd_if_create(adapter, be_if_cap_flags(adapter), en_flags,
3659
				  &adapter->if_handle, 0);
3660
	if (status)
3661
		goto err;
S
Sathya Perla 已提交
3662

3663 3664
	/* Updating real_num_tx/rx_queues() requires rtnl_lock() */
	rtnl_lock();
3665
	status = be_setup_queues(adapter);
3666
	rtnl_unlock();
3667
	if (status)
3668 3669
		goto err;

3670 3671 3672
	be_cmd_get_fn_privileges(adapter, &adapter->cmd_privileges, 0);

	status = be_mac_setup(adapter);
S
Sathya Perla 已提交
3673 3674 3675
	if (status)
		goto err;

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

3679
	if (BE2_chip(adapter) && fw_major_num(adapter->fw_ver) < 4) {
V
Vasundhara Volam 已提交
3680
		dev_err(dev, "Firmware on card is old(%s), IRQs may not work",
3681 3682 3683 3684
			adapter->fw_ver);
		dev_err(dev, "Please upgrade firmware to version >= 4.0\n");
	}

3685
	if (adapter->vlans_added)
S
Sathya Perla 已提交
3686
		be_vid_config(adapter);
3687

3688
	be_set_rx_mode(adapter->netdev);
3689

S
Suresh Reddy 已提交
3690 3691
	be_cmd_get_acpi_wol_cap(adapter);

3692
	be_cmd_get_flow_control(adapter, &tx_fc, &rx_fc);
3693

3694 3695
	if (rx_fc != adapter->rx_fc || tx_fc != adapter->tx_fc)
		be_cmd_set_flow_control(adapter, adapter->tx_fc,
3696
					adapter->rx_fc);
3697

3698 3699 3700 3701
	if (be_physfn(adapter))
		be_cmd_set_logical_link_config(adapter,
					       IFLA_VF_LINK_STATE_AUTO, 0);

3702 3703
	if (adapter->num_vfs)
		be_vf_setup(adapter);
3704

3705 3706
	status = be_cmd_get_phy_info(adapter);
	if (!status && be_pause_supported(adapter))
A
Ajit Khaparde 已提交
3707 3708
		adapter->phy.fc_autoneg = 1;

3709
	be_schedule_worker(adapter);
3710
	adapter->flags |= BE_FLAGS_SETUP_DONE;
3711
	return 0;
3712 3713 3714 3715
err:
	be_clear(adapter);
	return status;
}
S
Sathya Perla 已提交
3716

I
Ivan Vecera 已提交
3717 3718 3719 3720
#ifdef CONFIG_NET_POLL_CONTROLLER
static void be_netpoll(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
3721
	struct be_eq_obj *eqo;
I
Ivan Vecera 已提交
3722 3723
	int i;

3724 3725 3726 3727
	for_all_evt_queues(adapter, eqo, i) {
		be_eq_notify(eqo->adapter, eqo->q.id, false, true, 0);
		napi_schedule(&eqo->napi);
	}
I
Ivan Vecera 已提交
3728 3729 3730
}
#endif

3731
static char flash_cookie[2][16] = {"*** SE FLAS", "H DIRECTORY *** "};
3732

3733 3734
static bool phy_flashing_required(struct be_adapter *adapter)
{
A
Ajit Khaparde 已提交
3735 3736
	return (adapter->phy.phy_type == TN_8022 &&
		adapter->phy.interface_type == PHY_TYPE_BASET_10GB);
3737 3738
}

3739 3740 3741 3742 3743 3744
static bool is_comp_in_ufi(struct be_adapter *adapter,
			   struct flash_section_info *fsec, int type)
{
	int i = 0, img_type = 0;
	struct flash_section_info_g2 *fsec_g2 = NULL;

3745
	if (BE2_chip(adapter))
3746 3747 3748 3749 3750 3751 3752 3753 3754 3755 3756 3757 3758 3759 3760
		fsec_g2 = (struct flash_section_info_g2 *)fsec;

	for (i = 0; i < MAX_FLASH_COMP; i++) {
		if (fsec_g2)
			img_type = le32_to_cpu(fsec_g2->fsec_entry[i].type);
		else
			img_type = le32_to_cpu(fsec->fsec_entry[i].type);

		if (img_type == type)
			return true;
	}
	return false;

}

J
Jingoo Han 已提交
3761
static struct flash_section_info *get_fsec_info(struct be_adapter *adapter,
3762 3763
						int header_size,
						const struct firmware *fw)
3764 3765 3766 3767 3768 3769 3770 3771 3772 3773 3774 3775 3776 3777
{
	struct flash_section_info *fsec = NULL;
	const u8 *p = fw->data;

	p += header_size;
	while (p < (fw->data + fw->size)) {
		fsec = (struct flash_section_info *)p;
		if (!memcmp(flash_cookie, fsec->cookie, sizeof(flash_cookie)))
			return fsec;
		p += 32;
	}
	return NULL;
}

3778 3779 3780 3781 3782 3783 3784 3785 3786 3787 3788 3789 3790 3791 3792 3793 3794 3795 3796 3797 3798 3799 3800
static int be_check_flash_crc(struct be_adapter *adapter, const u8 *p,
			      u32 img_offset, u32 img_size, int hdr_size,
			      u16 img_optype, bool *crc_match)
{
	u32 crc_offset;
	int status;
	u8 crc[4];

	status = be_cmd_get_flash_crc(adapter, crc, img_optype, img_size - 4);
	if (status)
		return status;

	crc_offset = hdr_size + img_offset + img_size - 4;

	/* Skip flashing, if crc of flashed region matches */
	if (!memcmp(crc, p + crc_offset, 4))
		*crc_match = true;
	else
		*crc_match = false;

	return status;
}

3801
static int be_flash(struct be_adapter *adapter, const u8 *img,
3802
		    struct be_dma_mem *flash_cmd, int optype, int img_size)
3803 3804
{
	struct be_cmd_write_flashrom *req = flash_cmd->va;
3805 3806
	u32 total_bytes, flash_op, num_bytes;
	int status;
3807 3808 3809 3810 3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823 3824 3825

	total_bytes = img_size;
	while (total_bytes) {
		num_bytes = min_t(u32, 32*1024, total_bytes);

		total_bytes -= num_bytes;

		if (!total_bytes) {
			if (optype == OPTYPE_PHY_FW)
				flash_op = FLASHROM_OPER_PHY_FLASH;
			else
				flash_op = FLASHROM_OPER_FLASH;
		} else {
			if (optype == OPTYPE_PHY_FW)
				flash_op = FLASHROM_OPER_PHY_SAVE;
			else
				flash_op = FLASHROM_OPER_SAVE;
		}

3826
		memcpy(req->data_buf, img, num_bytes);
3827 3828
		img += num_bytes;
		status = be_cmd_write_flashrom(adapter, flash_cmd, optype,
3829
					       flash_op, num_bytes);
3830
		if (base_status(status) == MCC_STATUS_ILLEGAL_REQUEST &&
3831 3832 3833
		    optype == OPTYPE_PHY_FW)
			break;
		else if (status)
3834 3835 3836 3837 3838
			return status;
	}
	return 0;
}

3839
/* For BE2, BE3 and BE3-R */
3840
static int be_flash_BEx(struct be_adapter *adapter,
3841 3842
			const struct firmware *fw,
			struct be_dma_mem *flash_cmd, int num_of_images)
3843
{
3844
	int img_hdrs_size = (num_of_images * sizeof(struct image_hdr));
3845
	struct device *dev = &adapter->pdev->dev;
3846
	struct flash_section_info *fsec = NULL;
3847 3848 3849 3850
	int status, i, filehdr_size, num_comp;
	const struct flash_comp *pflashcomp;
	bool crc_match;
	const u8 *p;
3851 3852 3853 3854 3855 3856 3857 3858 3859 3860 3861 3862 3863 3864 3865 3866 3867 3868 3869 3870 3871 3872

	struct flash_comp gen3_flash_types[] = {
		{ FLASH_iSCSI_PRIMARY_IMAGE_START_g3, OPTYPE_ISCSI_ACTIVE,
			FLASH_IMAGE_MAX_SIZE_g3, IMAGE_FIRMWARE_iSCSI},
		{ FLASH_REDBOOT_START_g3, OPTYPE_REDBOOT,
			FLASH_REDBOOT_IMAGE_MAX_SIZE_g3, IMAGE_BOOT_CODE},
		{ FLASH_iSCSI_BIOS_START_g3, OPTYPE_BIOS,
			FLASH_BIOS_IMAGE_MAX_SIZE_g3, IMAGE_OPTION_ROM_ISCSI},
		{ FLASH_PXE_BIOS_START_g3, OPTYPE_PXE_BIOS,
			FLASH_BIOS_IMAGE_MAX_SIZE_g3, IMAGE_OPTION_ROM_PXE},
		{ FLASH_FCoE_BIOS_START_g3, OPTYPE_FCOE_BIOS,
			FLASH_BIOS_IMAGE_MAX_SIZE_g3, IMAGE_OPTION_ROM_FCoE},
		{ FLASH_iSCSI_BACKUP_IMAGE_START_g3, OPTYPE_ISCSI_BACKUP,
			FLASH_IMAGE_MAX_SIZE_g3, IMAGE_FIRMWARE_BACKUP_iSCSI},
		{ FLASH_FCoE_PRIMARY_IMAGE_START_g3, OPTYPE_FCOE_FW_ACTIVE,
			FLASH_IMAGE_MAX_SIZE_g3, IMAGE_FIRMWARE_FCoE},
		{ FLASH_FCoE_BACKUP_IMAGE_START_g3, OPTYPE_FCOE_FW_BACKUP,
			FLASH_IMAGE_MAX_SIZE_g3, IMAGE_FIRMWARE_BACKUP_FCoE},
		{ FLASH_NCSI_START_g3, OPTYPE_NCSI_FW,
			FLASH_NCSI_IMAGE_MAX_SIZE_g3, IMAGE_NCSI},
		{ FLASH_PHY_FW_START_g3, OPTYPE_PHY_FW,
			FLASH_PHY_FW_IMAGE_MAX_SIZE_g3, IMAGE_FIRMWARE_PHY}
3873
	};
3874 3875 3876 3877 3878 3879 3880 3881 3882 3883 3884 3885 3886 3887 3888 3889 3890 3891

	struct flash_comp gen2_flash_types[] = {
		{ FLASH_iSCSI_PRIMARY_IMAGE_START_g2, OPTYPE_ISCSI_ACTIVE,
			FLASH_IMAGE_MAX_SIZE_g2, IMAGE_FIRMWARE_iSCSI},
		{ FLASH_REDBOOT_START_g2, OPTYPE_REDBOOT,
			FLASH_REDBOOT_IMAGE_MAX_SIZE_g2, IMAGE_BOOT_CODE},
		{ FLASH_iSCSI_BIOS_START_g2, OPTYPE_BIOS,
			FLASH_BIOS_IMAGE_MAX_SIZE_g2, IMAGE_OPTION_ROM_ISCSI},
		{ FLASH_PXE_BIOS_START_g2, OPTYPE_PXE_BIOS,
			FLASH_BIOS_IMAGE_MAX_SIZE_g2, IMAGE_OPTION_ROM_PXE},
		{ FLASH_FCoE_BIOS_START_g2, OPTYPE_FCOE_BIOS,
			FLASH_BIOS_IMAGE_MAX_SIZE_g2, IMAGE_OPTION_ROM_FCoE},
		{ FLASH_iSCSI_BACKUP_IMAGE_START_g2, OPTYPE_ISCSI_BACKUP,
			FLASH_IMAGE_MAX_SIZE_g2, IMAGE_FIRMWARE_BACKUP_iSCSI},
		{ FLASH_FCoE_PRIMARY_IMAGE_START_g2, OPTYPE_FCOE_FW_ACTIVE,
			FLASH_IMAGE_MAX_SIZE_g2, IMAGE_FIRMWARE_FCoE},
		{ FLASH_FCoE_BACKUP_IMAGE_START_g2, OPTYPE_FCOE_FW_BACKUP,
			 FLASH_IMAGE_MAX_SIZE_g2, IMAGE_FIRMWARE_BACKUP_FCoE}
3892 3893
	};

3894
	if (BE3_chip(adapter)) {
3895 3896
		pflashcomp = gen3_flash_types;
		filehdr_size = sizeof(struct flash_file_hdr_g3);
J
Joe Perches 已提交
3897
		num_comp = ARRAY_SIZE(gen3_flash_types);
3898 3899 3900
	} else {
		pflashcomp = gen2_flash_types;
		filehdr_size = sizeof(struct flash_file_hdr_g2);
J
Joe Perches 已提交
3901
		num_comp = ARRAY_SIZE(gen2_flash_types);
3902
	}
3903

3904 3905 3906
	/* Get flash section info*/
	fsec = get_fsec_info(adapter, filehdr_size + img_hdrs_size, fw);
	if (!fsec) {
3907
		dev_err(dev, "Invalid Cookie. FW image may be corrupted\n");
3908 3909
		return -1;
	}
3910
	for (i = 0; i < num_comp; i++) {
3911
		if (!is_comp_in_ufi(adapter, fsec, pflashcomp[i].img_type))
3912
			continue;
3913 3914 3915 3916 3917

		if ((pflashcomp[i].optype == OPTYPE_NCSI_FW) &&
		    memcmp(adapter->fw_ver, "3.102.148.0", 11) < 0)
			continue;

3918 3919
		if (pflashcomp[i].optype == OPTYPE_PHY_FW  &&
		    !phy_flashing_required(adapter))
3920
				continue;
3921

3922
		if (pflashcomp[i].optype == OPTYPE_REDBOOT) {
3923 3924 3925 3926 3927 3928 3929 3930 3931 3932 3933 3934 3935 3936
			status = be_check_flash_crc(adapter, fw->data,
						    pflashcomp[i].offset,
						    pflashcomp[i].size,
						    filehdr_size +
						    img_hdrs_size,
						    OPTYPE_REDBOOT, &crc_match);
			if (status) {
				dev_err(dev,
					"Could not get CRC for 0x%x region\n",
					pflashcomp[i].optype);
				continue;
			}

			if (crc_match)
3937 3938
				continue;
		}
3939

3940 3941
		p = fw->data + filehdr_size + pflashcomp[i].offset +
			img_hdrs_size;
3942 3943
		if (p + pflashcomp[i].size > fw->data + fw->size)
			return -1;
3944 3945

		status = be_flash(adapter, p, flash_cmd, pflashcomp[i].optype,
3946
				  pflashcomp[i].size);
3947
		if (status) {
3948
			dev_err(dev, "Flashing section type 0x%x failed\n",
3949 3950
				pflashcomp[i].img_type);
			return status;
3951 3952 3953 3954 3955
		}
	}
	return 0;
}

3956 3957 3958 3959 3960 3961 3962 3963 3964 3965 3966 3967 3968 3969 3970 3971 3972 3973 3974 3975 3976 3977 3978 3979 3980 3981 3982 3983 3984 3985 3986 3987 3988 3989 3990 3991 3992 3993 3994 3995 3996 3997 3998 3999 4000 4001 4002 4003 4004 4005 4006 4007
static u16 be_get_img_optype(struct flash_section_entry fsec_entry)
{
	u32 img_type = le32_to_cpu(fsec_entry.type);
	u16 img_optype = le16_to_cpu(fsec_entry.optype);

	if (img_optype != 0xFFFF)
		return img_optype;

	switch (img_type) {
	case IMAGE_FIRMWARE_iSCSI:
		img_optype = OPTYPE_ISCSI_ACTIVE;
		break;
	case IMAGE_BOOT_CODE:
		img_optype = OPTYPE_REDBOOT;
		break;
	case IMAGE_OPTION_ROM_ISCSI:
		img_optype = OPTYPE_BIOS;
		break;
	case IMAGE_OPTION_ROM_PXE:
		img_optype = OPTYPE_PXE_BIOS;
		break;
	case IMAGE_OPTION_ROM_FCoE:
		img_optype = OPTYPE_FCOE_BIOS;
		break;
	case IMAGE_FIRMWARE_BACKUP_iSCSI:
		img_optype = OPTYPE_ISCSI_BACKUP;
		break;
	case IMAGE_NCSI:
		img_optype = OPTYPE_NCSI_FW;
		break;
	case IMAGE_FLASHISM_JUMPVECTOR:
		img_optype = OPTYPE_FLASHISM_JUMPVECTOR;
		break;
	case IMAGE_FIRMWARE_PHY:
		img_optype = OPTYPE_SH_PHY_FW;
		break;
	case IMAGE_REDBOOT_DIR:
		img_optype = OPTYPE_REDBOOT_DIR;
		break;
	case IMAGE_REDBOOT_CONFIG:
		img_optype = OPTYPE_REDBOOT_CONFIG;
		break;
	case IMAGE_UFI_DIR:
		img_optype = OPTYPE_UFI_DIR;
		break;
	default:
		break;
	}

	return img_optype;
}

4008
static int be_flash_skyhawk(struct be_adapter *adapter,
4009 4010
			    const struct firmware *fw,
			    struct be_dma_mem *flash_cmd, int num_of_images)
4011
{
4012
	int img_hdrs_size = num_of_images * sizeof(struct image_hdr);
4013
	struct device *dev = &adapter->pdev->dev;
4014
	struct flash_section_info *fsec = NULL;
4015 4016 4017 4018 4019
	u32 img_offset, img_size, img_type;
	int status, i, filehdr_size;
	bool crc_match, old_fw_img;
	u16 img_optype;
	const u8 *p;
4020 4021 4022 4023

	filehdr_size = sizeof(struct flash_file_hdr_g3);
	fsec = get_fsec_info(adapter, filehdr_size + img_hdrs_size, fw);
	if (!fsec) {
4024
		dev_err(dev, "Invalid Cookie. FW image may be corrupted\n");
4025
		return -EINVAL;
4026 4027 4028 4029 4030
	}

	for (i = 0; i < le32_to_cpu(fsec->fsec_hdr.num_images); i++) {
		img_offset = le32_to_cpu(fsec->fsec_entry[i].offset);
		img_size   = le32_to_cpu(fsec->fsec_entry[i].pad_size);
4031 4032 4033
		img_type   = le32_to_cpu(fsec->fsec_entry[i].type);
		img_optype = be_get_img_optype(fsec->fsec_entry[i]);
		old_fw_img = fsec->fsec_entry[i].optype == 0xFFFF;
4034

4035
		if (img_optype == 0xFFFF)
4036
			continue;
4037 4038 4039 4040 4041 4042 4043 4044 4045 4046 4047 4048 4049 4050 4051 4052
		/* Don't bother verifying CRC if an old FW image is being
		 * flashed
		 */
		if (old_fw_img)
			goto flash;

		status = be_check_flash_crc(adapter, fw->data, img_offset,
					    img_size, filehdr_size +
					    img_hdrs_size, img_optype,
					    &crc_match);
		/* The current FW image on the card does not recognize the new
		 * FLASH op_type. The FW download is partially complete.
		 * Reboot the server now to enable FW image to recognize the
		 * new FLASH op_type. To complete the remaining process,
		 * download the same FW again after the reboot.
		 */
4053 4054
		if (base_status(status) == MCC_STATUS_ILLEGAL_REQUEST ||
		    base_status(status) == MCC_STATUS_ILLEGAL_FIELD) {
4055 4056 4057 4058 4059 4060 4061
			dev_err(dev, "Flash incomplete. Reset the server\n");
			dev_err(dev, "Download FW image again after reset\n");
			return -EAGAIN;
		} else if (status) {
			dev_err(dev, "Could not get CRC for 0x%x region\n",
				img_optype);
			return -EFAULT;
4062 4063
		}

4064 4065
		if (crc_match)
			continue;
4066

4067 4068
flash:
		p = fw->data + filehdr_size + img_offset + img_hdrs_size;
4069 4070 4071 4072
		if (p + img_size > fw->data + fw->size)
			return -1;

		status = be_flash(adapter, p, flash_cmd, img_optype, img_size);
4073 4074 4075
		/* For old FW images ignore ILLEGAL_FIELD error or errors on
		 * UFI_DIR region
		 */
4076 4077 4078 4079
		if (old_fw_img &&
		    (base_status(status) == MCC_STATUS_ILLEGAL_FIELD ||
		     (img_optype == OPTYPE_UFI_DIR &&
		      base_status(status) == MCC_STATUS_FAILED))) {
4080 4081 4082 4083 4084
			continue;
		} else if (status) {
			dev_err(dev, "Flashing section type 0x%x failed\n",
				img_type);
			return -EFAULT;
4085 4086 4087
		}
	}
	return 0;
4088 4089
}

4090
static int lancer_fw_download(struct be_adapter *adapter,
4091
			      const struct firmware *fw)
4092
{
4093 4094
#define LANCER_FW_DOWNLOAD_CHUNK      (32 * 1024)
#define LANCER_FW_DOWNLOAD_LOCATION   "/prg"
4095
	struct device *dev = &adapter->pdev->dev;
4096
	struct be_dma_mem flash_cmd;
4097 4098 4099 4100 4101 4102 4103 4104
	const u8 *data_ptr = NULL;
	u8 *dest_image_ptr = NULL;
	size_t image_size = 0;
	u32 chunk_size = 0;
	u32 data_written = 0;
	u32 offset = 0;
	int status = 0;
	u8 add_status = 0;
4105
	u8 change_status;
4106

4107
	if (!IS_ALIGNED(fw->size, sizeof(u32))) {
4108
		dev_err(dev, "FW image size should be multiple of 4\n");
K
Kalesh AP 已提交
4109
		return -EINVAL;
4110 4111
	}

4112 4113
	flash_cmd.size = sizeof(struct lancer_cmd_req_write_object)
				+ LANCER_FW_DOWNLOAD_CHUNK;
4114
	flash_cmd.va = dma_alloc_coherent(dev, flash_cmd.size,
4115
					  &flash_cmd.dma, GFP_KERNEL);
K
Kalesh AP 已提交
4116 4117
	if (!flash_cmd.va)
		return -ENOMEM;
4118

4119 4120 4121 4122 4123 4124 4125 4126 4127 4128 4129 4130
	dest_image_ptr = flash_cmd.va +
				sizeof(struct lancer_cmd_req_write_object);
	image_size = fw->size;
	data_ptr = fw->data;

	while (image_size) {
		chunk_size = min_t(u32, image_size, LANCER_FW_DOWNLOAD_CHUNK);

		/* Copy the image chunk content. */
		memcpy(dest_image_ptr, data_ptr, chunk_size);

		status = lancer_cmd_write_object(adapter, &flash_cmd,
4131 4132 4133 4134
						 chunk_size, offset,
						 LANCER_FW_DOWNLOAD_LOCATION,
						 &data_written, &change_status,
						 &add_status);
4135 4136 4137 4138 4139 4140 4141 4142 4143 4144 4145
		if (status)
			break;

		offset += data_written;
		data_ptr += data_written;
		image_size -= data_written;
	}

	if (!status) {
		/* Commit the FW written */
		status = lancer_cmd_write_object(adapter, &flash_cmd,
4146 4147 4148 4149
						 0, offset,
						 LANCER_FW_DOWNLOAD_LOCATION,
						 &data_written, &change_status,
						 &add_status);
4150 4151
	}

4152
	dma_free_coherent(dev, flash_cmd.size, flash_cmd.va, flash_cmd.dma);
4153
	if (status) {
4154
		dev_err(dev, "Firmware load error\n");
K
Kalesh AP 已提交
4155
		return be_cmd_status(status);
4156 4157
	}

4158 4159
	dev_info(dev, "Firmware flashed successfully\n");

4160
	if (change_status == LANCER_FW_RESET_NEEDED) {
4161
		dev_info(dev, "Resetting adapter to activate new FW\n");
4162 4163
		status = lancer_physdev_ctrl(adapter,
					     PHYSDEV_CONTROL_FW_RESET_MASK);
4164
		if (status) {
4165 4166
			dev_err(dev, "Adapter busy, could not reset FW\n");
			dev_err(dev, "Reboot server to activate new FW\n");
4167 4168
		}
	} else if (change_status != LANCER_NO_RESET_NEEDED) {
4169
		dev_info(dev, "Reboot server to activate new FW\n");
4170
	}
K
Kalesh AP 已提交
4171 4172

	return 0;
4173 4174
}

4175 4176
#define UFI_TYPE2		2
#define UFI_TYPE3		3
4177
#define UFI_TYPE3R		10
4178 4179
#define UFI_TYPE4		4
static int be_get_ufi_type(struct be_adapter *adapter,
4180
			   struct flash_file_hdr_g3 *fhdr)
4181
{
K
Kalesh AP 已提交
4182
	if (!fhdr)
4183 4184
		goto be_get_ufi_exit;

4185 4186
	if (skyhawk_chip(adapter) && fhdr->build[0] == '4')
		return UFI_TYPE4;
4187 4188 4189 4190 4191 4192
	else if (BE3_chip(adapter) && fhdr->build[0] == '3') {
		if (fhdr->asic_type_rev == 0x10)
			return UFI_TYPE3R;
		else
			return UFI_TYPE3;
	} else if (BE2_chip(adapter) && fhdr->build[0] == '2')
4193
		return UFI_TYPE2;
4194 4195 4196 4197 4198 4199 4200

be_get_ufi_exit:
	dev_err(&adapter->pdev->dev,
		"UFI and Interface are not compatible for flashing\n");
	return -1;
}

4201 4202 4203 4204 4205 4206
static int be_fw_download(struct be_adapter *adapter, const struct firmware* fw)
{
	struct flash_file_hdr_g3 *fhdr3;
	struct image_hdr *img_hdr_ptr = NULL;
	struct be_dma_mem flash_cmd;
	const u8 *p;
4207
	int status = 0, i = 0, num_imgs = 0, ufi_type = 0;
4208

4209
	flash_cmd.size = sizeof(struct be_cmd_write_flashrom);
I
Ivan Vecera 已提交
4210 4211
	flash_cmd.va = dma_alloc_coherent(&adapter->pdev->dev, flash_cmd.size,
					  &flash_cmd.dma, GFP_KERNEL);
4212 4213
	if (!flash_cmd.va) {
		status = -ENOMEM;
4214
		goto be_fw_exit;
4215 4216
	}

4217
	p = fw->data;
4218
	fhdr3 = (struct flash_file_hdr_g3 *)p;
4219

4220
	ufi_type = be_get_ufi_type(adapter, fhdr3);
4221 4222 4223 4224 4225 4226 4227

	num_imgs = le32_to_cpu(fhdr3->num_imgs);
	for (i = 0; i < num_imgs; i++) {
		img_hdr_ptr = (struct image_hdr *)(fw->data +
				(sizeof(struct flash_file_hdr_g3) +
				 i * sizeof(struct image_hdr)));
		if (le32_to_cpu(img_hdr_ptr->imageid) == 1) {
4228 4229
			switch (ufi_type) {
			case UFI_TYPE4:
4230
				status = be_flash_skyhawk(adapter, fw,
4231
							  &flash_cmd, num_imgs);
4232 4233
				break;
			case UFI_TYPE3R:
4234 4235
				status = be_flash_BEx(adapter, fw, &flash_cmd,
						      num_imgs);
4236 4237 4238 4239 4240 4241 4242 4243
				break;
			case UFI_TYPE3:
				/* Do not flash this ufi on BE3-R cards */
				if (adapter->asic_rev < 0x10)
					status = be_flash_BEx(adapter, fw,
							      &flash_cmd,
							      num_imgs);
				else {
4244
					status = -EINVAL;
4245 4246 4247 4248
					dev_err(&adapter->pdev->dev,
						"Can't load BE3 UFI on BE3R\n");
				}
			}
4249
		}
4250 4251
	}

4252 4253
	if (ufi_type == UFI_TYPE2)
		status = be_flash_BEx(adapter, fw, &flash_cmd, 0);
4254
	else if (ufi_type == -1)
4255
		status = -EINVAL;
4256

I
Ivan Vecera 已提交
4257 4258
	dma_free_coherent(&adapter->pdev->dev, flash_cmd.size, flash_cmd.va,
			  flash_cmd.dma);
4259 4260
	if (status) {
		dev_err(&adapter->pdev->dev, "Firmware load error\n");
4261
		goto be_fw_exit;
4262 4263
	}

4264
	dev_info(&adapter->pdev->dev, "Firmware flashed successfully\n");
4265

4266 4267 4268 4269 4270 4271 4272 4273 4274 4275 4276 4277
be_fw_exit:
	return status;
}

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");
4278
		return -ENETDOWN;
4279 4280 4281 4282 4283 4284 4285 4286 4287 4288 4289 4290 4291
	}

	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 已提交
4292
	if (!status)
4293
		be_cmd_get_fw_ver(adapter);
S
Somnath Kotur 已提交
4294

4295 4296 4297 4298 4299
fw_exit:
	release_firmware(fw);
	return status;
}

4300
static int be_ndo_bridge_setlink(struct net_device *dev, struct nlmsghdr *nlh)
4301 4302 4303 4304 4305 4306 4307 4308 4309 4310 4311 4312 4313 4314 4315 4316
{
	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);

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

4317 4318 4319
		if (nla_len(attr) < sizeof(mode))
			return -EINVAL;

4320 4321 4322 4323 4324 4325 4326 4327 4328 4329 4330 4331 4332 4333 4334 4335 4336 4337 4338 4339 4340 4341 4342 4343 4344
		mode = nla_get_u16(attr);
		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 :
					       PORT_FWD_TYPE_VEB);
		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,
4345
				 struct net_device *dev, u32 filter_mask)
4346 4347 4348 4349 4350 4351 4352 4353 4354 4355 4356 4357 4358 4359 4360 4361 4362 4363 4364 4365 4366 4367 4368
{
	struct be_adapter *adapter = netdev_priv(dev);
	int status = 0;
	u8 hsw_mode;

	if (!sriov_enabled(adapter))
		return 0;

	/* BE and Lancer chips support VEB mode only */
	if (BEx_chip(adapter) || lancer_chip(adapter)) {
		hsw_mode = PORT_FWD_TYPE_VEB;
	} else {
		status = be_cmd_get_hsw_config(adapter, NULL, 0,
					       adapter->if_handle, &hsw_mode);
		if (status)
			return 0;
	}

	return ndo_dflt_bridge_getlink(skb, pid, seq, dev,
				       hsw_mode == PORT_FWD_TYPE_VEPA ?
				       BRIDGE_MODE_VEPA : BRIDGE_MODE_VEB);
}

4369
#ifdef CONFIG_BE2NET_VXLAN
4370 4371 4372 4373 4374 4375 4376 4377 4378 4379 4380 4381 4382 4383 4384 4385 4386 4387 4388 4389 4390 4391 4392 4393 4394 4395 4396 4397 4398 4399 4400 4401 4402 4403 4404 4405 4406 4407 4408 4409 4410 4411 4412 4413 4414 4415 4416 4417 4418 4419 4420 4421 4422 4423 4424 4425 4426
static void be_add_vxlan_port(struct net_device *netdev, sa_family_t sa_family,
			      __be16 port)
{
	struct be_adapter *adapter = netdev_priv(netdev);
	struct device *dev = &adapter->pdev->dev;
	int status;

	if (lancer_chip(adapter) || BEx_chip(adapter))
		return;

	if (adapter->flags & BE_FLAGS_VXLAN_OFFLOADS) {
		dev_warn(dev, "Cannot add UDP port %d for VxLAN offloads\n",
			 be16_to_cpu(port));
		dev_info(dev,
			 "Only one UDP port supported for VxLAN offloads\n");
		return;
	}

	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;

	dev_info(dev, "Enabled VxLAN offloads for UDP port %d\n",
		 be16_to_cpu(port));
	return;
err:
	be_disable_vxlan_offloads(adapter);
}

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

	if (lancer_chip(adapter) || BEx_chip(adapter))
		return;

	if (adapter->vxlan_port != port)
		return;

	be_disable_vxlan_offloads(adapter);

	dev_info(&adapter->pdev->dev,
		 "Disabled VxLAN offloads for UDP port %d\n",
		 be16_to_cpu(port));
}
J
Joe Stringer 已提交
4427 4428 4429 4430 4431

static bool be_gso_check(struct sk_buff *skb, struct net_device *dev)
{
	return vxlan_gso_check(skb);
}
4432
#endif
4433

4434
static const struct net_device_ops be_netdev_ops = {
S
Sathya Perla 已提交
4435 4436 4437
	.ndo_open		= be_open,
	.ndo_stop		= be_close,
	.ndo_start_xmit		= be_xmit,
4438
	.ndo_set_rx_mode	= be_set_rx_mode,
S
Sathya Perla 已提交
4439 4440
	.ndo_set_mac_address	= be_mac_addr_set,
	.ndo_change_mtu		= be_change_mtu,
4441
	.ndo_get_stats64	= be_get_stats64,
S
Sathya Perla 已提交
4442 4443 4444
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_vlan_rx_add_vid	= be_vlan_add_vid,
	.ndo_vlan_rx_kill_vid	= be_vlan_rem_vid,
4445
	.ndo_set_vf_mac		= be_set_vf_mac,
4446
	.ndo_set_vf_vlan	= be_set_vf_vlan,
4447
	.ndo_set_vf_rate	= be_set_vf_tx_rate,
I
Ivan Vecera 已提交
4448
	.ndo_get_vf_config	= be_get_vf_config,
4449
	.ndo_set_vf_link_state  = be_set_vf_link_state,
I
Ivan Vecera 已提交
4450 4451 4452
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= be_netpoll,
#endif
4453 4454
	.ndo_bridge_setlink	= be_ndo_bridge_setlink,
	.ndo_bridge_getlink	= be_ndo_bridge_getlink,
4455
#ifdef CONFIG_NET_RX_BUSY_POLL
4456
	.ndo_busy_poll		= be_busy_poll,
4457
#endif
4458
#ifdef CONFIG_BE2NET_VXLAN
4459 4460
	.ndo_add_vxlan_port	= be_add_vxlan_port,
	.ndo_del_vxlan_port	= be_del_vxlan_port,
J
Joe Stringer 已提交
4461
	.ndo_gso_check		= be_gso_check,
4462
#endif
S
Sathya Perla 已提交
4463 4464 4465 4466 4467 4468
};

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

4469 4470 4471 4472 4473 4474
	if (skyhawk_chip(adapter)) {
		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;
	}
4475
	netdev->hw_features |= NETIF_F_SG | NETIF_F_TSO | NETIF_F_TSO6 |
4476
		NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM | NETIF_F_RXCSUM |
4477
		NETIF_F_HW_VLAN_CTAG_TX;
4478 4479
	if (be_multi_rxq(adapter))
		netdev->hw_features |= NETIF_F_RXHASH;
4480 4481

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

4484
	netdev->vlan_features |= NETIF_F_SG | NETIF_F_TSO | NETIF_F_TSO6 |
4485
		NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM;
4486

4487 4488
	netdev->priv_flags |= IFF_UNICAST_FLT;

S
Sathya Perla 已提交
4489 4490
	netdev->flags |= IFF_MULTICAST;

4491
	netif_set_gso_max_size(netdev, 65535 - ETH_HLEN);
4492

S
Sathya Perla 已提交
4493
	netdev->netdev_ops = &be_netdev_ops;
S
Sathya Perla 已提交
4494

4495
	netdev->ethtool_ops = &be_ethtool_ops;
S
Sathya Perla 已提交
4496 4497 4498 4499
}

static void be_unmap_pci_bars(struct be_adapter *adapter)
{
4500 4501
	if (adapter->csr)
		pci_iounmap(adapter->pdev, adapter->csr);
4502
	if (adapter->db)
S
Sathya Perla 已提交
4503
		pci_iounmap(adapter->pdev, adapter->db);
4504 4505
}

S
Sathya Perla 已提交
4506 4507 4508 4509 4510 4511 4512 4513 4514
static int db_bar(struct be_adapter *adapter)
{
	if (lancer_chip(adapter) || !be_physfn(adapter))
		return 0;
	else
		return 4;
}

static int be_roce_map_pci_bars(struct be_adapter *adapter)
4515
{
S
Sathya Perla 已提交
4516
	if (skyhawk_chip(adapter)) {
S
Sathya Perla 已提交
4517 4518 4519 4520 4521 4522
		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));
	}
4523
	return 0;
S
Sathya Perla 已提交
4524 4525 4526 4527 4528
}

static int be_map_pci_bars(struct be_adapter *adapter)
{
	u8 __iomem *addr;
4529

4530 4531
	if (BEx_chip(adapter) && be_physfn(adapter)) {
		adapter->csr = pci_iomap(adapter->pdev, 2, 0);
K
Kalesh AP 已提交
4532
		if (!adapter->csr)
4533 4534 4535
			return -ENOMEM;
	}

S
Sathya Perla 已提交
4536
	addr = pci_iomap(adapter->pdev, db_bar(adapter), 0);
K
Kalesh AP 已提交
4537
	if (!addr)
S
Sathya Perla 已提交
4538
		goto pci_map_err;
4539
	adapter->db = addr;
S
Sathya Perla 已提交
4540 4541

	be_roce_map_pci_bars(adapter);
S
Sathya Perla 已提交
4542
	return 0;
S
Sathya Perla 已提交
4543

S
Sathya Perla 已提交
4544
pci_map_err:
S
Sathya Perla 已提交
4545
	dev_err(&adapter->pdev->dev, "Error in mapping PCI BARs\n");
S
Sathya Perla 已提交
4546 4547 4548 4549 4550 4551
	be_unmap_pci_bars(adapter);
	return -ENOMEM;
}

static void be_ctrl_cleanup(struct be_adapter *adapter)
{
4552
	struct be_dma_mem *mem = &adapter->mbox_mem_alloced;
S
Sathya Perla 已提交
4553 4554 4555 4556

	be_unmap_pci_bars(adapter);

	if (mem->va)
I
Ivan Vecera 已提交
4557 4558
		dma_free_coherent(&adapter->pdev->dev, mem->size, mem->va,
				  mem->dma);
4559

4560
	mem = &adapter->rx_filter;
4561
	if (mem->va)
I
Ivan Vecera 已提交
4562 4563
		dma_free_coherent(&adapter->pdev->dev, mem->size, mem->va,
				  mem->dma);
S
Sathya Perla 已提交
4564 4565 4566 4567
}

static int be_ctrl_init(struct be_adapter *adapter)
{
4568 4569
	struct be_dma_mem *mbox_mem_alloc = &adapter->mbox_mem_alloced;
	struct be_dma_mem *mbox_mem_align = &adapter->mbox_mem;
4570
	struct be_dma_mem *rx_filter = &adapter->rx_filter;
S
Sathya Perla 已提交
4571
	u32 sli_intf;
S
Sathya Perla 已提交
4572 4573
	int status;

S
Sathya Perla 已提交
4574 4575 4576 4577 4578
	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;

S
Sathya Perla 已提交
4579 4580
	status = be_map_pci_bars(adapter);
	if (status)
4581
		goto done;
S
Sathya Perla 已提交
4582 4583

	mbox_mem_alloc->size = sizeof(struct be_mcc_mailbox) + 16;
I
Ivan Vecera 已提交
4584 4585 4586 4587
	mbox_mem_alloc->va = dma_alloc_coherent(&adapter->pdev->dev,
						mbox_mem_alloc->size,
						&mbox_mem_alloc->dma,
						GFP_KERNEL);
S
Sathya Perla 已提交
4588
	if (!mbox_mem_alloc->va) {
4589 4590
		status = -ENOMEM;
		goto unmap_pci_bars;
S
Sathya Perla 已提交
4591 4592 4593 4594 4595
	}
	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);
	memset(mbox_mem_align->va, 0, sizeof(struct be_mcc_mailbox));
4596

4597
	rx_filter->size = sizeof(struct be_cmd_req_rx_filter);
4598 4599 4600
	rx_filter->va = dma_zalloc_coherent(&adapter->pdev->dev,
					    rx_filter->size, &rx_filter->dma,
					    GFP_KERNEL);
K
Kalesh AP 已提交
4601
	if (!rx_filter->va) {
4602 4603 4604
		status = -ENOMEM;
		goto free_mbox;
	}
4605

4606
	mutex_init(&adapter->mbox_lock);
4607 4608
	spin_lock_init(&adapter->mcc_lock);
	spin_lock_init(&adapter->mcc_cq_lock);
4609

4610
	init_completion(&adapter->et_cmd_compl);
4611
	pci_save_state(adapter->pdev);
S
Sathya Perla 已提交
4612
	return 0;
4613 4614

free_mbox:
I
Ivan Vecera 已提交
4615 4616
	dma_free_coherent(&adapter->pdev->dev, mbox_mem_alloc->size,
			  mbox_mem_alloc->va, mbox_mem_alloc->dma);
4617 4618 4619 4620 4621 4622

unmap_pci_bars:
	be_unmap_pci_bars(adapter);

done:
	return status;
S
Sathya Perla 已提交
4623 4624 4625 4626
}

static void be_stats_cleanup(struct be_adapter *adapter)
{
4627
	struct be_dma_mem *cmd = &adapter->stats_cmd;
S
Sathya Perla 已提交
4628 4629

	if (cmd->va)
I
Ivan Vecera 已提交
4630 4631
		dma_free_coherent(&adapter->pdev->dev, cmd->size,
				  cmd->va, cmd->dma);
S
Sathya Perla 已提交
4632 4633 4634 4635
}

static int be_stats_init(struct be_adapter *adapter)
{
4636
	struct be_dma_mem *cmd = &adapter->stats_cmd;
S
Sathya Perla 已提交
4637

4638 4639 4640
	if (lancer_chip(adapter))
		cmd->size = sizeof(struct lancer_cmd_req_pport_stats);
	else if (BE2_chip(adapter))
4641
		cmd->size = sizeof(struct be_cmd_req_get_stats_v0);
4642
	else if (BE3_chip(adapter))
4643
		cmd->size = sizeof(struct be_cmd_req_get_stats_v1);
4644 4645 4646
	else
		/* ALL non-BE ASICs */
		cmd->size = sizeof(struct be_cmd_req_get_stats_v2);
4647

4648 4649
	cmd->va = dma_zalloc_coherent(&adapter->pdev->dev, cmd->size, &cmd->dma,
				      GFP_KERNEL);
K
Kalesh AP 已提交
4650
	if (!cmd->va)
4651
		return -ENOMEM;
S
Sathya Perla 已提交
4652 4653 4654
	return 0;
}

B
Bill Pemberton 已提交
4655
static void be_remove(struct pci_dev *pdev)
S
Sathya Perla 已提交
4656 4657
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);
4658

S
Sathya Perla 已提交
4659 4660 4661
	if (!adapter)
		return;

4662
	be_roce_dev_remove(adapter);
4663
	be_intr_set(adapter, false);
4664

4665 4666
	cancel_delayed_work_sync(&adapter->func_recovery_work);

S
Sathya Perla 已提交
4667 4668
	unregister_netdev(adapter->netdev);

4669 4670
	be_clear(adapter);

4671 4672 4673
	/* tell fw we're done with firing cmds */
	be_cmd_fw_clean(adapter);

S
Sathya Perla 已提交
4674 4675 4676 4677
	be_stats_cleanup(adapter);

	be_ctrl_cleanup(adapter);

S
Sathya Perla 已提交
4678 4679
	pci_disable_pcie_error_reporting(pdev);

S
Sathya Perla 已提交
4680 4681 4682 4683 4684 4685
	pci_release_regions(pdev);
	pci_disable_device(pdev);

	free_netdev(adapter->netdev);
}

4686
static int be_get_initial_config(struct be_adapter *adapter)
S
Sathya Perla 已提交
4687
{
4688
	int status, level;
S
Sathya Perla 已提交
4689

4690 4691 4692 4693
	status = be_cmd_get_cntl_attributes(adapter);
	if (status)
		return status;

4694 4695 4696
	/* Must be a power of 2 or else MODULO will BUG_ON */
	adapter->be_get_temp_freq = 64;

4697 4698 4699 4700 4701
	if (BEx_chip(adapter)) {
		level = be_cmd_get_fw_log_level(adapter);
		adapter->msg_enable =
			level <= FW_LOG_LEVEL_DEFAULT ? NETIF_MSG_HW : 0;
	}
4702

4703
	adapter->cfg_num_qs = netif_get_num_default_rss_queues();
4704
	return 0;
S
Sathya Perla 已提交
4705 4706
}

4707
static int lancer_recover_func(struct be_adapter *adapter)
4708
{
4709
	struct device *dev = &adapter->pdev->dev;
4710 4711
	int status;

4712 4713 4714
	status = lancer_test_and_set_rdy_state(adapter);
	if (status)
		goto err;
4715

4716 4717
	if (netif_running(adapter->netdev))
		be_close(adapter->netdev);
4718

4719 4720
	be_clear(adapter);

4721
	be_clear_all_error(adapter);
4722 4723 4724 4725

	status = be_setup(adapter);
	if (status)
		goto err;
4726

4727 4728
	if (netif_running(adapter->netdev)) {
		status = be_open(adapter->netdev);
4729 4730
		if (status)
			goto err;
4731
	}
4732

4733
	dev_err(dev, "Adapter recovery successful\n");
4734 4735
	return 0;
err:
4736 4737 4738
	if (status == -EAGAIN)
		dev_err(dev, "Waiting for resource provisioning\n");
	else
4739
		dev_err(dev, "Adapter recovery failed\n");
4740

4741 4742 4743 4744 4745 4746 4747
	return status;
}

static void be_func_recovery_task(struct work_struct *work)
{
	struct be_adapter *adapter =
		container_of(work, struct be_adapter,  func_recovery_work.work);
4748
	int status = 0;
4749

4750
	be_detect_error(adapter);
4751

4752 4753 4754 4755
	if (adapter->hw_error && lancer_chip(adapter)) {
		rtnl_lock();
		netif_device_detach(adapter->netdev);
		rtnl_unlock();
4756

4757 4758 4759
		status = lancer_recover_func(adapter);
		if (!status)
			netif_device_attach(adapter->netdev);
4760
	}
4761

4762 4763 4764 4765 4766 4767
	/* In Lancer, for all errors other than provisioning error (-EAGAIN),
	 * no need to attempt further recovery.
	 */
	if (!status || status == -EAGAIN)
		schedule_delayed_work(&adapter->func_recovery_work,
				      msecs_to_jiffies(1000));
4768 4769 4770 4771 4772 4773 4774 4775 4776 4777 4778 4779
}

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

	/* when interrupts are not yet enabled, just reap any pending
	* mcc completions */
	if (!netif_running(adapter->netdev)) {
4780
		local_bh_disable();
S
Sathya Perla 已提交
4781
		be_process_mcc(adapter);
4782
		local_bh_enable();
4783 4784 4785 4786 4787 4788
		goto reschedule;
	}

	if (!adapter->stats_cmd_sent) {
		if (lancer_chip(adapter))
			lancer_cmd_get_pport_stats(adapter,
K
Kalesh AP 已提交
4789
						   &adapter->stats_cmd);
4790 4791 4792 4793
		else
			be_cmd_get_stats(adapter, &adapter->stats_cmd);
	}

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

4798
	for_all_rx_queues(adapter, rxo, i) {
4799 4800 4801 4802
		/* Replenish RX-queues starved due to memory
		 * allocation failures.
		 */
		if (rxo->rx_post_starved)
4803
			be_post_rx_frags(rxo, GFP_KERNEL, MAX_RX_POST);
4804 4805
	}

4806
	be_eqd_update(adapter);
S
Sathya Perla 已提交
4807

4808 4809 4810 4811 4812
reschedule:
	adapter->work_counter++;
	schedule_delayed_work(&adapter->work, msecs_to_jiffies(1000));
}

4813
/* If any VFs are already enabled don't FLR the PF */
4814 4815
static bool be_reset_required(struct be_adapter *adapter)
{
4816
	return pci_num_vf(adapter->pdev) ? false : true;
4817 4818
}

S
Sathya Perla 已提交
4819 4820
static char *mc_name(struct be_adapter *adapter)
{
4821 4822 4823 4824 4825 4826 4827 4828 4829 4830 4831 4832 4833 4834 4835 4836 4837 4838 4839 4840 4841 4842 4843 4844 4845 4846
	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 已提交
4847 4848 4849 4850 4851 4852 4853
}

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

4854
static int be_probe(struct pci_dev *pdev, const struct pci_device_id *pdev_id)
S
Sathya Perla 已提交
4855 4856 4857 4858
{
	int status = 0;
	struct be_adapter *adapter;
	struct net_device *netdev;
4859
	char port_name;
S
Sathya Perla 已提交
4860

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

S
Sathya Perla 已提交
4863 4864 4865 4866 4867 4868 4869 4870 4871
	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);

4872
	netdev = alloc_etherdev_mqs(sizeof(*adapter), MAX_TX_QS, MAX_RX_QS);
K
Kalesh AP 已提交
4873
	if (!netdev) {
S
Sathya Perla 已提交
4874 4875 4876 4877 4878 4879 4880
		status = -ENOMEM;
		goto rel_reg;
	}
	adapter = netdev_priv(netdev);
	adapter->pdev = pdev;
	pci_set_drvdata(pdev, adapter);
	adapter->netdev = netdev;
4881
	SET_NETDEV_DEV(netdev, &pdev->dev);
S
Sathya Perla 已提交
4882

4883
	status = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
S
Sathya Perla 已提交
4884 4885 4886
	if (!status) {
		netdev->features |= NETIF_F_HIGHDMA;
	} else {
4887
		status = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
S
Sathya Perla 已提交
4888 4889 4890 4891 4892 4893
		if (status) {
			dev_err(&pdev->dev, "Could not set PCI DMA Mask\n");
			goto free_netdev;
		}
	}

4894 4895 4896
	status = pci_enable_pcie_error_reporting(pdev);
	if (!status)
		dev_info(&pdev->dev, "PCIe error reporting enabled\n");
S
Sathya Perla 已提交
4897

S
Sathya Perla 已提交
4898 4899
	status = be_ctrl_init(adapter);
	if (status)
4900
		goto free_netdev;
S
Sathya Perla 已提交
4901

4902
	/* sync up with fw's ready state */
4903
	if (be_physfn(adapter)) {
4904
		status = be_fw_wait_ready(adapter);
4905 4906 4907
		if (status)
			goto ctrl_clean;
	}
S
Sathya Perla 已提交
4908

4909 4910 4911 4912
	if (be_reset_required(adapter)) {
		status = be_cmd_reset_function(adapter);
		if (status)
			goto ctrl_clean;
4913

4914 4915 4916
		/* Wait for interrupts to quiesce after an FLR */
		msleep(100);
	}
4917 4918 4919

	/* Allow interrupts for other ULPs running on NIC function */
	be_intr_set(adapter, true);
S
Sathya Perla 已提交
4920

4921 4922 4923 4924 4925
	/* tell fw we're ready to fire cmds */
	status = be_cmd_fw_init(adapter);
	if (status)
		goto ctrl_clean;

4926 4927 4928 4929
	status = be_stats_init(adapter);
	if (status)
		goto ctrl_clean;

4930
	status = be_get_initial_config(adapter);
S
Sathya Perla 已提交
4931 4932 4933 4934
	if (status)
		goto stats_clean;

	INIT_DELAYED_WORK(&adapter->work, be_worker);
4935
	INIT_DELAYED_WORK(&adapter->func_recovery_work, be_func_recovery_task);
4936 4937
	adapter->rx_fc = true;
	adapter->tx_fc = true;
S
Sathya Perla 已提交
4938

4939 4940
	status = be_setup(adapter);
	if (status)
4941
		goto stats_clean;
4942

4943
	be_netdev_init(netdev);
S
Sathya Perla 已提交
4944 4945
	status = register_netdev(netdev);
	if (status != 0)
4946
		goto unsetup;
S
Sathya Perla 已提交
4947

4948 4949
	be_roce_dev_add(adapter);

4950 4951
	schedule_delayed_work(&adapter->func_recovery_work,
			      msecs_to_jiffies(1000));
4952 4953 4954

	be_cmd_query_port_name(adapter, &port_name);

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

S
Sathya Perla 已提交
4958 4959
	return 0;

4960 4961
unsetup:
	be_clear(adapter);
S
Sathya Perla 已提交
4962 4963 4964 4965
stats_clean:
	be_stats_cleanup(adapter);
ctrl_clean:
	be_ctrl_cleanup(adapter);
4966
free_netdev:
4967
	free_netdev(netdev);
S
Sathya Perla 已提交
4968 4969 4970 4971 4972
rel_reg:
	pci_release_regions(pdev);
disable_dev:
	pci_disable_device(pdev);
do_none:
4973
	dev_err(&pdev->dev, "%s initialization failed\n", nic_name(pdev));
S
Sathya Perla 已提交
4974 4975 4976 4977 4978 4979 4980 4981
	return status;
}

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

S
Suresh Reddy 已提交
4982
	if (adapter->wol_en)
4983 4984
		be_setup_wol(adapter, true);

4985
	be_intr_set(adapter, false);
4986 4987
	cancel_delayed_work_sync(&adapter->func_recovery_work);

S
Sathya Perla 已提交
4988 4989 4990 4991 4992 4993
	netif_device_detach(netdev);
	if (netif_running(netdev)) {
		rtnl_lock();
		be_close(netdev);
		rtnl_unlock();
	}
4994
	be_clear(adapter);
S
Sathya Perla 已提交
4995 4996 4997 4998 4999 5000 5001 5002 5003 5004 5005 5006 5007 5008 5009 5010 5011 5012 5013

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

static int be_resume(struct pci_dev *pdev)
{
	int status = 0;
	struct be_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev =  adapter->netdev;

	netif_device_detach(netdev);

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

5014
	pci_set_power_state(pdev, PCI_D0);
S
Sathya Perla 已提交
5015 5016
	pci_restore_state(pdev);

5017 5018 5019 5020
	status = be_fw_wait_ready(adapter);
	if (status)
		return status;

5021
	be_intr_set(adapter, true);
5022 5023 5024 5025 5026
	/* tell fw we're ready to fire cmds */
	status = be_cmd_fw_init(adapter);
	if (status)
		return status;

5027
	be_setup(adapter);
S
Sathya Perla 已提交
5028 5029 5030 5031 5032
	if (netif_running(netdev)) {
		rtnl_lock();
		be_open(netdev);
		rtnl_unlock();
	}
5033 5034 5035

	schedule_delayed_work(&adapter->func_recovery_work,
			      msecs_to_jiffies(1000));
S
Sathya Perla 已提交
5036
	netif_device_attach(netdev);
5037

S
Suresh Reddy 已提交
5038
	if (adapter->wol_en)
5039
		be_setup_wol(adapter, false);
5040

S
Sathya Perla 已提交
5041 5042 5043
	return 0;
}

5044 5045 5046 5047 5048 5049 5050
/*
 * 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);

5051 5052
	if (!adapter)
		return;
5053

5054
	be_roce_dev_shutdown(adapter);
5055
	cancel_delayed_work_sync(&adapter->work);
5056
	cancel_delayed_work_sync(&adapter->func_recovery_work);
5057

5058
	netif_device_detach(adapter->netdev);
5059

5060 5061
	be_cmd_reset_function(adapter);

5062 5063 5064
	pci_disable_device(pdev);
}

5065
static pci_ers_result_t be_eeh_err_detected(struct pci_dev *pdev,
5066
					    pci_channel_state_t state)
5067 5068 5069 5070 5071 5072
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev =  adapter->netdev;

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

5073 5074
	if (!adapter->eeh_error) {
		adapter->eeh_error = true;
5075

5076
		cancel_delayed_work_sync(&adapter->func_recovery_work);
5077 5078

		rtnl_lock();
5079 5080 5081
		netif_device_detach(netdev);
		if (netif_running(netdev))
			be_close(netdev);
5082
		rtnl_unlock();
5083 5084

		be_clear(adapter);
5085 5086 5087 5088 5089 5090 5091
	}

	if (state == pci_channel_io_perm_failure)
		return PCI_ERS_RESULT_DISCONNECT;

	pci_disable_device(pdev);

5092 5093
	/* The error could cause the FW to trigger a flash debug dump.
	 * Resetting the card while flash dump is in progress
5094 5095 5096
	 * can cause it not to recover; wait for it to finish.
	 * Wait only for first function as it is needed only once per
	 * adapter.
5097
	 */
5098 5099 5100
	if (pdev->devfn == 0)
		ssleep(30);

5101 5102 5103 5104 5105 5106 5107 5108 5109 5110 5111 5112 5113 5114 5115
	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);
5116
	pci_set_power_state(pdev, PCI_D0);
5117 5118 5119
	pci_restore_state(pdev);

	/* Check if card is ok and fw is ready */
5120 5121
	dev_info(&adapter->pdev->dev,
		 "Waiting for FW to be ready after EEH reset\n");
5122
	status = be_fw_wait_ready(adapter);
5123 5124 5125
	if (status)
		return PCI_ERS_RESULT_DISCONNECT;

S
Sathya Perla 已提交
5126
	pci_cleanup_aer_uncorrect_error_status(pdev);
5127
	be_clear_all_error(adapter);
5128 5129 5130 5131 5132 5133 5134 5135 5136 5137 5138 5139 5140
	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);
	struct net_device *netdev =  adapter->netdev;

	dev_info(&adapter->pdev->dev, "EEH resume\n");

	pci_save_state(pdev);

5141
	status = be_cmd_reset_function(adapter);
5142 5143 5144
	if (status)
		goto err;

5145 5146 5147 5148 5149 5150
	/* On some BE3 FW versions, after a HW reset,
	 * interrupts will remain disabled for each function.
	 * So, explicitly enable interrupts
	 */
	be_intr_set(adapter, true);

5151 5152
	/* tell fw we're ready to fire cmds */
	status = be_cmd_fw_init(adapter);
5153 5154 5155
	if (status)
		goto err;

5156 5157 5158 5159 5160 5161 5162 5163 5164
	status = be_setup(adapter);
	if (status)
		goto err;

	if (netif_running(netdev)) {
		status = be_open(netdev);
		if (status)
			goto err;
	}
5165 5166 5167

	schedule_delayed_work(&adapter->func_recovery_work,
			      msecs_to_jiffies(1000));
5168 5169 5170 5171 5172 5173
	netif_device_attach(netdev);
	return;
err:
	dev_err(&adapter->pdev->dev, "EEH resume failed\n");
}

5174
static const struct pci_error_handlers be_eeh_handlers = {
5175 5176 5177 5178 5179
	.error_detected = be_eeh_err_detected,
	.slot_reset = be_eeh_reset,
	.resume = be_eeh_resume,
};

S
Sathya Perla 已提交
5180 5181 5182 5183 5184 5185
static struct pci_driver be_driver = {
	.name = DRV_NAME,
	.id_table = be_dev_ids,
	.probe = be_probe,
	.remove = be_remove,
	.suspend = be_suspend,
5186
	.resume = be_resume,
5187
	.shutdown = be_shutdown,
5188
	.err_handler = &be_eeh_handlers
S
Sathya Perla 已提交
5189 5190 5191 5192
};

static int __init be_init_module(void)
{
5193 5194
	if (rx_frag_size != 8192 && rx_frag_size != 4096 &&
	    rx_frag_size != 2048) {
S
Sathya Perla 已提交
5195 5196 5197 5198 5199 5200 5201 5202 5203 5204 5205 5206 5207 5208 5209
		printk(KERN_WARNING DRV_NAME
			" : Module param rx_frag_size must be 2048/4096/8192."
			" Using 2048\n");
		rx_frag_size = 2048;
	}

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