be_cmds.c 44.7 KB
Newer Older
S
Sathya Perla 已提交
1
/*
A
Ajit Khaparde 已提交
2
 * Copyright (C) 2005 - 2010 ServerEngines
S
Sathya Perla 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18
 * 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:
 * linux-drivers@serverengines.com
 *
 * ServerEngines
 * 209 N. Fair Oaks Ave
 * Sunnyvale, CA 94085
 */

#include "be.h"
19
#include "be_cmds.h"
S
Sathya Perla 已提交
20

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

	val |= mccq->id & DB_MCCQ_RING_ID_MASK;
	val |= 1 << DB_MCCQ_NUM_POSTED_SHIFT;
28 29

	wmb();
30
	iowrite32(val, adapter->db + DB_MCCQ_OFFSET);
31 32 33 34 35
}

/* 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) */
36
static inline bool be_mcc_compl_is_new(struct be_mcc_compl *compl)
37 38 39 40 41 42 43 44 45 46 47
{
	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 */
48
static inline void be_mcc_compl_use(struct be_mcc_compl *compl)
49 50 51 52
{
	compl->flags = 0;
}

53
static int be_mcc_compl_process(struct be_adapter *adapter,
54
	struct be_mcc_compl *compl)
55 56 57 58 59 60 61 62 63
{
	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;
64 65 66 67 68 69 70

	if ((compl->tag0 == OPCODE_COMMON_WRITE_FLASHROM) &&
		(compl->tag1 == CMD_SUBSYSTEM_COMMON)) {
		adapter->flash_status = compl_status;
		complete(&adapter->flash_compl);
	}

71 72 73
	if (compl_status == MCC_STATUS_SUCCESS) {
		if (compl->tag0 == OPCODE_ETH_GET_STATISTICS) {
			struct be_cmd_resp_get_stats *resp =
74
						adapter->stats_cmd.va;
75 76 77
			be_dws_le_to_cpu(&resp->hw_stats,
						sizeof(resp->hw_stats));
			netdev_stats_update(adapter);
78
			adapter->stats_ioctl_sent = false;
79
		}
80 81
	} else if ((compl_status != MCC_STATUS_NOT_SUPPORTED) &&
		   (compl->tag0 != OPCODE_COMMON_NTWK_MAC_QUERY)) {
82 83
		extd_status = (compl->status >> CQE_STATUS_EXTD_SHIFT) &
				CQE_STATUS_EXTD_MASK;
84
		dev_warn(&adapter->pdev->dev,
85 86
		"Error in cmd completion - opcode %d, compl %d, extd %d\n",
			compl->tag0, compl_status, extd_status);
87
	}
88
	return compl_status;
89 90
}

91
/* Link state evt is a string of bytes; no need for endian swapping */
92
static void be_async_link_state_process(struct be_adapter *adapter,
93 94
		struct be_async_event_link_state *evt)
{
95 96
	be_link_status_update(adapter,
		evt->port_link_status == ASYNC_EVENT_LINK_UP);
97 98
}

99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142
/* 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;
		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;
	}
}

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;
	default:
		dev_warn(&adapter->pdev->dev, "Unknown grp5 event!\n");
		break;
	}
}

143 144
static inline bool is_link_state_evt(u32 trailer)
{
145
	return ((trailer >> ASYNC_TRAILER_EVENT_CODE_SHIFT) &
146
		ASYNC_TRAILER_EVENT_CODE_MASK) ==
147
				ASYNC_EVENT_CODE_LINK_STATE;
148
}
149

150 151 152 153 154 155 156
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);
}

157
static struct be_mcc_compl *be_mcc_compl_get(struct be_adapter *adapter)
158
{
159
	struct be_queue_info *mcc_cq = &adapter->mcc_obj.cq;
160
	struct be_mcc_compl *compl = queue_tail_node(mcc_cq);
161 162 163 164 165 166 167 168

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

169 170 171 172 173 174 175 176 177 178 179 180 181 182 183
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 已提交
184
int be_process_mcc(struct be_adapter *adapter, int *status)
185
{
186
	struct be_mcc_compl *compl;
S
Sathya Perla 已提交
187
	int num = 0;
188
	struct be_mcc_obj *mcc_obj = &adapter->mcc_obj;
189

190 191
	spin_lock_bh(&adapter->mcc_cq_lock);
	while ((compl = be_mcc_compl_get(adapter))) {
192 193
		if (compl->flags & CQE_FLAGS_ASYNC_MASK) {
			/* Interpret flags as an async trailer */
194 195
			if (is_link_state_evt(compl->flags))
				be_async_link_state_process(adapter,
196
				(struct be_async_event_link_state *) compl);
197 198 199
			else if (is_grp5_evt(compl->flags))
				be_async_grp5_evt_process(adapter,
				compl->flags, compl);
200
		} else if (compl->flags & CQE_FLAGS_COMPLETED_MASK) {
S
Sathya Perla 已提交
201
				*status = be_mcc_compl_process(adapter, compl);
202
				atomic_dec(&mcc_obj->q.used);
203 204 205 206
		}
		be_mcc_compl_use(compl);
		num++;
	}
