be_cmds.c 57.6 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 "be.h"
19
#include "be_cmds.h"
S
Sathya Perla 已提交
20

21 22 23
/* Must be a power of 2 or else MODULO will BUG_ON */
static int be_get_temp_freq = 32;

24
static void be_mcc_notify(struct be_adapter *adapter)
25
{
26
	struct be_queue_info *mccq = &adapter->mcc_obj.q;
27 28
	u32 val = 0;

29 30 31 32 33 34
	if (adapter->eeh_err) {
		dev_info(&adapter->pdev->dev,
			"Error in Card Detected! Cannot issue commands\n");
		return;
	}

35 36
	val |= mccq->id & DB_MCCQ_RING_ID_MASK;
	val |= 1 << DB_MCCQ_NUM_POSTED_SHIFT;
37 38

	wmb();
39
	iowrite32(val, adapter->db + DB_MCCQ_OFFSET);
40 41 42 43 44
}

/* To check if valid bit is set, check the entire word as we don't know
 * the endianness of the data (old entry is host endian while a new entry is
 * little endian) */
45
static inline bool be_mcc_compl_is_new(struct be_mcc_compl *compl)
46 47 48 49 50 51 52 53 54 55 56
{
	if (compl->flags != 0) {
		compl->flags = le32_to_cpu(compl->flags);
		BUG_ON((compl->flags & CQE_FLAGS_VALID_MASK) == 0);
		return true;
	} else {
		return false;
	}
}

/* Need to reset the entire word that houses the valid bit */
57
static inline void be_mcc_compl_use(struct be_mcc_compl *compl)
58 59 60 61
{
	compl->flags = 0;
}

62
static int be_mcc_compl_process(struct be_adapter *adapter,
63
	struct be_mcc_compl *compl)
64 65 66 67 68 69 70 71 72
{
	u16 compl_status, extd_status;

	/* Just swap the status to host endian; mcc tag is opaquely copied
	 * from mcc_wrb */
	be_dws_le_to_cpu(compl, 4);

	compl_status = (compl->status >> CQE_STATUS_COMPL_SHIFT) &
				CQE_STATUS_COMPL_MASK;
73

74 75
	if (((compl->tag0 == OPCODE_COMMON_WRITE_FLASHROM) ||
		(compl->tag0 == OPCODE_COMMON_WRITE_OBJECT)) &&
76 77 78 79 80
		(compl->tag1 == CMD_SUBSYSTEM_COMMON)) {
		adapter->flash_status = compl_status;
		complete(&adapter->flash_compl);
	}

81
	if (compl_status == MCC_STATUS_SUCCESS) {
S
Selvin Xavier 已提交
82 83
		if (((compl->tag0 == OPCODE_ETH_GET_STATISTICS) ||
			 (compl->tag0 == OPCODE_ETH_GET_PPORT_STATS)) &&
84
			(compl->tag1 == CMD_SUBSYSTEM_ETH)) {
85
			be_parse_stats(adapter);
A
Ajit Khaparde 已提交
86
			adapter->stats_cmd_sent = false;
87
		}
88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103
	} else {
		if (compl_status == MCC_STATUS_NOT_SUPPORTED ||
			compl_status == MCC_STATUS_ILLEGAL_REQUEST)
			goto done;

		if (compl_status == MCC_STATUS_UNAUTHORIZED_REQUEST) {
			dev_warn(&adapter->pdev->dev, "This domain(VM) is not "
				"permitted to execute this cmd (opcode %d)\n",
				compl->tag0);
		} else {
			extd_status = (compl->status >> CQE_STATUS_EXTD_SHIFT) &
					CQE_STATUS_EXTD_MASK;
			dev_err(&adapter->pdev->dev, "Cmd (opcode %d) failed:"
				"status %d, extd-status %d\n",
				compl->tag0, compl_status, extd_status);
		}
104
	}
105
done:
106
	return compl_status;
107 108
}

109
/* Link state evt is a string of bytes; no need for endian swapping */
110
static void be_async_link_state_process(struct be_adapter *adapter,
111 112
		struct be_async_event_link_state *evt)
{
113
	be_link_status_update(adapter, evt->port_link_status);
114 115
}

116 117 118 119 120 121
/* Grp5 CoS Priority evt */
static void be_async_grp5_cos_priority_process(struct be_adapter *adapter,
		struct be_async_event_grp5_cos_priority *evt)
{
	if (evt->valid) {
		adapter->vlan_prio_bmap = evt->available_priority_bmap;
122
		adapter->recommended_prio &= ~VLAN_PRIO_MASK;
123 124 125 126 127 128 129 130 131 132 133 134 135 136 137
		adapter->recommended_prio =
			evt->reco_default_priority << VLAN_PRIO_SHIFT;
	}
}

/* Grp5 QOS Speed evt */
static void be_async_grp5_qos_speed_process(struct be_adapter *adapter,
		struct be_async_event_grp5_qos_link_speed *evt)
{
	if (evt->physical_port == adapter->port_num) {
		/* qos_link_speed is in units of 10 Mbps */
		adapter->link_speed = evt->qos_link_speed * 10;
	}
}

138 139 140 141 142
/*Grp5 PVID evt*/
static void be_async_grp5_pvid_state_process(struct be_adapter *adapter,
		struct be_async_event_grp5_pvid_state *evt)
{
	if (evt->enabled)
143
		adapter->pvid = le16_to_cpu(evt->tag) & VLAN_VID_MASK;
144 145 146 147
	else
		adapter->pvid = 0;
}

148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164
static void be_async_grp5_evt_process(struct be_adapter *adapter,
		u32 trailer, struct be_mcc_compl *evt)
{
	u8 event_type = 0;

	event_type = (trailer >> ASYNC_TRAILER_EVENT_TYPE_SHIFT) &
		ASYNC_TRAILER_EVENT_TYPE_MASK;

	switch (event_type) {
	case ASYNC_EVENT_COS_PRIORITY:
		be_async_grp5_cos_priority_process(adapter,
		(struct be_async_event_grp5_cos_priority *)evt);
	break;
	case ASYNC_EVENT_QOS_SPEED:
		be_async_grp5_qos_speed_process(adapter,
		(struct be_async_event_grp5_qos_link_speed *)evt);
	break;
165 166 167 168
	case ASYNC_EVENT_PVID_STATE:
		be_async_grp5_pvid_state_process(adapter,
		(struct be_async_event_grp5_pvid_state *)evt);
	break;
169 170 171 172 173 174
	default:
		dev_warn(&adapter->pdev->dev, "Unknown grp5 event!\n");
		break;
	}
}

175 176
static inline bool is_link_state_evt(u32 trailer)
{
177
	return ((trailer >> ASYNC_TRAILER_EVENT_CODE_SHIFT) &
178
		ASYNC_TRAILER_EVENT_CODE_MASK) ==
179
				ASYNC_EVENT_CODE_LINK_STATE;
180
}
181

182 183 184 185 186 187 188
static inline bool is_grp5_evt(u32 trailer)
{
	return (((trailer >> ASYNC_TRAILER_EVENT_CODE_SHIFT) &
		ASYNC_TRAILER_EVENT_CODE_MASK) ==
				ASYNC_EVENT_CODE_GRP_5);
}

189
static struct be_mcc_compl *be_mcc_compl_get(struct be_adapter *adapter)
190
{
191
	struct be_queue_info *mcc_cq = &adapter->mcc_obj.cq;
192
	struct be_mcc_compl *compl = queue_tail_node(mcc_cq);
193 194 195 196 197 198 199 200

	if (be_mcc_compl_is_new(compl)) {
		queue_tail_inc(mcc_cq);
		return compl;
	}
	return NULL;
}

201 202 203 204 205 206 207 208 209 210 211 212 213 214 215
void be_async_mcc_enable(struct be_adapter *adapter)
{
	spin_lock_bh(&adapter->mcc_cq_lock);

	be_cq_notify(adapter, adapter->mcc_obj.cq.id, true, 0);
	adapter->mcc_obj.rearm_cq = true;

	spin_unlock_bh(&adapter->mcc_cq_lock);
}

void be_async_mcc_disable(struct be_adapter *adapter)
{
	adapter->mcc_obj.rearm_cq = false;
}

S
Sathya Perla 已提交
216
int be_process_mcc(struct be_adapter *adapter, int *status)
217
{
218
	struct be_mcc_compl *compl;
S
Sathya Perla 已提交
219
	int num = 0;
220
	struct be_mcc_obj *mcc_obj = &adapter->mcc_obj;
221

222 223
	spin_lock_bh(&adapter->mcc_cq_lock);
	while ((compl = be_mcc_compl_get(adapter))) {
224 225
		if (compl->flags & CQE_FLAGS_ASYNC_MASK) {
			/* Interpret flags as an async trailer */
226 227
			if (is_link_state_evt(compl->flags))
				be_async_link_state_process(adapter,
228
				(struct be_async_event_link_state *) compl);
229 230 231
			else if (is_grp5_evt(compl->flags))
				be_async_grp5_evt_process(adapter,
				compl->flags, compl);
232
		} else if (compl->flags & CQE_FLAGS_COMPLETED_MASK) {
S
Sathya Perla 已提交
233
				*status = be_mcc_compl_process(adapter, compl);
234
				atomic_dec(&mcc_obj->q.used);
235 236 237 238
		}
		be_mcc_compl_use(compl);
		num++;
	}
239

240
	spin_unlock_bh(&adapter->mcc_cq_lock);
S
Sathya Perla 已提交
241
	return num;
242 243
}

