be_main.c 107.2 KB
Newer Older
S
Sathya Perla 已提交
1
/*
2
 * Copyright (C) 2005 - 2011 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>
S
Sathya Perla 已提交
24 25 26 27 28 29 30

MODULE_VERSION(DRV_VER);
MODULE_DEVICE_TABLE(pci, be_dev_ids);
MODULE_DESCRIPTION(DRV_DESC " " DRV_VER);
MODULE_AUTHOR("ServerEngines Corporation");
MODULE_LICENSE("GPL");

31 32 33
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 已提交
34

35 36 37 38
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.");

S
Sathya Perla 已提交
39
static DEFINE_PCI_DEVICE_TABLE(be_dev_ids) = {
40
	{ PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID1) },
41
	{ PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID2) },
42 43
	{ PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID1) },
	{ PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID2) },
44
	{ PCI_DEVICE(EMULEX_VENDOR_ID, OC_DEVICE_ID3)},
45
	{ PCI_DEVICE(EMULEX_VENDOR_ID, OC_DEVICE_ID4)},
46
	{ PCI_DEVICE(EMULEX_VENDOR_ID, OC_DEVICE_ID5)},
S
Sathya Perla 已提交
47 48 49
	{ 0 }
};
MODULE_DEVICE_TABLE(pci, be_dev_ids);
50
/* UE Status Low CSR */
51
static const char * const ue_status_low_desc[] = {
52 53 54 55 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 84 85
	"CEV",
	"CTX",
	"DBUF",
	"ERX",
	"Host",
	"MPU",
	"NDMA",
	"PTC ",
	"RDMA ",
	"RXF ",
	"RXIPS ",
	"RXULP0 ",
	"RXULP1 ",
	"RXULP2 ",
	"TIM ",
	"TPOST ",
	"TPRE ",
	"TXIPS ",
	"TXULP0 ",
	"TXULP1 ",
	"UC ",
	"WDMA ",
	"TXULP2 ",
	"HOST1 ",
	"P0_OB_LINK ",
	"P1_OB_LINK ",
	"HOST_GPIO ",
	"MBOX ",
	"AXGMAC0",
	"AXGMAC1",
	"JTAG",
	"MPU_INTPEND"
};
/* UE Status High CSR */
86
static const char * const ue_status_hi_desc[] = {
87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109
	"LPCMEMHOST",
	"MGMT_MAC",
	"PCS0ONLINE",
	"MPU_IRAM",
	"PCS1ONLINE",
	"PCTL0",
	"PCTL1",
	"PMEM",
	"RR",
	"TXPB",
	"RXPP",
	"XAUI",
	"TXP",
	"ARM",
	"IPC",
	"HOST2",
	"HOST3",
	"HOST4",
	"HOST5",
	"HOST6",
	"HOST7",
	"HOST8",
	"HOST9",
110
	"NETC",
111 112 113 114 115 116 117 118 119
	"Unknown",
	"Unknown",
	"Unknown",
	"Unknown",
	"Unknown",
	"Unknown",
	"Unknown",
	"Unknown"
};
S
Sathya Perla 已提交
120

121 122 123 124 125 126 127
/* Is BE in a multi-channel mode */
static inline bool be_is_mc(struct be_adapter *adapter) {
	return (adapter->function_mode & FLEX10_MODE ||
		adapter->function_mode & VNIC_MODE ||
		adapter->function_mode & UMC_ENABLED);
}

S
Sathya Perla 已提交
128 129 130
static void be_queue_free(struct be_adapter *adapter, struct be_queue_info *q)
{
	struct be_dma_mem *mem = &q->dma_mem;
131
	if (mem->va) {
I
Ivan Vecera 已提交
132 133
		dma_free_coherent(&adapter->pdev->dev, mem->size, mem->va,
				  mem->dma);
134 135
		mem->va = NULL;
	}
S
Sathya Perla 已提交
136 137 138 139 140 141 142 143 144 145 146
}

static int be_queue_alloc(struct be_adapter *adapter, struct be_queue_info *q,
		u16 len, u16 entry_size)
{
	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;
I
Ivan Vecera 已提交
147 148
	mem->va = dma_alloc_coherent(&adapter->pdev->dev, mem->size, &mem->dma,
				     GFP_KERNEL);
S
Sathya Perla 已提交
149
	if (!mem->va)
S
Sathya Perla 已提交
150
		return -ENOMEM;
S
Sathya Perla 已提交
151 152 153 154
	memset(mem->va, 0, mem->size);
	return 0;
}

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

159
	if (adapter->eeh_error)
160 161
		return;

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

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

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

177
static void be_rxq_notify(struct be_adapter *adapter, u16 qid, u16 posted)
S
Sathya Perla 已提交
178 179 180 181
{
	u32 val = 0;
	val |= qid & DB_RQ_RING_ID_MASK;
	val |= posted << DB_RQ_NUM_POSTED_SHIFT;
182 183

	wmb();
184
	iowrite32(val, adapter->db + DB_RQ_OFFSET);
S
Sathya Perla 已提交
185 186
}

187
static void be_txq_notify(struct be_adapter *adapter, u16 qid, u16 posted)
S
Sathya Perla 已提交
188 189 190 191
{
	u32 val = 0;
	val |= qid & DB_TXULP_RING_ID_MASK;
	val |= (posted & DB_TXULP_NUM_POSTED_MASK) << DB_TXULP_NUM_POSTED_SHIFT;
192 193

	wmb();
194
	iowrite32(val, adapter->db + DB_TXULP1_OFFSET);
S
Sathya Perla 已提交
195 196
}

197
static void be_eq_notify(struct be_adapter *adapter, u16 qid,
S
Sathya Perla 已提交
198 199 200 201
		bool arm, bool clear_int, u16 num_popped)
{
	u32 val = 0;
	val |= qid & DB_EQ_RING_ID_MASK;
202 203
	val |= ((qid & DB_EQ_RING_ID_EXT_MASK) <<
			DB_EQ_RING_ID_EXT_MASK_SHIFT);
204

205
	if (adapter->eeh_error)
206 207
		return;

S
Sathya Perla 已提交
208 209 210 211 212 213
	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;
214
	iowrite32(val, adapter->db + DB_EQ_OFFSET);
S
Sathya Perla 已提交
215 216
}

217
void be_cq_notify(struct be_adapter *adapter, u16 qid, bool arm, u16 num_popped)
S
Sathya Perla 已提交
218 219 220
{
	u32 val = 0;
	val |= qid & DB_CQ_RING_ID_MASK;
221 222
	val |= ((qid & DB_CQ_RING_ID_EXT_MASK) <<
			DB_CQ_RING_ID_EXT_MASK_SHIFT);
223

224
	if (adapter->eeh_error)
225 226
		return;

S
Sathya Perla 已提交
227 228 229
	if (arm)
		val |= 1 << DB_CQ_REARM_SHIFT;
	val |= num_popped << DB_CQ_NUM_POPPED_SHIFT;
230
	iowrite32(val, adapter->db + DB_CQ_OFFSET);
S
Sathya Perla 已提交
231 232 233 234 235 236 237
}

static int be_mac_addr_set(struct net_device *netdev, void *p)
{
	struct be_adapter *adapter = netdev_priv(netdev);
	struct sockaddr *addr = p;
	int status = 0;
238
	u8 current_mac[ETH_ALEN];
239
	u32 pmac_id = adapter->pmac_id[0];
S
Sathya Perla 已提交
240

241 242 243
	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

244 245
	status = be_cmd_mac_addr_query(adapter, current_mac, false,
				       adapter->if_handle, 0);
246
	if (status)
247
		goto err;
S
Sathya Perla 已提交
248

249 250
	if (memcmp(addr->sa_data, current_mac, ETH_ALEN)) {
		status = be_cmd_pmac_add(adapter, (u8 *)addr->sa_data,
251
				adapter->if_handle, &adapter->pmac_id[0], 0);
252 253
		if (status)
			goto err;
S
Sathya Perla 已提交
254

255 256 257 258 259 260
		be_cmd_pmac_del(adapter, adapter->if_handle, pmac_id, 0);
	}
	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
	return 0;
err:
	dev_err(&adapter->pdev->dev, "MAC %pM set Failed\n", addr->sa_data);
S
Sathya Perla 已提交
261 262 263
	return status;
}

264 265
static void populate_be2_stats(struct be_adapter *adapter)
{
266 267 268
	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;
269
	struct be_port_rxf_stats_v0 *port_stats =
270 271
					&rxf_stats->port[adapter->port_num];
	struct be_drv_stats *drvs = &adapter->drv_stats;
272

273
	be_dws_le_to_cpu(hw_stats, sizeof(*hw_stats));
274 275 276 277 278 279 280 281 282 283 284 285 286 287
	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;
288
	drvs->rx_input_fifo_overflow_drop = port_stats->rx_input_fifo_overflow;
289 290
	drvs->rx_dropped_header_too_small =
		port_stats->rx_dropped_header_too_small;
291 292 293
	drvs->rx_address_mismatch_drops =
					port_stats->rx_address_mismatch_drops +
					port_stats->rx_vlan_mismatch_drops;
294 295 296 297 298 299 300
	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)
301
		drvs->jabber_events = rxf_stats->port1_jabber_events;
302
	else
303
		drvs->jabber_events = rxf_stats->port0_jabber_events;
304 305 306 307
	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;
308 309
	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;
310 311 312 313 314
	adapter->drv_stats.eth_red_drops = pmem_sts->eth_red_drops;
}

static void populate_be3_stats(struct be_adapter *adapter)
{
315 316 317
	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;
318
	struct be_port_rxf_stats_v1 *port_stats =
319 320
					&rxf_stats->port[adapter->port_num];
	struct be_drv_stats *drvs = &adapter->drv_stats;
321

322
	be_dws_le_to_cpu(hw_stats, sizeof(*hw_stats));
323 324
	drvs->pmem_fifo_overflow_drop = port_stats->pmem_fifo_overflow_drop;
	drvs->rx_priority_pause_frames = port_stats->rx_priority_pause_frames;
325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341
	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;
342
	drvs->rx_address_mismatch_drops = port_stats->rx_address_mismatch_drops;
343 344
	drvs->rx_alignment_symbol_errors =
		port_stats->rx_alignment_symbol_errors;
345
	drvs->rxpp_fifo_overflow_drop = port_stats->rxpp_fifo_overflow_drop;
346 347 348 349 350 351 352
	drvs->tx_pauseframes = port_stats->tx_pauseframes;
	drvs->tx_controlframes = port_stats->tx_controlframes;
	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;
353 354
	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;
355 356 357
	adapter->drv_stats.eth_red_drops = pmem_sts->eth_red_drops;
}

S
Selvin Xavier 已提交
358 359
static void populate_lancer_stats(struct be_adapter *adapter)
{
360

S
Selvin Xavier 已提交
361
	struct be_drv_stats *drvs = &adapter->drv_stats;
362 363 364 365 366 367 368
	struct lancer_pport_stats *pport_stats =
					pport_stats_from_cmd(adapter);

	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 已提交
369
	drvs->rx_in_range_errors = pport_stats->rx_in_range_errors;
370
	drvs->rx_frame_too_long = pport_stats->rx_frames_too_long_lo;
S
Selvin Xavier 已提交
371 372 373 374 375 376 377 378 379 380 381 382
	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;
383 384 385
	drvs->rx_address_mismatch_drops =
					pport_stats->rx_address_mismatch_drops +
					pport_stats->rx_vlan_mismatch_drops;
386
	drvs->rx_alignment_symbol_errors = pport_stats->rx_symbol_errors_lo;
S
Selvin Xavier 已提交
387
	drvs->rxpp_fifo_overflow_drop = pport_stats->rx_fifo_overflow;
388 389
	drvs->tx_pauseframes = pport_stats->tx_pause_frames_lo;
	drvs->tx_controlframes = pport_stats->tx_control_frames_lo;
S
Selvin Xavier 已提交
390
	drvs->jabber_events = pport_stats->rx_jabbers;
391 392
	drvs->forwarded_packets = pport_stats->num_forwards_lo;
	drvs->rx_drops_mtu = pport_stats->rx_drops_mtu_lo;
S
Selvin Xavier 已提交
393
	drvs->rx_drops_too_many_frags =
394
				pport_stats->rx_drops_too_many_frags_lo;
S
Selvin Xavier 已提交
395
}
396

397 398 399 400 401 402 403 404 405 406 407 408
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;
}