207

208
	spin_unlock_bh(&adapter->mcc_cq_lock);
S
Sathya Perla 已提交
209
	return num;
210 211
}

212
/* Wait till no more pending mcc requests are present */
213
static int be_mcc_wait_compl(struct be_adapter *adapter)
214
{
215
#define mcc_timeout		120000 /* 12s timeout */
S
Sathya Perla 已提交
216 217 218
	int i, num, status = 0;
	struct be_mcc_obj *mcc_obj = &adapter->mcc_obj;

219
	for (i = 0; i < mcc_timeout; i++) {
S
Sathya Perla 已提交
220 221 222 223
		num = be_process_mcc(adapter, &status);
		if (num)
			be_cq_notify(adapter, mcc_obj->cq.id,
				mcc_obj->rearm_cq, num);
224

S
Sathya Perla 已提交
225
		if (atomic_read(&mcc_obj->q.used) == 0)
226 227 228
			break;
		udelay(100);
	}
229
	if (i == mcc_timeout) {
230
		dev_err(&adapter->pdev->dev, "mccq poll timed out\n");
231 232
		return -1;
	}
S
Sathya Perla 已提交
233
	return status;
234 235 236
}

/* Notify MCC requests and wait for completion */
237
static int be_mcc_notify_wait(struct be_adapter *adapter)
238
{
239
	be_mcc_notify(adapter);
240
	return be_mcc_wait_compl(adapter);
241 242
}

243
static int be_mbox_db_ready_wait(struct be_adapter *adapter, void __iomem *db)
S
Sathya Perla 已提交
244
{
245
	int msecs = 0;
S
Sathya Perla 已提交
246 247 248
	u32 ready;

	do {
249 250 251 252 253 254 255 256
		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 已提交
257 258 259
		if (ready)
			break;

260
		if (msecs > 4000) {
261
			dev_err(&adapter->pdev->dev, "mbox poll timed out\n");
262
			be_detect_dump_ue(adapter);
S
Sathya Perla 已提交
263 264 265
			return -1;
		}

266 267 268
		set_current_state(TASK_INTERRUPTIBLE);
		schedule_timeout(msecs_to_jiffies(1));
		msecs++;
S
Sathya Perla 已提交
269 270 271 272 273 274 275
	} while (true);

	return 0;
}

/*
 * Insert the mailbox address into the doorbell in two steps
276
 * Polls on the mbox doorbell till a command completion (or a timeout) occurs
S
Sathya Perla 已提交
277
 */
278
static int be_mbox_notify_wait(struct be_adapter *adapter)
S
Sathya Perla 已提交
279 280 281
{
	int status;
	u32 val = 0;
282 283
	void __iomem *db = adapter->db + MPU_MAILBOX_DB_OFFSET;
	struct be_dma_mem *mbox_mem = &adapter->mbox_mem;
S
Sathya Perla 已提交
284
	struct be_mcc_mailbox *mbox = mbox_mem->va;
285
	struct be_mcc_compl *compl = &mbox->compl;
S
Sathya Perla 已提交
286

287 288 289 290 291
	/* wait for ready to be set */
	status = be_mbox_db_ready_wait(adapter, db);
	if (status != 0)
		return status;

S
Sathya Perla 已提交
292 293 294 295 296 297
	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 */
298
	status = be_mbox_db_ready_wait(adapter, db);
S
Sathya Perla 已提交
299 300 301 302 303 304 305 306
	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);

307
	status = be_mbox_db_ready_wait(adapter, db);
S
Sathya Perla 已提交
308 309 310
	if (status != 0)
		return status;

311
	/* A cq entry has been made now */
312 313 314
	if (be_mcc_compl_is_new(compl)) {
		status = be_mcc_compl_process(adapter, &mbox->compl);
		be_mcc_compl_use(compl);
315 316 317
		if (status)
			return status;
	} else {
318
		dev_err(&adapter->pdev->dev, "invalid mailbox completion\n");
S
Sathya Perla 已提交
319 320
		return -1;
	}
321
	return 0;
S
Sathya Perla 已提交
322 323
}

324
static int be_POST_stage_get(struct be_adapter *adapter, u16 *stage)
S
Sathya Perla 已提交
325
{
326 327 328 329 330 331
	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 已提交
332 333 334 335 336 337 338 339

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

340
int be_cmd_POST(struct be_adapter *adapter)
S
Sathya Perla 已提交
341
{
342 343
	u16 stage;
	int status, timeout = 0;
S
Sathya Perla 已提交
344

345 346 347 348 349 350 351 352 353 354 355 356 357
	do {
		status = be_POST_stage_get(adapter, &stage);
		if (status) {
			dev_err(&adapter->pdev->dev, "POST error; stage=0x%x\n",
				stage);
			return -1;
		} else if (stage != POST_STAGE_ARMFW_RDY) {
			set_current_state(TASK_INTERRUPTIBLE);
			schedule_timeout(2 * HZ);
			timeout += 2;
		} else {
			return 0;
		}
358
	} while (timeout < 40);
S
Sathya Perla 已提交
359

360 361
	dev_err(&adapter->pdev->dev, "POST timeout; stage=0x%x\n", stage);
	return -1;
S
Sathya Perla 已提交
362 363 364 365 366 367 368 369 370 371 372 373 374 375
}

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,
376
				bool embedded, u8 sge_cnt, u32 opcode)