244
/* Wait till no more pending mcc requests are present */
245
static int be_mcc_wait_compl(struct be_adapter *adapter)
246
{
247
#define mcc_timeout		120000 /* 12s timeout */
S
Sathya Perla 已提交
248 249 250
	int i, num, status = 0;
	struct be_mcc_obj *mcc_obj = &adapter->mcc_obj;

251 252 253
	if (adapter->eeh_err)
		return -EIO;

254
	for (i = 0; i < mcc_timeout; i++) {
S
Sathya Perla 已提交
255 256 257 258
		num = be_process_mcc(adapter, &status);
		if (num)
			be_cq_notify(adapter, mcc_obj->cq.id,
				mcc_obj->rearm_cq, num);
259

S
Sathya Perla 已提交
260
		if (atomic_read(&mcc_obj->q.used) == 0)
261 262 263
			break;
		udelay(100);
	}
264
	if (i == mcc_timeout) {
265
		dev_err(&adapter->pdev->dev, "mccq poll timed out\n");
266 267
		return -1;
	}
S
Sathya Perla 已提交
268
	return status;
269 270 271
}

/* Notify MCC requests and wait for completion */
272
static int be_mcc_notify_wait(struct be_adapter *adapter)
273
{
274
	be_mcc_notify(adapter);
275
	return be_mcc_wait_compl(adapter);
276 277
}

278
static int be_mbox_db_ready_wait(struct be_adapter *adapter, void __iomem *db)
S
Sathya Perla 已提交
279
{
280
	int msecs = 0;
S
Sathya Perla 已提交
281 282
	u32 ready;

283 284 285 286 287 288
	if (adapter->eeh_err) {
		dev_err(&adapter->pdev->dev,
			"Error detected in card.Cannot issue commands\n");
		return -EIO;
	}

S
Sathya Perla 已提交
289
	do {
290 291 292 293 294 295 296 297
		ready = ioread32(db);
		if (ready == 0xffffffff) {
			dev_err(&adapter->pdev->dev,
				"pci slot disconnected\n");
			return -1;
		}

		ready &= MPU_MAILBOX_DB_RDY_MASK;
S
Sathya Perla 已提交
298 299 300
		if (ready)
			break;

301
		if (msecs > 4000) {
302
			dev_err(&adapter->pdev->dev, "mbox poll timed out\n");
303 304
			if (!lancer_chip(adapter))
				be_detect_dump_ue(adapter);
S
Sathya Perla 已提交
305 306 307
			return -1;
		}

308
		msleep(1);
309
		msecs++;
S
Sathya Perla 已提交
310 311 312 313 314 315 316
	} while (true);

	return 0;
}

/*
 * Insert the mailbox address into the doorbell in two steps
317
 * Polls on the mbox doorbell till a command completion (or a timeout) occurs
S
Sathya Perla 已提交
318
 */
319
static int be_mbox_notify_wait(struct be_adapter *adapter)
S
Sathya Perla 已提交
320 321 322
{
	int status;
	u32 val = 0;
323 324
	void __iomem *db = adapter->db + MPU_MAILBOX_DB_OFFSET;
	struct be_dma_mem *mbox_mem = &adapter->mbox_mem;
S
Sathya Perla 已提交
325
	struct be_mcc_mailbox *mbox = mbox_mem->va;
326
	struct be_mcc_compl *compl = &mbox->compl;
S
Sathya Perla 已提交
327

328 329 330 331 332
	/* wait for ready to be set */
	status = be_mbox_db_ready_wait(adapter, db);
	if (status != 0)
		return status;

S
Sathya Perla 已提交
333 334 335 336 337 338
	val |= MPU_MAILBOX_DB_HI_MASK;
	/* at bits 2 - 31 place mbox dma addr msb bits 34 - 63 */
	val |= (upper_32_bits(mbox_mem->dma) >> 2) << 2;
	iowrite32(val, db);

	/* wait for ready to be set */
339
	status = be_mbox_db_ready_wait(adapter, db);
S
Sathya Perla 已提交
340 341 342 343 344 345 346 347
	if (status != 0)
		return status;

	val = 0;
	/* at bits 2 - 31 place mbox dma addr lsb bits 4 - 33 */
	val |= (u32)(mbox_mem->dma >> 4) << 2;
	iowrite32(val, db);

348
	status = be_mbox_db_ready_wait(adapter, db);
S
Sathya Perla 已提交
349 350 351
	if (status != 0)
		return status;

352
	/* A cq entry has been made now */
353 354 355
	if (be_mcc_compl_is_new(compl)) {
		status = be_mcc_compl_process(adapter, &mbox->compl);
		be_mcc_compl_use(compl);
356 357 358
		if (status)
			return status;
	} else {
359
		dev_err(&adapter->pdev->dev, "invalid mailbox completion\n");
S
Sathya Perla 已提交
360 361
		return -1;
	}
362
	return 0;
S
Sathya Perla 已提交
363 364
}

365
static int be_POST_stage_get(struct be_adapter *adapter, u16 *stage)
S
Sathya Perla 已提交
366
{
367 368 369 370 371 372
	u32 sem;

	if (lancer_chip(adapter))
		sem  = ioread32(adapter->db + MPU_EP_SEMAPHORE_IF_TYPE2_OFFSET);
	else
		sem  = ioread32(adapter->csr + MPU_EP_SEMAPHORE_OFFSET);
S
Sathya Perla 已提交
373 374 375 376 377 378 379 380

	*stage = sem & EP_SEMAPHORE_POST_STAGE_MASK;
	if ((sem >> EP_SEMAPHORE_POST_ERR_SHIFT) & EP_SEMAPHORE_POST_ERR_MASK)
		return -1;
	else
		return 0;
}

381
int be_cmd_POST(struct be_adapter *adapter)
S
Sathya Perla 已提交
382
{
383 384
	u16 stage;
	int status, timeout = 0;
385
	struct device *dev = &adapter->pdev->dev;
S
Sathya Perla 已提交
386

387 388 389
	do {
		status = be_POST_stage_get(adapter, &stage);
		if (status) {
390
			dev_err(dev, "POST error; stage=0x%x\n", stage);
391 392
			return -1;
		} else if (stage != POST_STAGE_ARMFW_RDY) {
393 394 395 396
			if (msleep_interruptible(2000)) {
				dev_err(dev, "Waiting for POST aborted\n");
				return -EINTR;
			}
397 398 399 400
			timeout += 2;
		} else {
			return 0;
		}
401
	} while (timeout < 40);
S
Sathya Perla 已提交
402

403
	dev_err(dev, "POST timeout; stage=0x%x\n", stage);
404
	return -1;
S
Sathya Perla 已提交
405 406 407 408 409 410 411 412 413 414 415 416 417 418
}

static inline void *embedded_payload(struct be_mcc_wrb *wrb)
{
	return wrb->payload.embedded_payload;
}

static inline struct be_sge *nonembedded_sgl(struct be_mcc_wrb *wrb)
{
	return &wrb->payload.sgl[0];
}

/* Don't touch the hdr after it's prepared */
static void be_wrb_hdr_prepare(struct be_mcc_wrb *wrb, int payload_len,
419
				bool embedded, u8 sge_cnt, u32 opcode)
S
Sathya Perla 已提交
420 421 422 423 424 425 426
{
	if (embedded)
		wrb->embedded |= MCC_WRB_EMBEDDED_MASK;
	else
		wrb->embedded |= (sge_cnt & MCC_WRB_SGE_CNT_MASK) <<
				MCC_WRB_SGE_CNT_SHIFT;
	wrb->payload_length = payload_len;
427
	wrb->tag0 = opcode;
428
	be_dws_cpu_to_le(wrb, 8);
S
Sathya Perla 已提交
429 430 431 432 433 434 435 436 437
}

/* Don't touch the hdr after it's prepared */
static void be_cmd_hdr_prepare(struct be_cmd_req_hdr *req_hdr,
				u8 subsystem, u8 opcode, int cmd_len)
{
	req_hdr->opcode = opcode;
	req_hdr->subsystem = subsystem;
	req_hdr->request_length = cpu_to_le32(cmd_len - sizeof(*req_hdr));
438
	req_hdr->version = 0;
S
Sathya Perla 已提交
439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478
}

static void be_cmd_page_addrs_prepare(struct phys_addr *pages, u32 max_pages,
			struct be_dma_mem *mem)
{
	int i, buf_pages = min(PAGES_4K_SPANNED(mem->va, mem->size), max_pages);
	u64 dma = (u64)mem->dma;

	for (i = 0; i < buf_pages; i++) {
		pages[i].lo = cpu_to_le32(dma & 0xFFFFFFFF);
		pages[i].hi = cpu_to_le32(upper_32_bits(dma));
		dma += PAGE_SIZE_4K;
	}
}

/* Converts interrupt delay in microseconds to multiplier value */
static u32 eq_delay_to_mult(u32 usec_delay)
{
#define MAX_INTR_RATE			651042
	const u32 round = 10;
	u32 multiplier;

	if (usec_delay == 0)
		multiplier = 0;
	else {
		u32 interrupt_rate = 1000000 / usec_delay;
		/* Max delay, corresponding to the lowest interrupt rate */
		if (interrupt_rate == 0)
			multiplier = 1023;
		else {
			multiplier = (MAX_INTR_RATE - interrupt_rate) * round;
			multiplier /= interrupt_rate;
			/* Round the multiplier to the closest value.*/
			multiplier = (multiplier + round/2) / round;
			multiplier = min(multiplier, (u32)1023);
		}
	}
	return multiplier;
}

479
static inline struct be_mcc_wrb *wrb_from_mbox(struct be_adapter *adapter)
S
Sathya Perla 已提交
480
{
481 482 483 484 485
	struct be_dma_mem *mbox_mem = &adapter->mbox_mem;
	struct be_mcc_wrb *wrb
		= &((struct be_mcc_mailbox *)(mbox_mem->va))->wrb;
	memset(wrb, 0, sizeof(*wrb));
	return wrb;
S
Sathya Perla 已提交
486 487
}