409 410
void be_parse_stats(struct be_adapter *adapter)
{
411 412 413 414
	struct be_erx_stats_v1 *erx = be_erx_stats_from_cmd(adapter);
	struct be_rx_obj *rxo;
	int i;

S
Selvin Xavier 已提交
415 416 417 418 419 420
	if (adapter->generation == BE_GEN3) {
		if (lancer_chip(adapter))
			populate_lancer_stats(adapter);
		 else
			populate_be3_stats(adapter);
	} else {
421
		populate_be2_stats(adapter);
S
Selvin Xavier 已提交
422
	}
423

424 425 426
	if (lancer_chip(adapter))
		goto done;

427
	/* as erx_v1 is longer than v0, ok to use v1 defn for v0 access */
428 429 430 431 432 433 434
	for_all_rx_queues(adapter, rxo, i) {
		/* 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->rx_drops_no_fragments[rxo->q.id]);
	}
435 436
done:
	return;
437 438
}

439 440
static struct rtnl_link_stats64 *be_get_stats64(struct net_device *netdev,
					struct rtnl_link_stats64 *stats)
S
Sathya Perla 已提交
441
{
442
	struct be_adapter *adapter = netdev_priv(netdev);
443
	struct be_drv_stats *drvs = &adapter->drv_stats;
444
	struct be_rx_obj *rxo;
445
	struct be_tx_obj *txo;
446 447
	u64 pkts, bytes;
	unsigned int start;
448
	int i;
S
Sathya Perla 已提交
449

450
	for_all_rx_queues(adapter, rxo, i) {
451 452 453 454 455 456 457 458 459 460 461
		const struct be_rx_stats *rx_stats = rx_stats(rxo);
		do {
			start = u64_stats_fetch_begin_bh(&rx_stats->sync);
			pkts = rx_stats(rxo)->rx_pkts;
			bytes = rx_stats(rxo)->rx_bytes;
		} while (u64_stats_fetch_retry_bh(&rx_stats->sync, start));
		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;
462 463
	}

464
	for_all_tx_queues(adapter, txo, i) {
465 466 467 468 469 470 471 472
		const struct be_tx_stats *tx_stats = tx_stats(txo);
		do {
			start = u64_stats_fetch_begin_bh(&tx_stats->sync);
			pkts = tx_stats(txo)->tx_pkts;
			bytes = tx_stats(txo)->tx_bytes;
		} while (u64_stats_fetch_retry_bh(&tx_stats->sync, start));
		stats->tx_packets += pkts;
		stats->tx_bytes += bytes;
473
	}
S
Sathya Perla 已提交
474 475

	/* bad pkts received */
476
	stats->rx_errors = drvs->rx_crc_errors +
477 478 479 480 481 482 483 484
		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 +
485
		drvs->rx_dropped_runt;
486

S
Sathya Perla 已提交
487
	/* detailed rx errors */
488
	stats->rx_length_errors = drvs->rx_in_range_errors +
489 490
		drvs->rx_out_range_errors +
		drvs->rx_frame_too_long;
491

492
	stats->rx_crc_errors = drvs->rx_crc_errors;
S
Sathya Perla 已提交
493 494

	/* frame alignment errors */
495
	stats->rx_frame_errors = drvs->rx_alignment_symbol_errors;
496

S
Sathya Perla 已提交
497 498
	/* receiver fifo overrun */
	/* drops_no_pbuf is no per i/f, it's per BE card */
499
	stats->rx_fifo_errors = drvs->rxpp_fifo_overflow_drop +
500 501
				drvs->rx_input_fifo_overflow_drop +
				drvs->rx_drops_no_pbuf;
502
	return stats;
S
Sathya Perla 已提交
503 504
}

505
void be_link_status_update(struct be_adapter *adapter, u8 link_status)
S
Sathya Perla 已提交
506 507 508
{
	struct net_device *netdev = adapter->netdev;

509
	if (!(adapter->flags & BE_FLAGS_LINK_STATUS_INIT)) {
510
		netif_carrier_off(netdev);
511
		adapter->flags |= BE_FLAGS_LINK_STATUS_INIT;
S
Sathya Perla 已提交
512
	}
513 514 515 516 517

	if ((link_status & LINK_STATUS_MASK) == LINK_UP)
		netif_carrier_on(netdev);
	else
		netif_carrier_off(netdev);
S
Sathya Perla 已提交
518 519
}

520
static void be_tx_stats_update(struct be_tx_obj *txo,
521
			u32 wrb_cnt, u32 copied, u32 gso_segs, bool stopped)
S
Sathya Perla 已提交
522
{
523 524
	struct be_tx_stats *stats = tx_stats(txo);

525
	u64_stats_update_begin(&stats->sync);
526 527 528 529
	stats->tx_reqs++;
	stats->tx_wrbs += wrb_cnt;
	stats->tx_bytes += copied;
	stats->tx_pkts += (gso_segs ? gso_segs : 1);
S
Sathya Perla 已提交
530
	if (stopped)
531
		stats->tx_stops++;
532
	u64_stats_update_end(&stats->sync);
S
Sathya Perla 已提交
533 534 535
}

/* Determine number of WRB entries needed to xmit data in an skb */
536 537
static u32 wrb_cnt_for_skb(struct be_adapter *adapter, struct sk_buff *skb,
								bool *dummy)
S
Sathya Perla 已提交
538
{
539 540 541 542
	int cnt = (skb->len > skb->data_len);

	cnt += skb_shinfo(skb)->nr_frags;

S
Sathya Perla 已提交
543 544
	/* to account for hdr wrb */
	cnt++;
545 546 547
	if (lancer_chip(adapter) || !(cnt & 1)) {
		*dummy = false;
	} else {
S
Sathya Perla 已提交
548 549 550
		/* add a dummy to make it an even num */
		cnt++;
		*dummy = true;
551
	}
S
Sathya Perla 已提交
552 553 554 555 556 557 558 559 560
	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;
561
	wrb->rsvd0 = 0;
S
Sathya Perla 已提交
562 563
}

564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579
static inline u16 be_get_tx_vlan_tag(struct be_adapter *adapter,
					struct sk_buff *skb)
{
	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;
}

580 581 582 583 584
static int be_vlan_tag_chk(struct be_adapter *adapter, struct sk_buff *skb)
{
	return vlan_tx_tag_present(skb) || adapter->pvid;
}

585 586
static void wrb_fill_hdr(struct be_adapter *adapter, struct be_eth_hdr_wrb *hdr,
		struct sk_buff *skb, u32 wrb_cnt, u32 len)
S
Sathya Perla 已提交
587
{
588
	u16 vlan_tag;
589

S
Sathya Perla 已提交
590 591 592 593
	memset(hdr, 0, sizeof(*hdr));

	AMAP_SET_BITS(struct amap_eth_hdr_wrb, crc, hdr, 1);

A
Ajit Khaparde 已提交
594
	if (skb_is_gso(skb)) {
S
Sathya Perla 已提交
595 596 597
		AMAP_SET_BITS(struct amap_eth_hdr_wrb, lso, hdr, 1);
		AMAP_SET_BITS(struct amap_eth_hdr_wrb, lso_mss,
			hdr, skb_shinfo(skb)->gso_size);
598
		if (skb_is_gso_v6(skb) && !lancer_chip(adapter))
A
Ajit Khaparde 已提交
599
			AMAP_SET_BITS(struct amap_eth_hdr_wrb, lso6, hdr, 1);
600 601 602 603 604 605 606 607 608 609
		if (lancer_chip(adapter) && adapter->sli_family  ==
							LANCER_A0_SLI_FAMILY) {
			AMAP_SET_BITS(struct amap_eth_hdr_wrb, ipcs, hdr, 1);
			if (is_tcp_pkt(skb))
				AMAP_SET_BITS(struct amap_eth_hdr_wrb,
								tcpcs, hdr, 1);
			else if (is_udp_pkt(skb))
				AMAP_SET_BITS(struct amap_eth_hdr_wrb,
								udpcs, hdr, 1);
		}
S
Sathya Perla 已提交
610 611 612 613 614 615 616
	} else if (skb->ip_summed == CHECKSUM_PARTIAL) {
		if (is_tcp_pkt(skb))
			AMAP_SET_BITS(struct amap_eth_hdr_wrb, tcpcs, hdr, 1);
		else if (is_udp_pkt(skb))
			AMAP_SET_BITS(struct amap_eth_hdr_wrb, udpcs, hdr, 1);
	}

A
Ajit Khaparde 已提交
617
	if (vlan_tx_tag_present(skb)) {
S
Sathya Perla 已提交
618
		AMAP_SET_BITS(struct amap_eth_hdr_wrb, vlan, hdr, 1);
619
		vlan_tag = be_get_tx_vlan_tag(adapter, skb);
620
		AMAP_SET_BITS(struct amap_eth_hdr_wrb, vlan_tag, hdr, vlan_tag);
S
Sathya Perla 已提交
621 622 623 624 625 626 627 628
	}

	AMAP_SET_BITS(struct amap_eth_hdr_wrb, event, hdr, 1);
	AMAP_SET_BITS(struct amap_eth_hdr_wrb, complete, hdr, 1);
	AMAP_SET_BITS(struct amap_eth_hdr_wrb, num_wrb, hdr, wrb_cnt);
	AMAP_SET_BITS(struct amap_eth_hdr_wrb, len, hdr, len);
}

I
Ivan Vecera 已提交
629
static void unmap_tx_frag(struct device *dev, struct be_eth_wrb *wrb,
630 631 632 633 634 635 636
		bool unmap_single)
{
	dma_addr_t dma;

	be_dws_le_to_cpu(wrb, sizeof(*wrb));

	dma = (u64)wrb->frag_pa_hi << 32 | (u64)wrb->frag_pa_lo;
637
	if (wrb->frag_len) {
638
		if (unmap_single)
I
Ivan Vecera 已提交
639 640
			dma_unmap_single(dev, dma, wrb->frag_len,
					 DMA_TO_DEVICE);
641
		else
I
Ivan Vecera 已提交
642
			dma_unmap_page(dev, dma, wrb->frag_len, DMA_TO_DEVICE);
643 644
	}
}
S
Sathya Perla 已提交
645

646
static int make_tx_wrbs(struct be_adapter *adapter, struct be_queue_info *txq,
S
Sathya Perla 已提交
647 648
		struct sk_buff *skb, u32 wrb_cnt, bool dummy_wrb)
{
649 650
	dma_addr_t busaddr;
	int i, copied = 0;
I
Ivan Vecera 已提交
651
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
652 653 654
	struct sk_buff *first_skb = skb;
	struct be_eth_wrb *wrb;
	struct be_eth_hdr_wrb *hdr;
655 656
	bool map_single = false;
	u16 map_head;
S
Sathya Perla 已提交
657 658 659

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

662
	if (skb->len > skb->data_len) {
E
Eric Dumazet 已提交
663
		int len = skb_headlen(skb);
I
Ivan Vecera 已提交
664 665
		busaddr = dma_map_single(dev, skb->data, len, DMA_TO_DEVICE);
		if (dma_mapping_error(dev, busaddr))
666 667
			goto dma_err;
		map_single = true;
668 669 670 671 672 673
		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 已提交
674

675
	for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
E
Eric Dumazet 已提交
676
		const struct skb_frag_struct *frag =
677
			&skb_shinfo(skb)->frags[i];
678
		busaddr = skb_frag_dma_map(dev, frag, 0,
E
Eric Dumazet 已提交
679
					   skb_frag_size(frag), DMA_TO_DEVICE);
I
Ivan Vecera 已提交
680
		if (dma_mapping_error(dev, busaddr))
681
			goto dma_err;
682
		wrb = queue_head_node(txq);
E
Eric Dumazet 已提交
683
		wrb_fill(wrb, busaddr, skb_frag_size(frag));
684 685
		be_dws_cpu_to_le(wrb, sizeof(*wrb));
		queue_head_inc(txq);
E
Eric Dumazet 已提交
686
		copied += skb_frag_size(frag);
S
Sathya Perla 已提交
687 688 689 690 691 692 693 694 695
	}

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

696
	wrb_fill_hdr(adapter, hdr, first_skb, wrb_cnt, copied);
S
Sathya Perla 已提交
697 698 699
	be_dws_cpu_to_le(hdr, sizeof(*hdr));

	return copied;
700 701 702 703
dma_err:
	txq->head = map_head;
	while (copied) {
		wrb = queue_head_node(txq);
I
Ivan Vecera 已提交
704
		unmap_tx_frag(dev, wrb, map_single);
705 706 707 708 709
		map_single = false;
		copied -= wrb->frag_len;
		queue_head_inc(txq);
	}
	return 0;
S
Sathya Perla 已提交
710 711
}

712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729
static struct sk_buff *be_insert_vlan_in_pkt(struct be_adapter *adapter,
					     struct sk_buff *skb)
{
	u16 vlan_tag = 0;

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

	if (vlan_tx_tag_present(skb)) {
		vlan_tag = be_get_tx_vlan_tag(adapter, skb);
		__vlan_put_tag(skb, vlan_tag);
		skb->vlan_tci = 0;
	}

	return skb;
}

730
static netdev_tx_t be_xmit(struct sk_buff *skb,
731
			struct net_device *netdev)
S
Sathya Perla 已提交
732 733
{
	struct be_adapter *adapter = netdev_priv(netdev);
734 735
	struct be_tx_obj *txo = &adapter->tx_obj[skb_get_queue_mapping(skb)];
	struct be_queue_info *txq = &txo->q;
736
	struct iphdr *ip = NULL;
S
Sathya Perla 已提交
737
	u32 wrb_cnt = 0, copied = 0;
738
	u32 start = txq->head, eth_hdr_len;
S
Sathya Perla 已提交
739 740
	bool dummy_wrb, stopped = false;

741 742 743 744 745
	eth_hdr_len = ntohs(skb->protocol) == ETH_P_8021Q ?
		VLAN_ETH_HLEN : ETH_HLEN;

	/* HW has a bug which considers padding bytes as legal
	 * and modifies the IPv4 hdr's 'tot_len' field
746
	 */
747 748 749 750 751
	if (skb->len <= 60 && be_vlan_tag_chk(adapter, skb) &&
			is_ipv4_pkt(skb)) {
		ip = (struct iphdr *)ip_hdr(skb);
		pskb_trim(skb, eth_hdr_len + ntohs(ip->tot_len));
	}
752

753 754 755 756 757 758 759
	/* 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 &&
			be_vlan_tag_chk(adapter, skb)) {
		skb = be_insert_vlan_in_pkt(adapter, skb);
760 761 762 763
		if (unlikely(!skb))
			goto tx_drop;
	}

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

766
	copied = make_tx_wrbs(adapter, txq, skb, wrb_cnt, dummy_wrb);
767
	if (copied) {
E
Eric Dumazet 已提交
768 769
		int gso_segs = skb_shinfo(skb)->gso_segs;

770
		/* record the sent skb in the sent_skb table */
771 772
		BUG_ON(txo->sent_skb_list[start]);
		txo->sent_skb_list[start] = skb;
773 774 775 776 777

		/* 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
		 */
778
		atomic_add(wrb_cnt, &txq->used);
779 780
		if ((BE_MAX_TX_FRAG_COUNT + atomic_read(&txq->used)) >=
								txq->len) {
781
			netif_stop_subqueue(netdev, skb_get_queue_mapping(skb));
782 783
			stopped = true;
		}
S
Sathya Perla 已提交
784

785
		be_txq_notify(adapter, txq->id, wrb_cnt);
S
Sathya Perla 已提交
786

E
Eric Dumazet 已提交
787
		be_tx_stats_update(txo, wrb_cnt, copied, gso_segs, stopped);
788 789 790
	} else {
		txq->head = start;
		dev_kfree_skb_any(skb);
S
Sathya Perla 已提交
791
	}
792
tx_drop:
S
Sathya Perla 已提交
793 794 795 796 797 798 799
	return NETDEV_TX_OK;
}

static int be_change_mtu(struct net_device *netdev, int new_mtu)
{
	struct be_adapter *adapter = netdev_priv(netdev);
	if (new_mtu < BE_MIN_MTU ||
A
Ajit Khaparde 已提交
800 801
			new_mtu > (BE_MAX_JUMBO_FRAME_SIZE -
					(ETH_HLEN + ETH_FCS_LEN))) {
S
Sathya Perla 已提交
802 803
		dev_info(&adapter->pdev->dev,
			"MTU must be between %d and %d bytes\n",
A
Ajit Khaparde 已提交
804 805
			BE_MIN_MTU,
			(BE_MAX_JUMBO_FRAME_SIZE - (ETH_HLEN + ETH_FCS_LEN)));
S
Sathya Perla 已提交
806 807 808 809 810 811 812 813 814
		return -EINVAL;
	}
	dev_info(&adapter->pdev->dev, "MTU changed from %d to %d bytes\n",
			netdev->mtu, new_mtu);
	netdev->mtu = new_mtu;
	return 0;
}

/*
815 816
 * 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 已提交
817
 */
S
Sathya Perla 已提交
818
static int be_vid_config(struct be_adapter *adapter)
S
Sathya Perla 已提交
819
{
S
Sathya Perla 已提交
820 821
	u16 vids[BE_NUM_VLANS_SUPPORTED];
	u16 num = 0, i;
822
	int status = 0;
823

824 825 826 827
	/* No need to further configure vids if in promiscuous mode */
	if (adapter->promiscuous)
		return 0;

828 829 830 831 832 833
	if (adapter->vlans_added > adapter->max_vlans)
		goto set_vlan_promisc;

	/* Construct VLAN Table to give to HW */
	for (i = 0; i < VLAN_N_VID; i++)
		if (adapter->vlan_tag[i])
S
Sathya Perla 已提交
834
			vids[num++] = cpu_to_le16(i);
835 836

	status = be_cmd_vlan_config(adapter, adapter->if_handle,
S
Sathya Perla 已提交
837
				    vids, num, 1, 0);
838 839 840 841 842 843

	/* Set to VLAN promisc mode as setting VLAN filter failed */
	if (status) {
		dev_info(&adapter->pdev->dev, "Exhausted VLAN HW filters.\n");
		dev_info(&adapter->pdev->dev, "Disabling HW VLAN filtering.\n");
		goto set_vlan_promisc;
S
Sathya Perla 已提交
844
	}
845

846
	return status;
847 848 849 850 851

set_vlan_promisc:
	status = be_cmd_vlan_config(adapter, adapter->if_handle,
				    NULL, 0, 1, 1);
	return status;
S
Sathya Perla 已提交
852 853
}

854
static int be_vlan_add_vid(struct net_device *netdev, u16 vid)
S
Sathya Perla 已提交
855 856
{
	struct be_adapter *adapter = netdev_priv(netdev);
A
Ajit Khaparde 已提交
857
	int status = 0;
S
Sathya Perla 已提交
858

A
Ajit Khaparde 已提交
859 860 861 862
	if (!be_physfn(adapter)) {
		status = -EINVAL;
		goto ret;
	}
863

S
Sathya Perla 已提交
864
	adapter->vlan_tag[vid] = 1;
865
	if (adapter->vlans_added <= (adapter->max_vlans + 1))
S
Sathya Perla 已提交
866
		status = be_vid_config(adapter);
867

A
Ajit Khaparde 已提交
868 869 870 871 872 873
	if (!status)
		adapter->vlans_added++;
	else
		adapter->vlan_tag[vid] = 0;
ret:
	return status;
S
Sathya Perla 已提交
874 875
}

876
static int be_vlan_rem_vid(struct net_device *netdev, u16 vid)
S
Sathya Perla 已提交
877 878
{
	struct be_adapter *adapter = netdev_priv(netdev);
A
Ajit Khaparde 已提交
879
	int status = 0;
S
Sathya Perla 已提交
880

A
Ajit Khaparde 已提交
881 882 883 884
	if (!be_physfn(adapter)) {
		status = -EINVAL;
		goto ret;
	}
885

S
Sathya Perla 已提交
886
	adapter->vlan_tag[vid] = 0;
887
	if (adapter->vlans_added <= adapter->max_vlans)
S
Sathya Perla 已提交
888
		status = be_vid_config(adapter);
889

A
Ajit Khaparde 已提交
890 891 892 893 894 895
	if (!status)
		adapter->vlans_added--;
	else
		adapter->vlan_tag[vid] = 1;
ret:
	return status;
S
Sathya Perla 已提交
896 897
}

898
static void be_set_rx_mode(struct net_device *netdev)
S
Sathya Perla 已提交
899 900
{
	struct be_adapter *adapter = netdev_priv(netdev);
901
	int status;
S
Sathya Perla 已提交
902

903
	if (netdev->flags & IFF_PROMISC) {
904
		be_cmd_rx_filter(adapter, IFF_PROMISC, ON);
905 906
		adapter->promiscuous = true;
		goto done;
S
Sathya Perla 已提交
907 908
	}

L
Lucas De Marchi 已提交
909
	/* BE was previously in promiscuous mode; disable it */
910 911
	if (adapter->promiscuous) {
		adapter->promiscuous = false;
912
		be_cmd_rx_filter(adapter, IFF_PROMISC, OFF);
913 914

		if (adapter->vlans_added)
S
Sathya Perla 已提交
915
			be_vid_config(adapter);
S
Sathya Perla 已提交
916 917
	}

918
	/* Enable multicast promisc if num configured exceeds what we support */
919
	if (netdev->flags & IFF_ALLMULTI ||
920
	    netdev_mc_count(netdev) > adapter->max_mcast_mac) {
921
		be_cmd_rx_filter(adapter, IFF_ALLMULTI, ON);
922
		goto done;
S
Sathya Perla 已提交
923 924
	}

925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947
	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);
		}

		if (netdev_uc_count(netdev) > adapter->max_pmac_cnt) {
			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);
		}
	}

948 949 950 951 952 953 954 955
	status = be_cmd_rx_filter(adapter, IFF_MULTICAST, ON);

	/* Set to MCAST promisc mode if setting MULTICAST address fails */
	if (status) {
		dev_info(&adapter->pdev->dev, "Exhausted multicast HW filters.\n");
		dev_info(&adapter->pdev->dev, "Disabling HW multicast filtering.\n");
		be_cmd_rx_filter(adapter, IFF_ALLMULTI, ON);
	}
956 957
done:
	return;
S
Sathya Perla 已提交
958 959
}

960 961 962
static int be_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
{
	struct be_adapter *adapter = netdev_priv(netdev);
963
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
964 965
	int status;

966
	if (!sriov_enabled(adapter))
967 968
		return -EPERM;

969
	if (!is_valid_ether_addr(mac) || vf >= adapter->num_vfs)
970 971
		return -EINVAL;

972 973 974
	if (lancer_chip(adapter)) {
		status = be_cmd_set_mac_list(adapter,  mac, 1, vf + 1);
	} else {
975 976
		status = be_cmd_pmac_del(adapter, vf_cfg->if_handle,
					 vf_cfg->pmac_id, vf + 1);
977

978 979
		status = be_cmd_pmac_add(adapter, mac, vf_cfg->if_handle,
					 &vf_cfg->pmac_id, vf + 1);
980 981
	}

982
	if (status)
983 984
		dev_err(&adapter->pdev->dev, "MAC %pM set on VF %d Failed\n",
				mac, vf);
985
	else
986
		memcpy(vf_cfg->mac_addr, mac, ETH_ALEN);
987

988 989 990
	return status;
}

991 992 993 994
static int be_get_vf_config(struct net_device *netdev, int vf,
			struct ifla_vf_info *vi)
{
	struct be_adapter *adapter = netdev_priv(netdev);
995
	struct be_vf_cfg *vf_cfg = &adapter->vf_cfg[vf];
996

997
	if (!sriov_enabled(adapter))
998 999
		return -EPERM;

1000
	if (vf >= adapter->num_vfs)
1001 1002 1003
		return -EINVAL;

	vi->vf = vf;
1004 1005
	vi->tx_rate = vf_cfg->tx_rate;
	vi->vlan = vf_cfg->vlan_tag;
1006
	vi->qos = 0;
1007
	memcpy(&vi->mac, vf_cfg->mac_addr, ETH_ALEN);
1008 1009 1010 1011

	return 0;
}

1012 1013 1014 1015 1016 1017
static int be_set_vf_vlan(struct net_device *netdev,
			int vf, u16 vlan, u8 qos)
{
	struct be_adapter *adapter = netdev_priv(netdev);
	int status = 0;

1018
	if (!sriov_enabled(adapter))
1019 1020
		return -EPERM;

1021
	if (vf >= adapter->num_vfs || vlan > 4095)
1022 1023 1024
		return -EINVAL;

	if (vlan) {
1025 1026 1027 1028 1029 1030 1031
		if (adapter->vf_cfg[vf].vlan_tag != vlan) {
			/* If this is new value, program it. Else skip. */
			adapter->vf_cfg[vf].vlan_tag = vlan;

			status = be_cmd_set_hsw_config(adapter, vlan,
				vf + 1, adapter->vf_cfg[vf].if_handle);
		}
1032
	} else {
1033
		/* Reset Transparent Vlan Tagging. */
1034
		adapter->vf_cfg[vf].vlan_tag = 0;
1035 1036 1037
		vlan = adapter->vf_cfg[vf].def_vid;
		status = be_cmd_set_hsw_config(adapter, vlan, vf + 1,
			adapter->vf_cfg[vf].if_handle);
1038 1039 1040 1041 1042 1043 1044 1045 1046
	}


	if (status)
		dev_info(&adapter->pdev->dev,
				"VLAN %d config on VF %d failed\n", vlan, vf);
	return status;
}

1047 1048 1049 1050 1051 1052
static int be_set_vf_tx_rate(struct net_device *netdev,
			int vf, int rate)
{
	struct be_adapter *adapter = netdev_priv(netdev);
	int status = 0;

1053
	if (!sriov_enabled(adapter))
1054 1055
		return -EPERM;

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

1059 1060 1061 1062 1063
	if (rate < 100 || rate > 10000) {
		dev_err(&adapter->pdev->dev,
			"tx rate must be between 100 and 10000 Mbps\n");
		return -EINVAL;
	}
1064

1065 1066 1067 1068
	if (lancer_chip(adapter))
		status = be_cmd_set_profile_config(adapter, rate / 10, vf + 1);
	else
		status = be_cmd_set_qos(adapter, rate / 10, vf + 1);
1069 1070

	if (status)
1071
		dev_err(&adapter->pdev->dev,
1072
				"tx rate %d on VF %d failed\n", rate, vf);
1073 1074
	else
		adapter->vf_cfg[vf].tx_rate = rate;
1075 1076 1077
	return status;
}

1078 1079 1080
static int be_find_vfs(struct be_adapter *adapter, int vf_state)
{
	struct pci_dev *dev, *pdev = adapter->pdev;
I
Ivan Vecera 已提交
1081
	int vfs = 0, assigned_vfs = 0, pos;
1082 1083 1084
	u16 offset, stride;

	pos = pci_find_ext_capability(pdev, PCI_EXT_CAP_ID_SRIOV);
1085 1086
	if (!pos)
		return 0;
1087 1088 1089 1090 1091
	pci_read_config_word(pdev, pos + PCI_SRIOV_VF_OFFSET, &offset);
	pci_read_config_word(pdev, pos + PCI_SRIOV_VF_STRIDE, &stride);

	dev = pci_get_device(pdev->vendor, PCI_ANY_ID, NULL);
	while (dev) {
I
Ivan Vecera 已提交
1092
		if (dev->is_virtfn && pci_physfn(dev) == pdev) {
1093 1094 1095 1096 1097 1098 1099 1100 1101
			vfs++;
			if (dev->dev_flags & PCI_DEV_FLAGS_ASSIGNED)
				assigned_vfs++;
		}
		dev = pci_get_device(pdev->vendor, PCI_ANY_ID, dev);
	}
	return (vf_state == ASSIGNED) ? assigned_vfs : vfs;
}