S
Sathya Perla 已提交
377 378 379 380 381 382 383
{
	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;
384
	wrb->tag0 = opcode;
385
	be_dws_cpu_to_le(wrb, 8);
S
Sathya Perla 已提交
386 387 388 389 390 391 392 393 394
}

/* 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));
395
	req_hdr->version = 0;
S
Sathya Perla 已提交
396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435
}

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

436
static inline struct be_mcc_wrb *wrb_from_mbox(struct be_adapter *adapter)
S
Sathya Perla 已提交
437
{
438 439 440 441 442
	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 已提交
443 444
}

445
static struct be_mcc_wrb *wrb_from_mccq(struct be_adapter *adapter)
446
{
447 448 449
	struct be_queue_info *mccq = &adapter->mcc_obj.q;
	struct be_mcc_wrb *wrb;

450 451 452 453 454
	if (atomic_read(&mccq->used) >= mccq->len) {
		dev_err(&adapter->pdev->dev, "Out of MCCQ wrbs\n");
		return NULL;
	}

455 456 457 458
	wrb = queue_head_node(mccq);
	queue_head_inc(mccq);
	atomic_inc(&mccq->used);
	memset(wrb, 0, sizeof(*wrb));
459 460 461
	return wrb;
}

462 463 464 465 466 467 468 469 470 471 472
/* 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;

	spin_lock(&adapter->mbox_lock);

	wrb = (u8 *)wrb_from_mbox(adapter);
473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491
	if (lancer_chip(adapter)) {
		*wrb++ = 0xFF;
		*wrb++ = 0x34;
		*wrb++ = 0x12;
		*wrb++ = 0xFF;
		*wrb++ = 0xFF;
		*wrb++ = 0x78;
		*wrb++ = 0x56;
		*wrb = 0xFF;
	} else {
		*wrb++ = 0xFF;
		*wrb++ = 0x12;
		*wrb++ = 0x34;
		*wrb++ = 0xFF;
		*wrb++ = 0xFF;
		*wrb++ = 0x56;
		*wrb++ = 0x78;
		*wrb = 0xFF;
	}
492 493 494 495 496 497 498 499 500 501 502 503 504 505 506

	status = be_mbox_notify_wait(adapter);

	spin_unlock(&adapter->mbox_lock);
	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;

507 508 509
	if (adapter->eeh_err)
		return -EIO;

510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526
	spin_lock(&adapter->mbox_lock);

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

	spin_unlock(&adapter->mbox_lock);
	return status;
}
527
int be_cmd_eq_create(struct be_adapter *adapter,
S
Sathya Perla 已提交
528 529
		struct be_queue_info *eq, int eq_delay)
{
530 531
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_eq_create *req;
S
Sathya Perla 已提交
532 533 534
	struct be_dma_mem *q_mem = &eq->dma_mem;
	int status;

535
	spin_lock(&adapter->mbox_lock);
536 537 538

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

540
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, OPCODE_COMMON_EQ_CREATE);
S
Sathya Perla 已提交
541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557

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

558
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
559
	if (!status) {
560
		struct be_cmd_resp_eq_create *resp = embedded_payload(wrb);
S
Sathya Perla 已提交
561 562 563
		eq->id = le16_to_cpu(resp->eq_id);
		eq->created = true;
	}
564

565
	spin_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
566 567 568
	return status;
}

569
/* Uses mbox */
570
int be_cmd_mac_addr_query(struct be_adapter *adapter, u8 *mac_addr,
S
Sathya Perla 已提交
571 572
			u8 type, bool permanent, u32 if_handle)
{
573 574
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_mac_query *req;
S
Sathya Perla 已提交
575 576
	int status;

577
	spin_lock(&adapter->mbox_lock);
578 579 580

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

582 583
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_MAC_QUERY);
S
Sathya Perla 已提交
584 585 586 587 588 589 590 591

	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 {
592
		req->if_id = cpu_to_le16((u16) if_handle);
S
Sathya Perla 已提交
593 594 595
		req->permanent = 0;
	}

596 597 598
	status = be_mbox_notify_wait(adapter);
	if (!status) {
		struct be_cmd_resp_mac_query *resp = embedded_payload(wrb);
S
Sathya Perla 已提交
599
		memcpy(mac_addr, resp->mac.addr, ETH_ALEN);
600
	}