488
static struct be_mcc_wrb *wrb_from_mccq(struct be_adapter *adapter)
489
{
490 491 492
	struct be_queue_info *mccq = &adapter->mcc_obj.q;
	struct be_mcc_wrb *wrb;

493 494 495 496 497
	if (atomic_read(&mccq->used) >= mccq->len) {
		dev_err(&adapter->pdev->dev, "Out of MCCQ wrbs\n");
		return NULL;
	}

498 499 500 501
	wrb = queue_head_node(mccq);
	queue_head_inc(mccq);
	atomic_inc(&mccq->used);
	memset(wrb, 0, sizeof(*wrb));
502 503 504
	return wrb;
}

505 506 507 508 509 510 511 512
/* Tell fw we're about to start firing cmds by writing a
 * special pattern across the wrb hdr; uses mbox
 */
int be_cmd_fw_init(struct be_adapter *adapter)
{
	u8 *wrb;
	int status;

513 514
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
515 516

	wrb = (u8 *)wrb_from_mbox(adapter);
S
Sathya Perla 已提交
517 518 519 520 521 522 523 524
	*wrb++ = 0xFF;
	*wrb++ = 0x12;
	*wrb++ = 0x34;
	*wrb++ = 0xFF;
	*wrb++ = 0xFF;
	*wrb++ = 0x56;
	*wrb++ = 0x78;
	*wrb = 0xFF;
525 526 527

	status = be_mbox_notify_wait(adapter);

528
	mutex_unlock(&adapter->mbox_lock);
529 530 531 532 533 534 535 536 537 538 539
	return status;
}

/* Tell fw we're done with firing cmds by writing a
 * special pattern across the wrb hdr; uses mbox
 */
int be_cmd_fw_clean(struct be_adapter *adapter)
{
	u8 *wrb;
	int status;

540 541 542
	if (adapter->eeh_err)
		return -EIO;

543 544
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
545 546 547 548 549 550 551 552 553 554 555 556 557

	wrb = (u8 *)wrb_from_mbox(adapter);
	*wrb++ = 0xFF;
	*wrb++ = 0xAA;
	*wrb++ = 0xBB;
	*wrb++ = 0xFF;
	*wrb++ = 0xFF;
	*wrb++ = 0xCC;
	*wrb++ = 0xDD;
	*wrb = 0xFF;

	status = be_mbox_notify_wait(adapter);

558
	mutex_unlock(&adapter->mbox_lock);
559 560
	return status;
}
561
int be_cmd_eq_create(struct be_adapter *adapter,
S
Sathya Perla 已提交
562 563
		struct be_queue_info *eq, int eq_delay)
{
564 565
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_eq_create *req;
S
Sathya Perla 已提交
566 567 568
	struct be_dma_mem *q_mem = &eq->dma_mem;
	int status;

569 570
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
571 572 573

	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
574

575
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, OPCODE_COMMON_EQ_CREATE);
S
Sathya Perla 已提交
576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_EQ_CREATE, sizeof(*req));

	req->num_pages =  cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size));

	AMAP_SET_BITS(struct amap_eq_context, valid, req->context, 1);
	/* 4byte eqe*/
	AMAP_SET_BITS(struct amap_eq_context, size, req->context, 0);
	AMAP_SET_BITS(struct amap_eq_context, count, req->context,
			__ilog2_u32(eq->len/256));
	AMAP_SET_BITS(struct amap_eq_context, delaymult, req->context,
			eq_delay_to_mult(eq_delay));
	be_dws_cpu_to_le(req->context, sizeof(req->context));

	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);

593
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
594
	if (!status) {
595
		struct be_cmd_resp_eq_create *resp = embedded_payload(wrb);
S
Sathya Perla 已提交
596 597 598
		eq->id = le16_to_cpu(resp->eq_id);
		eq->created = true;
	}
599

600
	mutex_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
601 602 603
	return status;
}

604
/* Uses mbox */
605
int be_cmd_mac_addr_query(struct be_adapter *adapter, u8 *mac_addr,
S
Sathya Perla 已提交
606 607
			u8 type, bool permanent, u32 if_handle)
{
608 609
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_mac_query *req;
S
Sathya Perla 已提交
610 611
	int status;

612 613
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
614 615 616

	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
617

618 619
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_MAC_QUERY);
S
Sathya Perla 已提交
620 621 622 623 624 625 626 627

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_NTWK_MAC_QUERY, sizeof(*req));

	req->type = type;
	if (permanent) {
		req->permanent = 1;
	} else {
628
		req->if_id = cpu_to_le16((u16) if_handle);
S
Sathya Perla 已提交
629 630 631
		req->permanent = 0;
	}

632 633 634
	status = be_mbox_notify_wait(adapter);
	if (!status) {
		struct be_cmd_resp_mac_query *resp = embedded_payload(wrb);
S
Sathya Perla 已提交
635
		memcpy(mac_addr, resp->mac.addr, ETH_ALEN);
636
	}
S
Sathya Perla 已提交
637

638
	mutex_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
639 640 641
	return status;
}

642
/* Uses synchronous MCCQ */
643
int be_cmd_pmac_add(struct be_adapter *adapter, u8 *mac_addr,
644
		u32 if_id, u32 *pmac_id, u32 domain)
S
Sathya Perla 已提交
645
{
646 647
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_pmac_add *req;
S
Sathya Perla 已提交
648 649
	int status;

650 651 652
	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
653 654 655 656
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
657
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
658

659 660
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_PMAC_ADD);
S
Sathya Perla 已提交
661 662 663 664

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_NTWK_PMAC_ADD, sizeof(*req));

665
	req->hdr.domain = domain;
S
Sathya Perla 已提交
666 667 668
	req->if_id = cpu_to_le32(if_id);
	memcpy(req->mac_address, mac_addr, ETH_ALEN);

669
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
670 671 672 673 674
	if (!status) {
		struct be_cmd_resp_pmac_add *resp = embedded_payload(wrb);
		*pmac_id = le32_to_cpu(resp->pmac_id);
	}

675
err:
676
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
677 678 679
	return status;
}

680
/* Uses synchronous MCCQ */
681
int be_cmd_pmac_del(struct be_adapter *adapter, u32 if_id, u32 pmac_id, u32 dom)
S
Sathya Perla 已提交
682
{
683 684
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_pmac_del *req;
S
Sathya Perla 已提交
685 686
	int status;

687 688 689
	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
690 691 692 693
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
694
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
695

696 697
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_PMAC_DEL);
S
Sathya Perla 已提交
698 699 700 701

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_NTWK_PMAC_DEL, sizeof(*req));

702
	req->hdr.domain = dom;
S
Sathya Perla 已提交
703 704 705
	req->if_id = cpu_to_le32(if_id);
	req->pmac_id = cpu_to_le32(pmac_id);

706 707
	status = be_mcc_notify_wait(adapter);

708
err:
709
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
710 711 712
	return status;
}

713
/* Uses Mbox */
714
int be_cmd_cq_create(struct be_adapter *adapter,
S
Sathya Perla 已提交
715 716 717
		struct be_queue_info *cq, struct be_queue_info *eq,
		bool sol_evts, bool no_delay, int coalesce_wm)
{
718 719
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_cq_create *req;
S
Sathya Perla 已提交
720
	struct be_dma_mem *q_mem = &cq->dma_mem;
721
	void *ctxt;
S
Sathya Perla 已提交
722 723
	int status;

724 725
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
726 727 728 729

	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
	ctxt = &req->context;
S
Sathya Perla 已提交
730

731 732
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_CQ_CREATE);
S
Sathya Perla 已提交
733 734 735 736 737

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_CQ_CREATE, sizeof(*req));

	req->num_pages =  cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size));
738
	if (lancer_chip(adapter)) {
739
		req->hdr.version = 2;
740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764
		req->page_size = 1; /* 1 for 4K */
		AMAP_SET_BITS(struct amap_cq_context_lancer, nodelay, ctxt,
								no_delay);
		AMAP_SET_BITS(struct amap_cq_context_lancer, count, ctxt,
						__ilog2_u32(cq->len/256));
		AMAP_SET_BITS(struct amap_cq_context_lancer, valid, ctxt, 1);
		AMAP_SET_BITS(struct amap_cq_context_lancer, eventable,
								ctxt, 1);
		AMAP_SET_BITS(struct amap_cq_context_lancer, eqid,
								ctxt, eq->id);
		AMAP_SET_BITS(struct amap_cq_context_lancer, armed, ctxt, 1);
	} else {
		AMAP_SET_BITS(struct amap_cq_context_be, coalescwm, ctxt,
								coalesce_wm);
		AMAP_SET_BITS(struct amap_cq_context_be, nodelay,
								ctxt, no_delay);
		AMAP_SET_BITS(struct amap_cq_context_be, count, ctxt,
						__ilog2_u32(cq->len/256));
		AMAP_SET_BITS(struct amap_cq_context_be, valid, ctxt, 1);
		AMAP_SET_BITS(struct amap_cq_context_be, solevent,
								ctxt, sol_evts);
		AMAP_SET_BITS(struct amap_cq_context_be, eventable, ctxt, 1);
		AMAP_SET_BITS(struct amap_cq_context_be, eqid, ctxt, eq->id);
		AMAP_SET_BITS(struct amap_cq_context_be, armed, ctxt, 1);
	}
S
Sathya Perla 已提交
765 766 767 768 769

	be_dws_cpu_to_le(ctxt, sizeof(req->context));

	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);

770
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
771
	if (!status) {
772
		struct be_cmd_resp_cq_create *resp = embedded_payload(wrb);
S
Sathya Perla 已提交
773 774 775
		cq->id = le16_to_cpu(resp->cq_id);
		cq->created = true;
	}
776

777
	mutex_unlock(&adapter->mbox_lock);
778 779 780 781 782 783 784 785 786 787 788 789

	return status;
}

static u32 be_encoded_q_len(int q_len)
{
	u32 len_encoded = fls(q_len); /* log2(len) + 1 */
	if (len_encoded == 16)
		len_encoded = 0;
	return len_encoded;
}