S
Sathya Perla 已提交
1102
static void be_eqd_update(struct be_adapter *adapter, struct be_eq_obj *eqo)
S
Sathya Perla 已提交
1103
{
S
Sathya Perla 已提交
1104
	struct be_rx_stats *stats = rx_stats(&adapter->rx_obj[eqo->idx]);
1105
	ulong now = jiffies;
1106
	ulong delta = now - stats->rx_jiffies;
1107 1108
	u64 pkts;
	unsigned int start, eqd;
1109

S
Sathya Perla 已提交
1110 1111 1112 1113 1114 1115
	if (!eqo->enable_aic) {
		eqd = eqo->eqd;
		goto modify_eqd;
	}

	if (eqo->idx >= adapter->num_rx_qs)
1116
		return;
S
Sathya Perla 已提交
1117

S
Sathya Perla 已提交
1118 1119
	stats = rx_stats(&adapter->rx_obj[eqo->idx]);

1120
	/* Wrapped around */
1121 1122
	if (time_before(now, stats->rx_jiffies)) {
		stats->rx_jiffies = now;
1123 1124
		return;
	}
S
Sathya Perla 已提交
1125

1126 1127
	/* Update once a second */
	if (delta < HZ)
S
Sathya Perla 已提交
1128 1129
		return;

1130 1131 1132 1133 1134
	do {
		start = u64_stats_fetch_begin_bh(&stats->sync);
		pkts = stats->rx_pkts;
	} while (u64_stats_fetch_retry_bh(&stats->sync, start));

1135
	stats->rx_pps = (unsigned long)(pkts - stats->rx_pkts_prev) / (delta / HZ);
1136
	stats->rx_pkts_prev = pkts;
1137
	stats->rx_jiffies = now;
S
Sathya Perla 已提交
1138 1139 1140
	eqd = (stats->rx_pps / 110000) << 3;
	eqd = min(eqd, eqo->max_eqd);
	eqd = max(eqd, eqo->min_eqd);
1141 1142
	if (eqd < 10)
		eqd = 0;
S
Sathya Perla 已提交
1143 1144 1145 1146 1147

modify_eqd:
	if (eqd != eqo->cur_eqd) {
		be_cmd_modify_eqd(adapter, eqo->q.id, eqd);
		eqo->cur_eqd = eqd;
1148
	}
S
Sathya Perla 已提交
1149 1150
}

1151
static void be_rx_stats_update(struct be_rx_obj *rxo,
1152
		struct be_rx_compl_info *rxcp)
1153
{
1154
	struct be_rx_stats *stats = rx_stats(rxo);
1155

1156
	u64_stats_update_begin(&stats->sync);
1157
	stats->rx_compl++;
1158
	stats->rx_bytes += rxcp->pkt_size;
1159
	stats->rx_pkts++;
1160
	if (rxcp->pkt_type == BE_MULTICAST_PACKET)
1161
		stats->rx_mcast_pkts++;
1162
	if (rxcp->err)
1163
		stats->rx_compl_err++;
1164
	u64_stats_update_end(&stats->sync);
1165 1166
}

1167
static inline bool csum_passed(struct be_rx_compl_info *rxcp)
1168
{
1169 1170
	/* L4 checksum is not reliable for non TCP/UDP packets.
	 * Also ignore ipcksm for ipv6 pkts */
1171 1172
	return (rxcp->tcpf || rxcp->udpf) && rxcp->l4_csum &&
				(rxcp->ip_csum || rxcp->ipv6);
1173 1174
}

S
Sathya Perla 已提交
1175 1176
static struct be_rx_page_info *get_rx_page_info(struct be_rx_obj *rxo,
						u16 frag_idx)
S
Sathya Perla 已提交
1177
{
S
Sathya Perla 已提交
1178
	struct be_adapter *adapter = rxo->adapter;
S
Sathya Perla 已提交
1179
	struct be_rx_page_info *rx_page_info;
1180
	struct be_queue_info *rxq = &rxo->q;
S
Sathya Perla 已提交
1181

1182
	rx_page_info = &rxo->page_info_tbl[frag_idx];
S
Sathya Perla 已提交
1183 1184
	BUG_ON(!rx_page_info->page);

A
Ajit Khaparde 已提交
1185
	if (rx_page_info->last_page_user) {
I
Ivan Vecera 已提交
1186 1187 1188
		dma_unmap_page(&adapter->pdev->dev,
			       dma_unmap_addr(rx_page_info, bus),
			       adapter->big_page_size, DMA_FROM_DEVICE);
A
Ajit Khaparde 已提交
1189 1190
		rx_page_info->last_page_user = false;
	}
S
Sathya Perla 已提交
1191 1192 1193 1194 1195 1196

	atomic_dec(&rxq->used);
	return rx_page_info;
}

/* Throwaway the data in the Rx completion */
S
Sathya Perla 已提交
1197 1198
static void be_rx_compl_discard(struct be_rx_obj *rxo,
				struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
1199
{
1200
	struct be_queue_info *rxq = &rxo->q;
S
Sathya Perla 已提交
1201
	struct be_rx_page_info *page_info;
1202
	u16 i, num_rcvd = rxcp->num_rcvd;
S
Sathya Perla 已提交
1203

1204
	for (i = 0; i < num_rcvd; i++) {
S
Sathya Perla 已提交
1205
		page_info = get_rx_page_info(rxo, rxcp->rxq_idx);
1206 1207
		put_page(page_info->page);
		memset(page_info, 0, sizeof(*page_info));
1208
		index_inc(&rxcp->rxq_idx, rxq->len);
S
Sathya Perla 已提交
1209 1210 1211 1212 1213 1214 1215
	}
}

/*
 * skb_fill_rx_data forms a complete skb for an ether frame
 * indicated by rxcp.
 */
S
Sathya Perla 已提交
1216 1217
static void skb_fill_rx_data(struct be_rx_obj *rxo, struct sk_buff *skb,
			     struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
1218
{
1219
	struct be_queue_info *rxq = &rxo->q;
S
Sathya Perla 已提交
1220
	struct be_rx_page_info *page_info;
1221 1222
	u16 i, j;
	u16 hdr_len, curr_frag_len, remaining;
S
Sathya Perla 已提交
1223 1224
	u8 *start;

S
Sathya Perla 已提交
1225
	page_info = get_rx_page_info(rxo, rxcp->rxq_idx);
S
Sathya Perla 已提交
1226 1227 1228 1229
	start = page_address(page_info->page) + page_info->page_offset;
	prefetch(start);

	/* Copy data in the first descriptor of this completion */
1230
	curr_frag_len = min(rxcp->pkt_size, rx_frag_size);
S
Sathya Perla 已提交
1231 1232 1233

	skb->len = curr_frag_len;
	if (curr_frag_len <= BE_HDR_LEN) { /* tiny packet */
1234
		memcpy(skb->data, start, curr_frag_len);
S
Sathya Perla 已提交
1235 1236 1237 1238 1239
		/* Complete packet has now been moved to data */
		put_page(page_info->page);
		skb->data_len = 0;
		skb->tail += curr_frag_len;
	} else {
1240 1241
		hdr_len = ETH_HLEN;
		memcpy(skb->data, start, hdr_len);
S
Sathya Perla 已提交
1242
		skb_shinfo(skb)->nr_frags = 1;
1243
		skb_frag_set_page(skb, 0, page_info->page);
S
Sathya Perla 已提交
1244 1245
		skb_shinfo(skb)->frags[0].page_offset =
					page_info->page_offset + hdr_len;
E
Eric Dumazet 已提交
1246
		skb_frag_size_set(&skb_shinfo(skb)->frags[0], curr_frag_len - hdr_len);
S
Sathya Perla 已提交
1247
		skb->data_len = curr_frag_len - hdr_len;
E
Eric Dumazet 已提交
1248
		skb->truesize += rx_frag_size;
S
Sathya Perla 已提交
1249 1250
		skb->tail += hdr_len;
	}
A
Ajit Khaparde 已提交
1251
	page_info->page = NULL;
S
Sathya Perla 已提交
1252

1253 1254 1255
	if (rxcp->pkt_size <= rx_frag_size) {
		BUG_ON(rxcp->num_rcvd != 1);
		return;
S
Sathya Perla 已提交
1256 1257 1258
	}

	/* More frags present for this completion */
1259 1260 1261
	index_inc(&rxcp->rxq_idx, rxq->len);
	remaining = rxcp->pkt_size - curr_frag_len;
	for (i = 1, j = 0; i < rxcp->num_rcvd; i++) {
S
Sathya Perla 已提交
1262
		page_info = get_rx_page_info(rxo, rxcp->rxq_idx);
1263
		curr_frag_len = min(remaining, rx_frag_size);
S
Sathya Perla 已提交
1264

1265 1266 1267 1268
		/* Coalesce all frags from the same physical page in one slot */
		if (page_info->page_offset == 0) {
			/* Fresh page */
			j++;
1269
			skb_frag_set_page(skb, j, page_info->page);
1270 1271
			skb_shinfo(skb)->frags[j].page_offset =
							page_info->page_offset;
E
Eric Dumazet 已提交
1272
			skb_frag_size_set(&skb_shinfo(skb)->frags[j], 0);
1273 1274 1275 1276 1277
			skb_shinfo(skb)->nr_frags++;
		} else {
			put_page(page_info->page);
		}

E
Eric Dumazet 已提交
1278
		skb_frag_size_add(&skb_shinfo(skb)->frags[j], curr_frag_len);
S
Sathya Perla 已提交
1279 1280
		skb->len += curr_frag_len;
		skb->data_len += curr_frag_len;
E
Eric Dumazet 已提交
1281
		skb->truesize += rx_frag_size;
1282 1283
		remaining -= curr_frag_len;
		index_inc(&rxcp->rxq_idx, rxq->len);
A
Ajit Khaparde 已提交
1284
		page_info->page = NULL;
S
Sathya Perla 已提交
1285
	}
1286
	BUG_ON(j > MAX_SKB_FRAGS);
S
Sathya Perla 已提交
1287 1288
}

1289
/* Process the RX completion indicated by rxcp when GRO is disabled */
S
Sathya Perla 已提交
1290 1291
static void be_rx_compl_process(struct be_rx_obj *rxo,
				struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
1292
{
S
Sathya Perla 已提交
1293
	struct be_adapter *adapter = rxo->adapter;
1294
	struct net_device *netdev = adapter->netdev;
S
Sathya Perla 已提交
1295
	struct sk_buff *skb;
1296

1297
	skb = netdev_alloc_skb_ip_align(netdev, BE_RX_SKB_ALLOC_SIZE);
1298
	if (unlikely(!skb)) {
1299
		rx_stats(rxo)->rx_drops_no_skbs++;
S
Sathya Perla 已提交
1300
		be_rx_compl_discard(rxo, rxcp);
S
Sathya Perla 已提交
1301 1302 1303
		return;
	}

S
Sathya Perla 已提交
1304
	skb_fill_rx_data(rxo, skb, rxcp);
S
Sathya Perla 已提交
1305

1306
	if (likely((netdev->features & NETIF_F_RXCSUM) && csum_passed(rxcp)))
1307
		skb->ip_summed = CHECKSUM_UNNECESSARY;
S
Somnath Kotur 已提交
1308 1309
	else
		skb_checksum_none_assert(skb);
S
Sathya Perla 已提交
1310

1311
	skb->protocol = eth_type_trans(skb, netdev);
1312
	skb_record_rx_queue(skb, rxo - &adapter->rx_obj[0]);
S
Sathya Perla 已提交
1313
	if (netdev->features & NETIF_F_RXHASH)
A
Ajit Khaparde 已提交
1314 1315
		skb->rxhash = rxcp->rss_hash;

S
Sathya Perla 已提交
1316

1317
	if (rxcp->vlanf)
A
Ajit Khaparde 已提交
1318 1319 1320
		__vlan_hwaccel_put_tag(skb, rxcp->vlan_tag);

	netif_receive_skb(skb);
S
Sathya Perla 已提交
1321 1322
}

1323
/* Process the RX completion indicated by rxcp when GRO is enabled */
S
Sathya Perla 已提交
1324 1325
void be_rx_compl_process_gro(struct be_rx_obj *rxo, struct napi_struct *napi,
			     struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
1326
{
S
Sathya Perla 已提交
1327
	struct be_adapter *adapter = rxo->adapter;
S
Sathya Perla 已提交
1328
	struct be_rx_page_info *page_info;
1329
	struct sk_buff *skb = NULL;
1330
	struct be_queue_info *rxq = &rxo->q;
1331 1332
	u16 remaining, curr_frag_len;
	u16 i, j;
1333

S
Sathya Perla 已提交
1334
	skb = napi_get_frags(napi);
1335
	if (!skb) {
S
Sathya Perla 已提交
1336
		be_rx_compl_discard(rxo, rxcp);
1337 1338 1339
		return;
	}

1340 1341
	remaining = rxcp->pkt_size;
	for (i = 0, j = -1; i < rxcp->num_rcvd; i++) {
S
Sathya Perla 已提交
1342
		page_info = get_rx_page_info(rxo, rxcp->rxq_idx);
S
Sathya Perla 已提交
1343 1344 1345

		curr_frag_len = min(remaining, rx_frag_size);

1346 1347 1348 1349
		/* 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++;
1350
			skb_frag_set_page(skb, j, page_info->page);
1351 1352
			skb_shinfo(skb)->frags[j].page_offset =
							page_info->page_offset;
E
Eric Dumazet 已提交
1353
			skb_frag_size_set(&skb_shinfo(skb)->frags[j], 0);
1354 1355 1356
		} else {
			put_page(page_info->page);
		}
E
Eric Dumazet 已提交
1357
		skb_frag_size_add(&skb_shinfo(skb)->frags[j], curr_frag_len);
E
Eric Dumazet 已提交
1358
		skb->truesize += rx_frag_size;
1359
		remaining -= curr_frag_len;
1360
		index_inc(&rxcp->rxq_idx, rxq->len);
S
Sathya Perla 已提交
1361 1362
		memset(page_info, 0, sizeof(*page_info));
	}
1363
	BUG_ON(j > MAX_SKB_FRAGS);
S
Sathya Perla 已提交
1364

1365
	skb_shinfo(skb)->nr_frags = j + 1;
1366 1367
	skb->len = rxcp->pkt_size;
	skb->data_len = rxcp->pkt_size;
1368
	skb->ip_summed = CHECKSUM_UNNECESSARY;
1369
	skb_record_rx_queue(skb, rxo - &adapter->rx_obj[0]);
A
Ajit Khaparde 已提交
1370 1371
	if (adapter->netdev->features & NETIF_F_RXHASH)
		skb->rxhash = rxcp->rss_hash;
1372

1373
	if (rxcp->vlanf)
A
Ajit Khaparde 已提交
1374 1375
		__vlan_hwaccel_put_tag(skb, rxcp->vlan_tag);

S
Sathya Perla 已提交
1376
	napi_gro_frags(napi);
1377 1378
}

S
Sathya Perla 已提交
1379 1380
static void be_parse_rx_compl_v1(struct be_eth_rx_compl *compl,
				 struct be_rx_compl_info *rxcp)
1381 1382 1383 1384 1385 1386
{
	rxcp->pkt_size =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v1, pktsize, compl);
	rxcp->vlanf = AMAP_GET_BITS(struct amap_eth_rx_compl_v1, vtp, compl);
	rxcp->err = AMAP_GET_BITS(struct amap_eth_rx_compl_v1, err, compl);
	rxcp->tcpf = AMAP_GET_BITS(struct amap_eth_rx_compl_v1, tcpf, compl);
1387
	rxcp->udpf = AMAP_GET_BITS(struct amap_eth_rx_compl_v1, udpf, compl);
1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399
	rxcp->ip_csum =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v1, ipcksm, compl);
	rxcp->l4_csum =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v1, l4_cksm, compl);
	rxcp->ipv6 =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v1, ip_version, compl);
	rxcp->rxq_idx =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v1, fragndx, compl);
	rxcp->num_rcvd =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v1, numfrags, compl);
	rxcp->pkt_type =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v1, cast_enc, compl);
A
Ajit Khaparde 已提交
1400
	rxcp->rss_hash =
1401
		AMAP_GET_BITS(struct amap_eth_rx_compl_v1, rsshash, compl);
1402 1403
	if (rxcp->vlanf) {
		rxcp->vtm = AMAP_GET_BITS(struct amap_eth_rx_compl_v1, vtm,
1404 1405 1406
					  compl);
		rxcp->vlan_tag = AMAP_GET_BITS(struct amap_eth_rx_compl_v1, vlan_tag,
					       compl);
1407
	}
1408
	rxcp->port = AMAP_GET_BITS(struct amap_eth_rx_compl_v1, port, compl);
1409 1410
}

S
Sathya Perla 已提交
1411 1412
static void be_parse_rx_compl_v0(struct be_eth_rx_compl *compl,
				 struct be_rx_compl_info *rxcp)
1413 1414 1415 1416 1417 1418
{
	rxcp->pkt_size =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v0, pktsize, compl);
	rxcp->vlanf = AMAP_GET_BITS(struct amap_eth_rx_compl_v0, vtp, compl);
	rxcp->err = AMAP_GET_BITS(struct amap_eth_rx_compl_v0, err, compl);
	rxcp->tcpf = AMAP_GET_BITS(struct amap_eth_rx_compl_v0, tcpf, compl);
1419
	rxcp->udpf = AMAP_GET_BITS(struct amap_eth_rx_compl_v0, udpf, compl);
1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431
	rxcp->ip_csum =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v0, ipcksm, compl);
	rxcp->l4_csum =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v0, l4_cksm, compl);
	rxcp->ipv6 =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v0, ip_version, compl);
	rxcp->rxq_idx =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v0, fragndx, compl);
	rxcp->num_rcvd =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v0, numfrags, compl);
	rxcp->pkt_type =
		AMAP_GET_BITS(struct amap_eth_rx_compl_v0, cast_enc, compl);
A
Ajit Khaparde 已提交
1432
	rxcp->rss_hash =
1433
		AMAP_GET_BITS(struct amap_eth_rx_compl_v0, rsshash, compl);
1434 1435
	if (rxcp->vlanf) {
		rxcp->vtm = AMAP_GET_BITS(struct amap_eth_rx_compl_v0, vtm,
1436 1437 1438
					  compl);
		rxcp->vlan_tag = AMAP_GET_BITS(struct amap_eth_rx_compl_v0, vlan_tag,
					       compl);
1439
	}
1440
	rxcp->port = AMAP_GET_BITS(struct amap_eth_rx_compl_v0, port, compl);
1441 1442 1443 1444 1445 1446 1447
}

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

1449 1450 1451 1452
	/* 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 已提交
1453

1454 1455
	rmb();
	be_dws_le_to_cpu(compl, sizeof(*compl));
S
Sathya Perla 已提交
1456

1457
	if (adapter->be3_native)
S
Sathya Perla 已提交
1458
		be_parse_rx_compl_v1(compl, rxcp);
1459
	else
S
Sathya Perla 已提交
1460
		be_parse_rx_compl_v0(compl, rxcp);
S
Sathya Perla 已提交
1461

1462 1463 1464
	if (rxcp->vlanf) {
		/* vlanf could be wrongly set in some cards.
		 * ignore if vtm is not set */
1465
		if ((adapter->function_mode & FLEX10_MODE) && !rxcp->vtm)
1466
			rxcp->vlanf = 0;
S
Sathya Perla 已提交
1467

1468
		if (!lancer_chip(adapter))
1469
			rxcp->vlan_tag = swab16(rxcp->vlan_tag);
S
Sathya Perla 已提交
1470

1471
		if (adapter->pvid == (rxcp->vlan_tag & VLAN_VID_MASK) &&
1472
		    !adapter->vlan_tag[rxcp->vlan_tag])
1473 1474
			rxcp->vlanf = 0;
	}
1475 1476 1477

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

1479
	queue_tail_inc(&rxo->cq);
S
Sathya Perla 已提交
1480 1481 1482
	return rxcp;
}

1483
static inline struct page *be_alloc_pages(u32 size, gfp_t gfp)
S
Sathya Perla 已提交
1484 1485
{
	u32 order = get_order(size);
1486

S
Sathya Perla 已提交
1487
	if (order > 0)
1488 1489
		gfp |= __GFP_COMP;
	return  alloc_pages(gfp, order);
S
Sathya Perla 已提交
1490 1491 1492 1493 1494 1495
}

/*
 * Allocate a page, split it to fragments of size rx_frag_size and post as
 * receive buffers to BE
 */
1496
static void be_post_rx_frags(struct be_rx_obj *rxo, gfp_t gfp)
S
Sathya Perla 已提交
1497
{
1498
	struct be_adapter *adapter = rxo->adapter;
1499
	struct be_rx_page_info *page_info = NULL, *prev_page_info = NULL;
1500
	struct be_queue_info *rxq = &rxo->q;
S
Sathya Perla 已提交
1501 1502 1503 1504 1505
	struct page *pagep = NULL;
	struct be_eth_rx_d *rxd;
	u64 page_dmaaddr = 0, frag_dmaaddr;
	u32 posted, page_offset = 0;

1506
	page_info = &rxo->page_info_tbl[rxq->head];
S
Sathya Perla 已提交
1507 1508
	for (posted = 0; posted < MAX_RX_POST && !page_info->page; posted++) {
		if (!pagep) {
1509
			pagep = be_alloc_pages(adapter->big_page_size, gfp);
S
Sathya Perla 已提交
1510
			if (unlikely(!pagep)) {
1511
				rx_stats(rxo)->rx_post_fail++;
S
Sathya Perla 已提交
1512 1513
				break;
			}
I
Ivan Vecera 已提交
1514 1515 1516
			page_dmaaddr = dma_map_page(&adapter->pdev->dev, pagep,
						    0, adapter->big_page_size,
						    DMA_FROM_DEVICE);
S
Sathya Perla 已提交
1517 1518 1519 1520 1521 1522 1523
			page_info->page_offset = 0;
		} else {
			get_page(pagep);
			page_info->page_offset = page_offset + rx_frag_size;
		}
		page_offset = page_info->page_offset;
		page_info->page = pagep;
1524
		dma_unmap_addr_set(page_info, bus, page_dmaaddr);
S
Sathya Perla 已提交
1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536
		frag_dmaaddr = page_dmaaddr + page_info->page_offset;

		rxd = queue_head_node(rxq);
		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;
			page_info->last_page_user = true;
		}
1537 1538 1539

		prev_page_info = page_info;
		queue_head_inc(rxq);
S
Sathya Perla 已提交
1540
		page_info = &rxo->page_info_tbl[rxq->head];
S
Sathya Perla 已提交
1541 1542
	}
	if (pagep)
1543
		prev_page_info->last_page_user = true;
S
Sathya Perla 已提交
1544 1545 1546

	if (posted) {
		atomic_add(posted, &rxq->used);
1547
		be_rxq_notify(adapter, rxq->id, posted);
1548 1549
	} else if (atomic_read(&rxq->used) == 0) {
		/* Let be_worker replenish when memory is available */
1550
		rxo->rx_post_starved = true;
S
Sathya Perla 已提交
1551 1552 1553
	}
}

1554
static struct be_eth_tx_compl *be_tx_compl_get(struct be_queue_info *tx_cq)
S
Sathya Perla 已提交
1555 1556 1557 1558 1559 1560
{
	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;

1561
	rmb();
S
Sathya Perla 已提交
1562 1563 1564 1565 1566 1567 1568 1569
	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;
}

1570 1571
static u16 be_tx_compl_process(struct be_adapter *adapter,
		struct be_tx_obj *txo, u16 last_index)
S
Sathya Perla 已提交
1572
{
1573
	struct be_queue_info *txq = &txo->q;
1574
	struct be_eth_wrb *wrb;
1575
	struct sk_buff **sent_skbs = txo->sent_skb_list;
S
Sathya Perla 已提交
1576
	struct sk_buff *sent_skb;
1577 1578
	u16 cur_index, num_wrbs = 1; /* account for hdr wrb */
	bool unmap_skb_hdr = true;
S
Sathya Perla 已提交
1579

1580
	sent_skb = sent_skbs[txq->tail];
S
Sathya Perla 已提交
1581
	BUG_ON(!sent_skb);
1582 1583 1584
	sent_skbs[txq->tail] = NULL;

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

1587
	do {
S
Sathya Perla 已提交
1588
		cur_index = txq->tail;
1589
		wrb = queue_tail_node(txq);
I
Ivan Vecera 已提交
1590 1591
		unmap_tx_frag(&adapter->pdev->dev, wrb,
			      (unmap_skb_hdr && skb_headlen(sent_skb)));
1592 1593
		unmap_skb_hdr = false;

S
Sathya Perla 已提交
1594 1595
		num_wrbs++;
		queue_tail_inc(txq);
1596
	} while (cur_index != last_index);
S
Sathya Perla 已提交
1597 1598

	kfree_skb(sent_skb);
1599
	return num_wrbs;
S
Sathya Perla 已提交
1600 1601
}

S
Sathya Perla 已提交
1602 1603
/* Return the number of events in the event queue */
static inline int events_get(struct be_eq_obj *eqo)
1604
{
S
Sathya Perla 已提交
1605 1606
	struct be_eq_entry *eqe;
	int num = 0;
1607

S
Sathya Perla 已提交
1608 1609 1610 1611
	do {
		eqe = queue_tail_node(&eqo->q);
		if (eqe->evt == 0)
			break;
1612

S
Sathya Perla 已提交
1613 1614 1615 1616 1617 1618 1619
		rmb();
		eqe->evt = 0;
		num++;
		queue_tail_inc(&eqo->q);
	} while (true);

	return num;
1620 1621
}

S
Sathya Perla 已提交
1622
static int event_handle(struct be_eq_obj *eqo)
1623
{
S
Sathya Perla 已提交
1624 1625
	bool rearm = false;
	int num = events_get(eqo);
1626

S
Sathya Perla 已提交
1627
	/* Deal with any spurious interrupts that come without events */
1628 1629 1630
	if (!num)
		rearm = true;

1631 1632 1633
	if (num || msix_enabled(eqo->adapter))
		be_eq_notify(eqo->adapter, eqo->q.id, rearm, true, num);

1634
	if (num)
S
Sathya Perla 已提交
1635
		napi_schedule(&eqo->napi);
1636 1637 1638 1639

	return num;
}

S
Sathya Perla 已提交
1640 1641
/* Leaves the EQ is disarmed state */
static void be_eq_clean(struct be_eq_obj *eqo)
1642
{
S
Sathya Perla 已提交
1643
	int num = events_get(eqo);
1644

S
Sathya Perla 已提交
1645
	be_eq_notify(eqo->adapter, eqo->q.id, false, true, num);
1646 1647
}

S
Sathya Perla 已提交
1648
static void be_rx_cq_clean(struct be_rx_obj *rxo)
S
Sathya Perla 已提交
1649 1650
{
	struct be_rx_page_info *page_info;
1651 1652
	struct be_queue_info *rxq = &rxo->q;
	struct be_queue_info *rx_cq = &rxo->cq;
1653
	struct be_rx_compl_info *rxcp;
S
Sathya Perla 已提交
1654 1655 1656
	u16 tail;

	/* First cleanup pending rx completions */
1657
	while ((rxcp = be_rx_compl_get(rxo)) != NULL) {
S
Sathya Perla 已提交
1658 1659
		be_rx_compl_discard(rxo, rxcp);
		be_cq_notify(rxo->adapter, rx_cq->id, false, 1);
S
Sathya Perla 已提交
1660 1661 1662 1663
	}

	/* Then free posted rx buffer that were not used */
	tail = (rxq->head + rxq->len - atomic_read(&rxq->used)) % rxq->len;
1664
	for (; atomic_read(&rxq->used) > 0; index_inc(&tail, rxq->len)) {
S
Sathya Perla 已提交
1665
		page_info = get_rx_page_info(rxo, tail);
S
Sathya Perla 已提交
1666 1667 1668 1669
		put_page(page_info->page);
		memset(page_info, 0, sizeof(*page_info));
	}
	BUG_ON(atomic_read(&rxq->used));
1670
	rxq->tail = rxq->head = 0;
S
Sathya Perla 已提交
1671 1672
}

S
Sathya Perla 已提交
1673
static void be_tx_compl_clean(struct be_adapter *adapter)
S
Sathya Perla 已提交
1674
{
S
Sathya Perla 已提交
1675 1676
	struct be_tx_obj *txo;
	struct be_queue_info *txq;
1677
	struct be_eth_tx_compl *txcp;
1678
	u16 end_idx, cmpl = 0, timeo = 0, num_wrbs = 0;
1679 1680
	struct sk_buff *sent_skb;
	bool dummy_wrb;
S
Sathya Perla 已提交
1681
	int i, pending_txqs;
1682 1683 1684

	/* Wait for a max of 200ms for all the tx-completions to arrive. */
	do {
S
Sathya Perla 已提交
1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704
		pending_txqs = adapter->num_tx_qs;

		for_all_tx_queues(adapter, txo, i) {
			txq = &txo->q;
			while ((txcp = be_tx_compl_get(&txo->cq))) {
				end_idx =
					AMAP_GET_BITS(struct amap_eth_tx_compl,
						      wrb_index, txcp);
				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);
				cmpl = 0;
				num_wrbs = 0;
			}
			if (atomic_read(&txq->used) == 0)
				pending_txqs--;
1705 1706
		}

S
Sathya Perla 已提交
1707
		if (pending_txqs == 0 || ++timeo > 200)
1708 1709 1710 1711 1712
			break;

		mdelay(1);
	} while (true);

S
Sathya Perla 已提交
1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728
	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);
		}
1729
	}