S
Sathya Perla 已提交
601

602
	spin_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
603 604 605
	return status;
}

606
/* Uses synchronous MCCQ */
607
int be_cmd_pmac_add(struct be_adapter *adapter, u8 *mac_addr,
S
Sathya Perla 已提交
608 609
		u32 if_id, u32 *pmac_id)
{
610 611
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_pmac_add *req;
S
Sathya Perla 已提交
612 613
	int status;

614 615 616
	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
617 618 619 620
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
621
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
622

623 624
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_PMAC_ADD);
S
Sathya Perla 已提交
625 626 627 628 629 630 631

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

	req->if_id = cpu_to_le32(if_id);
	memcpy(req->mac_address, mac_addr, ETH_ALEN);

632
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
633 634 635 636 637
	if (!status) {
		struct be_cmd_resp_pmac_add *resp = embedded_payload(wrb);
		*pmac_id = le32_to_cpu(resp->pmac_id);
	}

638
err:
639
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
640 641 642
	return status;
}

643
/* Uses synchronous MCCQ */
644
int be_cmd_pmac_del(struct be_adapter *adapter, u32 if_id, u32 pmac_id)
S
Sathya Perla 已提交
645
{
646 647
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_pmac_del *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_DEL);
S
Sathya Perla 已提交
661 662 663 664 665 666 667

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

	req->if_id = cpu_to_le32(if_id);
	req->pmac_id = cpu_to_le32(pmac_id);

668 669
	status = be_mcc_notify_wait(adapter);

670
err:
671
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
672 673 674
	return status;
}

675
/* Uses Mbox */
676
int be_cmd_cq_create(struct be_adapter *adapter,
S
Sathya Perla 已提交
677 678 679
		struct be_queue_info *cq, struct be_queue_info *eq,
		bool sol_evts, bool no_delay, int coalesce_wm)
{
680 681
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_cq_create *req;
S
Sathya Perla 已提交
682
	struct be_dma_mem *q_mem = &cq->dma_mem;
683
	void *ctxt;
S
Sathya Perla 已提交
684 685
	int status;

686
	spin_lock(&adapter->mbox_lock);
687 688 689 690

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

692 693
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_CQ_CREATE);
S
Sathya Perla 已提交
694 695 696 697 698

	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));
699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727
	if (lancer_chip(adapter)) {
		req->hdr.version = 1;
		req->page_size = 1; /* 1 for 4K */
		AMAP_SET_BITS(struct amap_cq_context_lancer, coalescwm, ctxt,
								coalesce_wm);
		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 已提交
728 729 730 731 732

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

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

733
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
734
	if (!status) {
735
		struct be_cmd_resp_cq_create *resp = embedded_payload(wrb);
S
Sathya Perla 已提交
736 737 738
		cq->id = le16_to_cpu(resp->cq_id);
		cq->created = true;
	}
739

740
	spin_unlock(&adapter->mbox_lock);
741 742 743 744 745 746 747 748 749 750 751 752

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

753
int be_cmd_mccq_create(struct be_adapter *adapter,
754 755 756
			struct be_queue_info *mccq,
			struct be_queue_info *cq)
{
757 758
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_mcc_create *req;
759
	struct be_dma_mem *q_mem = &mccq->dma_mem;
760
	void *ctxt;
761 762
	int status;

763
	spin_lock(&adapter->mbox_lock);
764 765 766 767

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

769
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
770
			OPCODE_COMMON_MCC_CREATE_EXT);
771 772

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
773
			OPCODE_COMMON_MCC_CREATE_EXT, sizeof(*req));
774

775
	req->num_pages = cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size));
776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793
	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);
	}
794

795
	/* Subscribe to Link State and Group 5 Events(bits 1 and 5 set) */
796
	req->async_event_bitmap[0] = cpu_to_le32(0x00000022);
797 798 799 800
	be_dws_cpu_to_le(ctxt, sizeof(req->context));

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

801
	status = be_mbox_notify_wait(adapter);
802 803 804 805 806
	if (!status) {
		struct be_cmd_resp_mcc_create *resp = embedded_payload(wrb);
		mccq->id = le16_to_cpu(resp->id);
		mccq->created = true;
	}
807
	spin_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
808 809 810 811

	return status;
}

812
int be_cmd_txq_create(struct be_adapter *adapter,
S
Sathya Perla 已提交
813 814 815
			struct be_queue_info *txq,
			struct be_queue_info *cq)
{
816 817
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_eth_tx_create *req;
S
Sathya Perla 已提交
818
	struct be_dma_mem *q_mem = &txq->dma_mem;
819
	void *ctxt;
S
Sathya Perla 已提交
820 821
	int status;

822
	spin_lock(&adapter->mbox_lock);
823 824 825 826

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

828 829
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_ETH_TX_CREATE);
S
Sathya Perla 已提交
830 831 832 833 834 835 836 837

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

	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;

838 839
	AMAP_SET_BITS(struct amap_tx_context, tx_ring_size, ctxt,
		be_encoded_q_len(txq->len));