790
int be_cmd_mccq_ext_create(struct be_adapter *adapter,
791 792 793
			struct be_queue_info *mccq,
			struct be_queue_info *cq)
{
794
	struct be_mcc_wrb *wrb;
795
	struct be_cmd_req_mcc_ext_create *req;
796
	struct be_dma_mem *q_mem = &mccq->dma_mem;
797
	void *ctxt;
798 799
	int status;

800 801
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
802 803 804 805

	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
	ctxt = &req->context;
806

807
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
808
			OPCODE_COMMON_MCC_CREATE_EXT);
809 810

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
811
			OPCODE_COMMON_MCC_CREATE_EXT, sizeof(*req));
812

813
	req->num_pages = cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size));
814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831
	if (lancer_chip(adapter)) {
		req->hdr.version = 1;
		req->cq_id = cpu_to_le16(cq->id);

		AMAP_SET_BITS(struct amap_mcc_context_lancer, ring_size, ctxt,
						be_encoded_q_len(mccq->len));
		AMAP_SET_BITS(struct amap_mcc_context_lancer, valid, ctxt, 1);
		AMAP_SET_BITS(struct amap_mcc_context_lancer, async_cq_id,
								ctxt, cq->id);
		AMAP_SET_BITS(struct amap_mcc_context_lancer, async_cq_valid,
								 ctxt, 1);

	} else {
		AMAP_SET_BITS(struct amap_mcc_context_be, valid, ctxt, 1);
		AMAP_SET_BITS(struct amap_mcc_context_be, ring_size, ctxt,
						be_encoded_q_len(mccq->len));
		AMAP_SET_BITS(struct amap_mcc_context_be, cq_id, ctxt, cq->id);
	}
832

833
	/* Subscribe to Link State and Group 5 Events(bits 1 and 5 set) */
834
	req->async_event_bitmap[0] = cpu_to_le32(0x00000022);
835 836 837 838
	be_dws_cpu_to_le(ctxt, sizeof(req->context));

	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);

839
	status = be_mbox_notify_wait(adapter);
840 841 842 843 844
	if (!status) {
		struct be_cmd_resp_mcc_create *resp = embedded_payload(wrb);
		mccq->id = le16_to_cpu(resp->id);
		mccq->created = true;
	}
845
	mutex_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
846 847 848 849

	return status;
}

850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910
int be_cmd_mccq_org_create(struct be_adapter *adapter,
			struct be_queue_info *mccq,
			struct be_queue_info *cq)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_mcc_create *req;
	struct be_dma_mem *q_mem = &mccq->dma_mem;
	void *ctxt;
	int status;

	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;

	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
	ctxt = &req->context;

	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_MCC_CREATE);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
			OPCODE_COMMON_MCC_CREATE, sizeof(*req));

	req->num_pages = cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size));

	AMAP_SET_BITS(struct amap_mcc_context_be, valid, ctxt, 1);
	AMAP_SET_BITS(struct amap_mcc_context_be, ring_size, ctxt,
			be_encoded_q_len(mccq->len));
	AMAP_SET_BITS(struct amap_mcc_context_be, cq_id, ctxt, cq->id);

	be_dws_cpu_to_le(ctxt, sizeof(req->context));

	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);

	status = be_mbox_notify_wait(adapter);
	if (!status) {
		struct be_cmd_resp_mcc_create *resp = embedded_payload(wrb);
		mccq->id = le16_to_cpu(resp->id);
		mccq->created = true;
	}

	mutex_unlock(&adapter->mbox_lock);
	return status;
}

int be_cmd_mccq_create(struct be_adapter *adapter,
			struct be_queue_info *mccq,
			struct be_queue_info *cq)
{
	int status;

	status = be_cmd_mccq_ext_create(adapter, mccq, cq);
	if (status && !lancer_chip(adapter)) {
		dev_warn(&adapter->pdev->dev, "Upgrade to F/W ver 2.102.235.0 "
			"or newer to avoid conflicting priorities between NIC "
			"and FCoE traffic");
		status = be_cmd_mccq_org_create(adapter, mccq, cq);
	}
	return status;
}

911
int be_cmd_txq_create(struct be_adapter *adapter,
S
Sathya Perla 已提交
912 913 914
			struct be_queue_info *txq,
			struct be_queue_info *cq)
{
915 916
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_eth_tx_create *req;
S
Sathya Perla 已提交
917
	struct be_dma_mem *q_mem = &txq->dma_mem;
918
	void *ctxt;
S
Sathya Perla 已提交
919 920
	int status;

921 922
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
923 924 925 926

	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
	ctxt = &req->context;
S
Sathya Perla 已提交
927

928 929
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_ETH_TX_CREATE);
S
Sathya Perla 已提交
930 931 932 933

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH, OPCODE_ETH_TX_CREATE,
		sizeof(*req));

934 935 936 937 938 939
	if (lancer_chip(adapter)) {
		req->hdr.version = 1;
		AMAP_SET_BITS(struct amap_tx_context, if_id, ctxt,
					adapter->if_handle);
	}

S
Sathya Perla 已提交
940 941 942 943
	req->num_pages = PAGES_4K_SPANNED(q_mem->va, q_mem->size);
	req->ulp_num = BE_ULP1_NUM;
	req->type = BE_ETH_TX_RING_TYPE_STANDARD;

944 945
	AMAP_SET_BITS(struct amap_tx_context, tx_ring_size, ctxt,
		be_encoded_q_len(txq->len));
S
Sathya Perla 已提交
946 947 948 949 950 951 952
	AMAP_SET_BITS(struct amap_tx_context, ctx_valid, ctxt, 1);
	AMAP_SET_BITS(struct amap_tx_context, cq_id_send, ctxt, cq->id);

	be_dws_cpu_to_le(ctxt, sizeof(req->context));

	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);

953
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
954 955 956 957 958
	if (!status) {
		struct be_cmd_resp_eth_tx_create *resp = embedded_payload(wrb);
		txq->id = le16_to_cpu(resp->cid);
		txq->created = true;
	}
959

960
	mutex_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
961 962 963 964

	return status;
}

965
/* Uses MCC */
966
int be_cmd_rxq_create(struct be_adapter *adapter,
S
Sathya Perla 已提交
967
		struct be_queue_info *rxq, u16 cq_id, u16 frag_size,
968
		u16 max_frame_size, u32 if_id, u32 rss, u8 *rss_id)
S
Sathya Perla 已提交
969
{
970 971
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_eth_rx_create *req;
S
Sathya Perla 已提交
972 973 974
	struct be_dma_mem *q_mem = &rxq->dma_mem;
	int status;

975
	spin_lock_bh(&adapter->mcc_lock);
976

977 978 979 980 981
	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
982
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
983

984 985
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_ETH_RX_CREATE);
S
Sathya Perla 已提交
986 987 988 989 990 991 992 993 994 995 996 997

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH, OPCODE_ETH_RX_CREATE,
		sizeof(*req));

	req->cq_id = cpu_to_le16(cq_id);
	req->frag_size = fls(frag_size) - 1;
	req->num_pages = 2;
	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);
	req->interface_id = cpu_to_le32(if_id);
	req->max_frame_size = cpu_to_le16(max_frame_size);
	req->rss_queue = cpu_to_le32(rss);

998
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
999 1000 1001 1002
	if (!status) {
		struct be_cmd_resp_eth_rx_create *resp = embedded_payload(wrb);
		rxq->id = le16_to_cpu(resp->id);
		rxq->created = true;
1003
		*rss_id = resp->rss_id;
S
Sathya Perla 已提交
1004
	}
1005

1006 1007
err:
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1008 1009 1010
	return status;
}

1011 1012 1013
/* Generic destroyer function for all types of queues
 * Uses Mbox
 */
1014
int be_cmd_q_destroy(struct be_adapter *adapter, struct be_queue_info *q,
S
Sathya Perla 已提交
1015 1016
		int queue_type)
{
1017 1018
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_q_destroy *req;
S
Sathya Perla 已提交
1019 1020 1021
	u8 subsys = 0, opcode = 0;
	int status;

1022 1023 1024
	if (adapter->eeh_err)
		return -EIO;

1025 1026
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
S
Sathya Perla 已提交
1027

1028 1029 1030
	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);

S
Sathya Perla 已提交
1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047
	switch (queue_type) {
	case QTYPE_EQ:
		subsys = CMD_SUBSYSTEM_COMMON;
		opcode = OPCODE_COMMON_EQ_DESTROY;
		break;
	case QTYPE_CQ:
		subsys = CMD_SUBSYSTEM_COMMON;
		opcode = OPCODE_COMMON_CQ_DESTROY;
		break;
	case QTYPE_TXQ:
		subsys = CMD_SUBSYSTEM_ETH;
		opcode = OPCODE_ETH_TX_DESTROY;
		break;
	case QTYPE_RXQ:
		subsys = CMD_SUBSYSTEM_ETH;
		opcode = OPCODE_ETH_RX_DESTROY;
		break;
1048 1049 1050 1051
	case QTYPE_MCCQ:
		subsys = CMD_SUBSYSTEM_COMMON;
		opcode = OPCODE_COMMON_MCC_DESTROY;
		break;
S
Sathya Perla 已提交
1052
	default:
1053
		BUG();
S
Sathya Perla 已提交
1054
	}
1055 1056 1057

	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, opcode);

S
Sathya Perla 已提交
1058 1059 1060
	be_cmd_hdr_prepare(&req->hdr, subsys, opcode, sizeof(*req));
	req->id = cpu_to_le16(q->id);

1061
	status = be_mbox_notify_wait(adapter);
1062 1063
	if (!status)
		q->created = false;
1064

1065
	mutex_unlock(&adapter->mbox_lock);
1066 1067
	return status;
}
S
Sathya Perla 已提交
1068