S
Sathya Perla 已提交
1730 1731
}

S
Sathya Perla 已提交
1732 1733 1734 1735 1736 1737
static void be_evt_queues_destroy(struct be_adapter *adapter)
{
	struct be_eq_obj *eqo;
	int i;

	for_all_evt_queues(adapter, eqo, i) {
1738 1739
		if (eqo->q.created) {
			be_eq_clean(eqo);
S
Sathya Perla 已提交
1740
			be_cmd_q_destroy(adapter, &eqo->q, QTYPE_EQ);
1741
		}
S
Sathya Perla 已提交
1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770
		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;
	int i, rc;

	adapter->num_evt_qs = num_irqs(adapter);

	for_all_evt_queues(adapter, eqo, i) {
		eqo->adapter = adapter;
		eqo->tx_budget = BE_TX_BUDGET;
		eqo->idx = i;
		eqo->max_eqd = BE_MAX_EQD;
		eqo->enable_aic = true;

		eq = &eqo->q;
		rc = be_queue_alloc(adapter, eq, EVNT_Q_LEN,
					sizeof(struct be_eq_entry));
		if (rc)
			return rc;

		rc = be_cmd_eq_create(adapter, eq, eqo->cur_eqd);
		if (rc)
			return rc;
	}
1771
	return 0;
S
Sathya Perla 已提交
1772 1773
}

1774 1775 1776 1777
static void be_mcc_queues_destroy(struct be_adapter *adapter)
{
	struct be_queue_info *q;

1778
	q = &adapter->mcc_obj.q;
1779
	if (q->created)
1780
		be_cmd_q_destroy(adapter, q, QTYPE_MCCQ);
1781 1782
	be_queue_free(adapter, q);

1783
	q = &adapter->mcc_obj.cq;
1784
	if (q->created)
1785
		be_cmd_q_destroy(adapter, q, QTYPE_CQ);
1786 1787 1788 1789 1790 1791 1792 1793
	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;

1794
	cq = &adapter->mcc_obj.cq;
1795
	if (be_queue_alloc(adapter, cq, MCC_CQ_LEN,
1796
			sizeof(struct be_mcc_compl)))
1797 1798
		goto err;

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

1803
	q = &adapter->mcc_obj.q;
1804 1805 1806
	if (be_queue_alloc(adapter, q, MCC_Q_LEN, sizeof(struct be_mcc_wrb)))
		goto mcc_cq_destroy;

1807
	if (be_cmd_mccq_create(adapter, q, cq))
1808 1809 1810 1811 1812 1813 1814
		goto mcc_q_free;

	return 0;

mcc_q_free:
	be_queue_free(adapter, q);
mcc_cq_destroy:
1815
	be_cmd_q_destroy(adapter, cq, QTYPE_CQ);
1816 1817 1818 1819 1820 1821
mcc_cq_free:
	be_queue_free(adapter, cq);
err:
	return -1;
}

S
Sathya Perla 已提交
1822 1823 1824
static void be_tx_queues_destroy(struct be_adapter *adapter)
{
	struct be_queue_info *q;
1825 1826
	struct be_tx_obj *txo;
	u8 i;
S
Sathya Perla 已提交
1827

1828 1829 1830 1831 1832
	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 已提交
1833

1834 1835 1836 1837 1838
		q = &txo->cq;
		if (q->created)
			be_cmd_q_destroy(adapter, q, QTYPE_CQ);
		be_queue_free(adapter, q);
	}
S
Sathya Perla 已提交
1839 1840
}

1841 1842
static int be_num_txqs_want(struct be_adapter *adapter)
{
1843 1844 1845
	if ((!lancer_chip(adapter) && sriov_want(adapter)) ||
	    be_is_mc(adapter) ||
	    (!lancer_chip(adapter) && !be_physfn(adapter)) ||
1846
	    adapter->generation == BE_GEN2)
1847 1848
		return 1;
	else
1849
		return adapter->max_tx_queues;
1850 1851
}

S
Sathya Perla 已提交
1852
static int be_tx_cqs_create(struct be_adapter *adapter)
S
Sathya Perla 已提交
1853
{
S
Sathya Perla 已提交
1854 1855
	struct be_queue_info *cq, *eq;
	int status;
1856 1857
	struct be_tx_obj *txo;
	u8 i;
S
Sathya Perla 已提交
1858

1859
	adapter->num_tx_qs = be_num_txqs_want(adapter);
1860 1861
	if (adapter->num_tx_qs != MAX_TX_QS) {
		rtnl_lock();
1862 1863
		netif_set_real_num_tx_queues(adapter->netdev,
			adapter->num_tx_qs);
1864 1865
		rtnl_unlock();
	}
1866

S
Sathya Perla 已提交
1867 1868 1869 1870 1871 1872
	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;
1873

S
Sathya Perla 已提交
1874 1875 1876 1877 1878 1879 1880 1881 1882 1883
		/* 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;
	}
	return 0;
}
S
Sathya Perla 已提交
1884

S
Sathya Perla 已提交
1885 1886 1887 1888
static int be_tx_qs_create(struct be_adapter *adapter)
{
	struct be_tx_obj *txo;
	int i, status;
1889

1890
	for_all_tx_queues(adapter, txo, i) {
S
Sathya Perla 已提交
1891 1892 1893 1894
		status = be_queue_alloc(adapter, &txo->q, TX_Q_LEN,
					sizeof(struct be_eth_wrb));
		if (status)
			return status;
S
Sathya Perla 已提交
1895

S
Sathya Perla 已提交
1896 1897 1898
		status = be_cmd_txq_create(adapter, &txo->q, &txo->cq);
		if (status)
			return status;
1899
	}
S
Sathya Perla 已提交
1900

S
Sathya Perla 已提交
1901 1902
	dev_info(&adapter->pdev->dev, "created %d TX queue(s)\n",
		 adapter->num_tx_qs);
S
Sathya Perla 已提交
1903
	return 0;
S
Sathya Perla 已提交
1904 1905
}

S
Sathya Perla 已提交
1906
static void be_rx_cqs_destroy(struct be_adapter *adapter)
S
Sathya Perla 已提交
1907 1908
{
	struct be_queue_info *q;
1909 1910 1911 1912 1913 1914 1915 1916
	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);
1917 1918 1919
	}
}

S
Sathya Perla 已提交
1920
static int be_rx_cqs_create(struct be_adapter *adapter)
S
Sathya Perla 已提交
1921
{
S
Sathya Perla 已提交
1922
	struct be_queue_info *eq, *cq;
1923 1924
	struct be_rx_obj *rxo;
	int rc, i;
S
Sathya Perla 已提交
1925

S
Sathya Perla 已提交
1926 1927 1928 1929 1930
	/* We'll create as many RSS rings as there are irqs.
	 * But when there's only one irq there's no use creating RSS rings
	 */
	adapter->num_rx_qs = (num_irqs(adapter) > 1) ?
				num_irqs(adapter) + 1 : 1;
1931 1932 1933 1934 1935 1936
	if (adapter->num_rx_qs != MAX_RX_QS) {
		rtnl_lock();
		netif_set_real_num_rx_queues(adapter->netdev,
					     adapter->num_rx_qs);
		rtnl_unlock();
	}
1937

S
Sathya Perla 已提交
1938
	adapter->big_page_size = (1 << get_order(rx_frag_size)) * PAGE_SIZE;
1939 1940 1941 1942 1943 1944
	for_all_rx_queues(adapter, rxo, i) {
		rxo->adapter = adapter;
		cq = &rxo->cq;
		rc = be_queue_alloc(adapter, cq, RX_CQ_LEN,
				sizeof(struct be_eth_rx_compl));
		if (rc)
S
Sathya Perla 已提交
1945
			return rc;
1946

S
Sathya Perla 已提交
1947 1948
		eq = &adapter->eq_obj[i % adapter->num_evt_qs].q;
		rc = be_cmd_cq_create(adapter, cq, eq, false, 3);
1949
		if (rc)
S
Sathya Perla 已提交
1950
			return rc;
1951
	}
S
Sathya Perla 已提交
1952

S
Sathya Perla 已提交
1953 1954 1955
	dev_info(&adapter->pdev->dev,
		 "created %d RSS queue(s) and 1 default RX queue\n",
		 adapter->num_rx_qs - 1);
S
Sathya Perla 已提交
1956
	return 0;
1957 1958
}

S
Sathya Perla 已提交
1959 1960 1961
static irqreturn_t be_intx(int irq, void *dev)
{
	struct be_adapter *adapter = dev;
S
Sathya Perla 已提交
1962
	int num_evts;
S
Sathya Perla 已提交
1963

S
Sathya Perla 已提交
1964 1965 1966 1967 1968 1969
	/* With INTx only one EQ is used */
	num_evts = event_handle(&adapter->eq_obj[0]);
	if (num_evts)
		return IRQ_HANDLED;
	else
		return IRQ_NONE;
S
Sathya Perla 已提交
1970 1971
}

S
Sathya Perla 已提交
1972
static irqreturn_t be_msix(int irq, void *dev)
S
Sathya Perla 已提交
1973
{
S
Sathya Perla 已提交
1974
	struct be_eq_obj *eqo = dev;
S
Sathya Perla 已提交
1975

S
Sathya Perla 已提交
1976
	event_handle(eqo);
S
Sathya Perla 已提交
1977 1978 1979
	return IRQ_HANDLED;
}

1980
static inline bool do_gro(struct be_rx_compl_info *rxcp)
S
Sathya Perla 已提交
1981
{
1982
	return (rxcp->tcpf && !rxcp->err) ? true : false;
S
Sathya Perla 已提交
1983 1984
}

S
Sathya Perla 已提交
1985 1986
static int be_process_rx(struct be_rx_obj *rxo, struct napi_struct *napi,
			int budget)