S
Sathya Perla 已提交
840 841 842 843 844 845 846
	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);

847
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
848 849 850 851 852
	if (!status) {
		struct be_cmd_resp_eth_tx_create *resp = embedded_payload(wrb);
		txq->id = le16_to_cpu(resp->cid);
		txq->created = true;
	}
853

854
	spin_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
855 856 857 858

	return status;
}

859
/* Uses mbox */
860
int be_cmd_rxq_create(struct be_adapter *adapter,
S
Sathya Perla 已提交
861
		struct be_queue_info *rxq, u16 cq_id, u16 frag_size,
862
		u16 max_frame_size, u32 if_id, u32 rss, u8 *rss_id)
S
Sathya Perla 已提交
863
{
864 865
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_eth_rx_create *req;
S
Sathya Perla 已提交
866 867 868
	struct be_dma_mem *q_mem = &rxq->dma_mem;
	int status;

869
	spin_lock(&adapter->mbox_lock);
870 871 872

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

874 875
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_ETH_RX_CREATE);
S
Sathya Perla 已提交
876 877 878 879 880 881 882 883 884 885 886 887

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

888
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
889 890 891 892
	if (!status) {
		struct be_cmd_resp_eth_rx_create *resp = embedded_payload(wrb);
		rxq->id = le16_to_cpu(resp->id);
		rxq->created = true;
893
		*rss_id = resp->rss_id;
S
Sathya Perla 已提交
894
	}
895

896
	spin_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
897 898 899 900

	return status;
}

901 902 903
/* Generic destroyer function for all types of queues
 * Uses Mbox
 */
904
int be_cmd_q_destroy(struct be_adapter *adapter, struct be_queue_info *q,
S
Sathya Perla 已提交
905 906
		int queue_type)
{
907 908
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_q_destroy *req;
S
Sathya Perla 已提交
909 910 911
	u8 subsys = 0, opcode = 0;
	int status;

912 913 914
	if (adapter->eeh_err)
		return -EIO;

915
	spin_lock(&adapter->mbox_lock);
S
Sathya Perla 已提交
916

917 918 919
	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);

S
Sathya Perla 已提交
920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936
	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;
937 938 939 940
	case QTYPE_MCCQ:
		subsys = CMD_SUBSYSTEM_COMMON;
		opcode = OPCODE_COMMON_MCC_DESTROY;
		break;
S
Sathya Perla 已提交
941
	default:
942
		BUG();
S
Sathya Perla 已提交
943
	}
944 945 946

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

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

950
	status = be_mbox_notify_wait(adapter);
951

952
	spin_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
953 954 955 956

	return status;
}

957 958 959
/* Create an rx filtering policy configuration on an i/f
 * Uses mbox
 */
960
int be_cmd_if_create(struct be_adapter *adapter, u32 cap_flags, u32 en_flags,
961 962
		u8 *mac, bool pmac_invalid, u32 *if_handle, u32 *pmac_id,
		u32 domain)
S
Sathya Perla 已提交
963
{
964 965
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_if_create *req;
S
Sathya Perla 已提交
966 967
	int status;

968
	spin_lock(&adapter->mbox_lock);
969 970 971

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

973 974
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_INTERFACE_CREATE);
S
Sathya Perla 已提交
975 976 977 978

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

979
	req->hdr.domain = domain;
980 981
	req->capability_flags = cpu_to_le32(cap_flags);
	req->enable_flags = cpu_to_le32(en_flags);
982
	req->pmac_invalid = pmac_invalid;
S
Sathya Perla 已提交
983 984 985
	if (!pmac_invalid)
		memcpy(req->mac_addr, mac, ETH_ALEN);

986
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
987 988 989 990 991 992 993
	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);
	}

994
	spin_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
995 996 997
	return status;
}

998
/* Uses mbox */
999
int be_cmd_if_destroy(struct be_adapter *adapter, u32 interface_id)
S
Sathya Perla 已提交
1000
{
1001 1002
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_if_destroy *req;
S
Sathya Perla 已提交
1003 1004
	int status;

1005 1006 1007
	if (adapter->eeh_err)
		return -EIO;

1008
	spin_lock(&adapter->mbox_lock);
1009 1010 1011

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

1013 1014
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_INTERFACE_DESTROY);
S
Sathya Perla 已提交
1015 1016 1017 1018 1019

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

	req->interface_id = cpu_to_le32(interface_id);
1020 1021

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

1023
	spin_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
1024 1025 1026 1027 1028 1029

	return status;
}

/* Get stats is a non embedded command: the request is not embedded inside
 * WRB but is a separate dma memory block
1030
 * Uses asynchronous MCC
S
Sathya Perla 已提交
1031
 */