1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095
/* Uses MCC */
int be_cmd_rxq_destroy(struct be_adapter *adapter, struct be_queue_info *q)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_q_destroy *req;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
	req = embedded_payload(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, OPCODE_ETH_RX_DESTROY);
	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH, OPCODE_ETH_RX_DESTROY,
		sizeof(*req));
	req->id = cpu_to_le16(q->id);

	status = be_mcc_notify_wait(adapter);
	if (!status)
		q->created = false;

err:
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1096 1097 1098
	return status;
}

1099 1100 1101
/* Create an rx filtering policy configuration on an i/f
 * Uses mbox
 */
1102
int be_cmd_if_create(struct be_adapter *adapter, u32 cap_flags, u32 en_flags,
1103 1104
		u8 *mac, bool pmac_invalid, u32 *if_handle, u32 *pmac_id,
		u32 domain)
S
Sathya Perla 已提交
1105
{
1106 1107
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_if_create *req;
S
Sathya Perla 已提交
1108 1109
	int status;

1110 1111
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
1112 1113 1114

	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1115

1116 1117
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_INTERFACE_CREATE);
S
Sathya Perla 已提交
1118 1119 1120 1121

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_NTWK_INTERFACE_CREATE, sizeof(*req));

1122
	req->hdr.domain = domain;
1123 1124
	req->capability_flags = cpu_to_le32(cap_flags);
	req->enable_flags = cpu_to_le32(en_flags);
1125
	req->pmac_invalid = pmac_invalid;
S
Sathya Perla 已提交
1126 1127 1128
	if (!pmac_invalid)
		memcpy(req->mac_addr, mac, ETH_ALEN);

1129
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
1130 1131 1132 1133 1134 1135 1136
	if (!status) {
		struct be_cmd_resp_if_create *resp = embedded_payload(wrb);
		*if_handle = le32_to_cpu(resp->interface_id);
		if (!pmac_invalid)
			*pmac_id = le32_to_cpu(resp->pmac_id);
	}

1137
	mutex_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
1138 1139 1140
	return status;
}

1141
/* Uses mbox */
1142
int be_cmd_if_destroy(struct be_adapter *adapter, u32 interface_id, u32 domain)
S
Sathya Perla 已提交
1143
{
1144 1145
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_if_destroy *req;
S
Sathya Perla 已提交
1146 1147
	int status;

1148 1149 1150
	if (adapter->eeh_err)
		return -EIO;

1151 1152
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
1153 1154 1155

	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1156

1157 1158
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_INTERFACE_DESTROY);
S
Sathya Perla 已提交
1159 1160 1161 1162

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_NTWK_INTERFACE_DESTROY, sizeof(*req));

1163
	req->hdr.domain = domain;
S
Sathya Perla 已提交
1164
	req->interface_id = cpu_to_le32(interface_id);
1165 1166

	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
1167

1168
	mutex_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
1169 1170 1171 1172 1173 1174

	return status;
}

/* Get stats is a non embedded command: the request is not embedded inside
 * WRB but is a separate dma memory block
1175
 * Uses asynchronous MCC
S
Sathya Perla 已提交
1176
 */
1177
int be_cmd_get_stats(struct be_adapter *adapter, struct be_dma_mem *nonemb_cmd)
S
Sathya Perla 已提交
1178
{
1179
	struct be_mcc_wrb *wrb;
1180
	struct be_cmd_req_hdr *hdr;
1181
	struct be_sge *sge;
1182
	int status = 0;
S
Sathya Perla 已提交
1183

1184 1185 1186
	if (MODULO(adapter->work_counter, be_get_temp_freq) == 0)
		be_cmd_get_die_temperature(adapter);

1187
	spin_lock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1188

1189
	wrb = wrb_from_mccq(adapter);
1190 1191 1192 1193
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1194
	hdr = nonemb_cmd->va;
1195
	sge = nonembedded_sgl(wrb);
S
Sathya Perla 已提交
1196

1197
	be_wrb_hdr_prepare(wrb, nonemb_cmd->size, false, 1,
1198
			OPCODE_ETH_GET_STATISTICS);
S
Sathya Perla 已提交
1199

1200 1201 1202 1203 1204 1205
	be_cmd_hdr_prepare(hdr, CMD_SUBSYSTEM_ETH,
		OPCODE_ETH_GET_STATISTICS, nonemb_cmd->size);

	if (adapter->generation == BE_GEN3)
		hdr->version = 1;

1206
	wrb->tag1 = CMD_SUBSYSTEM_ETH;
S
Sathya Perla 已提交
1207 1208 1209 1210
	sge->pa_hi = cpu_to_le32(upper_32_bits(nonemb_cmd->dma));
	sge->pa_lo = cpu_to_le32(nonemb_cmd->dma & 0xFFFFFFFF);
	sge->len = cpu_to_le32(nonemb_cmd->size);

1211
	be_mcc_notify(adapter);
A
Ajit Khaparde 已提交
1212
	adapter->stats_cmd_sent = true;
S
Sathya Perla 已提交
1213

1214
err:
1215
	spin_unlock_bh(&adapter->mcc_lock);
1216
	return status;
S
Sathya Perla 已提交
1217 1218
}

S
Selvin Xavier 已提交
1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261
/* Lancer Stats */
int lancer_cmd_get_pport_stats(struct be_adapter *adapter,
				struct be_dma_mem *nonemb_cmd)
{

	struct be_mcc_wrb *wrb;
	struct lancer_cmd_req_pport_stats *req;
	struct be_sge *sge;
	int status = 0;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
	req = nonemb_cmd->va;
	sge = nonembedded_sgl(wrb);

	be_wrb_hdr_prepare(wrb, nonemb_cmd->size, false, 1,
			OPCODE_ETH_GET_PPORT_STATS);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,
			OPCODE_ETH_GET_PPORT_STATS, nonemb_cmd->size);


	req->cmd_params.params.pport_num = cpu_to_le16(adapter->port_num);
	req->cmd_params.params.reset_stats = 0;

	wrb->tag1 = CMD_SUBSYSTEM_ETH;
	sge->pa_hi = cpu_to_le32(upper_32_bits(nonemb_cmd->dma));
	sge->pa_lo = cpu_to_le32(nonemb_cmd->dma & 0xFFFFFFFF);
	sge->len = cpu_to_le32(nonemb_cmd->size);

	be_mcc_notify(adapter);
	adapter->stats_cmd_sent = true;

err:
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}

1262
/* Uses synchronous mcc */
1263 1264
int be_cmd_link_status_query(struct be_adapter *adapter, u8 *mac_speed,
			u16 *link_speed, u32 dom)
S
Sathya Perla 已提交
1265
{
1266 1267
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_link_status *req;
S
Sathya Perla 已提交
1268 1269
	int status;

1270 1271 1272
	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
1273 1274 1275 1276
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1277
	req = embedded_payload(wrb);
1278

1279 1280
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_LINK_STATUS_QUERY);
S
Sathya Perla 已提交
1281 1282 1283 1284

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_NTWK_LINK_STATUS_QUERY, sizeof(*req));

1285
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
1286 1287
	if (!status) {
		struct be_cmd_resp_link_status *resp = embedded_payload(wrb);
1288 1289 1290 1291
		if (resp->mac_speed != PHY_LINK_SPEED_ZERO) {
			*link_speed = le16_to_cpu(resp->link_speed);
			*mac_speed = resp->mac_speed;
		}
S
Sathya Perla 已提交
1292 1293
	}

1294
err:
1295
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1296 1297 1298
	return status;
}

1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336
/* Uses synchronous mcc */
int be_cmd_get_die_temperature(struct be_adapter *adapter)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_get_cntl_addnl_attribs *req;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
	req = embedded_payload(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_GET_CNTL_ADDITIONAL_ATTRIBUTES);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_GET_CNTL_ADDITIONAL_ATTRIBUTES, sizeof(*req));

	status = be_mcc_notify_wait(adapter);
	if (!status) {
		struct be_cmd_resp_get_cntl_addnl_attribs *resp =
						embedded_payload(wrb);
		adapter->drv_stats.be_on_die_temperature =
						resp->on_die_temperature;
	}
	/* If IOCTL fails once, do not bother issuing it again */
	else
		be_get_temp_freq = 0;

err:
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}

1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362
/* Uses synchronous mcc */
int be_cmd_get_reg_len(struct be_adapter *adapter, u32 *log_size)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_get_fat *req;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
	req = embedded_payload(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_MANAGE_FAT);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_MANAGE_FAT, sizeof(*req));
	req->fat_operation = cpu_to_le32(QUERY_FAT);
	status = be_mcc_notify_wait(adapter);
	if (!status) {
		struct be_cmd_resp_get_fat *resp = embedded_payload(wrb);
		if (log_size && resp->log_size)
1363 1364
			*log_size = le32_to_cpu(resp->log_size) -
					sizeof(u32);
1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376
	}
err:
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}