S
Sathya Perla 已提交
1987
{
1988 1989
	struct be_adapter *adapter = rxo->adapter;
	struct be_queue_info *rx_cq = &rxo->cq;
1990
	struct be_rx_compl_info *rxcp;
S
Sathya Perla 已提交
1991 1992 1993
	u32 work_done;

	for (work_done = 0; work_done < budget; work_done++) {
1994
		rxcp = be_rx_compl_get(rxo);
S
Sathya Perla 已提交
1995 1996 1997
		if (!rxcp)
			break;

1998 1999 2000 2001 2002 2003
		/* 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 已提交
2004
			be_rx_compl_discard(rxo, rxcp);
2005 2006 2007 2008 2009 2010 2011 2012
			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 &&
				!lancer_chip(adapter))) {
S
Sathya Perla 已提交
2013
			be_rx_compl_discard(rxo, rxcp);
2014
			goto loop_continue;
2015
		}
2016

2017
		if (do_gro(rxcp))
S
Sathya Perla 已提交
2018
			be_rx_compl_process_gro(rxo, napi, rxcp);
2019
		else
S
Sathya Perla 已提交
2020
			be_rx_compl_process(rxo, rxcp);
2021
loop_continue:
2022
		be_rx_stats_update(rxo, rxcp);
S
Sathya Perla 已提交
2023 2024
	}

S
Sathya Perla 已提交
2025 2026
	if (work_done) {
		be_cq_notify(adapter, rx_cq->id, true, work_done);
2027

S
Sathya Perla 已提交
2028 2029
		if (atomic_read(&rxo->q.used) < RX_FRAGS_REFILL_WM)
			be_post_rx_frags(rxo, GFP_ATOMIC);
S
Sathya Perla 已提交
2030
	}
S
Sathya Perla 已提交
2031

S
Sathya Perla 已提交
2032 2033 2034
	return work_done;
}

S
Sathya Perla 已提交
2035 2036
static bool be_process_tx(struct be_adapter *adapter, struct be_tx_obj *txo,
			  int budget, int idx)
S
Sathya Perla 已提交
2037 2038
{
	struct be_eth_tx_compl *txcp;
S
Sathya Perla 已提交
2039
	int num_wrbs = 0, work_done;
2040

S
Sathya Perla 已提交
2041 2042 2043 2044 2045
	for (work_done = 0; work_done < budget; work_done++) {
		txcp = be_tx_compl_get(&txo->cq);
		if (!txcp)
			break;
		num_wrbs += be_tx_compl_process(adapter, txo,
2046 2047
				AMAP_GET_BITS(struct amap_eth_tx_compl,
					wrb_index, txcp));
S
Sathya Perla 已提交
2048
	}
S
Sathya Perla 已提交
2049

S
Sathya Perla 已提交
2050 2051 2052
	if (work_done) {
		be_cq_notify(adapter, txo->cq.id, true, work_done);
		atomic_sub(num_wrbs, &txo->q.used);
2053

S
Sathya Perla 已提交
2054 2055 2056 2057 2058
		/* 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) &&
			atomic_read(&txo->q.used) < txo->q.len / 2) {
			netif_wake_subqueue(adapter->netdev, idx);
2059
		}
S
Sathya Perla 已提交
2060 2061 2062 2063

		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 已提交
2064
	}
S
Sathya Perla 已提交
2065 2066
	return (work_done < budget); /* Done */
}
S
Sathya Perla 已提交
2067

S
Sathya Perla 已提交
2068 2069 2070 2071 2072 2073
int be_poll(struct napi_struct *napi, int budget)
{
	struct be_eq_obj *eqo = container_of(napi, struct be_eq_obj, napi);
	struct be_adapter *adapter = eqo->adapter;
	int max_work = 0, work, i;
	bool tx_done;
S
Sathya Perla 已提交
2074

S
Sathya Perla 已提交
2075 2076 2077 2078 2079 2080
	/* Process all TXQs serviced by this EQ */
	for (i = eqo->idx; i < adapter->num_tx_qs; i += adapter->num_evt_qs) {
		tx_done = be_process_tx(adapter, &adapter->tx_obj[i],
					eqo->tx_budget, i);
		if (!tx_done)
			max_work = budget;
S
Sathya Perla 已提交
2081 2082
	}

S
Sathya Perla 已提交
2083 2084 2085 2086 2087 2088 2089 2090
	/* 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 (i = eqo->idx; i < adapter->num_rx_qs; i += adapter->num_evt_qs) {
		work = be_process_rx(&adapter->rx_obj[i], napi, budget);
		max_work = max(work, max_work);
	}
S
Sathya Perla 已提交
2091

S
Sathya Perla 已提交
2092 2093
	if (is_mcc_eqo(eqo))
		be_process_mcc(adapter);
2094

S
Sathya Perla 已提交
2095 2096 2097 2098 2099 2100
	if (max_work < budget) {
		napi_complete(napi);
		be_eq_notify(adapter, eqo->q.id, true, false, 0);
	} else {
		/* As we'll continue in polling mode, count and clear events */
		be_eq_notify(adapter, eqo->q.id, false, false, events_get(eqo));
2101
	}
S
Sathya Perla 已提交
2102
	return max_work;
S
Sathya Perla 已提交
2103 2104
}

2105
void be_detect_error(struct be_adapter *adapter)
2106
{
2107 2108
	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;
2109 2110
	u32 i;

2111
	if (be_crit_error(adapter))
2112 2113
		return;

2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131
	if (lancer_chip(adapter)) {
		sliport_status = ioread32(adapter->db + SLIPORT_STATUS_OFFSET);
		if (sliport_status & SLIPORT_STATUS_ERR_MASK) {
			sliport_err1 = ioread32(adapter->db +
					SLIPORT_ERROR1_OFFSET);
			sliport_err2 = ioread32(adapter->db +
					SLIPORT_ERROR2_OFFSET);
		}
	} else {
		pci_read_config_dword(adapter->pdev,
				PCICFG_UE_STATUS_LOW, &ue_lo);
		pci_read_config_dword(adapter->pdev,
				PCICFG_UE_STATUS_HIGH, &ue_hi);
		pci_read_config_dword(adapter->pdev,
				PCICFG_UE_STATUS_LOW_MASK, &ue_lo_mask);
		pci_read_config_dword(adapter->pdev,
				PCICFG_UE_STATUS_HI_MASK, &ue_hi_mask);

2132 2133
		ue_lo = (ue_lo & ~ue_lo_mask);
		ue_hi = (ue_hi & ~ue_hi_mask);
2134
	}
2135

2136 2137 2138 2139 2140
	/* On certain platforms BE hardware can indicate spurious UEs.
	 * Allow the h/w to stop working completely in case of a real UE.
	 * Hence not setting the hw_error for UE detection.
	 */
	if (sliport_status & SLIPORT_STATUS_ERR_MASK) {
2141
		adapter->hw_error = true;
2142
		dev_err(&adapter->pdev->dev,
2143 2144 2145 2146 2147 2148 2149 2150 2151 2152
			"Error detected in the card\n");
	}

	if (sliport_status & SLIPORT_STATUS_ERR_MASK) {
		dev_err(&adapter->pdev->dev,
			"ERR: sliport status 0x%x\n", sliport_status);
		dev_err(&adapter->pdev->dev,
			"ERR: sliport error1 0x%x\n", sliport_err1);
		dev_err(&adapter->pdev->dev,
			"ERR: sliport error2 0x%x\n", sliport_err2);
2153 2154
	}

2155 2156 2157
	if (ue_lo) {
		for (i = 0; ue_lo; ue_lo >>= 1, i++) {
			if (ue_lo & 1)
2158 2159 2160 2161
				dev_err(&adapter->pdev->dev,
				"UE: %s bit set\n", ue_status_low_desc[i]);
		}
	}
2162

2163 2164 2165
	if (ue_hi) {
		for (i = 0; ue_hi; ue_hi >>= 1, i++) {
			if (ue_hi & 1)
2166 2167 2168 2169 2170 2171 2172
				dev_err(&adapter->pdev->dev,
				"UE: %s bit set\n", ue_status_hi_desc[i]);
		}
	}

}

2173 2174
static void be_msix_disable(struct be_adapter *adapter)
{
2175
	if (msix_enabled(adapter)) {
2176
		pci_disable_msix(adapter->pdev);
2177
		adapter->num_msix_vec = 0;
2178 2179 2180
	}
}

S
Sathya Perla 已提交
2181 2182
static uint be_num_rss_want(struct be_adapter *adapter)
{
2183
	u32 num = 0;
2184

S
Sathya Perla 已提交
2185
	if ((adapter->function_caps & BE_FUNCTION_CAPS_RSS) &&
2186 2187 2188
	    (lancer_chip(adapter) ||
	     (!sriov_want(adapter) && be_physfn(adapter)))) {
		num = adapter->max_rss_queues;
2189 2190 2191
		num = min_t(u32, num, (u32)netif_get_num_default_rss_queues());
	}
	return num;
S
Sathya Perla 已提交
2192 2193
}

S
Sathya Perla 已提交
2194 2195
static void be_msix_enable(struct be_adapter *adapter)
{
S
Sathya Perla 已提交
2196
#define BE_MIN_MSIX_VECTORS		1
2197
	int i, status, num_vec, num_roce_vec = 0;
S
Sathya Perla 已提交
2198
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
2199

S
Sathya Perla 已提交
2200 2201
	/* If RSS queues are not used, need a vec for default RX Q */
	num_vec = min(be_num_rss_want(adapter), num_online_cpus());
2202 2203 2204 2205 2206 2207 2208
	if (be_roce_supported(adapter)) {
		num_roce_vec = min_t(u32, MAX_ROCE_MSIX_VECTORS,
					(num_online_cpus() + 1));
		num_roce_vec = min(num_roce_vec, MAX_ROCE_EQS);
		num_vec += num_roce_vec;
		num_vec = min(num_vec, MAX_MSIX_VECTORS);
	}
S
Sathya Perla 已提交
2209
	num_vec = max(num_vec, BE_MIN_MSIX_VECTORS);
2210

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

2214
	status = pci_enable_msix(adapter->pdev, adapter->msix_entries, num_vec);
2215 2216 2217
	if (status == 0) {
		goto done;
	} else if (status >= BE_MIN_MSIX_VECTORS) {
2218
		num_vec = status;
2219
		if (pci_enable_msix(adapter->pdev, adapter->msix_entries,
2220
				num_vec) == 0)
2221 2222
			goto done;
	}
S
Sathya Perla 已提交
2223 2224

	dev_warn(dev, "MSIx enable failed\n");
2225 2226
	return;
done:
2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237
	if (be_roce_supported(adapter)) {
		if (num_vec > num_roce_vec) {
			adapter->num_msix_vec = num_vec - num_roce_vec;
			adapter->num_msix_roce_vec =
				num_vec - adapter->num_msix_vec;
		} else {
			adapter->num_msix_vec = num_vec;
			adapter->num_msix_roce_vec = 0;
		}
	} else
		adapter->num_msix_vec = num_vec;
S
Sathya Perla 已提交
2238
	dev_info(dev, "enabled %d MSI-x vector(s)\n", adapter->num_msix_vec);
2239
	return;
S
Sathya Perla 已提交
2240 2241
}

2242
static inline int be_msix_vec_get(struct be_adapter *adapter,
S
Sathya Perla 已提交
2243
				struct be_eq_obj *eqo)
2244
{
S
Sathya Perla 已提交
2245
	return adapter->msix_entries[eqo->idx].vector;
2246
}
S
Sathya Perla 已提交
2247

2248 2249
static int be_msix_register(struct be_adapter *adapter)
{
S
Sathya Perla 已提交
2250 2251 2252
	struct net_device *netdev = adapter->netdev;
	struct be_eq_obj *eqo;
	int status, i, vec;
S
Sathya Perla 已提交
2253

S
Sathya Perla 已提交
2254 2255 2256 2257
	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);
2258 2259 2260
		if (status)
			goto err_msix;
	}
2261

S
Sathya Perla 已提交
2262
	return 0;
2263
err_msix:
S
Sathya Perla 已提交
2264 2265 2266 2267
	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",
		status);
2268
	be_msix_disable(adapter);
S
Sathya Perla 已提交
2269 2270 2271 2272 2273 2274 2275 2276
	return status;
}

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

2277
	if (msix_enabled(adapter)) {
S
Sathya Perla 已提交
2278 2279 2280
		status = be_msix_register(adapter);
		if (status == 0)
			goto done;
2281 2282 2283
		/* INTx is not supported for VF */
		if (!be_physfn(adapter))
			return status;
S
Sathya Perla 已提交
2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302
	}

	/* INTx */
	netdev->irq = adapter->pdev->irq;
	status = request_irq(netdev->irq, be_intx, IRQF_SHARED, netdev->name,
			adapter);
	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 已提交
2303
	struct be_eq_obj *eqo;
2304
	int i;
S
Sathya Perla 已提交
2305 2306 2307 2308 2309

	if (!adapter->isr_registered)
		return;

	/* INTx */
2310
	if (!msix_enabled(adapter)) {
S
Sathya Perla 已提交
2311 2312 2313 2314 2315
		free_irq(netdev->irq, adapter);
		goto done;
	}

	/* MSIx */
S
Sathya Perla 已提交
2316 2317
	for_all_evt_queues(adapter, eqo, i)
		free_irq(be_msix_vec_get(adapter, eqo), eqo);
2318

S
Sathya Perla 已提交
2319 2320 2321 2322
done:
	adapter->isr_registered = false;
}

S
Sathya Perla 已提交
2323
static void be_rx_qs_destroy(struct be_adapter *adapter)
2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337
{
	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);
			/* After the rxq is invalidated, wait for a grace time
			 * of 1ms for all dma to end and the flush compl to
			 * arrive
			 */
			mdelay(1);
S
Sathya Perla 已提交
2338
			be_rx_cq_clean(rxo);
2339
		}
S
Sathya Perla 已提交
2340
		be_queue_free(adapter, q);
2341 2342 2343
	}
}

2344 2345 2346
static int be_close(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
2347 2348
	struct be_eq_obj *eqo;
	int i;
2349

2350 2351
	be_roce_dev_close(adapter);

2352 2353
	be_async_mcc_disable(adapter);

2354 2355
	if (!lancer_chip(adapter))
		be_intr_set(adapter, false);
2356

S
Sathya Perla 已提交
2357 2358 2359 2360 2361 2362 2363
	for_all_evt_queues(adapter, eqo, i) {
		napi_disable(&eqo->napi);
		if (msix_enabled(adapter))
			synchronize_irq(be_msix_vec_get(adapter, eqo));
		else
			synchronize_irq(netdev->irq);
		be_eq_clean(eqo);
2364 2365
	}

2366 2367 2368 2369 2370
	be_irq_unregister(adapter);

	/* Wait for all pending tx completions to arrive so that
	 * all tx skbs are freed.
	 */
S
Sathya Perla 已提交
2371
	be_tx_compl_clean(adapter);
2372

S
Sathya Perla 已提交
2373
	be_rx_qs_destroy(adapter);
2374 2375 2376
	return 0;
}

S
Sathya Perla 已提交
2377
static int be_rx_qs_create(struct be_adapter *adapter)
2378 2379
{
	struct be_rx_obj *rxo;
2380 2381
	int rc, i, j;
	u8 rsstable[128];
2382 2383

	for_all_rx_queues(adapter, rxo, i) {
S
Sathya Perla 已提交
2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397
		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) {
2398
		rc = be_cmd_rxq_create(adapter, &rxo->q, rxo->cq.id,
S
Sathya Perla 已提交
2399 2400
				       rx_frag_size, adapter->if_handle,
				       true, &rxo->rss_id);
2401 2402 2403 2404 2405
		if (rc)
			return rc;
	}

	if (be_multi_rxq(adapter)) {
2406 2407 2408 2409 2410 2411 2412 2413
		for (j = 0; j < 128; j += adapter->num_rx_qs - 1) {
			for_all_rss_queues(adapter, rxo, i) {
				if ((j + i) >= 128)
					break;
				rsstable[j + i] = rxo->rss_id;
			}
		}
		rc = be_cmd_rss_config(adapter, rsstable, 128);
2414 2415 2416 2417 2418
		if (rc)
			return rc;
	}

	/* First time posting */
S
Sathya Perla 已提交
2419
	for_all_rx_queues(adapter, rxo, i)
2420
		be_post_rx_frags(rxo, GFP_KERNEL);
2421 2422 2423
	return 0;
}

S
Sathya Perla 已提交
2424 2425 2426
static int be_open(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
2427
	struct be_eq_obj *eqo;
2428
	struct be_rx_obj *rxo;
S
Sathya Perla 已提交
2429
	struct be_tx_obj *txo;
2430
	u8 link_status;
2431
	int status, i;
2432

S
Sathya Perla 已提交
2433
	status = be_rx_qs_create(adapter);
2434 2435 2436
	if (status)
		goto err;

2437 2438
	be_irq_register(adapter);

2439 2440
	if (!lancer_chip(adapter))
		be_intr_set(adapter, true);
2441

S
Sathya Perla 已提交
2442
	for_all_rx_queues(adapter, rxo, i)
2443
		be_cq_notify(adapter, rxo->cq.id, true, 0);
2444

S
Sathya Perla 已提交
2445 2446 2447
	for_all_tx_queues(adapter, txo, i)
		be_cq_notify(adapter, txo->cq.id, true, 0);

2448 2449
	be_async_mcc_enable(adapter);

S
Sathya Perla 已提交
2450 2451 2452 2453 2454
	for_all_evt_queues(adapter, eqo, i) {
		napi_enable(&eqo->napi);
		be_eq_notify(adapter, eqo->q.id, true, false, 0);
	}

2455
	status = be_cmd_link_status_query(adapter, NULL, &link_status, 0);
2456 2457 2458
	if (!status)
		be_link_status_update(adapter, link_status);

2459
	be_roce_dev_open(adapter);
2460 2461 2462 2463
	return 0;
err:
	be_close(adapter->netdev);
	return -EIO;
2464 2465
}

2466 2467 2468 2469 2470 2471 2472 2473 2474
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);
I
Ivan Vecera 已提交
2475 2476
	cmd.va = dma_alloc_coherent(&adapter->pdev->dev, cmd.size, &cmd.dma,
				    GFP_KERNEL);
2477 2478 2479 2480 2481 2482 2483 2484 2485
	if (cmd.va == NULL)
		return -1;
	memset(cmd.va, 0, cmd.size);

	if (enable) {
		status = pci_write_config_dword(adapter->pdev,
			PCICFG_PM_CONTROL_OFFSET, PCICFG_PM_CONTROL_MASK);
		if (status) {
			dev_err(&adapter->pdev->dev,
2486
				"Could not enable Wake-on-lan\n");
I
Ivan Vecera 已提交
2487 2488
			dma_free_coherent(&adapter->pdev->dev, cmd.size, cmd.va,
					  cmd.dma);
2489 2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500
			return status;
		}
		status = be_cmd_enable_magic_wol(adapter,
				adapter->netdev->dev_addr, &cmd);
		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 已提交
2501
	dma_free_coherent(&adapter->pdev->dev, cmd.size, cmd.va, cmd.dma);
2502 2503 2504
	return status;
}

2505 2506 2507 2508 2509 2510 2511 2512
/*
 * 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.
 */