1032
int be_cmd_get_stats(struct be_adapter *adapter, struct be_dma_mem *nonemb_cmd)
S
Sathya Perla 已提交
1033
{
1034 1035 1036
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_get_stats *req;
	struct be_sge *sge;
1037
	int status = 0;
S
Sathya Perla 已提交
1038

1039
	spin_lock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1040

1041
	wrb = wrb_from_mccq(adapter);
1042 1043 1044 1045
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1046 1047
	req = nonemb_cmd->va;
	sge = nonembedded_sgl(wrb);
S
Sathya Perla 已提交
1048

1049 1050
	be_wrb_hdr_prepare(wrb, sizeof(*req), false, 1,
			OPCODE_ETH_GET_STATISTICS);
S
Sathya Perla 已提交
1051 1052 1053 1054 1055 1056 1057

	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,
		OPCODE_ETH_GET_STATISTICS, 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);

1058
	be_mcc_notify(adapter);
1059
	adapter->stats_ioctl_sent = true;
S
Sathya Perla 已提交
1060

1061
err:
1062
	spin_unlock_bh(&adapter->mcc_lock);
1063
	return status;
S
Sathya Perla 已提交
1064 1065
}

1066
/* Uses synchronous mcc */
1067
int be_cmd_link_status_query(struct be_adapter *adapter,
1068
			bool *link_up, u8 *mac_speed, u16 *link_speed)
S
Sathya Perla 已提交
1069
{
1070 1071
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_link_status *req;
S
Sathya Perla 已提交
1072 1073
	int status;

1074 1075 1076
	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
1077 1078 1079 1080
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1081
	req = embedded_payload(wrb);
1082 1083

	*link_up = false;
S
Sathya Perla 已提交
1084

1085 1086
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_LINK_STATUS_QUERY);
S
Sathya Perla 已提交
1087 1088 1089 1090

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

1091
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
1092 1093
	if (!status) {
		struct be_cmd_resp_link_status *resp = embedded_payload(wrb);
1094
		if (resp->mac_speed != PHY_LINK_SPEED_ZERO) {
1095
			*link_up = true;
1096 1097 1098
			*link_speed = le16_to_cpu(resp->link_speed);
			*mac_speed = resp->mac_speed;
		}
S
Sathya Perla 已提交
1099 1100
	}

1101
err:
1102
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1103 1104 1105
	return status;
}

1106
/* Uses Mbox */
1107
int be_cmd_get_fw_ver(struct be_adapter *adapter, char *fw_ver)
S
Sathya Perla 已提交
1108
{
1109 1110
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_get_fw_version *req;
S
Sathya Perla 已提交
1111 1112
	int status;

1113
	spin_lock(&adapter->mbox_lock);
1114 1115 1116

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

1118 1119
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_GET_FW_VERSION);
S
Sathya Perla 已提交
1120 1121 1122 1123

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

1124
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
1125 1126 1127 1128 1129
	if (!status) {
		struct be_cmd_resp_get_fw_version *resp = embedded_payload(wrb);
		strncpy(fw_ver, resp->firmware_version_string, FW_VER_LEN);
	}

1130
	spin_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
1131 1132 1133
	return status;
}

1134 1135 1136
/* set the EQ delay interval of an EQ to specified value
 * Uses async mcc
 */
1137
int be_cmd_modify_eqd(struct be_adapter *adapter, u32 eq_id, u32 eqd)
S
Sathya Perla 已提交
1138
{
1139 1140
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_modify_eq_delay *req;
1141
	int status = 0;
S
Sathya Perla 已提交
1142

1143 1144 1145
	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
1146 1147 1148 1149
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1150
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1151

1152 1153
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_MODIFY_EQ_DELAY);
S
Sathya Perla 已提交
1154 1155 1156 1157 1158 1159 1160 1161 1162

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

1163
	be_mcc_notify(adapter);
S
Sathya Perla 已提交
1164

1165
err:
1166
	spin_unlock_bh(&adapter->mcc_lock);
1167
	return status;
S
Sathya Perla 已提交
1168 1169
}

1170
/* Uses sycnhronous mcc */
1171
int be_cmd_vlan_config(struct be_adapter *adapter, u32 if_id, u16 *vtag_array,
S
Sathya Perla 已提交
1172 1173
			u32 num, bool untagged, bool promiscuous)
{
1174 1175
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_vlan_config *req;
S
Sathya Perla 已提交
1176 1177
	int status;

1178 1179 1180
	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
1181 1182 1183 1184
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1185
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1186

1187 1188
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_NTWK_VLAN_CONFIG);
S
Sathya Perla 已提交
1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201

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

1202
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
1203

1204
err:
1205
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1206 1207 1208
	return status;
}

1209 1210 1211
/* Uses MCC for this command as it may be called in BH context
 * Uses synchronous mcc
 */
1212
int be_cmd_promiscuous_config(struct be_adapter *adapter, u8 port_num, bool en)
S
Sathya Perla 已提交
1213
{
1214 1215
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_promiscuous_config *req;
1216
	int status;
S
Sathya Perla 已提交
1217

1218
	spin_lock_bh(&adapter->mcc_lock);
1219

1220
	wrb = wrb_from_mccq(adapter);
1221 1222 1223 1224
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1225
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1226

1227
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, OPCODE_ETH_PROMISCUOUS);
S
Sathya Perla 已提交
1228 1229 1230 1231

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