void be_cmd_get_regs(struct be_adapter *adapter, u32 buf_len, void *buf)
{
	struct be_dma_mem get_fat_cmd;
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_get_fat *req;
	struct be_sge *sge;
1377 1378
	u32 offset = 0, total_size, buf_size,
				log_offset = sizeof(u32), payload_len;
1379 1380 1381 1382 1383 1384 1385
	int status;

	if (buf_len == 0)
		return;

	total_size = buf_len;

1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396
	get_fat_cmd.size = sizeof(struct be_cmd_req_get_fat) + 60*1024;
	get_fat_cmd.va = pci_alloc_consistent(adapter->pdev,
			get_fat_cmd.size,
			&get_fat_cmd.dma);
	if (!get_fat_cmd.va) {
		status = -ENOMEM;
		dev_err(&adapter->pdev->dev,
		"Memory allocation failure while retrieving FAT data\n");
		return;
	}

1397 1398 1399 1400 1401 1402
	spin_lock_bh(&adapter->mcc_lock);

	while (total_size) {
		buf_size = min(total_size, (u32)60*1024);
		total_size -= buf_size;

1403 1404 1405
		wrb = wrb_from_mccq(adapter);
		if (!wrb) {
			status = -EBUSY;
1406 1407 1408 1409 1410
			goto err;
		}
		req = get_fat_cmd.va;
		sge = nonembedded_sgl(wrb);

1411 1412
		payload_len = sizeof(struct be_cmd_req_get_fat) + buf_size;
		be_wrb_hdr_prepare(wrb, payload_len, false, 1,
1413 1414 1415
				OPCODE_COMMON_MANAGE_FAT);

		be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1416
				OPCODE_COMMON_MANAGE_FAT, payload_len);
1417

1418
		sge->pa_hi = cpu_to_le32(upper_32_bits(get_fat_cmd.dma));
1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432
		sge->pa_lo = cpu_to_le32(get_fat_cmd.dma & 0xFFFFFFFF);
		sge->len = cpu_to_le32(get_fat_cmd.size);

		req->fat_operation = cpu_to_le32(RETRIEVE_FAT);
		req->read_log_offset = cpu_to_le32(log_offset);
		req->read_log_length = cpu_to_le32(buf_size);
		req->data_buffer_size = cpu_to_le32(buf_size);

		status = be_mcc_notify_wait(adapter);
		if (!status) {
			struct be_cmd_resp_get_fat *resp = get_fat_cmd.va;
			memcpy(buf + offset,
				resp->data_buffer,
				resp->read_log_length);
1433
		} else {
1434
			dev_err(&adapter->pdev->dev, "FAT Table Retrieve error\n");
1435 1436
			goto err;
		}
1437 1438 1439 1440
		offset += buf_size;
		log_offset += buf_size;
	}
err:
1441 1442 1443
	pci_free_consistent(adapter->pdev, get_fat_cmd.size,
			get_fat_cmd.va,
			get_fat_cmd.dma);
1444 1445 1446
	spin_unlock_bh(&adapter->mcc_lock);
}

1447
/* Uses Mbox */
1448
int be_cmd_get_fw_ver(struct be_adapter *adapter, char *fw_ver)
S
Sathya Perla 已提交
1449
{
1450 1451
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_get_fw_version *req;
S
Sathya Perla 已提交
1452 1453
	int status;

1454 1455
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
1456 1457 1458

	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1459

1460 1461
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_GET_FW_VERSION);
S
Sathya Perla 已提交
1462 1463 1464 1465

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_GET_FW_VERSION, sizeof(*req));

1466
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
1467 1468 1469 1470 1471
	if (!status) {
		struct be_cmd_resp_get_fw_version *resp = embedded_payload(wrb);
		strncpy(fw_ver, resp->firmware_version_string, FW_VER_LEN);
	}

1472
	mutex_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
1473 1474 1475
	return status;
}

1476 1477 1478
/* set the EQ delay interval of an EQ to specified value
 * Uses async mcc
 */
1479
int be_cmd_modify_eqd(struct be_adapter *adapter, u32 eq_id, u32 eqd)
S
Sathya Perla 已提交
1480
{
1481 1482
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_modify_eq_delay *req;
1483
	int status = 0;
S
Sathya Perla 已提交
1484

1485 1486 1487
	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
1488 1489 1490 1491
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1492
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1493

1494 1495
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_MODIFY_EQ_DELAY);
S
Sathya Perla 已提交
1496 1497 1498 1499 1500 1501 1502 1503 1504

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_MODIFY_EQ_DELAY, sizeof(*req));

	req->num_eq = cpu_to_le32(1);
	req->delay[0].eq_id = cpu_to_le32(eq_id);
	req->delay[0].phase = 0;
	req->delay[0].delay_multiplier = cpu_to_le32(eqd);

1505
	be_mcc_notify(adapter);
S
Sathya Perla 已提交
1506

1507
err:
1508
	spin_unlock_bh(&adapter->mcc_lock);
1509
	return status;
S
Sathya Perla 已提交
1510 1511
}

1512
/* Uses sycnhronous mcc */
1513
int be_cmd_vlan_config(struct be_adapter *adapter, u32 if_id, u16 *vtag_array,
S
Sathya Perla 已提交
1514 1515
			u32 num, bool untagged, bool promiscuous)
{
1516 1517
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_vlan_config *req;
S
Sathya Perla 已提交
1518 1519
	int status;

1520 1521 1522
	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
1523 1524 1525 1526
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1527
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1528

1529 1530
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_VLAN_CONFIG);
S
Sathya Perla 已提交
1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_NTWK_VLAN_CONFIG, sizeof(*req));

	req->interface_id = if_id;
	req->promiscuous = promiscuous;
	req->untagged = untagged;
	req->num_vlan = num;
	if (!promiscuous) {
		memcpy(req->normal_vlan, vtag_array,
			req->num_vlan * sizeof(vtag_array[0]));
	}

1544
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
1545

1546
err:
1547
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1548 1549 1550
	return status;
}

1551
int be_cmd_rx_filter(struct be_adapter *adapter, u32 flags, u32 value)
S
Sathya Perla 已提交
1552
{
1553
	struct be_mcc_wrb *wrb;
1554 1555
	struct be_dma_mem *mem = &adapter->rx_filter;
	struct be_cmd_req_rx_filter *req = mem->va;
1556 1557
	struct be_sge *sge;
	int status;
S
Sathya Perla 已提交
1558

1559
	spin_lock_bh(&adapter->mcc_lock);
1560

1561
	wrb = wrb_from_mccq(adapter);
1562 1563 1564 1565
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1566 1567 1568 1569
	sge = nonembedded_sgl(wrb);
	sge->pa_hi = cpu_to_le32(upper_32_bits(mem->dma));
	sge->pa_lo = cpu_to_le32(mem->dma & 0xFFFFFFFF);
	sge->len = cpu_to_le32(mem->size);
1570 1571
	be_wrb_hdr_prepare(wrb, sizeof(*req), false, 1,
				OPCODE_COMMON_NTWK_RX_FILTER);
S
Sathya Perla 已提交
1572

1573
	memset(req, 0, sizeof(*req));
S
Sathya Perla 已提交
1574
	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1575
				OPCODE_COMMON_NTWK_RX_FILTER, sizeof(*req));
S
Sathya Perla 已提交
1576

1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587
	req->if_id = cpu_to_le32(adapter->if_handle);
	if (flags & IFF_PROMISC) {
		req->if_flags_mask = cpu_to_le32(BE_IF_FLAGS_PROMISCUOUS |
					BE_IF_FLAGS_VLAN_PROMISCUOUS);
		if (value == ON)
			req->if_flags = cpu_to_le32(BE_IF_FLAGS_PROMISCUOUS |
					BE_IF_FLAGS_VLAN_PROMISCUOUS);
	} else if (flags & IFF_ALLMULTI) {
		req->if_flags_mask = req->if_flags =
			cpu_to_le32(BE_IF_FLAGS_MCAST_PROMISCUOUS);
	} else {
1588
		struct netdev_hw_addr *ha;
1589
		int i = 0;
1590

1591 1592 1593
		req->mcast_num = cpu_to_le16(netdev_mc_count(adapter->netdev));
		netdev_for_each_mc_addr(ha, adapter->netdev)
			memcpy(req->mcast_mac[i++].byte, ha->addr, ETH_ALEN);
S
Sathya Perla 已提交
1594 1595
	}

1596
	status = be_mcc_notify_wait(adapter);
1597
err:
1598
	spin_unlock_bh(&adapter->mcc_lock);
1599
	return status;
S
Sathya Perla 已提交
1600 1601
}

1602
/* Uses synchrounous mcc */
1603
int be_cmd_set_flow_control(struct be_adapter *adapter, u32 tx_fc, u32 rx_fc)
S
Sathya Perla 已提交
1604
{
1605 1606
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_set_flow_control *req;
S
Sathya Perla 已提交
1607 1608
	int status;

1609
	spin_lock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1610

1611
	wrb = wrb_from_mccq(adapter);
1612 1613 1614 1615
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1616
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1617

1618 1619
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_SET_FLOW_CONTROL);
S
Sathya Perla 已提交
1620 1621 1622 1623 1624 1625 1626

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_SET_FLOW_CONTROL, sizeof(*req));

	req->tx_flow_control = cpu_to_le16((u16)tx_fc);
	req->rx_flow_control = cpu_to_le16((u16)rx_fc);

1627
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
1628

1629
err:
1630
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1631 1632 1633
	return status;
}

1634
/* Uses sycn mcc */
1635
int be_cmd_get_flow_control(struct be_adapter *adapter, u32 *tx_fc, u32 *rx_fc)
S
Sathya Perla 已提交
1636
{
1637 1638
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_get_flow_control *req;
S
Sathya Perla 已提交
1639 1640
	int status;

1641
	spin_lock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1642

1643
	wrb = wrb_from_mccq(adapter);
1644 1645 1646 1647
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1648
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1649

1650 1651
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_GET_FLOW_CONTROL);
S
Sathya Perla 已提交
1652 1653 1654 1655

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_GET_FLOW_CONTROL, sizeof(*req));

1656
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
1657 1658 1659 1660 1661 1662 1663
	if (!status) {
		struct be_cmd_resp_get_flow_control *resp =
						embedded_payload(wrb);
		*tx_fc = le16_to_cpu(resp->tx_flow_control);
		*rx_fc = le16_to_cpu(resp->rx_flow_control);
	}

1664
err:
1665
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1666 1667 1668
	return status;
}

1669
/* Uses mbox */
1670 1671
int be_cmd_query_fw_cfg(struct be_adapter *adapter, u32 *port_num,
		u32 *mode, u32 *caps)
S
Sathya Perla 已提交
1672
{
1673 1674
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_query_fw_cfg *req;
S
Sathya Perla 已提交
1675 1676
	int status;

1677 1678
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
S
Sathya Perla 已提交
1679

1680 1681
	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1682

1683 1684
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_QUERY_FIRMWARE_CONFIG);
S
Sathya Perla 已提交
1685 1686 1687 1688

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_QUERY_FIRMWARE_CONFIG, sizeof(*req));