static inline int be_vf_eth_addr_config(struct be_adapter *adapter)
{
2513
	u32 vf;
2514
	int status = 0;
2515
	u8 mac[ETH_ALEN];
2516
	struct be_vf_cfg *vf_cfg;
2517 2518 2519

	be_vf_eth_addr_generate(adapter, mac);

2520
	for_all_vfs(adapter, vf_cfg, vf) {
2521 2522 2523 2524
		if (lancer_chip(adapter)) {
			status = be_cmd_set_mac_list(adapter,  mac, 1, vf + 1);
		} else {
			status = be_cmd_pmac_add(adapter, mac,
2525 2526
						 vf_cfg->if_handle,
						 &vf_cfg->pmac_id, vf + 1);
2527 2528
		}

2529 2530
		if (status)
			dev_err(&adapter->pdev->dev,
2531
			"Mac address assignment failed for VF %d\n", vf);
2532
		else
2533
			memcpy(vf_cfg->mac_addr, mac, ETH_ALEN);
2534 2535 2536 2537 2538 2539

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

2540
static void be_vf_clear(struct be_adapter *adapter)
2541
{
2542
	struct be_vf_cfg *vf_cfg;
2543 2544
	u32 vf;

2545 2546 2547 2548 2549
	if (be_find_vfs(adapter, ASSIGNED)) {
		dev_warn(&adapter->pdev->dev, "VFs are assigned to VMs\n");
		goto done;
	}

2550
	for_all_vfs(adapter, vf_cfg, vf) {
2551 2552 2553
		if (lancer_chip(adapter))
			be_cmd_set_mac_list(adapter, NULL, 0, vf + 1);
		else
2554 2555
			be_cmd_pmac_del(adapter, vf_cfg->if_handle,
					vf_cfg->pmac_id, vf + 1);
2556

2557 2558
		be_cmd_if_destroy(adapter, vf_cfg->if_handle, vf + 1);
	}
2559 2560 2561 2562
	pci_disable_sriov(adapter->pdev);
done:
	kfree(adapter->vf_cfg);
	adapter->num_vfs = 0;
2563 2564
}

2565 2566
static int be_clear(struct be_adapter *adapter)
{
2567 2568
	int i = 1;

2569 2570 2571 2572 2573
	if (adapter->flags & BE_FLAGS_WORKER_SCHEDULED) {
		cancel_delayed_work_sync(&adapter->work);
		adapter->flags &= ~BE_FLAGS_WORKER_SCHEDULED;
	}

2574
	if (sriov_enabled(adapter))
2575 2576
		be_vf_clear(adapter);

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

2581
	be_cmd_if_destroy(adapter, adapter->if_handle,  0);
2582 2583

	be_mcc_queues_destroy(adapter);
S
Sathya Perla 已提交
2584
	be_rx_cqs_destroy(adapter);
2585
	be_tx_queues_destroy(adapter);
S
Sathya Perla 已提交
2586
	be_evt_queues_destroy(adapter);
2587

2588 2589 2590
	kfree(adapter->pmac_id);
	adapter->pmac_id = NULL;

S
Sathya Perla 已提交
2591
	be_msix_disable(adapter);
2592 2593 2594
	return 0;
}

2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611
static void be_get_vf_if_cap_flags(struct be_adapter *adapter,
				   u32 *cap_flags, u8 domain)
{
	bool profile_present = false;
	int status;

	if (lancer_chip(adapter)) {
		status = be_cmd_get_profile_config(adapter, cap_flags, domain);
		if (!status)
			profile_present = true;
	}

	if (!profile_present)
		*cap_flags = BE_IF_FLAGS_UNTAGGED | BE_IF_FLAGS_BROADCAST |
			     BE_IF_FLAGS_MULTICAST;
}

2612
static int be_vf_setup_init(struct be_adapter *adapter)
2613
{
2614
	struct be_vf_cfg *vf_cfg;
2615 2616
	int vf;

2617 2618 2619 2620 2621
	adapter->vf_cfg = kcalloc(adapter->num_vfs, sizeof(*vf_cfg),
				  GFP_KERNEL);
	if (!adapter->vf_cfg)
		return -ENOMEM;

2622 2623 2624
	for_all_vfs(adapter, vf_cfg, vf) {
		vf_cfg->if_handle = -1;
		vf_cfg->pmac_id = -1;
2625
	}
2626
	return 0;
2627 2628
}

2629 2630
static int be_vf_setup(struct be_adapter *adapter)
{
2631
	struct be_vf_cfg *vf_cfg;
2632
	struct device *dev = &adapter->pdev->dev;
2633
	u32 cap_flags, en_flags, vf;
2634
	u16 def_vlan, lnk_speed;
2635 2636 2637 2638 2639 2640 2641 2642
	int status, enabled_vfs;

	enabled_vfs = be_find_vfs(adapter, ENABLED);
	if (enabled_vfs) {
		dev_warn(dev, "%d VFs are already enabled\n", enabled_vfs);
		dev_warn(dev, "Ignoring num_vfs=%d setting\n", num_vfs);
		return 0;
	}
2643

2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660 2661
	if (num_vfs > adapter->dev_num_vfs) {
		dev_warn(dev, "Device supports %d VFs and not %d\n",
			 adapter->dev_num_vfs, num_vfs);
		num_vfs = adapter->dev_num_vfs;
	}

	status = pci_enable_sriov(adapter->pdev, num_vfs);
	if (!status) {
		adapter->num_vfs = num_vfs;
	} else {
		/* Platform doesn't support SRIOV though device supports it */
		dev_warn(dev, "SRIOV enable failed\n");
		return 0;
	}

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

2663
	for_all_vfs(adapter, vf_cfg, vf) {
2664 2665 2666 2667 2668 2669
		be_get_vf_if_cap_flags(adapter, &cap_flags, vf + 1);

		en_flags = cap_flags & (BE_IF_FLAGS_UNTAGGED |
					BE_IF_FLAGS_BROADCAST |
					BE_IF_FLAGS_MULTICAST);

2670 2671
		status = be_cmd_if_create(adapter, cap_flags, en_flags,
					  &vf_cfg->if_handle, vf + 1);
2672 2673 2674 2675
		if (status)
			goto err;
	}

2676 2677 2678 2679 2680
	if (!enabled_vfs) {
		status = be_vf_eth_addr_config(adapter);
		if (status)
			goto err;
	}
2681

2682
	for_all_vfs(adapter, vf_cfg, vf) {
2683 2684
		lnk_speed = 1000;
		status = be_cmd_set_qos(adapter, lnk_speed, vf + 1);
2685 2686
		if (status)
			goto err;
2687
		vf_cfg->tx_rate = lnk_speed * 10;
2688 2689 2690 2691 2692 2693

		status = be_cmd_get_hsw_config(adapter, &def_vlan,
				vf + 1, vf_cfg->if_handle);
		if (status)
			goto err;
		vf_cfg->def_vid = def_vlan;
2694 2695 2696 2697 2698 2699
	}
	return 0;
err:
	return status;
}

2700 2701 2702
static void be_setup_init(struct be_adapter *adapter)
{
	adapter->vlan_prio_bmap = 0xff;
A
Ajit Khaparde 已提交
2703
	adapter->phy.link_speed = -1;
2704 2705 2706 2707 2708 2709
	adapter->if_handle = -1;
	adapter->be3_native = false;
	adapter->promiscuous = false;
	adapter->eq_next_idx = 0;
}

2710 2711
static int be_get_mac_addr(struct be_adapter *adapter, u8 *mac, u32 if_handle,
			   bool *active_mac, u32 *pmac_id)
2712
{
2713
	int status = 0;
2714

2715 2716 2717 2718 2719 2720
	if (!is_zero_ether_addr(adapter->netdev->perm_addr)) {
		memcpy(mac, adapter->netdev->dev_addr, ETH_ALEN);
		if (!lancer_chip(adapter) && !be_physfn(adapter))
			*active_mac = true;
		else
			*active_mac = false;
2721

2722 2723
		return status;
	}
2724

2725 2726 2727 2728
	if (lancer_chip(adapter)) {
		status = be_cmd_get_mac_from_list(adapter, mac,
						  active_mac, pmac_id, 0);
		if (*active_mac) {
2729 2730
			status = be_cmd_mac_addr_query(adapter, mac, false,
						       if_handle, *pmac_id);
2731 2732 2733
		}
	} else if (be_physfn(adapter)) {
		/* For BE3, for PF get permanent MAC */
2734
		status = be_cmd_mac_addr_query(adapter, mac, true, 0, 0);
2735
		*active_mac = false;
2736
	} else {
2737
		/* For BE3, for VF get soft MAC assigned by PF*/
2738
		status = be_cmd_mac_addr_query(adapter, mac, false,
2739 2740
					       if_handle, 0);
		*active_mac = true;
2741
	}
2742 2743 2744
	return status;
}

2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809
static void be_get_resources(struct be_adapter *adapter)
{
	int status;
	bool profile_present = false;

	if (lancer_chip(adapter)) {
		status = be_cmd_get_func_config(adapter);

		if (!status)
			profile_present = true;
	}

	if (profile_present) {
		/* Sanity fixes for Lancer */
		adapter->max_pmac_cnt = min_t(u16, adapter->max_pmac_cnt,
					      BE_UC_PMAC_COUNT);
		adapter->max_vlans = min_t(u16, adapter->max_vlans,
					   BE_NUM_VLANS_SUPPORTED);
		adapter->max_mcast_mac = min_t(u16, adapter->max_mcast_mac,
					       BE_MAX_MC);
		adapter->max_tx_queues = min_t(u16, adapter->max_tx_queues,
					       MAX_TX_QS);
		adapter->max_rss_queues = min_t(u16, adapter->max_rss_queues,
						BE3_MAX_RSS_QS);
		adapter->max_event_queues = min_t(u16,
						  adapter->max_event_queues,
						  BE3_MAX_RSS_QS);

		if (adapter->max_rss_queues &&
		    adapter->max_rss_queues == adapter->max_rx_queues)
			adapter->max_rss_queues -= 1;

		if (adapter->max_event_queues < adapter->max_rss_queues)
			adapter->max_rss_queues = adapter->max_event_queues;

	} else {
		if (be_physfn(adapter))
			adapter->max_pmac_cnt = BE_UC_PMAC_COUNT;
		else
			adapter->max_pmac_cnt = BE_VF_UC_PMAC_COUNT;

		if (adapter->function_mode & FLEX10_MODE)
			adapter->max_vlans = BE_NUM_VLANS_SUPPORTED/8;
		else
			adapter->max_vlans = BE_NUM_VLANS_SUPPORTED;

		adapter->max_mcast_mac = BE_MAX_MC;
		adapter->max_tx_queues = MAX_TX_QS;
		adapter->max_rss_queues = (adapter->be3_native) ?
					   BE3_MAX_RSS_QS : BE2_MAX_RSS_QS;
		adapter->max_event_queues = BE3_MAX_RSS_QS;

		adapter->if_cap_flags = BE_IF_FLAGS_UNTAGGED |
					BE_IF_FLAGS_BROADCAST |
					BE_IF_FLAGS_MULTICAST |
					BE_IF_FLAGS_PASS_L3L4_ERRORS |
					BE_IF_FLAGS_MCAST_PROMISCUOUS |
					BE_IF_FLAGS_VLAN_PROMISCUOUS |
					BE_IF_FLAGS_PROMISCUOUS;

		if (adapter->function_caps & BE_FUNCTION_CAPS_RSS)
			adapter->if_cap_flags |= BE_IF_FLAGS_RSS;
	}
}

2810 2811 2812
/* Routine to query per function resource limits */
static int be_get_config(struct be_adapter *adapter)
{
2813
	int pos, status;
2814 2815
	u16 dev_num_vfs;

2816 2817 2818 2819 2820 2821 2822 2823 2824 2825 2826 2827 2828 2829 2830 2831
	status = be_cmd_query_fw_cfg(adapter, &adapter->port_num,
				     &adapter->function_mode,
				     &adapter->function_caps);
	if (status)
		goto err;

	be_get_resources(adapter);

	/* primary mac needs 1 pmac entry */
	adapter->pmac_id = kcalloc(adapter->max_pmac_cnt + 1,
				   sizeof(u32), GFP_KERNEL);
	if (!adapter->pmac_id) {
		status = -ENOMEM;
		goto err;
	}

2832 2833 2834 2835
	pos = pci_find_ext_capability(adapter->pdev, PCI_EXT_CAP_ID_SRIOV);
	if (pos) {
		pci_read_config_word(adapter->pdev, pos + PCI_SRIOV_TOTAL_VF,
				     &dev_num_vfs);
2836 2837
		if (!lancer_chip(adapter))
			dev_num_vfs = min_t(u16, dev_num_vfs, MAX_VFS);
2838 2839
		adapter->dev_num_vfs = dev_num_vfs;
	}
2840 2841
err:
	return status;
2842 2843
}

2844 2845
static int be_setup(struct be_adapter *adapter)
{
2846
	struct device *dev = &adapter->pdev->dev;
2847
	u32 en_flags;
2848
	u32 tx_fc, rx_fc;
S
Sathya Perla 已提交
2849
	int status;
2850
	u8 mac[ETH_ALEN];
2851
	bool active_mac;
2852

2853
	be_setup_init(adapter);
S
Sathya Perla 已提交
2854

2855 2856
	if (!lancer_chip(adapter))
		be_cmd_req_native_mode(adapter);
2857

2858 2859 2860
	status = be_get_config(adapter);
	if (status)
		goto err;
2861

S
Sathya Perla 已提交
2862 2863 2864 2865
	be_msix_enable(adapter);

	status = be_evt_queues_create(adapter);
	if (status)
2866
		goto err;
S
Sathya Perla 已提交
2867

S
Sathya Perla 已提交
2868 2869 2870 2871 2872 2873
	status = be_tx_cqs_create(adapter);
	if (status)
		goto err;

	status = be_rx_cqs_create(adapter);
	if (status)
2874
		goto err;
S
Sathya Perla 已提交
2875

2876
	status = be_mcc_queues_create(adapter);
S
Sathya Perla 已提交
2877
	if (status)
2878
		goto err;
S
Sathya Perla 已提交
2879

2880 2881
	en_flags = BE_IF_FLAGS_UNTAGGED | BE_IF_FLAGS_BROADCAST |
			BE_IF_FLAGS_MULTICAST | BE_IF_FLAGS_PASS_L3L4_ERRORS;
2882

2883
	if (adapter->function_caps & BE_FUNCTION_CAPS_RSS)
2884
		en_flags |= BE_IF_FLAGS_RSS;
2885

2886
	en_flags = en_flags & adapter->if_cap_flags;
2887

2888
	status = be_cmd_if_create(adapter, adapter->if_cap_flags, en_flags,
2889
				  &adapter->if_handle, 0);
2890
	if (status != 0)
2891
		goto err;
S
Sathya Perla 已提交
2892

2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909
	memset(mac, 0, ETH_ALEN);
	active_mac = false;
	status = be_get_mac_addr(adapter, mac, adapter->if_handle,
				 &active_mac, &adapter->pmac_id[0]);
	if (status != 0)
		goto err;

	if (!active_mac) {
		status = be_cmd_pmac_add(adapter, mac, adapter->if_handle,
					 &adapter->pmac_id[0], 0);
		if (status != 0)
			goto err;
	}

	if (is_zero_ether_addr(adapter->netdev->dev_addr)) {
		memcpy(adapter->netdev->dev_addr, mac, ETH_ALEN);
		memcpy(adapter->netdev->perm_addr, mac, ETH_ALEN);
2910
	}
2911

S
Sathya Perla 已提交
2912 2913 2914 2915
	status = be_tx_qs_create(adapter);
	if (status)
		goto err;

2916
	be_cmd_get_fw_ver(adapter, adapter->fw_ver, NULL);
2917

2918
	if (adapter->vlans_added)
S
Sathya Perla 已提交
2919
		be_vid_config(adapter);
2920

2921
	be_set_rx_mode(adapter->netdev);
2922

2923
	be_cmd_get_flow_control(adapter, &tx_fc, &rx_fc);
2924

2925 2926
	if (rx_fc != adapter->rx_fc || tx_fc != adapter->tx_fc)
		be_cmd_set_flow_control(adapter, adapter->tx_fc,
2927
					adapter->rx_fc);
2928

2929 2930 2931 2932 2933
	if (be_physfn(adapter) && num_vfs) {
		if (adapter->dev_num_vfs)
			be_vf_setup(adapter);
		else
			dev_warn(dev, "device doesn't support SRIOV\n");
2934 2935
	}

A
Ajit Khaparde 已提交
2936 2937 2938 2939
	be_cmd_get_phy_info(adapter);
	if (be_pause_supported(adapter))
		adapter->phy.fc_autoneg = 1;

2940 2941
	schedule_delayed_work(&adapter->work, msecs_to_jiffies(1000));
	adapter->flags |= BE_FLAGS_WORKER_SCHEDULED;
2942
	return 0;
2943 2944 2945 2946
err:
	be_clear(adapter);
	return status;
}
S
Sathya Perla 已提交
2947

I
Ivan Vecera 已提交
2948 2949 2950 2951
#ifdef CONFIG_NET_POLL_CONTROLLER
static void be_netpoll(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
2952
	struct be_eq_obj *eqo;
I
Ivan Vecera 已提交
2953 2954
	int i;

S
Sathya Perla 已提交
2955 2956 2957 2958
	for_all_evt_queues(adapter, eqo, i)
		event_handle(eqo);

	return;
I
Ivan Vecera 已提交
2959 2960 2961
}
#endif

2962
#define FW_FILE_HDR_SIGN 	"ServerEngines Corp. "
2963 2964
char flash_cookie[2][16] =      {"*** SE FLAS", "H DIRECTORY *** "};

2965
static bool be_flash_redboot(struct be_adapter *adapter,
2966 2967
			const u8 *p, u32 img_start, int image_size,
			int hdr_size)
2968 2969 2970 2971
{
	u32 crc_offset;
	u8 flashed_crc[4];
	int status;
2972 2973 2974

	crc_offset = hdr_size + img_start + image_size - 4;

2975
	p += crc_offset;
2976 2977

	status = be_cmd_get_flash_crc(adapter, flashed_crc,
2978
			(image_size - 4));
2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991
	if (status) {
		dev_err(&adapter->pdev->dev,
		"could not get crc from flash, not flashing redboot\n");
		return false;
	}

	/*update redboot only if crc does not match*/
	if (!memcmp(flashed_crc, p, 4))
		return false;
	else
		return true;
}

2992 2993
static bool phy_flashing_required(struct be_adapter *adapter)
{
A
Ajit Khaparde 已提交
2994 2995
	return (adapter->phy.phy_type == TN_8022 &&
		adapter->phy.interface_type == PHY_TYPE_BASET_10GB);
2996 2997
}

2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036
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;

	if (adapter->generation != BE_GEN3)
		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;

}

struct flash_section_info *get_fsec_info(struct be_adapter *adapter,
					 int header_size,
					 const struct firmware *fw)
{
	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;
}

3037
static int be_flash_data(struct be_adapter *adapter,
3038 3039 3040
			 const struct firmware *fw,
			 struct be_dma_mem *flash_cmd,
			 int num_of_images)
3041

3042
{
3043
	int status = 0, i, filehdr_size = 0;
3044
	int img_hdrs_size = (num_of_images * sizeof(struct image_hdr));
3045
	u32 total_bytes = 0, flash_op;
3046 3047 3048
	int num_bytes;
	const u8 *p = fw->data;
	struct be_cmd_write_flashrom *req = flash_cmd->va;
J
Joe Perches 已提交
3049
	const struct flash_comp *pflashcomp;
3050 3051 3052 3053 3054 3055 3056 3057 3058 3059 3060 3061 3062 3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073
	int num_comp, hdr_size;
	struct flash_section_info *fsec = NULL;

	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}
3074
	};
3075 3076 3077 3078 3079 3080 3081 3082 3083 3084 3085 3086 3087 3088 3089 3090 3091 3092

	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}
3093 3094 3095 3096 3097
	};

	if (adapter->generation == BE_GEN3) {
		pflashcomp = gen3_flash_types;
		filehdr_size = sizeof(struct flash_file_hdr_g3);
J
Joe Perches 已提交
3098
		num_comp = ARRAY_SIZE(gen3_flash_types);
3099 3100 3101
	} else {
		pflashcomp = gen2_flash_types;
		filehdr_size = sizeof(struct flash_file_hdr_g2);
J
Joe Perches 已提交
3102
		num_comp = ARRAY_SIZE(gen2_flash_types);
3103
	}
3104 3105 3106 3107 3108 3109 3110
	/* Get flash section info*/
	fsec = get_fsec_info(adapter, filehdr_size + img_hdrs_size, fw);
	if (!fsec) {
		dev_err(&adapter->pdev->dev,
			"Invalid Cookie. UFI corrupted ?\n");
		return -1;
	}