1232 1233 1234 1235
	/* In FW versions X.102.149/X.101.487 and later,
	 * the port setting associated only with the
	 * issuing pci function will take effect
	 */
S
Sathya Perla 已提交
1236 1237 1238 1239 1240
	if (port_num)
		req->port1_promiscuous = en;
	else
		req->port0_promiscuous = en;

1241
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
1242

1243
err:
1244
	spin_unlock_bh(&adapter->mcc_lock);
1245
	return status;
S
Sathya Perla 已提交
1246 1247
}

1248
/*
1249
 * Uses MCC for this command as it may be called in BH context
1250 1251
 * (mc == NULL) => multicast promiscous
 */
1252
int be_cmd_multicast_set(struct be_adapter *adapter, u32 if_id,
1253
		struct net_device *netdev, struct be_dma_mem *mem)
S
Sathya Perla 已提交
1254
{
1255
	struct be_mcc_wrb *wrb;
1256 1257 1258
	struct be_cmd_req_mcast_mac_config *req = mem->va;
	struct be_sge *sge;
	int status;
S
Sathya Perla 已提交
1259

1260
	spin_lock_bh(&adapter->mcc_lock);
1261

1262
	wrb = wrb_from_mccq(adapter);
1263 1264 1265 1266
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1267 1268
	sge = nonembedded_sgl(wrb);
	memset(req, 0, sizeof(*req));
S
Sathya Perla 已提交
1269

1270 1271
	be_wrb_hdr_prepare(wrb, sizeof(*req), false, 1,
			OPCODE_COMMON_NTWK_MULTICAST_SET);
1272 1273 1274
	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);
S
Sathya Perla 已提交
1275 1276 1277 1278 1279

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

	req->interface_id = if_id;
1280
	if (netdev) {
1281
		int i;
1282
		struct netdev_hw_addr *ha;
1283

1284
		req->num_mac = cpu_to_le16(netdev_mc_count(netdev));
1285

1286
		i = 0;
1287 1288
		netdev_for_each_mc_addr(ha, netdev)
			memcpy(req->mac[i].byte, ha->addr, ETH_ALEN);
1289 1290
	} else {
		req->promiscuous = 1;
S
Sathya Perla 已提交
1291 1292
	}

1293
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
1294

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

1300
/* Uses synchrounous mcc */
1301
int be_cmd_set_flow_control(struct be_adapter *adapter, u32 tx_fc, u32 rx_fc)
S
Sathya Perla 已提交
1302
{
1303 1304
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_set_flow_control *req;
S
Sathya Perla 已提交
1305 1306
	int status;

1307
	spin_lock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1308

1309
	wrb = wrb_from_mccq(adapter);
1310 1311 1312 1313
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1314
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1315

1316 1317
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_SET_FLOW_CONTROL);
S
Sathya Perla 已提交
1318 1319 1320 1321 1322 1323 1324

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

1325
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
1326

1327
err:
1328
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1329 1330 1331
	return status;
}

1332
/* Uses sycn mcc */
1333
int be_cmd_get_flow_control(struct be_adapter *adapter, u32 *tx_fc, u32 *rx_fc)
S
Sathya Perla 已提交
1334
{
1335 1336
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_get_flow_control *req;
S
Sathya Perla 已提交
1337 1338
	int status;

1339
	spin_lock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1340

1341
	wrb = wrb_from_mccq(adapter);
1342 1343 1344 1345
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1346
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1347

1348 1349
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_GET_FLOW_CONTROL);
S
Sathya Perla 已提交
1350 1351 1352 1353

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

1354
	status = be_mcc_notify_wait(adapter);
S
Sathya Perla 已提交
1355 1356 1357 1358 1359 1360 1361
	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);
	}

1362
err:
1363
	spin_unlock_bh(&adapter->mcc_lock);
S
Sathya Perla 已提交
1364 1365 1366
	return status;
}

1367
/* Uses mbox */
1368 1369
int be_cmd_query_fw_cfg(struct be_adapter *adapter, u32 *port_num,
		u32 *mode, u32 *caps)
S
Sathya Perla 已提交
1370
{
1371 1372
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_query_fw_cfg *req;
S
Sathya Perla 已提交
1373 1374
	int status;

1375
	spin_lock(&adapter->mbox_lock);
S
Sathya Perla 已提交
1376

1377 1378
	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
S
Sathya Perla 已提交
1379

1380 1381
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_QUERY_FIRMWARE_CONFIG);
S
Sathya Perla 已提交
1382 1383 1384 1385

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

1386
	status = be_mbox_notify_wait(adapter);