1689
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
1690 1691 1692
	if (!status) {
		struct be_cmd_resp_query_fw_cfg *resp = embedded_payload(wrb);
		*port_num = le32_to_cpu(resp->phys_port);
A
Ajit Khaparde 已提交
1693
		*mode = le32_to_cpu(resp->function_mode);
1694
		*caps = le32_to_cpu(resp->function_caps);
S
Sathya Perla 已提交
1695 1696
	}

1697
	mutex_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
1698 1699
	return status;
}
1700

1701
/* Uses mbox */
1702 1703
int be_cmd_reset_function(struct be_adapter *adapter)
{
1704 1705
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_hdr *req;
1706 1707
	int status;

1708 1709
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
1710

1711 1712
	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
1713

1714 1715
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_FUNCTION_RESET);
1716 1717 1718 1719

	be_cmd_hdr_prepare(req, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_FUNCTION_RESET, sizeof(*req));

1720
	status = be_mbox_notify_wait(adapter);
1721

1722
	mutex_unlock(&adapter->mbox_lock);
1723 1724
	return status;
}
1725

1726 1727 1728 1729
int be_cmd_rss_config(struct be_adapter *adapter, u8 *rsstable, u16 table_size)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_rss_config *req;
1730 1731
	u32 myhash[10] = {0x0123, 0x4567, 0x89AB, 0xCDEF, 0x01EF,
			0x0123, 0x4567, 0x89AB, 0xCDEF, 0x01EF};
1732 1733
	int status;

1734 1735
	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;
1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754

	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
		OPCODE_ETH_RSS_CONFIG);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,
		OPCODE_ETH_RSS_CONFIG, sizeof(*req));

	req->if_id = cpu_to_le32(adapter->if_handle);
	req->enable_rss = cpu_to_le16(RSS_ENABLE_TCP_IPV4 | RSS_ENABLE_IPV4);
	req->cpu_table_size_log2 = cpu_to_le16(fls(table_size) - 1);
	memcpy(req->cpu_table, rsstable, table_size);
	memcpy(req->hash, myhash, sizeof(myhash));
	be_dws_cpu_to_le(req->hash, sizeof(req->hash));

	status = be_mbox_notify_wait(adapter);

1755
	mutex_unlock(&adapter->mbox_lock);
1756 1757 1758
	return status;
}

1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769
/* Uses sync mcc */
int be_cmd_set_beacon_state(struct be_adapter *adapter, u8 port_num,
			u8 bcn, u8 sts, u8 state)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_enable_disable_beacon *req;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
1770 1771 1772 1773
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1774 1775
	req = embedded_payload(wrb);

1776 1777
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_ENABLE_DISABLE_BEACON);
1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_ENABLE_DISABLE_BEACON, sizeof(*req));

	req->port_num = port_num;
	req->beacon_state = state;
	req->beacon_duration = bcn;
	req->status_duration = sts;

	status = be_mcc_notify_wait(adapter);

1789
err:
1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}

/* Uses sync mcc */
int be_cmd_get_beacon_state(struct be_adapter *adapter, u8 port_num, u32 *state)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_get_beacon_state *req;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
1804 1805 1806 1807
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1808 1809
	req = embedded_payload(wrb);

1810 1811
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_GET_BEACON_STATE);
1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_GET_BEACON_STATE, sizeof(*req));

	req->port_num = port_num;

	status = be_mcc_notify_wait(adapter);
	if (!status) {
		struct be_cmd_resp_get_beacon_state *resp =
						embedded_payload(wrb);
		*state = resp->beacon_state;
	}

1825
err:
1826 1827 1828 1829
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}

1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904
int lancer_cmd_write_object(struct be_adapter *adapter, struct be_dma_mem *cmd,
			u32 data_size, u32 data_offset, const char *obj_name,
			u32 *data_written, u8 *addn_status)
{
	struct be_mcc_wrb *wrb;
	struct lancer_cmd_req_write_object *req;
	struct lancer_cmd_resp_write_object *resp;
	void *ctxt = NULL;
	int status;

	spin_lock_bh(&adapter->mcc_lock);
	adapter->flash_status = 0;

	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err_unlock;
	}

	req = embedded_payload(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(struct lancer_cmd_req_write_object),
			true, 1, OPCODE_COMMON_WRITE_OBJECT);
	wrb->tag1 = CMD_SUBSYSTEM_COMMON;

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
				OPCODE_COMMON_WRITE_OBJECT,
				sizeof(struct lancer_cmd_req_write_object));

	ctxt = &req->context;
	AMAP_SET_BITS(struct amap_lancer_write_obj_context,
			write_length, ctxt, data_size);

	if (data_size == 0)
		AMAP_SET_BITS(struct amap_lancer_write_obj_context,
				eof, ctxt, 1);
	else
		AMAP_SET_BITS(struct amap_lancer_write_obj_context,
				eof, ctxt, 0);

	be_dws_cpu_to_le(ctxt, sizeof(req->context));
	req->write_offset = cpu_to_le32(data_offset);
	strcpy(req->object_name, obj_name);
	req->descriptor_count = cpu_to_le32(1);
	req->buf_len = cpu_to_le32(data_size);
	req->addr_low = cpu_to_le32((cmd->dma +
				sizeof(struct lancer_cmd_req_write_object))
				& 0xFFFFFFFF);
	req->addr_high = cpu_to_le32(upper_32_bits(cmd->dma +
				sizeof(struct lancer_cmd_req_write_object)));

	be_mcc_notify(adapter);
	spin_unlock_bh(&adapter->mcc_lock);

	if (!wait_for_completion_timeout(&adapter->flash_compl,
			msecs_to_jiffies(12000)))
		status = -1;
	else
		status = adapter->flash_status;

	resp = embedded_payload(wrb);
	if (!status) {
		*data_written = le32_to_cpu(resp->actual_write_len);
	} else {
		*addn_status = resp->additional_status;
		status = resp->status;
	}

	return status;

err_unlock:
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}

1905 1906 1907
int be_cmd_write_flashrom(struct be_adapter *adapter, struct be_dma_mem *cmd,
			u32 flash_type, u32 flash_opcode, u32 buf_size)
{
1908
	struct be_mcc_wrb *wrb;
1909
	struct be_cmd_write_flashrom *req;
1910
	struct be_sge *sge;
1911 1912
	int status;

1913
	spin_lock_bh(&adapter->mcc_lock);
1914
	adapter->flash_status = 0;
1915 1916

	wrb = wrb_from_mccq(adapter);
1917 1918
	if (!wrb) {
		status = -EBUSY;
D
Dan Carpenter 已提交
1919
		goto err_unlock;
1920 1921
	}
	req = cmd->va;
1922 1923
	sge = nonembedded_sgl(wrb);

1924 1925
	be_wrb_hdr_prepare(wrb, cmd->size, false, 1,
			OPCODE_COMMON_WRITE_FLASHROM);
1926
	wrb->tag1 = CMD_SUBSYSTEM_COMMON;
1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_WRITE_FLASHROM, cmd->size);
	sge->pa_hi = cpu_to_le32(upper_32_bits(cmd->dma));
	sge->pa_lo = cpu_to_le32(cmd->dma & 0xFFFFFFFF);
	sge->len = cpu_to_le32(cmd->size);

	req->params.op_type = cpu_to_le32(flash_type);
	req->params.op_code = cpu_to_le32(flash_opcode);
	req->params.data_buf_size = cpu_to_le32(buf_size);

1938 1939 1940 1941 1942 1943 1944 1945
	be_mcc_notify(adapter);
	spin_unlock_bh(&adapter->mcc_lock);

	if (!wait_for_completion_timeout(&adapter->flash_compl,
			msecs_to_jiffies(12000)))
		status = -1;
	else
		status = adapter->flash_status;
1946

D
Dan Carpenter 已提交
1947 1948 1949 1950
	return status;

err_unlock:
	spin_unlock_bh(&adapter->mcc_lock);
1951 1952
	return status;
}
1953

1954 1955
int be_cmd_get_flash_crc(struct be_adapter *adapter, u8 *flashed_crc,
			 int offset)
1956 1957 1958 1959 1960 1961 1962 1963
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_write_flashrom *req;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
1964 1965 1966 1967
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1968 1969
	req = embedded_payload(wrb);

1970 1971
	be_wrb_hdr_prepare(wrb, sizeof(*req)+4, true, 0,
			OPCODE_COMMON_READ_FLASHROM);
1972 1973 1974 1975

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_READ_FLASHROM, sizeof(*req)+4);

1976
	req->params.op_type = cpu_to_le32(IMG_TYPE_REDBOOT);
1977
	req->params.op_code = cpu_to_le32(FLASHROM_OPER_REPORT);
1978 1979
	req->params.offset = cpu_to_le32(offset);
	req->params.data_buf_size = cpu_to_le32(0x4);
1980 1981 1982 1983 1984

	status = be_mcc_notify_wait(adapter);
	if (!status)
		memcpy(flashed_crc, req->params.data_buf, 4);

1985
err:
1986 1987 1988
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}
1989

1990
int be_cmd_enable_magic_wol(struct be_adapter *adapter, u8 *mac,
1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024
				struct be_dma_mem *nonemb_cmd)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_acpi_wol_magic_config *req;
	struct be_sge *sge;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
	req = nonemb_cmd->va;
	sge = nonembedded_sgl(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(*req), false, 1,
			OPCODE_ETH_ACPI_WOL_MAGIC_CONFIG);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,
		OPCODE_ETH_ACPI_WOL_MAGIC_CONFIG, sizeof(*req));
	memcpy(req->magic_mac, mac, ETH_ALEN);

	sge->pa_hi = cpu_to_le32(upper_32_bits(nonemb_cmd->dma));
	sge->pa_lo = cpu_to_le32(nonemb_cmd->dma & 0xFFFFFFFF);
	sge->len = cpu_to_le32(nonemb_cmd->size);

	status = be_mcc_notify_wait(adapter);