3111
	for (i = 0; i < num_comp; i++) {
3112
		if (!is_comp_in_ufi(adapter, fsec, pflashcomp[i].img_type))
3113
			continue;
3114 3115 3116 3117 3118 3119

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

		if (pflashcomp[i].optype == OPTYPE_PHY_FW) {
3120 3121 3122
			if (!phy_flashing_required(adapter))
				continue;
		}
3123 3124 3125 3126 3127 3128 3129

		hdr_size = filehdr_size +
			   (num_of_images * sizeof(struct image_hdr));

		if ((pflashcomp[i].optype == OPTYPE_REDBOOT) &&
		    (!be_flash_redboot(adapter, fw->data, pflashcomp[i].offset,
				       pflashcomp[i].size, hdr_size)))
3130
			continue;
3131 3132

		/* Flash the component */
3133
		p = fw->data;
3134
		p += filehdr_size + pflashcomp[i].offset + img_hdrs_size;
3135 3136 3137
		if (p + pflashcomp[i].size > fw->data + fw->size)
			return -1;
		total_bytes = pflashcomp[i].size;
3138 3139 3140 3141 3142 3143
		while (total_bytes) {
			if (total_bytes > 32*1024)
				num_bytes = 32*1024;
			else
				num_bytes = total_bytes;
			total_bytes -= num_bytes;
3144
			if (!total_bytes) {
3145
				if (pflashcomp[i].optype == OPTYPE_PHY_FW)
3146 3147 3148 3149
					flash_op = FLASHROM_OPER_PHY_FLASH;
				else
					flash_op = FLASHROM_OPER_FLASH;
			} else {
3150
				if (pflashcomp[i].optype == OPTYPE_PHY_FW)
3151 3152 3153 3154
					flash_op = FLASHROM_OPER_PHY_SAVE;
				else
					flash_op = FLASHROM_OPER_SAVE;
			}
3155 3156 3157 3158 3159
			memcpy(req->params.data_buf, p, num_bytes);
			p += num_bytes;
			status = be_cmd_write_flashrom(adapter, flash_cmd,
				pflashcomp[i].optype, flash_op, num_bytes);
			if (status) {
3160 3161
				if ((status == ILLEGAL_IOCTL_REQ) &&
					(pflashcomp[i].optype ==
3162
						OPTYPE_PHY_FW))
3163
					break;
3164 3165 3166 3167
				dev_err(&adapter->pdev->dev,
					"cmd to write to flash rom failed.\n");
				return -1;
			}
3168 3169 3170 3171 3172
		}
	}
	return 0;
}

3173 3174 3175 3176 3177 3178 3179 3180 3181 3182 3183 3184
static int get_ufigen_type(struct flash_file_hdr_g2 *fhdr)
{
	if (fhdr == NULL)
		return 0;
	if (fhdr->build[0] == '3')
		return BE_GEN3;
	else if (fhdr->build[0] == '2')
		return BE_GEN2;
	else
		return 0;
}

3185 3186 3187 3188 3189 3190 3191 3192 3193 3194 3195 3196 3197 3198 3199 3200 3201 3202 3203 3204 3205 3206 3207 3208 3209 3210 3211 3212 3213 3214 3215 3216 3217 3218
static int lancer_wait_idle(struct be_adapter *adapter)
{
#define SLIPORT_IDLE_TIMEOUT 30
	u32 reg_val;
	int status = 0, i;

	for (i = 0; i < SLIPORT_IDLE_TIMEOUT; i++) {
		reg_val = ioread32(adapter->db + PHYSDEV_CONTROL_OFFSET);
		if ((reg_val & PHYSDEV_CONTROL_INP_MASK) == 0)
			break;

		ssleep(1);
	}

	if (i == SLIPORT_IDLE_TIMEOUT)
		status = -1;

	return status;
}

static int lancer_fw_reset(struct be_adapter *adapter)
{
	int status = 0;

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

	iowrite32(PHYSDEV_CONTROL_FW_RESET_MASK, adapter->db +
		  PHYSDEV_CONTROL_OFFSET);

	return status;
}

3219 3220
static int lancer_fw_download(struct be_adapter *adapter,
				const struct firmware *fw)
3221
{
3222 3223
#define LANCER_FW_DOWNLOAD_CHUNK      (32 * 1024)
#define LANCER_FW_DOWNLOAD_LOCATION   "/prg"
3224
	struct be_dma_mem flash_cmd;
3225 3226 3227 3228 3229 3230 3231 3232
	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;
3233
	u8 change_status;
3234

3235
	if (!IS_ALIGNED(fw->size, sizeof(u32))) {
3236
		dev_err(&adapter->pdev->dev,
3237 3238 3239 3240
			"FW Image not properly aligned. "
			"Length must be 4 byte aligned.\n");
		status = -EINVAL;
		goto lancer_fw_exit;
3241 3242
	}

3243 3244 3245 3246 3247 3248 3249 3250 3251 3252
	flash_cmd.size = sizeof(struct lancer_cmd_req_write_object)
				+ LANCER_FW_DOWNLOAD_CHUNK;
	flash_cmd.va = dma_alloc_coherent(&adapter->pdev->dev, flash_cmd.size,
						&flash_cmd.dma, GFP_KERNEL);
	if (!flash_cmd.va) {
		status = -ENOMEM;
		dev_err(&adapter->pdev->dev,
			"Memory allocation failure while flashing\n");
		goto lancer_fw_exit;
	}
3253

3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264 3265
	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,
3266 3267 3268 3269
						 chunk_size, offset,
						 LANCER_FW_DOWNLOAD_LOCATION,
						 &data_written, &change_status,
						 &add_status);
3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280
		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,
3281 3282 3283 3284
						 0, offset,
						 LANCER_FW_DOWNLOAD_LOCATION,
						 &data_written, &change_status,
						 &add_status);
3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296
	}

	dma_free_coherent(&adapter->pdev->dev, flash_cmd.size, flash_cmd.va,
				flash_cmd.dma);
	if (status) {
		dev_err(&adapter->pdev->dev,
			"Firmware load error. "
			"Status code: 0x%x Additional Status: 0x%x\n",
			status, add_status);
		goto lancer_fw_exit;
	}

3297 3298 3299 3300 3301 3302 3303 3304 3305 3306 3307 3308 3309 3310
	if (change_status == LANCER_FW_RESET_NEEDED) {
		status = lancer_fw_reset(adapter);
		if (status) {
			dev_err(&adapter->pdev->dev,
				"Adapter busy for FW reset.\n"
				"New FW will not be active.\n");
			goto lancer_fw_exit;
		}
	} else if (change_status != LANCER_NO_RESET_NEEDED) {
			dev_err(&adapter->pdev->dev,
				"System reboot required for new FW"
				" to be active\n");
	}

3311 3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323
	dev_info(&adapter->pdev->dev, "Firmware flashed successfully\n");
lancer_fw_exit:
	return status;
}

static int be_fw_download(struct be_adapter *adapter, const struct firmware* fw)
{
	struct flash_file_hdr_g2 *fhdr;
	struct flash_file_hdr_g3 *fhdr3;
	struct image_hdr *img_hdr_ptr = NULL;
	struct be_dma_mem flash_cmd;
	const u8 *p;
	int status = 0, i = 0, num_imgs = 0;
3324 3325

	p = fw->data;
3326
	fhdr = (struct flash_file_hdr_g2 *) p;
3327 3328

	flash_cmd.size = sizeof(struct be_cmd_write_flashrom) + 32*1024;
I
Ivan Vecera 已提交
3329 3330
	flash_cmd.va = dma_alloc_coherent(&adapter->pdev->dev, flash_cmd.size,
					  &flash_cmd.dma, GFP_KERNEL);
3331 3332 3333 3334
	if (!flash_cmd.va) {
		status = -ENOMEM;
		dev_err(&adapter->pdev->dev,
			"Memory allocation failure while flashing\n");
3335
		goto be_fw_exit;
3336 3337
	}

3338 3339 3340
	if ((adapter->generation == BE_GEN3) &&
			(get_ufigen_type(fhdr) == BE_GEN3)) {
		fhdr3 = (struct flash_file_hdr_g3 *) fw->data;
3341 3342
		num_imgs = le32_to_cpu(fhdr3->num_imgs);
		for (i = 0; i < num_imgs; i++) {
3343 3344
			img_hdr_ptr = (struct image_hdr *) (fw->data +
					(sizeof(struct flash_file_hdr_g3) +
3345 3346 3347 3348
					 i * sizeof(struct image_hdr)));
			if (le32_to_cpu(img_hdr_ptr->imageid) == 1)
				status = be_flash_data(adapter, fw, &flash_cmd,
							num_imgs);
3349 3350 3351 3352 3353 3354 3355 3356
		}
	} else if ((adapter->generation == BE_GEN2) &&
			(get_ufigen_type(fhdr) == BE_GEN2)) {
		status = be_flash_data(adapter, fw, &flash_cmd, 0);
	} else {
		dev_err(&adapter->pdev->dev,
			"UFI and Interface are not compatible for flashing\n");
		status = -1;
3357 3358
	}

I
Ivan Vecera 已提交
3359 3360
	dma_free_coherent(&adapter->pdev->dev, flash_cmd.size, flash_cmd.va,
			  flash_cmd.dma);
3361 3362
	if (status) {
		dev_err(&adapter->pdev->dev, "Firmware load error\n");
3363
		goto be_fw_exit;
3364 3365
	}

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

3368 3369 3370 3371 3372 3373 3374 3375 3376 3377 3378 3379 3380 3381 3382 3383 3384 3385 3386 3387 3388 3389 3390 3391 3392 3393
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");
		return -1;
	}

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

3394 3395 3396 3397 3398
fw_exit:
	release_firmware(fw);
	return status;
}

3399
static const struct net_device_ops be_netdev_ops = {
S
Sathya Perla 已提交
3400 3401 3402
	.ndo_open		= be_open,
	.ndo_stop		= be_close,
	.ndo_start_xmit		= be_xmit,
3403
	.ndo_set_rx_mode	= be_set_rx_mode,
S
Sathya Perla 已提交
3404 3405
	.ndo_set_mac_address	= be_mac_addr_set,
	.ndo_change_mtu		= be_change_mtu,
3406
	.ndo_get_stats64	= be_get_stats64,
S
Sathya Perla 已提交
3407 3408 3409
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_vlan_rx_add_vid	= be_vlan_add_vid,
	.ndo_vlan_rx_kill_vid	= be_vlan_rem_vid,
3410
	.ndo_set_vf_mac		= be_set_vf_mac,
3411
	.ndo_set_vf_vlan	= be_set_vf_vlan,
3412
	.ndo_set_vf_tx_rate	= be_set_vf_tx_rate,
I
Ivan Vecera 已提交
3413 3414 3415 3416
	.ndo_get_vf_config	= be_get_vf_config,
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= be_netpoll,
#endif
S
Sathya Perla 已提交
3417 3418 3419 3420 3421
};

static void be_netdev_init(struct net_device *netdev)
{
	struct be_adapter *adapter = netdev_priv(netdev);
S
Sathya Perla 已提交
3422
	struct be_eq_obj *eqo;
3423
	int i;
S
Sathya Perla 已提交
3424

3425
	netdev->hw_features |= NETIF_F_SG | NETIF_F_TSO | NETIF_F_TSO6 |
3426 3427 3428 3429
		NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM | NETIF_F_RXCSUM |
		NETIF_F_HW_VLAN_TX;
	if (be_multi_rxq(adapter))
		netdev->hw_features |= NETIF_F_RXHASH;
3430 3431

	netdev->features |= netdev->hw_features |
3432
		NETIF_F_HW_VLAN_RX | NETIF_F_HW_VLAN_FILTER;
A
Ajit Khaparde 已提交
3433

3434
	netdev->vlan_features |= NETIF_F_SG | NETIF_F_TSO | NETIF_F_TSO6 |
3435
		NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM;
3436

3437 3438
	netdev->priv_flags |= IFF_UNICAST_FLT;

S
Sathya Perla 已提交
3439 3440
	netdev->flags |= IFF_MULTICAST;

3441
	netif_set_gso_max_size(netdev, 65535 - ETH_HLEN);
3442

S
Sathya Perla 已提交
3443
	netdev->netdev_ops = &be_netdev_ops;
S
Sathya Perla 已提交
3444 3445 3446

	SET_ETHTOOL_OPS(netdev, &be_ethtool_ops);

S
Sathya Perla 已提交
3447 3448
	for_all_evt_queues(adapter, eqo, i)
		netif_napi_add(netdev, &eqo->napi, be_poll, BE_NAPI_WEIGHT);
S
Sathya Perla 已提交
3449 3450 3451 3452
}

static void be_unmap_pci_bars(struct be_adapter *adapter)
{
3453 3454 3455 3456
	if (adapter->csr)
		iounmap(adapter->csr);
	if (adapter->db)
		iounmap(adapter->db);
3457 3458 3459 3460 3461 3462 3463 3464 3465 3466 3467 3468 3469 3470 3471 3472 3473 3474
	if (adapter->roce_db.base)
		pci_iounmap(adapter->pdev, adapter->roce_db.base);
}

static int lancer_roce_map_pci_bars(struct be_adapter *adapter)
{
	struct pci_dev *pdev = adapter->pdev;
	u8 __iomem *addr;

	addr = pci_iomap(pdev, 2, 0);
	if (addr == NULL)
		return -ENOMEM;

	adapter->roce_db.base = addr;
	adapter->roce_db.io_addr = pci_resource_start(pdev, 2);
	adapter->roce_db.size = 8192;
	adapter->roce_db.total_size = pci_resource_len(pdev, 2);
	return 0;
S
Sathya Perla 已提交
3475 3476 3477 3478 3479
}

static int be_map_pci_bars(struct be_adapter *adapter)
{
	u8 __iomem *addr;
3480
	int db_reg;
S
Sathya Perla 已提交
3481

3482
	if (lancer_chip(adapter)) {
3483 3484 3485 3486 3487 3488 3489 3490 3491 3492 3493 3494
		if (be_type_2_3(adapter)) {
			addr = ioremap_nocache(
					pci_resource_start(adapter->pdev, 0),
					pci_resource_len(adapter->pdev, 0));
			if (addr == NULL)
				return -ENOMEM;
			adapter->db = addr;
		}
		if (adapter->if_type == SLI_INTF_TYPE_3) {
			if (lancer_roce_map_pci_bars(adapter))
				goto pci_map_err;
		}
3495 3496 3497
		return 0;
	}

3498 3499 3500 3501 3502 3503 3504
	if (be_physfn(adapter)) {
		addr = ioremap_nocache(pci_resource_start(adapter->pdev, 2),
				pci_resource_len(adapter->pdev, 2));
		if (addr == NULL)
			return -ENOMEM;
		adapter->csr = addr;
	}
S
Sathya Perla 已提交
3505

3506 3507 3508 3509 3510 3511 3512 3513 3514 3515
	if (adapter->generation == BE_GEN2) {
		db_reg = 4;
	} else {
		if (be_physfn(adapter))
			db_reg = 4;
		else
			db_reg = 0;
	}
	addr = ioremap_nocache(pci_resource_start(adapter->pdev, db_reg),
				pci_resource_len(adapter->pdev, db_reg));
S
Sathya Perla 已提交
3516 3517
	if (addr == NULL)
		goto pci_map_err;
3518
	adapter->db = addr;
3519 3520 3521 3522 3523 3524 3525
	if (adapter->sli_family == SKYHAWK_SLI_FAMILY) {
		adapter->roce_db.size = 4096;
		adapter->roce_db.io_addr =
				pci_resource_start(adapter->pdev, db_reg);
		adapter->roce_db.total_size =
				pci_resource_len(adapter->pdev, db_reg);
	}
S
Sathya Perla 已提交
3526 3527 3528 3529 3530 3531 3532 3533
	return 0;
pci_map_err:
	be_unmap_pci_bars(adapter);
	return -ENOMEM;
}

static void be_ctrl_cleanup(struct be_adapter *adapter)
{
3534
	struct be_dma_mem *mem = &adapter->mbox_mem_alloced;
S
Sathya Perla 已提交
3535 3536 3537 3538

	be_unmap_pci_bars(adapter);

	if (mem->va)
I
Ivan Vecera 已提交
3539 3540
		dma_free_coherent(&adapter->pdev->dev, mem->size, mem->va,
				  mem->dma);
3541

3542
	mem = &adapter->rx_filter;
3543
	if (mem->va)
I
Ivan Vecera 已提交
3544 3545
		dma_free_coherent(&adapter->pdev->dev, mem->size, mem->va,
				  mem->dma);
S
Sathya Perla 已提交
3546 3547 3548 3549
}

static int be_ctrl_init(struct be_adapter *adapter)
{
3550 3551
	struct be_dma_mem *mbox_mem_alloc = &adapter->mbox_mem_alloced;
	struct be_dma_mem *mbox_mem_align = &adapter->mbox_mem;
3552
	struct be_dma_mem *rx_filter = &adapter->rx_filter;
S
Sathya Perla 已提交
3553 3554 3555 3556
	int status;

	status = be_map_pci_bars(adapter);
	if (status)
3557
		goto done;
S
Sathya Perla 已提交
3558 3559

	mbox_mem_alloc->size = sizeof(struct be_mcc_mailbox) + 16;
I
Ivan Vecera 已提交
3560 3561 3562 3563
	mbox_mem_alloc->va = dma_alloc_coherent(&adapter->pdev->dev,
						mbox_mem_alloc->size,
						&mbox_mem_alloc->dma,
						GFP_KERNEL);
S
Sathya Perla 已提交
3564
	if (!mbox_mem_alloc->va) {
3565 3566
		status = -ENOMEM;
		goto unmap_pci_bars;
S
Sathya Perla 已提交
3567 3568 3569 3570 3571
	}
	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));
3572

3573 3574 3575 3576
	rx_filter->size = sizeof(struct be_cmd_req_rx_filter);
	rx_filter->va = dma_alloc_coherent(&adapter->pdev->dev, rx_filter->size,
					&rx_filter->dma, GFP_KERNEL);
	if (rx_filter->va == NULL) {
3577 3578 3579
		status = -ENOMEM;
		goto free_mbox;
	}
3580
	memset(rx_filter->va, 0, rx_filter->size);
3581
	mutex_init(&adapter->mbox_lock);
3582 3583
	spin_lock_init(&adapter->mcc_lock);
	spin_lock_init(&adapter->mcc_cq_lock);
3584

3585
	init_completion(&adapter->flash_compl);
3586
	pci_save_state(adapter->pdev);
S
Sathya Perla 已提交
3587
	return 0;
3588 3589

free_mbox:
I
Ivan Vecera 已提交
3590 3591
	dma_free_coherent(&adapter->pdev->dev, mbox_mem_alloc->size,
			  mbox_mem_alloc->va, mbox_mem_alloc->dma);
3592 3593 3594 3595 3596 3597

unmap_pci_bars:
	be_unmap_pci_bars(adapter);

done:
	return status;
S
Sathya Perla 已提交
3598 3599 3600 3601
}

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

	if (cmd->va)
I
Ivan Vecera 已提交
3605 3606
		dma_free_coherent(&adapter->pdev->dev, cmd->size,
				  cmd->va, cmd->dma);
S
Sathya Perla 已提交
3607 3608 3609 3610
}

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

S
Selvin Xavier 已提交
3613
	if (adapter->generation == BE_GEN2) {
3614
		cmd->size = sizeof(struct be_cmd_req_get_stats_v0);
S
Selvin Xavier 已提交
3615 3616 3617 3618 3619 3620
	} else {
		if (lancer_chip(adapter))
			cmd->size = sizeof(struct lancer_cmd_req_pport_stats);
		else
			cmd->size = sizeof(struct be_cmd_req_get_stats_v1);
	}
I
Ivan Vecera 已提交
3621 3622
	cmd->va = dma_alloc_coherent(&adapter->pdev->dev, cmd->size, &cmd->dma,
				     GFP_KERNEL);
S
Sathya Perla 已提交
3623 3624
	if (cmd->va == NULL)
		return -1;
3625
	memset(cmd->va, 0, cmd->size);
S
Sathya Perla 已提交
3626 3627 3628 3629 3630 3631
	return 0;
}

static void __devexit be_remove(struct pci_dev *pdev)
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);
3632

S
Sathya Perla 已提交
3633 3634 3635
	if (!adapter)
		return;

3636 3637
	be_roce_dev_remove(adapter);

3638 3639
	cancel_delayed_work_sync(&adapter->func_recovery_work);

S
Sathya Perla 已提交
3640 3641
	unregister_netdev(adapter->netdev);