S
Sathya Perla 已提交
1387 1388 1389
	if (!status) {
		struct be_cmd_resp_query_fw_cfg *resp = embedded_payload(wrb);
		*port_num = le32_to_cpu(resp->phys_port);
A
Ajit Khaparde 已提交
1390
		*mode = le32_to_cpu(resp->function_mode);
1391
		*caps = le32_to_cpu(resp->function_caps);
S
Sathya Perla 已提交
1392 1393
	}

1394
	spin_unlock(&adapter->mbox_lock);
S
Sathya Perla 已提交
1395 1396
	return status;
}
1397

1398
/* Uses mbox */
1399 1400
int be_cmd_reset_function(struct be_adapter *adapter)
{
1401 1402
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_hdr *req;
1403 1404 1405 1406
	int status;

	spin_lock(&adapter->mbox_lock);

1407 1408
	wrb = wrb_from_mbox(adapter);
	req = embedded_payload(wrb);
1409

1410 1411
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_FUNCTION_RESET);
1412 1413 1414 1415

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

1416
	status = be_mbox_notify_wait(adapter);
1417 1418 1419 1420

	spin_unlock(&adapter->mbox_lock);
	return status;
}
1421

1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452
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;
	u32 myhash[10];
	int status;

	spin_lock(&adapter->mbox_lock);

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

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

1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463
/* 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);
1464 1465 1466 1467
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1468 1469
	req = embedded_payload(wrb);

1470 1471
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_ENABLE_DISABLE_BEACON);
1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482

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

1483
err:
1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497
	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);
1498 1499 1500 1501
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1502 1503
	req = embedded_payload(wrb);

1504 1505
	be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0,
			OPCODE_COMMON_GET_BEACON_STATE);
1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518

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

1519
err:
1520 1521 1522 1523
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}

1524 1525 1526
int be_cmd_write_flashrom(struct be_adapter *adapter, struct be_dma_mem *cmd,
			u32 flash_type, u32 flash_opcode, u32 buf_size)
{
1527
	struct be_mcc_wrb *wrb;
1528
	struct be_cmd_write_flashrom *req;
1529
	struct be_sge *sge;
1530 1531
	int status;

1532
	spin_lock_bh(&adapter->mcc_lock);
1533
	adapter->flash_status = 0;
1534 1535

	wrb = wrb_from_mccq(adapter);
1536 1537
	if (!wrb) {
		status = -EBUSY;
D
Dan Carpenter 已提交
1538
		goto err_unlock;
1539 1540
	}
	req = cmd->va;
1541 1542
	sge = nonembedded_sgl(wrb);

1543 1544
	be_wrb_hdr_prepare(wrb, cmd->size, false, 1,
			OPCODE_COMMON_WRITE_FLASHROM);
1545
	wrb->tag1 = CMD_SUBSYSTEM_COMMON;
1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556

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

1557 1558 1559 1560 1561 1562 1563 1564
	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;
1565

D
Dan Carpenter 已提交
1566 1567 1568 1569
	return status;

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

1573 1574
int be_cmd_get_flash_crc(struct be_adapter *adapter, u8 *flashed_crc,
			 int offset)
1575 1576 1577 1578 1579 1580 1581 1582
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_write_flashrom *req;
	int status;

	spin_lock_bh(&adapter->mcc_lock);

	wrb = wrb_from_mccq(adapter);
1583 1584 1585 1586
	if (!wrb) {
		status = -EBUSY;
		goto err;
	}
1587 1588
	req = embedded_payload(wrb);

1589 1590
	be_wrb_hdr_prepare(wrb, sizeof(*req)+4, true, 0,
			OPCODE_COMMON_READ_FLASHROM);
1591 1592 1593 1594

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

1595
	req->params.op_type = cpu_to_le32(IMG_TYPE_REDBOOT);
1596
	req->params.op_code = cpu_to_le32(FLASHROM_OPER_REPORT);
1597 1598
	req->params.offset = cpu_to_le32(offset);
	req->params.data_buf_size = cpu_to_le32(0x4);
1599 1600 1601 1602 1603

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

1604
err:
1605 1606 1607
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}
1608

1609
int be_cmd_enable_magic_wol(struct be_adapter *adapter, u8 *mac,
1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643
				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;
}
1644

1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679
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;
}

1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701
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));
1702
	req->hdr.timeout = cpu_to_le32(4);
1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772

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

1774
int be_cmd_get_seeprom_data(struct be_adapter *adapter,
1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802
				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);
	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);

	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}
1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837

int be_cmd_get_phy_info(struct be_adapter *adapter, struct be_dma_mem *cmd)
{
	struct be_mcc_wrb *wrb;
	struct be_cmd_req_get_phy_info *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 = cmd->va;
	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));

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

	status = be_mcc_notify_wait(adapter);
err:
	spin_unlock_bh(&adapter->mcc_lock);
	return status;
}
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

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;
	req->valid_bits = BE_QOS_BITS_NIC;
	req->max_bps_nic = bps;

	status = be_mcc_notify_wait(adapter);

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