err:
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}
2025

2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060
int be_cmd_set_loopback(struct be_adapter *adapter, u8 port_num,
			u8 loopback_type, u8 enable)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_set_lmode *req;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}

	req = embedded_payload(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
				OPCODE_LOWLEVEL_SET_LOOPBACK_MODE);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_LOWLEVEL,
			OPCODE_LOWLEVEL_SET_LOOPBACK_MODE,
			sizeof(*req));

	req->src_port = port_num;
	req->dest_port = port_num;
	req->loopback_type = loopback_type;
	req->loopback_state = enable;

	status = be_mcc_notify_wait(adapter);
err:
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}

2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082
int be_cmd_loopback_test(struct be_adapter *adapter, u32 port_num,
		u32 loopback_type, u32 pkt_size, u32 num_pkts, u64 pattern)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_loopback_test *req;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}

	req = embedded_payload(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
				OPCODE_LOWLEVEL_LOOPBACK_TEST);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_LOWLEVEL,
			OPCODE_LOWLEVEL_LOOPBACK_TEST, sizeof(*req));
2083
	req->hdr.timeout = cpu_to_le32(4);
2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153

	req->pattern = cpu_to_le64(pattern);
	req->src_port = cpu_to_le32(port_num);
	req->dest_port = cpu_to_le32(port_num);
	req->pkt_size = cpu_to_le32(pkt_size);
	req->num_pkts = cpu_to_le32(num_pkts);
	req->loopback_type = cpu_to_le32(loopback_type);

	status = be_mcc_notify_wait(adapter);
	if (!status) {
		struct be_cmd_resp_loopback_test *resp = embedded_payload(wrb);
		status = le32_to_cpu(resp->status);
	}

err:
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}

int be_cmd_ddr_dma_test(struct be_adapter *adapter, u64 pattern,
				u32 byte_cnt, struct be_dma_mem *cmd)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_ddrdma_test *req;
	struct be_sge *sge;
	int status;
	int i, j = 0;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
	req = cmd->va;
	sge = nonembedded_sgl(wrb);
	be_wrb_hdr_prepare(wrb, cmd->size, false, 1,
				OPCODE_LOWLEVEL_HOST_DDR_DMA);
	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_LOWLEVEL,
			OPCODE_LOWLEVEL_HOST_DDR_DMA, cmd->size);

	sge->pa_hi = cpu_to_le32(upper_32_bits(cmd->dma));
	sge->pa_lo = cpu_to_le32(cmd->dma & 0xFFFFFFFF);
	sge->len = cpu_to_le32(cmd->size);

	req->pattern = cpu_to_le64(pattern);
	req->byte_count = cpu_to_le32(byte_cnt);
	for (i = 0; i < byte_cnt; i++) {
		req->snd_buff[i] = (u8)(pattern >> (j*8));
		j++;
		if (j > 7)
			j = 0;
	}

	status = be_mcc_notify_wait(adapter);

	if (!status) {
		struct be_cmd_resp_ddrdma_test *resp;
		resp = cmd->va;
		if ((memcmp(resp->rcv_buff, req->snd_buff, byte_cnt) != 0) ||
				resp->snd_err) {
			status = -1;
		}
	}

err:
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}
2154

2155
int be_cmd_get_seeprom_data(struct be_adapter *adapter,
2156 2157 2158 2159 2160 2161 2162 2163 2164 2165
				struct be_dma_mem *nonemb_cmd)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_seeprom_read *req;
	struct be_sge *sge;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
2166 2167 2168 2169
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182 2183 2184
	req = nonemb_cmd->va;
	sge = nonembedded_sgl(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(*req), false, 1,
			OPCODE_COMMON_SEEPROM_READ);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
			OPCODE_COMMON_SEEPROM_READ, sizeof(*req));

	sge->pa_hi = cpu_to_le32(upper_32_bits(nonemb_cmd->dma));
	sge->pa_lo = cpu_to_le32(nonemb_cmd->dma & 0xFFFFFFFF);
	sge->len = cpu_to_le32(nonemb_cmd->size);

	status = be_mcc_notify_wait(adapter);

2185
err:
2186 2187 2188
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}
2189

2190 2191
int be_cmd_get_phy_info(struct be_adapter *adapter,
				struct be_phy_info *phy_info)
2192 2193 2194 2195
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_get_phy_info *req;
	struct be_sge *sge;
2196
	struct be_dma_mem cmd;
2197 2198 2199 2200 2201 2202 2203 2204 2205
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
2206 2207 2208 2209 2210 2211 2212 2213
	cmd.size = sizeof(struct be_cmd_req_get_phy_info);
	cmd.va = pci_alloc_consistent(adapter->pdev, cmd.size,
					&cmd.dma);
	if (!cmd.va) {
		dev_err(&adapter->pdev->dev, "Memory alloc failure\n");
		status = -ENOMEM;
		goto err;
	}
2214

2215
	req = cmd.va;
2216 2217 2218 2219 2220 2221 2222 2223 2224
	sge = nonembedded_sgl(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(*req), false, 1,
				OPCODE_COMMON_GET_PHY_DETAILS);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
			OPCODE_COMMON_GET_PHY_DETAILS,
			sizeof(*req));

2225 2226 2227
	sge->pa_hi = cpu_to_le32(upper_32_bits(cmd.dma));
	sge->pa_lo = cpu_to_le32(cmd.dma & 0xFFFFFFFF);
	sge->len = cpu_to_le32(cmd.size);
2228 2229

	status = be_mcc_notify_wait(adapter);
2230 2231 2232 2233 2234 2235 2236 2237 2238
	if (!status) {
		struct be_phy_info *resp_phy_info =
				cmd.va + sizeof(struct be_cmd_req_hdr);
		phy_info->phy_type = le16_to_cpu(resp_phy_info->phy_type);
		phy_info->interface_type =
			le16_to_cpu(resp_phy_info->interface_type);
	}
	pci_free_consistent(adapter->pdev, cmd.size,
				cmd.va, cmd.dma);
2239 2240 2241 2242
err:
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}
2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266

int be_cmd_set_qos(struct be_adapter *adapter, u32 bps, u32 domain)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_set_qos *req;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}

	req = embedded_payload(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
				OPCODE_COMMON_SET_QOS);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
			OPCODE_COMMON_SET_QOS, sizeof(*req));

	req->hdr.domain = domain;
2267 2268
	req->valid_bits = cpu_to_le32(BE_QOS_BITS_NIC);
	req->max_bps_nic = cpu_to_le32(bps);
2269 2270 2271 2272 2273 2274 2275

	status = be_mcc_notify_wait(adapter);

err:
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}
2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318

int be_cmd_get_cntl_attributes(struct be_adapter *adapter)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_cntl_attribs *req;
	struct be_cmd_resp_cntl_attribs *resp;
	struct be_sge *sge;
	int status;
	int payload_len = max(sizeof(*req), sizeof(*resp));
	struct mgmt_controller_attrib *attribs;
	struct be_dma_mem attribs_cmd;

	memset(&attribs_cmd, 0, sizeof(struct be_dma_mem));
	attribs_cmd.size = sizeof(struct be_cmd_resp_cntl_attribs);
	attribs_cmd.va = pci_alloc_consistent(adapter->pdev, attribs_cmd.size,
						&attribs_cmd.dma);
	if (!attribs_cmd.va) {
		dev_err(&adapter->pdev->dev,
				"Memory allocation failure\n");
		return -ENOMEM;
	}

	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;

	wrb = wrb_from_mbox(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
	req = attribs_cmd.va;
	sge = nonembedded_sgl(wrb);

	be_wrb_hdr_prepare(wrb, payload_len, false, 1,
			OPCODE_COMMON_GET_CNTL_ATTRIBUTES);
	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
			 OPCODE_COMMON_GET_CNTL_ATTRIBUTES, payload_len);
	sge->pa_hi = cpu_to_le32(upper_32_bits(attribs_cmd.dma));
	sge->pa_lo = cpu_to_le32(attribs_cmd.dma & 0xFFFFFFFF);
	sge->len = cpu_to_le32(attribs_cmd.size);

	status = be_mbox_notify_wait(adapter);
	if (!status) {
2319
		attribs = attribs_cmd.va + sizeof(struct be_cmd_resp_hdr);
2320 2321 2322 2323 2324 2325 2326 2327 2328
		adapter->hba_port_num = attribs->hba_attribs.phy_port;
	}

err:
	mutex_unlock(&adapter->mbox_lock);
	pci_free_consistent(adapter->pdev, attribs_cmd.size, attribs_cmd.va,
					attribs_cmd.dma);
	return status;
}
2329 2330

/* Uses mbox */
2331
int be_cmd_req_native_mode(struct be_adapter *adapter)
2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_set_func_cap *req;
	int status;

	if (mutex_lock_interruptible(&adapter->mbox_lock))
		return -1;

	wrb = wrb_from_mbox(adapter);
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}

	req = embedded_payload(wrb);

	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
		OPCODE_COMMON_SET_DRIVER_FUNCTION_CAP);

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
		OPCODE_COMMON_SET_DRIVER_FUNCTION_CAP, sizeof(*req));

	req->valid_cap_flags = cpu_to_le32(CAPABILITY_SW_TIMESTAMPS |
				CAPABILITY_BE3_NATIVE_ERX_API);
	req->cap_flags = cpu_to_le32(CAPABILITY_BE3_NATIVE_ERX_API);

	status = be_mbox_notify_wait(adapter);
	if (!status) {
		struct be_cmd_resp_set_func_cap *resp = embedded_payload(wrb);
		adapter->be3_native = le32_to_cpu(resp->cap_flags) &
					CAPABILITY_BE3_NATIVE_ERX_API;
	}
err:
	mutex_unlock(&adapter->mbox_lock);
	return status;
}