3642 3643
	be_clear(adapter);

3644 3645 3646
	/* tell fw we're done with firing cmds */
	be_cmd_fw_clean(adapter);

S
Sathya Perla 已提交
3647 3648 3649 3650
	be_stats_cleanup(adapter);

	be_ctrl_cleanup(adapter);

S
Sathya Perla 已提交
3651 3652
	pci_disable_pcie_error_reporting(pdev);

S
Sathya Perla 已提交
3653 3654 3655 3656 3657 3658 3659
	pci_set_drvdata(pdev, NULL);
	pci_release_regions(pdev);
	pci_disable_device(pdev);

	free_netdev(adapter->netdev);
}

3660 3661 3662 3663 3664 3665
bool be_is_wol_supported(struct be_adapter *adapter)
{
	return ((adapter->wol_cap & BE_WOL_CAP) &&
		!be_is_wol_excluded(adapter)) ? true : false;
}

3666 3667 3668 3669 3670 3671 3672 3673 3674 3675 3676 3677 3678 3679 3680 3681 3682 3683 3684 3685 3686 3687 3688
u32 be_get_fw_log_level(struct be_adapter *adapter)
{
	struct be_dma_mem extfat_cmd;
	struct be_fat_conf_params *cfgs;
	int status;
	u32 level = 0;
	int j;

	memset(&extfat_cmd, 0, sizeof(struct be_dma_mem));
	extfat_cmd.size = sizeof(struct be_cmd_resp_get_ext_fat_caps);
	extfat_cmd.va = pci_alloc_consistent(adapter->pdev, extfat_cmd.size,
					     &extfat_cmd.dma);

	if (!extfat_cmd.va) {
		dev_err(&adapter->pdev->dev, "%s: Memory allocation failure\n",
			__func__);
		goto err;
	}

	status = be_cmd_get_ext_fat_capabilites(adapter, &extfat_cmd);
	if (!status) {
		cfgs = (struct be_fat_conf_params *)(extfat_cmd.va +
						sizeof(struct be_cmd_resp_hdr));
3689
		for (j = 0; j < le32_to_cpu(cfgs->module[0].num_modes); j++) {
3690 3691 3692 3693 3694 3695 3696 3697 3698
			if (cfgs->module[0].trace_lvl[j].mode == MODE_UART)
				level = cfgs->module[0].trace_lvl[j].dbg_lvl;
		}
	}
	pci_free_consistent(adapter->pdev, extfat_cmd.size, extfat_cmd.va,
			    extfat_cmd.dma);
err:
	return level;
}
3699

3700
static int be_get_initial_config(struct be_adapter *adapter)
S
Sathya Perla 已提交
3701 3702
{
	int status;
3703
	u32 level;
S
Sathya Perla 已提交
3704

3705 3706 3707 3708
	status = be_cmd_get_cntl_attributes(adapter);
	if (status)
		return status;

3709 3710 3711 3712 3713 3714 3715 3716 3717 3718 3719
	status = be_cmd_get_acpi_wol_cap(adapter);
	if (status) {
		/* in case of a failure to get wol capabillities
		 * check the exclusion list to determine WOL capability */
		if (!be_is_wol_excluded(adapter))
			adapter->wol_cap |= BE_WOL_CAP;
	}

	if (be_is_wol_supported(adapter))
		adapter->wol = true;

3720 3721 3722
	/* Must be a power of 2 or else MODULO will BUG_ON */
	adapter->be_get_temp_freq = 64;

3723 3724 3725
	level = be_get_fw_log_level(adapter);
	adapter->msg_enable = level <= FW_LOG_LEVEL_DEFAULT ? NETIF_MSG_HW : 0;

3726
	return 0;
S
Sathya Perla 已提交
3727 3728
}

3729
static int be_dev_type_check(struct be_adapter *adapter)
3730 3731 3732 3733 3734 3735 3736 3737 3738 3739 3740 3741 3742 3743
{
	struct pci_dev *pdev = adapter->pdev;
	u32 sli_intf = 0, if_type;

	switch (pdev->device) {
	case BE_DEVICE_ID1:
	case OC_DEVICE_ID1:
		adapter->generation = BE_GEN2;
		break;
	case BE_DEVICE_ID2:
	case OC_DEVICE_ID2:
		adapter->generation = BE_GEN3;
		break;
	case OC_DEVICE_ID3:
3744
	case OC_DEVICE_ID4:
3745
		pci_read_config_dword(pdev, SLI_INTF_REG_OFFSET, &sli_intf);
3746 3747
		adapter->if_type = (sli_intf & SLI_INTF_IF_TYPE_MASK) >>
						SLI_INTF_IF_TYPE_SHIFT;
3748 3749 3750
		if_type = (sli_intf & SLI_INTF_IF_TYPE_MASK) >>
						SLI_INTF_IF_TYPE_SHIFT;
		if (((sli_intf & SLI_INTF_VALID_MASK) != SLI_INTF_VALID) ||
3751 3752 3753 3754 3755 3756 3757 3758 3759 3760 3761
			!be_type_2_3(adapter)) {
			dev_err(&pdev->dev, "SLI_INTF reg val is not valid\n");
			return -EINVAL;
		}
		adapter->sli_family = ((sli_intf & SLI_INTF_FAMILY_MASK) >>
					 SLI_INTF_FAMILY_SHIFT);
		adapter->generation = BE_GEN3;
		break;
	case OC_DEVICE_ID5:
		pci_read_config_dword(pdev, SLI_INTF_REG_OFFSET, &sli_intf);
		if ((sli_intf & SLI_INTF_VALID_MASK) != SLI_INTF_VALID) {
3762 3763 3764 3765 3766 3767 3768 3769 3770 3771
			dev_err(&pdev->dev, "SLI_INTF reg val is not valid\n");
			return -EINVAL;
		}
		adapter->sli_family = ((sli_intf & SLI_INTF_FAMILY_MASK) >>
					 SLI_INTF_FAMILY_SHIFT);
		adapter->generation = BE_GEN3;
		break;
	default:
		adapter->generation = 0;
	}
3772 3773 3774

	pci_read_config_dword(adapter->pdev, SLI_INTF_REG_OFFSET, &sli_intf);
	adapter->virtfn = (sli_intf & SLI_INTF_FT_MASK) ? 1 : 0;
3775 3776 3777
	return 0;
}

3778
static int lancer_recover_func(struct be_adapter *adapter)
3779 3780 3781
{
	int status;

3782 3783 3784
	status = lancer_test_and_set_rdy_state(adapter);
	if (status)
		goto err;
3785

3786 3787
	if (netif_running(adapter->netdev))
		be_close(adapter->netdev);
3788

3789 3790 3791 3792 3793 3794 3795 3796
	be_clear(adapter);

	adapter->hw_error = false;
	adapter->fw_timeout = false;

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

3798 3799
	if (netif_running(adapter->netdev)) {
		status = be_open(adapter->netdev);
3800 3801
		if (status)
			goto err;
3802
	}
3803

3804 3805 3806 3807 3808 3809
	dev_err(&adapter->pdev->dev,
		"Adapter SLIPORT recovery succeeded\n");
	return 0;
err:
	dev_err(&adapter->pdev->dev,
		"Adapter SLIPORT recovery failed\n");
3810

3811 3812 3813 3814 3815 3816 3817 3818
	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);
	int status;
3819

3820
	be_detect_error(adapter);
3821

3822
	if (adapter->hw_error && lancer_chip(adapter)) {
3823

3824 3825
		if (adapter->eeh_error)
			goto out;
3826

3827 3828 3829
		rtnl_lock();
		netif_device_detach(adapter->netdev);
		rtnl_unlock();
3830

3831
		status = lancer_recover_func(adapter);
3832

3833 3834
		if (!status)
			netif_device_attach(adapter->netdev);
3835
	}
3836 3837 3838 3839

out:
	schedule_delayed_work(&adapter->func_recovery_work,
			      msecs_to_jiffies(1000));
3840 3841 3842 3843 3844 3845 3846
}

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;
S
Sathya Perla 已提交
3847
	struct be_eq_obj *eqo;
3848 3849 3850 3851 3852
	int i;

	/* when interrupts are not yet enabled, just reap any pending
	* mcc completions */
	if (!netif_running(adapter->netdev)) {
3853
		local_bh_disable();
S
Sathya Perla 已提交
3854
		be_process_mcc(adapter);
3855
		local_bh_enable();
3856 3857 3858 3859 3860 3861 3862 3863 3864 3865 3866
		goto reschedule;
	}

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

3867 3868 3869
	if (MODULO(adapter->work_counter, adapter->be_get_temp_freq) == 0)
		be_cmd_get_die_temperature(adapter);

3870 3871 3872 3873 3874 3875 3876
	for_all_rx_queues(adapter, rxo, i) {
		if (rxo->rx_post_starved) {
			rxo->rx_post_starved = false;
			be_post_rx_frags(rxo, GFP_KERNEL);
		}
	}

S
Sathya Perla 已提交
3877 3878 3879
	for_all_evt_queues(adapter, eqo, i)
		be_eqd_update(adapter, eqo);

3880 3881 3882 3883 3884
reschedule:
	adapter->work_counter++;
	schedule_delayed_work(&adapter->work, msecs_to_jiffies(1000));
}

3885 3886
static bool be_reset_required(struct be_adapter *adapter)
{
3887
	return be_find_vfs(adapter, ENABLED) > 0 ? false : true;
3888 3889
}

S
Sathya Perla 已提交
3890 3891 3892 3893 3894 3895 3896 3897 3898 3899 3900 3901 3902 3903 3904 3905 3906
static char *mc_name(struct be_adapter *adapter)
{
	if (adapter->function_mode & FLEX10_MODE)
		return "FLEX10";
	else if (adapter->function_mode & VNIC_MODE)
		return "vNIC";
	else if (adapter->function_mode & UMC_ENABLED)
		return "UMC";
	else
		return "";
}

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

S
Sathya Perla 已提交
3907 3908 3909 3910 3911 3912
static int __devinit be_probe(struct pci_dev *pdev,
			const struct pci_device_id *pdev_id)
{
	int status = 0;
	struct be_adapter *adapter;
	struct net_device *netdev;
3913
	char port_name;
S
Sathya Perla 已提交
3914 3915 3916 3917 3918 3919 3920 3921 3922 3923

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

3924
	netdev = alloc_etherdev_mqs(sizeof(*adapter), MAX_TX_QS, MAX_RX_QS);
S
Sathya Perla 已提交
3925 3926 3927 3928 3929 3930 3931
	if (netdev == NULL) {
		status = -ENOMEM;
		goto rel_reg;
	}
	adapter = netdev_priv(netdev);
	adapter->pdev = pdev;
	pci_set_drvdata(pdev, adapter);
3932

3933
	status = be_dev_type_check(adapter);
3934
	if (status)
3935 3936
		goto free_netdev;

S
Sathya Perla 已提交
3937
	adapter->netdev = netdev;
3938
	SET_NETDEV_DEV(netdev, &pdev->dev);
S
Sathya Perla 已提交
3939

I
Ivan Vecera 已提交
3940
	status = dma_set_mask(&pdev->dev, DMA_BIT_MASK(64));
S
Sathya Perla 已提交
3941 3942 3943
	if (!status) {
		netdev->features |= NETIF_F_HIGHDMA;
	} else {
I
Ivan Vecera 已提交
3944
		status = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32));
S
Sathya Perla 已提交
3945 3946 3947 3948 3949 3950
		if (status) {
			dev_err(&pdev->dev, "Could not set PCI DMA Mask\n");
			goto free_netdev;
		}
	}

S
Sathya Perla 已提交
3951 3952 3953 3954
	status = pci_enable_pcie_error_reporting(pdev);
	if (status)
		dev_err(&pdev->dev, "Could not use PCIe error reporting\n");

S
Sathya Perla 已提交
3955 3956
	status = be_ctrl_init(adapter);
	if (status)
3957
		goto free_netdev;
S
Sathya Perla 已提交
3958

3959
	/* sync up with fw's ready state */
3960
	if (be_physfn(adapter)) {
3961
		status = be_fw_wait_ready(adapter);
3962 3963 3964
		if (status)
			goto ctrl_clean;
	}
S
Sathya Perla 已提交
3965

3966 3967
	/* tell fw we're ready to fire cmds */
	status = be_cmd_fw_init(adapter);
S
Sathya Perla 已提交
3968
	if (status)
3969 3970
		goto ctrl_clean;

3971 3972 3973 3974 3975
	if (be_reset_required(adapter)) {
		status = be_cmd_reset_function(adapter);
		if (status)
			goto ctrl_clean;
	}
3976

S
Sathya Perla 已提交
3977 3978 3979 3980 3981 3982
	/* The INTR bit may be set in the card when probed by a kdump kernel
	 * after a crash.
	 */
	if (!lancer_chip(adapter))
		be_intr_set(adapter, false);

3983 3984 3985 3986
	status = be_stats_init(adapter);
	if (status)
		goto ctrl_clean;

3987
	status = be_get_initial_config(adapter);
S
Sathya Perla 已提交
3988 3989 3990 3991
	if (status)
		goto stats_clean;

	INIT_DELAYED_WORK(&adapter->work, be_worker);
3992
	INIT_DELAYED_WORK(&adapter->func_recovery_work, be_func_recovery_task);
3993
	adapter->rx_fc = adapter->tx_fc = true;
S
Sathya Perla 已提交
3994

3995 3996
	status = be_setup(adapter);
	if (status)
3997
		goto stats_clean;
3998

3999
	be_netdev_init(netdev);
S
Sathya Perla 已提交
4000 4001
	status = register_netdev(netdev);
	if (status != 0)
4002
		goto unsetup;
S
Sathya Perla 已提交
4003

4004 4005
	be_roce_dev_add(adapter);

4006 4007
	schedule_delayed_work(&adapter->func_recovery_work,
			      msecs_to_jiffies(1000));
4008 4009 4010

	be_cmd_query_port_name(adapter, &port_name);

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

S
Sathya Perla 已提交
4014 4015
	return 0;

4016 4017
unsetup:
	be_clear(adapter);
S
Sathya Perla 已提交
4018 4019 4020 4021
stats_clean:
	be_stats_cleanup(adapter);
ctrl_clean:
	be_ctrl_cleanup(adapter);
4022
free_netdev:
4023
	free_netdev(netdev);
4024
	pci_set_drvdata(pdev, NULL);
S
Sathya Perla 已提交
4025 4026 4027 4028 4029
rel_reg:
	pci_release_regions(pdev);
disable_dev:
	pci_disable_device(pdev);
do_none:
4030
	dev_err(&pdev->dev, "%s initialization failed\n", nic_name(pdev));
S
Sathya Perla 已提交
4031 4032 4033 4034 4035 4036 4037 4038
	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;

4039 4040 4041
	if (adapter->wol)
		be_setup_wol(adapter, true);

4042 4043
	cancel_delayed_work_sync(&adapter->func_recovery_work);

S
Sathya Perla 已提交
4044 4045 4046 4047 4048 4049
	netif_device_detach(netdev);
	if (netif_running(netdev)) {
		rtnl_lock();
		be_close(netdev);
		rtnl_unlock();
	}
4050
	be_clear(adapter);
S
Sathya Perla 已提交
4051 4052 4053 4054 4055 4056 4057 4058 4059 4060 4061 4062 4063 4064 4065 4066 4067 4068 4069 4070 4071 4072

	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;

	pci_set_power_state(pdev, 0);
	pci_restore_state(pdev);

4073 4074 4075 4076 4077
	/* tell fw we're ready to fire cmds */
	status = be_cmd_fw_init(adapter);
	if (status)
		return status;

4078
	be_setup(adapter);
S
Sathya Perla 已提交
4079 4080 4081 4082 4083
	if (netif_running(netdev)) {
		rtnl_lock();
		be_open(netdev);
		rtnl_unlock();
	}
4084 4085 4086

	schedule_delayed_work(&adapter->func_recovery_work,
			      msecs_to_jiffies(1000));
S
Sathya Perla 已提交
4087
	netif_device_attach(netdev);
4088 4089 4090

	if (adapter->wol)
		be_setup_wol(adapter, false);
4091

S
Sathya Perla 已提交
4092 4093 4094
	return 0;
}

4095 4096 4097 4098 4099 4100 4101
/*
 * 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);

4102 4103
	if (!adapter)
		return;
4104

4105
	cancel_delayed_work_sync(&adapter->work);
4106
	cancel_delayed_work_sync(&adapter->func_recovery_work);
4107

4108
	netif_device_detach(adapter->netdev);
4109 4110 4111 4112

	if (adapter->wol)
		be_setup_wol(adapter, true);

4113 4114
	be_cmd_reset_function(adapter);

4115 4116 4117
	pci_disable_device(pdev);
}

4118 4119 4120 4121 4122 4123 4124 4125
static pci_ers_result_t be_eeh_err_detected(struct pci_dev *pdev,
				pci_channel_state_t state)
{
	struct be_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev =  adapter->netdev;

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

4126 4127 4128
	adapter->eeh_error = true;

	cancel_delayed_work_sync(&adapter->func_recovery_work);
4129

4130
	rtnl_lock();
4131
	netif_device_detach(netdev);
4132
	rtnl_unlock();
4133 4134 4135 4136 4137 4138 4139 4140 4141 4142 4143 4144 4145

	if (netif_running(netdev)) {
		rtnl_lock();
		be_close(netdev);
		rtnl_unlock();
	}
	be_clear(adapter);

	if (state == pci_channel_io_perm_failure)
		return PCI_ERS_RESULT_DISCONNECT;

	pci_disable_device(pdev);

4146 4147 4148 4149 4150
	/* The error could cause the FW to trigger a flash debug dump.
	 * Resetting the card while flash dump is in progress
	 * can cause it not to recover; wait for it to finish
	 */
	ssleep(30);
4151 4152 4153 4154 4155 4156 4157 4158 4159
	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");
4160
	be_clear_all_error(adapter);
4161 4162 4163 4164 4165 4166 4167 4168 4169 4170

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

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

	/* Check if card is ok and fw is ready */
4171
	status = be_fw_wait_ready(adapter);
4172 4173 4174
	if (status)
		return PCI_ERS_RESULT_DISCONNECT;

S
Sathya Perla 已提交
4175
	pci_cleanup_aer_uncorrect_error_status(pdev);
4176 4177 4178 4179 4180 4181 4182 4183 4184 4185 4186 4187 4188 4189 4190 4191 4192 4193
	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);

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

4194 4195 4196 4197
	status = be_cmd_reset_function(adapter);
	if (status)
		goto err;

4198 4199 4200 4201 4202 4203 4204 4205 4206
	status = be_setup(adapter);
	if (status)
		goto err;

	if (netif_running(netdev)) {
		status = be_open(netdev);
		if (status)
			goto err;
	}
4207 4208 4209

	schedule_delayed_work(&adapter->func_recovery_work,
			      msecs_to_jiffies(1000));
4210 4211 4212 4213 4214 4215
	netif_device_attach(netdev);
	return;
err:
	dev_err(&adapter->pdev->dev, "EEH resume failed\n");
}

4216
static const struct pci_error_handlers be_eeh_handlers = {
4217 4218 4219 4220 4221
	.error_detected = be_eeh_err_detected,
	.slot_reset = be_eeh_reset,
	.resume = be_eeh_resume,
};

S
Sathya Perla 已提交
4222 4223 4224 4225 4226 4227
static struct pci_driver be_driver = {
	.name = DRV_NAME,
	.id_table = be_dev_ids,
	.probe = be_probe,
	.remove = be_remove,
	.suspend = be_suspend,
4228
	.resume = be_resume,
4229
	.shutdown = be_shutdown,
4230
	.err_handler = &be_eeh_handlers
S
Sathya Perla 已提交
4231 4232 4233 4234
};

static int __init be_init_module(void)
{
4235 4236
	if (rx_frag_size != 8192 && rx_frag_size != 4096 &&
	    rx_frag_size != 2048) {
S
Sathya Perla 已提交
4237 4238 4239 4240 4241 4242 4243 4244 4245 4246 4247 4248 4249 4250 4251
		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);