1 /*
2  * Copyright (C) 2005 - 2011 Emulex
3  * All rights reserved.
4  *
5  * This program is free software; you can redistribute it and/or
6  * modify it under the terms of the GNU General Public License version 2
7  * as published by the Free Software Foundation.  The full GNU General
8  * Public License is included in this distribution in the file called COPYING.
9  *
10  * Contact Information:
11  * linux-drivers@emulex.com
12  *
13  * Emulex
14  * 3333 Susan Street
15  * Costa Mesa, CA 92626
16  */
17 
18 #include "be.h"
19 #include "be_cmds.h"
20 
21 /* Must be a power of 2 or else MODULO will BUG_ON */
22 static int be_get_temp_freq = 64;
23 
embedded_payload(struct be_mcc_wrb * wrb)24 static inline void *embedded_payload(struct be_mcc_wrb *wrb)
25 {
26 	return wrb->payload.embedded_payload;
27 }
28 
be_mcc_notify(struct be_adapter * adapter)29 static void be_mcc_notify(struct be_adapter *adapter)
30 {
31 	struct be_queue_info *mccq = &adapter->mcc_obj.q;
32 	u32 val = 0;
33 
34 	if (be_error(adapter))
35 		return;
36 
37 	val |= mccq->id & DB_MCCQ_RING_ID_MASK;
38 	val |= 1 << DB_MCCQ_NUM_POSTED_SHIFT;
39 
40 	wmb();
41 	iowrite32(val, adapter->db + DB_MCCQ_OFFSET);
42 }
43 
44 /* To check if valid bit is set, check the entire word as we don't know
45  * the endianness of the data (old entry is host endian while a new entry is
46  * little endian) */
be_mcc_compl_is_new(struct be_mcc_compl * compl)47 static inline bool be_mcc_compl_is_new(struct be_mcc_compl *compl)
48 {
49 	if (compl->flags != 0) {
50 		compl->flags = le32_to_cpu(compl->flags);
51 		BUG_ON((compl->flags & CQE_FLAGS_VALID_MASK) == 0);
52 		return true;
53 	} else {
54 		return false;
55 	}
56 }
57 
58 /* Need to reset the entire word that houses the valid bit */
be_mcc_compl_use(struct be_mcc_compl * compl)59 static inline void be_mcc_compl_use(struct be_mcc_compl *compl)
60 {
61 	compl->flags = 0;
62 }
63 
be_mcc_compl_process(struct be_adapter * adapter,struct be_mcc_compl * compl)64 static int be_mcc_compl_process(struct be_adapter *adapter,
65 	struct be_mcc_compl *compl)
66 {
67 	u16 compl_status, extd_status;
68 
69 	/* Just swap the status to host endian; mcc tag is opaquely copied
70 	 * from mcc_wrb */
71 	be_dws_le_to_cpu(compl, 4);
72 
73 	compl_status = (compl->status >> CQE_STATUS_COMPL_SHIFT) &
74 				CQE_STATUS_COMPL_MASK;
75 
76 	if (((compl->tag0 == OPCODE_COMMON_WRITE_FLASHROM) ||
77 		(compl->tag0 == OPCODE_COMMON_WRITE_OBJECT)) &&
78 		(compl->tag1 == CMD_SUBSYSTEM_COMMON)) {
79 		adapter->flash_status = compl_status;
80 		complete(&adapter->flash_compl);
81 	}
82 
83 	if (compl_status == MCC_STATUS_SUCCESS) {
84 		if (((compl->tag0 == OPCODE_ETH_GET_STATISTICS) ||
85 			 (compl->tag0 == OPCODE_ETH_GET_PPORT_STATS)) &&
86 			(compl->tag1 == CMD_SUBSYSTEM_ETH)) {
87 			be_parse_stats(adapter);
88 			adapter->stats_cmd_sent = false;
89 		}
90 		if (compl->tag0 ==
91 				OPCODE_COMMON_GET_CNTL_ADDITIONAL_ATTRIBUTES) {
92 			struct be_mcc_wrb *mcc_wrb =
93 				queue_index_node(&adapter->mcc_obj.q,
94 						compl->tag1);
95 			struct be_cmd_resp_get_cntl_addnl_attribs *resp =
96 				embedded_payload(mcc_wrb);
97 			adapter->drv_stats.be_on_die_temperature =
98 				resp->on_die_temperature;
99 		}
100 	} else {
101 		if (compl->tag0 == OPCODE_COMMON_GET_CNTL_ADDITIONAL_ATTRIBUTES)
102 			be_get_temp_freq = 0;
103 
104 		if (compl_status == MCC_STATUS_NOT_SUPPORTED ||
105 			compl_status == MCC_STATUS_ILLEGAL_REQUEST)
106 			goto done;
107 
108 		if (compl_status == MCC_STATUS_UNAUTHORIZED_REQUEST) {
109 			dev_warn(&adapter->pdev->dev, "This domain(VM) is not "
110 				"permitted to execute this cmd (opcode %d)\n",
111 				compl->tag0);
112 		} else {
113 			extd_status = (compl->status >> CQE_STATUS_EXTD_SHIFT) &
114 					CQE_STATUS_EXTD_MASK;
115 			dev_err(&adapter->pdev->dev, "Cmd (opcode %d) failed:"
116 				"status %d, extd-status %d\n",
117 				compl->tag0, compl_status, extd_status);
118 		}
119 	}
120 done:
121 	return compl_status;
122 }
123 
124 /* Link state evt is a string of bytes; no need for endian swapping */
be_async_link_state_process(struct be_adapter * adapter,struct be_async_event_link_state * evt)125 static void be_async_link_state_process(struct be_adapter *adapter,
126 		struct be_async_event_link_state *evt)
127 {
128 	/* When link status changes, link speed must be re-queried from FW */
129 	adapter->link_speed = -1;
130 
131 	/* For the initial link status do not rely on the ASYNC event as
132 	 * it may not be received in some cases.
133 	 */
134 	if (adapter->flags & BE_FLAGS_LINK_STATUS_INIT)
135 		be_link_status_update(adapter, evt->port_link_status);
136 }
137 
138 /* Grp5 CoS Priority evt */
be_async_grp5_cos_priority_process(struct be_adapter * adapter,struct be_async_event_grp5_cos_priority * evt)139 static void be_async_grp5_cos_priority_process(struct be_adapter *adapter,
140 		struct be_async_event_grp5_cos_priority *evt)
141 {
142 	if (evt->valid) {
143 		adapter->vlan_prio_bmap = evt->available_priority_bmap;
144 		adapter->recommended_prio &= ~VLAN_PRIO_MASK;
145 		adapter->recommended_prio =
146 			evt->reco_default_priority << VLAN_PRIO_SHIFT;
147 	}
148 }
149 
150 /* Grp5 QOS Speed evt */
be_async_grp5_qos_speed_process(struct be_adapter * adapter,struct be_async_event_grp5_qos_link_speed * evt)151 static void be_async_grp5_qos_speed_process(struct be_adapter *adapter,
152 		struct be_async_event_grp5_qos_link_speed *evt)
153 {
154 	if (evt->physical_port == adapter->port_num) {
155 		/* qos_link_speed is in units of 10 Mbps */
156 		adapter->link_speed = evt->qos_link_speed * 10;
157 	}
158 }
159 
160 /*Grp5 PVID evt*/
be_async_grp5_pvid_state_process(struct be_adapter * adapter,struct be_async_event_grp5_pvid_state * evt)161 static void be_async_grp5_pvid_state_process(struct be_adapter *adapter,
162 		struct be_async_event_grp5_pvid_state *evt)
163 {
164 	if (evt->enabled)
165 		adapter->pvid = le16_to_cpu(evt->tag) & VLAN_VID_MASK;
166 	else
167 		adapter->pvid = 0;
168 }
169 
be_async_grp5_evt_process(struct be_adapter * adapter,u32 trailer,struct be_mcc_compl * evt)170 static void be_async_grp5_evt_process(struct be_adapter *adapter,
171 		u32 trailer, struct be_mcc_compl *evt)
172 {
173 	u8 event_type = 0;
174 
175 	event_type = (trailer >> ASYNC_TRAILER_EVENT_TYPE_SHIFT) &
176 		ASYNC_TRAILER_EVENT_TYPE_MASK;
177 
178 	switch (event_type) {
179 	case ASYNC_EVENT_COS_PRIORITY:
180 		be_async_grp5_cos_priority_process(adapter,
181 		(struct be_async_event_grp5_cos_priority *)evt);
182 	break;
183 	case ASYNC_EVENT_QOS_SPEED:
184 		be_async_grp5_qos_speed_process(adapter,
185 		(struct be_async_event_grp5_qos_link_speed *)evt);
186 	break;
187 	case ASYNC_EVENT_PVID_STATE:
188 		be_async_grp5_pvid_state_process(adapter,
189 		(struct be_async_event_grp5_pvid_state *)evt);
190 	break;
191 	default:
192 		dev_warn(&adapter->pdev->dev, "Unknown grp5 event!\n");
193 		break;
194 	}
195 }
196 
is_link_state_evt(u32 trailer)197 static inline bool is_link_state_evt(u32 trailer)
198 {
199 	return ((trailer >> ASYNC_TRAILER_EVENT_CODE_SHIFT) &
200 		ASYNC_TRAILER_EVENT_CODE_MASK) ==
201 				ASYNC_EVENT_CODE_LINK_STATE;
202 }
203 
is_grp5_evt(u32 trailer)204 static inline bool is_grp5_evt(u32 trailer)
205 {
206 	return (((trailer >> ASYNC_TRAILER_EVENT_CODE_SHIFT) &
207 		ASYNC_TRAILER_EVENT_CODE_MASK) ==
208 				ASYNC_EVENT_CODE_GRP_5);
209 }
210 
be_mcc_compl_get(struct be_adapter * adapter)211 static struct be_mcc_compl *be_mcc_compl_get(struct be_adapter *adapter)
212 {
213 	struct be_queue_info *mcc_cq = &adapter->mcc_obj.cq;
214 	struct be_mcc_compl *compl = queue_tail_node(mcc_cq);
215 
216 	if (be_mcc_compl_is_new(compl)) {
217 		queue_tail_inc(mcc_cq);
218 		return compl;
219 	}
220 	return NULL;
221 }
222 
be_async_mcc_enable(struct be_adapter * adapter)223 void be_async_mcc_enable(struct be_adapter *adapter)
224 {
225 	spin_lock_bh(&adapter->mcc_cq_lock);
226 
227 	be_cq_notify(adapter, adapter->mcc_obj.cq.id, true, 0);
228 	adapter->mcc_obj.rearm_cq = true;
229 
230 	spin_unlock_bh(&adapter->mcc_cq_lock);
231 }
232 
be_async_mcc_disable(struct be_adapter * adapter)233 void be_async_mcc_disable(struct be_adapter *adapter)
234 {
235 	adapter->mcc_obj.rearm_cq = false;
236 }
237 
be_process_mcc(struct be_adapter * adapter)238 int be_process_mcc(struct be_adapter *adapter)
239 {
240 	struct be_mcc_compl *compl;
241 	int num = 0, status = 0;
242 	struct be_mcc_obj *mcc_obj = &adapter->mcc_obj;
243 
244 	spin_lock_bh(&adapter->mcc_cq_lock);
245 	while ((compl = be_mcc_compl_get(adapter))) {
246 		if (compl->flags & CQE_FLAGS_ASYNC_MASK) {
247 			/* Interpret flags as an async trailer */
248 			if (is_link_state_evt(compl->flags))
249 				be_async_link_state_process(adapter,
250 				(struct be_async_event_link_state *) compl);
251 			else if (is_grp5_evt(compl->flags))
252 				be_async_grp5_evt_process(adapter,
253 				compl->flags, compl);
254 		} else if (compl->flags & CQE_FLAGS_COMPLETED_MASK) {
255 				status = be_mcc_compl_process(adapter, compl);
256 				atomic_dec(&mcc_obj->q.used);
257 		}
258 		be_mcc_compl_use(compl);
259 		num++;
260 	}
261 
262 	if (num)
263 		be_cq_notify(adapter, mcc_obj->cq.id, mcc_obj->rearm_cq, num);
264 
265 	spin_unlock_bh(&adapter->mcc_cq_lock);
266 	return status;
267 }
268 
269 /* Wait till no more pending mcc requests are present */
be_mcc_wait_compl(struct be_adapter * adapter)270 static int be_mcc_wait_compl(struct be_adapter *adapter)
271 {
272 #define mcc_timeout		120000 /* 12s timeout */
273 	int i, status = 0;
274 	struct be_mcc_obj *mcc_obj = &adapter->mcc_obj;
275 
276 	for (i = 0; i < mcc_timeout; i++) {
277 		if (be_error(adapter))
278 			return -EIO;
279 
280 		status = be_process_mcc(adapter);
281 
282 		if (atomic_read(&mcc_obj->q.used) == 0)
283 			break;
284 		udelay(100);
285 	}
286 	if (i == mcc_timeout) {
287 		dev_err(&adapter->pdev->dev, "FW not responding\n");
288 		adapter->fw_timeout = true;
289 		return -1;
290 	}
291 	return status;
292 }
293 
294 /* Notify MCC requests and wait for completion */
be_mcc_notify_wait(struct be_adapter * adapter)295 static int be_mcc_notify_wait(struct be_adapter *adapter)
296 {
297 	be_mcc_notify(adapter);
298 	return be_mcc_wait_compl(adapter);
299 }
300 
be_mbox_db_ready_wait(struct be_adapter * adapter,void __iomem * db)301 static int be_mbox_db_ready_wait(struct be_adapter *adapter, void __iomem *db)
302 {
303 	int msecs = 0;
304 	u32 ready;
305 
306 	do {
307 		if (be_error(adapter))
308 			return -EIO;
309 
310 		ready = ioread32(db);
311 		if (ready == 0xffffffff)
312 			return -1;
313 
314 		ready &= MPU_MAILBOX_DB_RDY_MASK;
315 		if (ready)
316 			break;
317 
318 		if (msecs > 4000) {
319 			dev_err(&adapter->pdev->dev, "FW not responding\n");
320 			adapter->fw_timeout = true;
321 			be_detect_dump_ue(adapter);
322 			return -1;
323 		}
324 
325 		msleep(1);
326 		msecs++;
327 	} while (true);
328 
329 	return 0;
330 }
331 
332 /*
333  * Insert the mailbox address into the doorbell in two steps
334  * Polls on the mbox doorbell till a command completion (or a timeout) occurs
335  */
be_mbox_notify_wait(struct be_adapter * adapter)336 static int be_mbox_notify_wait(struct be_adapter *adapter)
337 {
338 	int status;
339 	u32 val = 0;
340 	void __iomem *db = adapter->db + MPU_MAILBOX_DB_OFFSET;
341 	struct be_dma_mem *mbox_mem = &adapter->mbox_mem;
342 	struct be_mcc_mailbox *mbox = mbox_mem->va;
343 	struct be_mcc_compl *compl = &mbox->compl;
344 
345 	/* wait for ready to be set */
346 	status = be_mbox_db_ready_wait(adapter, db);
347 	if (status != 0)
348 		return status;
349 
350 	val |= MPU_MAILBOX_DB_HI_MASK;
351 	/* at bits 2 - 31 place mbox dma addr msb bits 34 - 63 */
352 	val |= (upper_32_bits(mbox_mem->dma) >> 2) << 2;
353 	iowrite32(val, db);
354 
355 	/* wait for ready to be set */
356 	status = be_mbox_db_ready_wait(adapter, db);
357 	if (status != 0)
358 		return status;
359 
360 	val = 0;
361 	/* at bits 2 - 31 place mbox dma addr lsb bits 4 - 33 */
362 	val |= (u32)(mbox_mem->dma >> 4) << 2;
363 	iowrite32(val, db);
364 
365 	status = be_mbox_db_ready_wait(adapter, db);
366 	if (status != 0)
367 		return status;
368 
369 	/* A cq entry has been made now */
370 	if (be_mcc_compl_is_new(compl)) {
371 		status = be_mcc_compl_process(adapter, &mbox->compl);
372 		be_mcc_compl_use(compl);
373 		if (status)
374 			return status;
375 	} else {
376 		dev_err(&adapter->pdev->dev, "invalid mailbox completion\n");
377 		return -1;
378 	}
379 	return 0;
380 }
381 
be_POST_stage_get(struct be_adapter * adapter,u16 * stage)382 static int be_POST_stage_get(struct be_adapter *adapter, u16 *stage)
383 {
384 	u32 sem;
385 
386 	if (lancer_chip(adapter))
387 		sem  = ioread32(adapter->db + MPU_EP_SEMAPHORE_IF_TYPE2_OFFSET);
388 	else
389 		sem  = ioread32(adapter->csr + MPU_EP_SEMAPHORE_OFFSET);
390 
391 	*stage = sem & EP_SEMAPHORE_POST_STAGE_MASK;
392 	if ((sem >> EP_SEMAPHORE_POST_ERR_SHIFT) & EP_SEMAPHORE_POST_ERR_MASK)
393 		return -1;
394 	else
395 		return 0;
396 }
397 
be_cmd_POST(struct be_adapter * adapter)398 int be_cmd_POST(struct be_adapter *adapter)
399 {
400 	u16 stage;
401 	int status, timeout = 0;
402 	struct device *dev = &adapter->pdev->dev;
403 
404 	do {
405 		status = be_POST_stage_get(adapter, &stage);
406 		if (status) {
407 			dev_err(dev, "POST error; stage=0x%x\n", stage);
408 			return -1;
409 		} else if (stage != POST_STAGE_ARMFW_RDY) {
410 			if (msleep_interruptible(2000)) {
411 				dev_err(dev, "Waiting for POST aborted\n");
412 				return -EINTR;
413 			}
414 			timeout += 2;
415 		} else {
416 			return 0;
417 		}
418 	} while (timeout < 60);
419 
420 	dev_err(dev, "POST timeout; stage=0x%x\n", stage);
421 	return -1;
422 }
423 
424 
nonembedded_sgl(struct be_mcc_wrb * wrb)425 static inline struct be_sge *nonembedded_sgl(struct be_mcc_wrb *wrb)
426 {
427 	return &wrb->payload.sgl[0];
428 }
429 
430 
431 /* Don't touch the hdr after it's prepared */
432 /* mem will be NULL for embedded commands */
be_wrb_cmd_hdr_prepare(struct be_cmd_req_hdr * req_hdr,u8 subsystem,u8 opcode,int cmd_len,struct be_mcc_wrb * wrb,struct be_dma_mem * mem)433 static void be_wrb_cmd_hdr_prepare(struct be_cmd_req_hdr *req_hdr,
434 				u8 subsystem, u8 opcode, int cmd_len,
435 				struct be_mcc_wrb *wrb, struct be_dma_mem *mem)
436 {
437 	struct be_sge *sge;
438 
439 	req_hdr->opcode = opcode;
440 	req_hdr->subsystem = subsystem;
441 	req_hdr->request_length = cpu_to_le32(cmd_len - sizeof(*req_hdr));
442 	req_hdr->version = 0;
443 
444 	wrb->tag0 = opcode;
445 	wrb->tag1 = subsystem;
446 	wrb->payload_length = cmd_len;
447 	if (mem) {
448 		wrb->embedded |= (1 & MCC_WRB_SGE_CNT_MASK) <<
449 			MCC_WRB_SGE_CNT_SHIFT;
450 		sge = nonembedded_sgl(wrb);
451 		sge->pa_hi = cpu_to_le32(upper_32_bits(mem->dma));
452 		sge->pa_lo = cpu_to_le32(mem->dma & 0xFFFFFFFF);
453 		sge->len = cpu_to_le32(mem->size);
454 	} else
455 		wrb->embedded |= MCC_WRB_EMBEDDED_MASK;
456 	be_dws_cpu_to_le(wrb, 8);
457 }
458 
be_cmd_page_addrs_prepare(struct phys_addr * pages,u32 max_pages,struct be_dma_mem * mem)459 static void be_cmd_page_addrs_prepare(struct phys_addr *pages, u32 max_pages,
460 			struct be_dma_mem *mem)
461 {
462 	int i, buf_pages = min(PAGES_4K_SPANNED(mem->va, mem->size), max_pages);
463 	u64 dma = (u64)mem->dma;
464 
465 	for (i = 0; i < buf_pages; i++) {
466 		pages[i].lo = cpu_to_le32(dma & 0xFFFFFFFF);
467 		pages[i].hi = cpu_to_le32(upper_32_bits(dma));
468 		dma += PAGE_SIZE_4K;
469 	}
470 }
471 
472 /* Converts interrupt delay in microseconds to multiplier value */
eq_delay_to_mult(u32 usec_delay)473 static u32 eq_delay_to_mult(u32 usec_delay)
474 {
475 #define MAX_INTR_RATE			651042
476 	const u32 round = 10;
477 	u32 multiplier;
478 
479 	if (usec_delay == 0)
480 		multiplier = 0;
481 	else {
482 		u32 interrupt_rate = 1000000 / usec_delay;
483 		/* Max delay, corresponding to the lowest interrupt rate */
484 		if (interrupt_rate == 0)
485 			multiplier = 1023;
486 		else {
487 			multiplier = (MAX_INTR_RATE - interrupt_rate) * round;
488 			multiplier /= interrupt_rate;
489 			/* Round the multiplier to the closest value.*/
490 			multiplier = (multiplier + round/2) / round;
491 			multiplier = min(multiplier, (u32)1023);
492 		}
493 	}
494 	return multiplier;
495 }
496 
wrb_from_mbox(struct be_adapter * adapter)497 static inline struct be_mcc_wrb *wrb_from_mbox(struct be_adapter *adapter)
498 {
499 	struct be_dma_mem *mbox_mem = &adapter->mbox_mem;
500 	struct be_mcc_wrb *wrb
501 		= &((struct be_mcc_mailbox *)(mbox_mem->va))->wrb;
502 	memset(wrb, 0, sizeof(*wrb));
503 	return wrb;
504 }
505 
wrb_from_mccq(struct be_adapter * adapter)506 static struct be_mcc_wrb *wrb_from_mccq(struct be_adapter *adapter)
507 {
508 	struct be_queue_info *mccq = &adapter->mcc_obj.q;
509 	struct be_mcc_wrb *wrb;
510 
511 	if (atomic_read(&mccq->used) >= mccq->len) {
512 		dev_err(&adapter->pdev->dev, "Out of MCCQ wrbs\n");
513 		return NULL;
514 	}
515 
516 	wrb = queue_head_node(mccq);
517 	queue_head_inc(mccq);
518 	atomic_inc(&mccq->used);
519 	memset(wrb, 0, sizeof(*wrb));
520 	return wrb;
521 }
522 
523 /* Tell fw we're about to start firing cmds by writing a
524  * special pattern across the wrb hdr; uses mbox
525  */
be_cmd_fw_init(struct be_adapter * adapter)526 int be_cmd_fw_init(struct be_adapter *adapter)
527 {
528 	u8 *wrb;
529 	int status;
530 
531 	if (mutex_lock_interruptible(&adapter->mbox_lock))
532 		return -1;
533 
534 	wrb = (u8 *)wrb_from_mbox(adapter);
535 	*wrb++ = 0xFF;
536 	*wrb++ = 0x12;
537 	*wrb++ = 0x34;
538 	*wrb++ = 0xFF;
539 	*wrb++ = 0xFF;
540 	*wrb++ = 0x56;
541 	*wrb++ = 0x78;
542 	*wrb = 0xFF;
543 
544 	status = be_mbox_notify_wait(adapter);
545 
546 	mutex_unlock(&adapter->mbox_lock);
547 	return status;
548 }
549 
550 /* Tell fw we're done with firing cmds by writing a
551  * special pattern across the wrb hdr; uses mbox
552  */
be_cmd_fw_clean(struct be_adapter * adapter)553 int be_cmd_fw_clean(struct be_adapter *adapter)
554 {
555 	u8 *wrb;
556 	int status;
557 
558 	if (mutex_lock_interruptible(&adapter->mbox_lock))
559 		return -1;
560 
561 	wrb = (u8 *)wrb_from_mbox(adapter);
562 	*wrb++ = 0xFF;
563 	*wrb++ = 0xAA;
564 	*wrb++ = 0xBB;
565 	*wrb++ = 0xFF;
566 	*wrb++ = 0xFF;
567 	*wrb++ = 0xCC;
568 	*wrb++ = 0xDD;
569 	*wrb = 0xFF;
570 
571 	status = be_mbox_notify_wait(adapter);
572 
573 	mutex_unlock(&adapter->mbox_lock);
574 	return status;
575 }
be_cmd_eq_create(struct be_adapter * adapter,struct be_queue_info * eq,int eq_delay)576 int be_cmd_eq_create(struct be_adapter *adapter,
577 		struct be_queue_info *eq, int eq_delay)
578 {
579 	struct be_mcc_wrb *wrb;
580 	struct be_cmd_req_eq_create *req;
581 	struct be_dma_mem *q_mem = &eq->dma_mem;
582 	int status;
583 
584 	if (mutex_lock_interruptible(&adapter->mbox_lock))
585 		return -1;
586 
587 	wrb = wrb_from_mbox(adapter);
588 	req = embedded_payload(wrb);
589 
590 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
591 		OPCODE_COMMON_EQ_CREATE, sizeof(*req), wrb, NULL);
592 
593 	req->num_pages =  cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size));
594 
595 	AMAP_SET_BITS(struct amap_eq_context, valid, req->context, 1);
596 	/* 4byte eqe*/
597 	AMAP_SET_BITS(struct amap_eq_context, size, req->context, 0);
598 	AMAP_SET_BITS(struct amap_eq_context, count, req->context,
599 			__ilog2_u32(eq->len/256));
600 	AMAP_SET_BITS(struct amap_eq_context, delaymult, req->context,
601 			eq_delay_to_mult(eq_delay));
602 	be_dws_cpu_to_le(req->context, sizeof(req->context));
603 
604 	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);
605 
606 	status = be_mbox_notify_wait(adapter);
607 	if (!status) {
608 		struct be_cmd_resp_eq_create *resp = embedded_payload(wrb);
609 		eq->id = le16_to_cpu(resp->eq_id);
610 		eq->created = true;
611 	}
612 
613 	mutex_unlock(&adapter->mbox_lock);
614 	return status;
615 }
616 
617 /* Use MCC */
be_cmd_mac_addr_query(struct be_adapter * adapter,u8 * mac_addr,u8 type,bool permanent,u32 if_handle,u32 pmac_id)618 int be_cmd_mac_addr_query(struct be_adapter *adapter, u8 *mac_addr,
619 			u8 type, bool permanent, u32 if_handle, u32 pmac_id)
620 {
621 	struct be_mcc_wrb *wrb;
622 	struct be_cmd_req_mac_query *req;
623 	int status;
624 
625 	spin_lock_bh(&adapter->mcc_lock);
626 
627 	wrb = wrb_from_mccq(adapter);
628 	if (!wrb) {
629 		status = -EBUSY;
630 		goto err;
631 	}
632 	req = embedded_payload(wrb);
633 
634 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
635 		OPCODE_COMMON_NTWK_MAC_QUERY, sizeof(*req), wrb, NULL);
636 	req->type = type;
637 	if (permanent) {
638 		req->permanent = 1;
639 	} else {
640 		req->if_id = cpu_to_le16((u16) if_handle);
641 		req->pmac_id = cpu_to_le32(pmac_id);
642 		req->permanent = 0;
643 	}
644 
645 	status = be_mcc_notify_wait(adapter);
646 	if (!status) {
647 		struct be_cmd_resp_mac_query *resp = embedded_payload(wrb);
648 		memcpy(mac_addr, resp->mac.addr, ETH_ALEN);
649 	}
650 
651 err:
652 	spin_unlock_bh(&adapter->mcc_lock);
653 	return status;
654 }
655 
656 /* Uses synchronous MCCQ */
be_cmd_pmac_add(struct be_adapter * adapter,u8 * mac_addr,u32 if_id,u32 * pmac_id,u32 domain)657 int be_cmd_pmac_add(struct be_adapter *adapter, u8 *mac_addr,
658 		u32 if_id, u32 *pmac_id, u32 domain)
659 {
660 	struct be_mcc_wrb *wrb;
661 	struct be_cmd_req_pmac_add *req;
662 	int status;
663 
664 	spin_lock_bh(&adapter->mcc_lock);
665 
666 	wrb = wrb_from_mccq(adapter);
667 	if (!wrb) {
668 		status = -EBUSY;
669 		goto err;
670 	}
671 	req = embedded_payload(wrb);
672 
673 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
674 		OPCODE_COMMON_NTWK_PMAC_ADD, sizeof(*req), wrb, NULL);
675 
676 	req->hdr.domain = domain;
677 	req->if_id = cpu_to_le32(if_id);
678 	memcpy(req->mac_address, mac_addr, ETH_ALEN);
679 
680 	status = be_mcc_notify_wait(adapter);
681 	if (!status) {
682 		struct be_cmd_resp_pmac_add *resp = embedded_payload(wrb);
683 		*pmac_id = le32_to_cpu(resp->pmac_id);
684 	}
685 
686 err:
687 	spin_unlock_bh(&adapter->mcc_lock);
688 
689 	 if (status == MCC_STATUS_UNAUTHORIZED_REQUEST)
690 		status = -EPERM;
691 
692 	return status;
693 }
694 
695 /* Uses synchronous MCCQ */
be_cmd_pmac_del(struct be_adapter * adapter,u32 if_id,int pmac_id,u32 dom)696 int be_cmd_pmac_del(struct be_adapter *adapter, u32 if_id, int pmac_id, u32 dom)
697 {
698 	struct be_mcc_wrb *wrb;
699 	struct be_cmd_req_pmac_del *req;
700 	int status;
701 
702 	if (pmac_id == -1)
703 		return 0;
704 
705 	spin_lock_bh(&adapter->mcc_lock);
706 
707 	wrb = wrb_from_mccq(adapter);
708 	if (!wrb) {
709 		status = -EBUSY;
710 		goto err;
711 	}
712 	req = embedded_payload(wrb);
713 
714 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
715 		OPCODE_COMMON_NTWK_PMAC_DEL, sizeof(*req), wrb, NULL);
716 
717 	req->hdr.domain = dom;
718 	req->if_id = cpu_to_le32(if_id);
719 	req->pmac_id = cpu_to_le32(pmac_id);
720 
721 	status = be_mcc_notify_wait(adapter);
722 
723 err:
724 	spin_unlock_bh(&adapter->mcc_lock);
725 	return status;
726 }
727 
728 /* Uses Mbox */
be_cmd_cq_create(struct be_adapter * adapter,struct be_queue_info * cq,struct be_queue_info * eq,bool no_delay,int coalesce_wm)729 int be_cmd_cq_create(struct be_adapter *adapter, struct be_queue_info *cq,
730 		struct be_queue_info *eq, bool no_delay, int coalesce_wm)
731 {
732 	struct be_mcc_wrb *wrb;
733 	struct be_cmd_req_cq_create *req;
734 	struct be_dma_mem *q_mem = &cq->dma_mem;
735 	void *ctxt;
736 	int status;
737 
738 	if (mutex_lock_interruptible(&adapter->mbox_lock))
739 		return -1;
740 
741 	wrb = wrb_from_mbox(adapter);
742 	req = embedded_payload(wrb);
743 	ctxt = &req->context;
744 
745 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
746 		OPCODE_COMMON_CQ_CREATE, sizeof(*req), wrb, NULL);
747 
748 	req->num_pages =  cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size));
749 	if (lancer_chip(adapter)) {
750 		req->hdr.version = 2;
751 		req->page_size = 1; /* 1 for 4K */
752 		AMAP_SET_BITS(struct amap_cq_context_lancer, nodelay, ctxt,
753 								no_delay);
754 		AMAP_SET_BITS(struct amap_cq_context_lancer, count, ctxt,
755 						__ilog2_u32(cq->len/256));
756 		AMAP_SET_BITS(struct amap_cq_context_lancer, valid, ctxt, 1);
757 		AMAP_SET_BITS(struct amap_cq_context_lancer, eventable,
758 								ctxt, 1);
759 		AMAP_SET_BITS(struct amap_cq_context_lancer, eqid,
760 								ctxt, eq->id);
761 	} else {
762 		AMAP_SET_BITS(struct amap_cq_context_be, coalescwm, ctxt,
763 								coalesce_wm);
764 		AMAP_SET_BITS(struct amap_cq_context_be, nodelay,
765 								ctxt, no_delay);
766 		AMAP_SET_BITS(struct amap_cq_context_be, count, ctxt,
767 						__ilog2_u32(cq->len/256));
768 		AMAP_SET_BITS(struct amap_cq_context_be, valid, ctxt, 1);
769 		AMAP_SET_BITS(struct amap_cq_context_be, eventable, ctxt, 1);
770 		AMAP_SET_BITS(struct amap_cq_context_be, eqid, ctxt, eq->id);
771 	}
772 
773 	be_dws_cpu_to_le(ctxt, sizeof(req->context));
774 
775 	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);
776 
777 	status = be_mbox_notify_wait(adapter);
778 	if (!status) {
779 		struct be_cmd_resp_cq_create *resp = embedded_payload(wrb);
780 		cq->id = le16_to_cpu(resp->cq_id);
781 		cq->created = true;
782 	}
783 
784 	mutex_unlock(&adapter->mbox_lock);
785 
786 	return status;
787 }
788 
be_encoded_q_len(int q_len)789 static u32 be_encoded_q_len(int q_len)
790 {
791 	u32 len_encoded = fls(q_len); /* log2(len) + 1 */
792 	if (len_encoded == 16)
793 		len_encoded = 0;
794 	return len_encoded;
795 }
796 
be_cmd_mccq_ext_create(struct be_adapter * adapter,struct be_queue_info * mccq,struct be_queue_info * cq)797 int be_cmd_mccq_ext_create(struct be_adapter *adapter,
798 			struct be_queue_info *mccq,
799 			struct be_queue_info *cq)
800 {
801 	struct be_mcc_wrb *wrb;
802 	struct be_cmd_req_mcc_ext_create *req;
803 	struct be_dma_mem *q_mem = &mccq->dma_mem;
804 	void *ctxt;
805 	int status;
806 
807 	if (mutex_lock_interruptible(&adapter->mbox_lock))
808 		return -1;
809 
810 	wrb = wrb_from_mbox(adapter);
811 	req = embedded_payload(wrb);
812 	ctxt = &req->context;
813 
814 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
815 			OPCODE_COMMON_MCC_CREATE_EXT, sizeof(*req), wrb, NULL);
816 
817 	req->num_pages = cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size));
818 	if (lancer_chip(adapter)) {
819 		req->hdr.version = 1;
820 		req->cq_id = cpu_to_le16(cq->id);
821 
822 		AMAP_SET_BITS(struct amap_mcc_context_lancer, ring_size, ctxt,
823 						be_encoded_q_len(mccq->len));
824 		AMAP_SET_BITS(struct amap_mcc_context_lancer, valid, ctxt, 1);
825 		AMAP_SET_BITS(struct amap_mcc_context_lancer, async_cq_id,
826 								ctxt, cq->id);
827 		AMAP_SET_BITS(struct amap_mcc_context_lancer, async_cq_valid,
828 								 ctxt, 1);
829 
830 	} else {
831 		AMAP_SET_BITS(struct amap_mcc_context_be, valid, ctxt, 1);
832 		AMAP_SET_BITS(struct amap_mcc_context_be, ring_size, ctxt,
833 						be_encoded_q_len(mccq->len));
834 		AMAP_SET_BITS(struct amap_mcc_context_be, cq_id, ctxt, cq->id);
835 	}
836 
837 	/* Subscribe to Link State and Group 5 Events(bits 1 and 5 set) */
838 	req->async_event_bitmap[0] = cpu_to_le32(0x00000022);
839 	be_dws_cpu_to_le(ctxt, sizeof(req->context));
840 
841 	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);
842 
843 	status = be_mbox_notify_wait(adapter);
844 	if (!status) {
845 		struct be_cmd_resp_mcc_create *resp = embedded_payload(wrb);
846 		mccq->id = le16_to_cpu(resp->id);
847 		mccq->created = true;
848 	}
849 	mutex_unlock(&adapter->mbox_lock);
850 
851 	return status;
852 }
853 
be_cmd_mccq_org_create(struct be_adapter * adapter,struct be_queue_info * mccq,struct be_queue_info * cq)854 int be_cmd_mccq_org_create(struct be_adapter *adapter,
855 			struct be_queue_info *mccq,
856 			struct be_queue_info *cq)
857 {
858 	struct be_mcc_wrb *wrb;
859 	struct be_cmd_req_mcc_create *req;
860 	struct be_dma_mem *q_mem = &mccq->dma_mem;
861 	void *ctxt;
862 	int status;
863 
864 	if (mutex_lock_interruptible(&adapter->mbox_lock))
865 		return -1;
866 
867 	wrb = wrb_from_mbox(adapter);
868 	req = embedded_payload(wrb);
869 	ctxt = &req->context;
870 
871 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
872 			OPCODE_COMMON_MCC_CREATE, sizeof(*req), wrb, NULL);
873 
874 	req->num_pages = cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size));
875 
876 	AMAP_SET_BITS(struct amap_mcc_context_be, valid, ctxt, 1);
877 	AMAP_SET_BITS(struct amap_mcc_context_be, ring_size, ctxt,
878 			be_encoded_q_len(mccq->len));
879 	AMAP_SET_BITS(struct amap_mcc_context_be, cq_id, ctxt, cq->id);
880 
881 	be_dws_cpu_to_le(ctxt, sizeof(req->context));
882 
883 	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);
884 
885 	status = be_mbox_notify_wait(adapter);
886 	if (!status) {
887 		struct be_cmd_resp_mcc_create *resp = embedded_payload(wrb);
888 		mccq->id = le16_to_cpu(resp->id);
889 		mccq->created = true;
890 	}
891 
892 	mutex_unlock(&adapter->mbox_lock);
893 	return status;
894 }
895 
be_cmd_mccq_create(struct be_adapter * adapter,struct be_queue_info * mccq,struct be_queue_info * cq)896 int be_cmd_mccq_create(struct be_adapter *adapter,
897 			struct be_queue_info *mccq,
898 			struct be_queue_info *cq)
899 {
900 	int status;
901 
902 	status = be_cmd_mccq_ext_create(adapter, mccq, cq);
903 	if (status && !lancer_chip(adapter)) {
904 		dev_warn(&adapter->pdev->dev, "Upgrade to F/W ver 2.102.235.0 "
905 			"or newer to avoid conflicting priorities between NIC "
906 			"and FCoE traffic");
907 		status = be_cmd_mccq_org_create(adapter, mccq, cq);
908 	}
909 	return status;
910 }
911 
be_cmd_txq_create(struct be_adapter * adapter,struct be_queue_info * txq,struct be_queue_info * cq)912 int be_cmd_txq_create(struct be_adapter *adapter,
913 			struct be_queue_info *txq,
914 			struct be_queue_info *cq)
915 {
916 	struct be_mcc_wrb *wrb;
917 	struct be_cmd_req_eth_tx_create *req;
918 	struct be_dma_mem *q_mem = &txq->dma_mem;
919 	void *ctxt;
920 	int status;
921 
922 	spin_lock_bh(&adapter->mcc_lock);
923 
924 	wrb = wrb_from_mccq(adapter);
925 	if (!wrb) {
926 		status = -EBUSY;
927 		goto err;
928 	}
929 
930 	req = embedded_payload(wrb);
931 	ctxt = &req->context;
932 
933 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,
934 		OPCODE_ETH_TX_CREATE, sizeof(*req), wrb, NULL);
935 
936 	if (lancer_chip(adapter)) {
937 		req->hdr.version = 1;
938 		AMAP_SET_BITS(struct amap_tx_context, if_id, ctxt,
939 					adapter->if_handle);
940 	}
941 
942 	req->num_pages = PAGES_4K_SPANNED(q_mem->va, q_mem->size);
943 	req->ulp_num = BE_ULP1_NUM;
944 	req->type = BE_ETH_TX_RING_TYPE_STANDARD;
945 
946 	AMAP_SET_BITS(struct amap_tx_context, tx_ring_size, ctxt,
947 		be_encoded_q_len(txq->len));
948 	AMAP_SET_BITS(struct amap_tx_context, ctx_valid, ctxt, 1);
949 	AMAP_SET_BITS(struct amap_tx_context, cq_id_send, ctxt, cq->id);
950 
951 	be_dws_cpu_to_le(ctxt, sizeof(req->context));
952 
953 	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);
954 
955 	status = be_mcc_notify_wait(adapter);
956 	if (!status) {
957 		struct be_cmd_resp_eth_tx_create *resp = embedded_payload(wrb);
958 		txq->id = le16_to_cpu(resp->cid);
959 		txq->created = true;
960 	}
961 
962 err:
963 	spin_unlock_bh(&adapter->mcc_lock);
964 
965 	return status;
966 }
967 
968 /* Uses MCC */
be_cmd_rxq_create(struct be_adapter * adapter,struct be_queue_info * rxq,u16 cq_id,u16 frag_size,u32 if_id,u32 rss,u8 * rss_id)969 int be_cmd_rxq_create(struct be_adapter *adapter,
970 		struct be_queue_info *rxq, u16 cq_id, u16 frag_size,
971 		u32 if_id, u32 rss, u8 *rss_id)
972 {
973 	struct be_mcc_wrb *wrb;
974 	struct be_cmd_req_eth_rx_create *req;
975 	struct be_dma_mem *q_mem = &rxq->dma_mem;
976 	int status;
977 
978 	spin_lock_bh(&adapter->mcc_lock);
979 
980 	wrb = wrb_from_mccq(adapter);
981 	if (!wrb) {
982 		status = -EBUSY;
983 		goto err;
984 	}
985 	req = embedded_payload(wrb);
986 
987 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,
988 				OPCODE_ETH_RX_CREATE, sizeof(*req), wrb, NULL);
989 
990 	req->cq_id = cpu_to_le16(cq_id);
991 	req->frag_size = fls(frag_size) - 1;
992 	req->num_pages = 2;
993 	be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem);
994 	req->interface_id = cpu_to_le32(if_id);
995 	req->max_frame_size = cpu_to_le16(BE_MAX_JUMBO_FRAME_SIZE);
996 	req->rss_queue = cpu_to_le32(rss);
997 
998 	status = be_mcc_notify_wait(adapter);
999 	if (!status) {
1000 		struct be_cmd_resp_eth_rx_create *resp = embedded_payload(wrb);
1001 		rxq->id = le16_to_cpu(resp->id);
1002 		rxq->created = true;
1003 		*rss_id = resp->rss_id;
1004 	}
1005 
1006 err:
1007 	spin_unlock_bh(&adapter->mcc_lock);
1008 	return status;
1009 }
1010 
1011 /* Generic destroyer function for all types of queues
1012  * Uses Mbox
1013  */
be_cmd_q_destroy(struct be_adapter * adapter,struct be_queue_info * q,int queue_type)1014 int be_cmd_q_destroy(struct be_adapter *adapter, struct be_queue_info *q,
1015 		int queue_type)
1016 {
1017 	struct be_mcc_wrb *wrb;
1018 	struct be_cmd_req_q_destroy *req;
1019 	u8 subsys = 0, opcode = 0;
1020 	int status;
1021 
1022 	if (mutex_lock_interruptible(&adapter->mbox_lock))
1023 		return -1;
1024 
1025 	wrb = wrb_from_mbox(adapter);
1026 	req = embedded_payload(wrb);
1027 
1028 	switch (queue_type) {
1029 	case QTYPE_EQ:
1030 		subsys = CMD_SUBSYSTEM_COMMON;
1031 		opcode = OPCODE_COMMON_EQ_DESTROY;
1032 		break;
1033 	case QTYPE_CQ:
1034 		subsys = CMD_SUBSYSTEM_COMMON;
1035 		opcode = OPCODE_COMMON_CQ_DESTROY;
1036 		break;
1037 	case QTYPE_TXQ:
1038 		subsys = CMD_SUBSYSTEM_ETH;
1039 		opcode = OPCODE_ETH_TX_DESTROY;
1040 		break;
1041 	case QTYPE_RXQ:
1042 		subsys = CMD_SUBSYSTEM_ETH;
1043 		opcode = OPCODE_ETH_RX_DESTROY;
1044 		break;
1045 	case QTYPE_MCCQ:
1046 		subsys = CMD_SUBSYSTEM_COMMON;
1047 		opcode = OPCODE_COMMON_MCC_DESTROY;
1048 		break;
1049 	default:
1050 		BUG();
1051 	}
1052 
1053 	be_wrb_cmd_hdr_prepare(&req->hdr, subsys, opcode, sizeof(*req), wrb,
1054 				NULL);
1055 	req->id = cpu_to_le16(q->id);
1056 
1057 	status = be_mbox_notify_wait(adapter);
1058 	if (!status)
1059 		q->created = false;
1060 
1061 	mutex_unlock(&adapter->mbox_lock);
1062 	return status;
1063 }
1064 
1065 /* Uses MCC */
be_cmd_rxq_destroy(struct be_adapter * adapter,struct be_queue_info * q)1066 int be_cmd_rxq_destroy(struct be_adapter *adapter, struct be_queue_info *q)
1067 {
1068 	struct be_mcc_wrb *wrb;
1069 	struct be_cmd_req_q_destroy *req;
1070 	int status;
1071 
1072 	spin_lock_bh(&adapter->mcc_lock);
1073 
1074 	wrb = wrb_from_mccq(adapter);
1075 	if (!wrb) {
1076 		status = -EBUSY;
1077 		goto err;
1078 	}
1079 	req = embedded_payload(wrb);
1080 
1081 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,
1082 			OPCODE_ETH_RX_DESTROY, sizeof(*req), wrb, NULL);
1083 	req->id = cpu_to_le16(q->id);
1084 
1085 	status = be_mcc_notify_wait(adapter);
1086 	if (!status)
1087 		q->created = false;
1088 
1089 err:
1090 	spin_unlock_bh(&adapter->mcc_lock);
1091 	return status;
1092 }
1093 
1094 /* Create an rx filtering policy configuration on an i/f
1095  * Uses MCCQ
1096  */
be_cmd_if_create(struct be_adapter * adapter,u32 cap_flags,u32 en_flags,u8 * mac,u32 * if_handle,u32 * pmac_id,u32 domain)1097 int be_cmd_if_create(struct be_adapter *adapter, u32 cap_flags, u32 en_flags,
1098 		u8 *mac, u32 *if_handle, u32 *pmac_id, u32 domain)
1099 {
1100 	struct be_mcc_wrb *wrb;
1101 	struct be_cmd_req_if_create *req;
1102 	int status;
1103 
1104 	spin_lock_bh(&adapter->mcc_lock);
1105 
1106 	wrb = wrb_from_mccq(adapter);
1107 	if (!wrb) {
1108 		status = -EBUSY;
1109 		goto err;
1110 	}
1111 	req = embedded_payload(wrb);
1112 
1113 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1114 		OPCODE_COMMON_NTWK_INTERFACE_CREATE, sizeof(*req), wrb, NULL);
1115 	req->hdr.domain = domain;
1116 	req->capability_flags = cpu_to_le32(cap_flags);
1117 	req->enable_flags = cpu_to_le32(en_flags);
1118 	if (mac)
1119 		memcpy(req->mac_addr, mac, ETH_ALEN);
1120 	else
1121 		req->pmac_invalid = true;
1122 
1123 	status = be_mcc_notify_wait(adapter);
1124 	if (!status) {
1125 		struct be_cmd_resp_if_create *resp = embedded_payload(wrb);
1126 		*if_handle = le32_to_cpu(resp->interface_id);
1127 		if (mac)
1128 			*pmac_id = le32_to_cpu(resp->pmac_id);
1129 	}
1130 
1131 err:
1132 	spin_unlock_bh(&adapter->mcc_lock);
1133 	return status;
1134 }
1135 
1136 /* Uses MCCQ */
be_cmd_if_destroy(struct be_adapter * adapter,int interface_id,u32 domain)1137 int be_cmd_if_destroy(struct be_adapter *adapter, int interface_id, u32 domain)
1138 {
1139 	struct be_mcc_wrb *wrb;
1140 	struct be_cmd_req_if_destroy *req;
1141 	int status;
1142 
1143 	if (interface_id == -1)
1144 		return 0;
1145 
1146 	spin_lock_bh(&adapter->mcc_lock);
1147 
1148 	wrb = wrb_from_mccq(adapter);
1149 	if (!wrb) {
1150 		status = -EBUSY;
1151 		goto err;
1152 	}
1153 	req = embedded_payload(wrb);
1154 
1155 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1156 		OPCODE_COMMON_NTWK_INTERFACE_DESTROY, sizeof(*req), wrb, NULL);
1157 	req->hdr.domain = domain;
1158 	req->interface_id = cpu_to_le32(interface_id);
1159 
1160 	status = be_mcc_notify_wait(adapter);
1161 err:
1162 	spin_unlock_bh(&adapter->mcc_lock);
1163 	return status;
1164 }
1165 
1166 /* Get stats is a non embedded command: the request is not embedded inside
1167  * WRB but is a separate dma memory block
1168  * Uses asynchronous MCC
1169  */
be_cmd_get_stats(struct be_adapter * adapter,struct be_dma_mem * nonemb_cmd)1170 int be_cmd_get_stats(struct be_adapter *adapter, struct be_dma_mem *nonemb_cmd)
1171 {
1172 	struct be_mcc_wrb *wrb;
1173 	struct be_cmd_req_hdr *hdr;
1174 	int status = 0;
1175 
1176 	if (MODULO(adapter->work_counter, be_get_temp_freq) == 0)
1177 		be_cmd_get_die_temperature(adapter);
1178 
1179 	spin_lock_bh(&adapter->mcc_lock);
1180 
1181 	wrb = wrb_from_mccq(adapter);
1182 	if (!wrb) {
1183 		status = -EBUSY;
1184 		goto err;
1185 	}
1186 	hdr = nonemb_cmd->va;
1187 
1188 	be_wrb_cmd_hdr_prepare(hdr, CMD_SUBSYSTEM_ETH,
1189 		OPCODE_ETH_GET_STATISTICS, nonemb_cmd->size, wrb, nonemb_cmd);
1190 
1191 	if (adapter->generation == BE_GEN3)
1192 		hdr->version = 1;
1193 
1194 	be_mcc_notify(adapter);
1195 	adapter->stats_cmd_sent = true;
1196 
1197 err:
1198 	spin_unlock_bh(&adapter->mcc_lock);
1199 	return status;
1200 }
1201 
1202 /* Lancer Stats */
lancer_cmd_get_pport_stats(struct be_adapter * adapter,struct be_dma_mem * nonemb_cmd)1203 int lancer_cmd_get_pport_stats(struct be_adapter *adapter,
1204 				struct be_dma_mem *nonemb_cmd)
1205 {
1206 
1207 	struct be_mcc_wrb *wrb;
1208 	struct lancer_cmd_req_pport_stats *req;
1209 	int status = 0;
1210 
1211 	spin_lock_bh(&adapter->mcc_lock);
1212 
1213 	wrb = wrb_from_mccq(adapter);
1214 	if (!wrb) {
1215 		status = -EBUSY;
1216 		goto err;
1217 	}
1218 	req = nonemb_cmd->va;
1219 
1220 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,
1221 			OPCODE_ETH_GET_PPORT_STATS, nonemb_cmd->size, wrb,
1222 			nonemb_cmd);
1223 
1224 	req->cmd_params.params.pport_num = cpu_to_le16(adapter->port_num);
1225 	req->cmd_params.params.reset_stats = 0;
1226 
1227 	be_mcc_notify(adapter);
1228 	adapter->stats_cmd_sent = true;
1229 
1230 err:
1231 	spin_unlock_bh(&adapter->mcc_lock);
1232 	return status;
1233 }
1234 
1235 /* Uses synchronous mcc */
be_cmd_link_status_query(struct be_adapter * adapter,u8 * mac_speed,u16 * link_speed,u8 * link_status,u32 dom)1236 int be_cmd_link_status_query(struct be_adapter *adapter, u8 *mac_speed,
1237 			     u16 *link_speed, u8 *link_status, u32 dom)
1238 {
1239 	struct be_mcc_wrb *wrb;
1240 	struct be_cmd_req_link_status *req;
1241 	int status;
1242 
1243 	spin_lock_bh(&adapter->mcc_lock);
1244 
1245 	if (link_status)
1246 		*link_status = LINK_DOWN;
1247 
1248 	wrb = wrb_from_mccq(adapter);
1249 	if (!wrb) {
1250 		status = -EBUSY;
1251 		goto err;
1252 	}
1253 	req = embedded_payload(wrb);
1254 
1255 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1256 		OPCODE_COMMON_NTWK_LINK_STATUS_QUERY, sizeof(*req), wrb, NULL);
1257 
1258 	if (adapter->generation == BE_GEN3 || lancer_chip(adapter))
1259 		req->hdr.version = 1;
1260 
1261 	req->hdr.domain = dom;
1262 
1263 	status = be_mcc_notify_wait(adapter);
1264 	if (!status) {
1265 		struct be_cmd_resp_link_status *resp = embedded_payload(wrb);
1266 		if (resp->mac_speed != PHY_LINK_SPEED_ZERO) {
1267 			if (link_speed)
1268 				*link_speed = le16_to_cpu(resp->link_speed);
1269 			if (mac_speed)
1270 				*mac_speed = resp->mac_speed;
1271 		}
1272 		if (link_status)
1273 			*link_status = resp->logical_link_status;
1274 	}
1275 
1276 err:
1277 	spin_unlock_bh(&adapter->mcc_lock);
1278 	return status;
1279 }
1280 
1281 /* Uses synchronous mcc */
be_cmd_get_die_temperature(struct be_adapter * adapter)1282 int be_cmd_get_die_temperature(struct be_adapter *adapter)
1283 {
1284 	struct be_mcc_wrb *wrb;
1285 	struct be_cmd_req_get_cntl_addnl_attribs *req;
1286 	u16 mccq_index;
1287 	int status;
1288 
1289 	spin_lock_bh(&adapter->mcc_lock);
1290 
1291 	mccq_index = adapter->mcc_obj.q.head;
1292 
1293 	wrb = wrb_from_mccq(adapter);
1294 	if (!wrb) {
1295 		status = -EBUSY;
1296 		goto err;
1297 	}
1298 	req = embedded_payload(wrb);
1299 
1300 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1301 		OPCODE_COMMON_GET_CNTL_ADDITIONAL_ATTRIBUTES, sizeof(*req),
1302 		wrb, NULL);
1303 
1304 	wrb->tag1 = mccq_index;
1305 
1306 	be_mcc_notify(adapter);
1307 
1308 err:
1309 	spin_unlock_bh(&adapter->mcc_lock);
1310 	return status;
1311 }
1312 
1313 /* Uses synchronous mcc */
be_cmd_get_reg_len(struct be_adapter * adapter,u32 * log_size)1314 int be_cmd_get_reg_len(struct be_adapter *adapter, u32 *log_size)
1315 {
1316 	struct be_mcc_wrb *wrb;
1317 	struct be_cmd_req_get_fat *req;
1318 	int status;
1319 
1320 	spin_lock_bh(&adapter->mcc_lock);
1321 
1322 	wrb = wrb_from_mccq(adapter);
1323 	if (!wrb) {
1324 		status = -EBUSY;
1325 		goto err;
1326 	}
1327 	req = embedded_payload(wrb);
1328 
1329 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1330 		OPCODE_COMMON_MANAGE_FAT, sizeof(*req), wrb, NULL);
1331 	req->fat_operation = cpu_to_le32(QUERY_FAT);
1332 	status = be_mcc_notify_wait(adapter);
1333 	if (!status) {
1334 		struct be_cmd_resp_get_fat *resp = embedded_payload(wrb);
1335 		if (log_size && resp->log_size)
1336 			*log_size = le32_to_cpu(resp->log_size) -
1337 					sizeof(u32);
1338 	}
1339 err:
1340 	spin_unlock_bh(&adapter->mcc_lock);
1341 	return status;
1342 }
1343 
be_cmd_get_regs(struct be_adapter * adapter,u32 buf_len,void * buf)1344 void be_cmd_get_regs(struct be_adapter *adapter, u32 buf_len, void *buf)
1345 {
1346 	struct be_dma_mem get_fat_cmd;
1347 	struct be_mcc_wrb *wrb;
1348 	struct be_cmd_req_get_fat *req;
1349 	u32 offset = 0, total_size, buf_size,
1350 				log_offset = sizeof(u32), payload_len;
1351 	int status;
1352 
1353 	if (buf_len == 0)
1354 		return;
1355 
1356 	total_size = buf_len;
1357 
1358 	get_fat_cmd.size = sizeof(struct be_cmd_req_get_fat) + 60*1024;
1359 	get_fat_cmd.va = pci_alloc_consistent(adapter->pdev,
1360 			get_fat_cmd.size,
1361 			&get_fat_cmd.dma);
1362 	if (!get_fat_cmd.va) {
1363 		status = -ENOMEM;
1364 		dev_err(&adapter->pdev->dev,
1365 		"Memory allocation failure while retrieving FAT data\n");
1366 		return;
1367 	}
1368 
1369 	spin_lock_bh(&adapter->mcc_lock);
1370 
1371 	while (total_size) {
1372 		buf_size = min(total_size, (u32)60*1024);
1373 		total_size -= buf_size;
1374 
1375 		wrb = wrb_from_mccq(adapter);
1376 		if (!wrb) {
1377 			status = -EBUSY;
1378 			goto err;
1379 		}
1380 		req = get_fat_cmd.va;
1381 
1382 		payload_len = sizeof(struct be_cmd_req_get_fat) + buf_size;
1383 		be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1384 				OPCODE_COMMON_MANAGE_FAT, payload_len, wrb,
1385 				&get_fat_cmd);
1386 
1387 		req->fat_operation = cpu_to_le32(RETRIEVE_FAT);
1388 		req->read_log_offset = cpu_to_le32(log_offset);
1389 		req->read_log_length = cpu_to_le32(buf_size);
1390 		req->data_buffer_size = cpu_to_le32(buf_size);
1391 
1392 		status = be_mcc_notify_wait(adapter);
1393 		if (!status) {
1394 			struct be_cmd_resp_get_fat *resp = get_fat_cmd.va;
1395 			memcpy(buf + offset,
1396 				resp->data_buffer,
1397 				le32_to_cpu(resp->read_log_length));
1398 		} else {
1399 			dev_err(&adapter->pdev->dev, "FAT Table Retrieve error\n");
1400 			goto err;
1401 		}
1402 		offset += buf_size;
1403 		log_offset += buf_size;
1404 	}
1405 err:
1406 	pci_free_consistent(adapter->pdev, get_fat_cmd.size,
1407 			get_fat_cmd.va,
1408 			get_fat_cmd.dma);
1409 	spin_unlock_bh(&adapter->mcc_lock);
1410 }
1411 
1412 /* Uses synchronous mcc */
be_cmd_get_fw_ver(struct be_adapter * adapter,char * fw_ver,char * fw_on_flash)1413 int be_cmd_get_fw_ver(struct be_adapter *adapter, char *fw_ver,
1414 			char *fw_on_flash)
1415 {
1416 	struct be_mcc_wrb *wrb;
1417 	struct be_cmd_req_get_fw_version *req;
1418 	int status;
1419 
1420 	spin_lock_bh(&adapter->mcc_lock);
1421 
1422 	wrb = wrb_from_mccq(adapter);
1423 	if (!wrb) {
1424 		status = -EBUSY;
1425 		goto err;
1426 	}
1427 
1428 	req = embedded_payload(wrb);
1429 
1430 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1431 		OPCODE_COMMON_GET_FW_VERSION, sizeof(*req), wrb, NULL);
1432 	status = be_mcc_notify_wait(adapter);
1433 	if (!status) {
1434 		struct be_cmd_resp_get_fw_version *resp = embedded_payload(wrb);
1435 		strcpy(fw_ver, resp->firmware_version_string);
1436 		if (fw_on_flash)
1437 			strcpy(fw_on_flash, resp->fw_on_flash_version_string);
1438 	}
1439 err:
1440 	spin_unlock_bh(&adapter->mcc_lock);
1441 	return status;
1442 }
1443 
1444 /* set the EQ delay interval of an EQ to specified value
1445  * Uses async mcc
1446  */
be_cmd_modify_eqd(struct be_adapter * adapter,u32 eq_id,u32 eqd)1447 int be_cmd_modify_eqd(struct be_adapter *adapter, u32 eq_id, u32 eqd)
1448 {
1449 	struct be_mcc_wrb *wrb;
1450 	struct be_cmd_req_modify_eq_delay *req;
1451 	int status = 0;
1452 
1453 	spin_lock_bh(&adapter->mcc_lock);
1454 
1455 	wrb = wrb_from_mccq(adapter);
1456 	if (!wrb) {
1457 		status = -EBUSY;
1458 		goto err;
1459 	}
1460 	req = embedded_payload(wrb);
1461 
1462 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1463 		OPCODE_COMMON_MODIFY_EQ_DELAY, sizeof(*req), wrb, NULL);
1464 
1465 	req->num_eq = cpu_to_le32(1);
1466 	req->delay[0].eq_id = cpu_to_le32(eq_id);
1467 	req->delay[0].phase = 0;
1468 	req->delay[0].delay_multiplier = cpu_to_le32(eqd);
1469 
1470 	be_mcc_notify(adapter);
1471 
1472 err:
1473 	spin_unlock_bh(&adapter->mcc_lock);
1474 	return status;
1475 }
1476 
1477 /* Uses sycnhronous mcc */
be_cmd_vlan_config(struct be_adapter * adapter,u32 if_id,u16 * vtag_array,u32 num,bool untagged,bool promiscuous)1478 int be_cmd_vlan_config(struct be_adapter *adapter, u32 if_id, u16 *vtag_array,
1479 			u32 num, bool untagged, bool promiscuous)
1480 {
1481 	struct be_mcc_wrb *wrb;
1482 	struct be_cmd_req_vlan_config *req;
1483 	int status;
1484 
1485 	spin_lock_bh(&adapter->mcc_lock);
1486 
1487 	wrb = wrb_from_mccq(adapter);
1488 	if (!wrb) {
1489 		status = -EBUSY;
1490 		goto err;
1491 	}
1492 	req = embedded_payload(wrb);
1493 
1494 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1495 		OPCODE_COMMON_NTWK_VLAN_CONFIG, sizeof(*req), wrb, NULL);
1496 
1497 	req->interface_id = if_id;
1498 	req->promiscuous = promiscuous;
1499 	req->untagged = untagged;
1500 	req->num_vlan = num;
1501 	if (!promiscuous) {
1502 		memcpy(req->normal_vlan, vtag_array,
1503 			req->num_vlan * sizeof(vtag_array[0]));
1504 	}
1505 
1506 	status = be_mcc_notify_wait(adapter);
1507 
1508 err:
1509 	spin_unlock_bh(&adapter->mcc_lock);
1510 	return status;
1511 }
1512 
be_cmd_rx_filter(struct be_adapter * adapter,u32 flags,u32 value)1513 int be_cmd_rx_filter(struct be_adapter *adapter, u32 flags, u32 value)
1514 {
1515 	struct be_mcc_wrb *wrb;
1516 	struct be_dma_mem *mem = &adapter->rx_filter;
1517 	struct be_cmd_req_rx_filter *req = mem->va;
1518 	int status;
1519 
1520 	spin_lock_bh(&adapter->mcc_lock);
1521 
1522 	wrb = wrb_from_mccq(adapter);
1523 	if (!wrb) {
1524 		status = -EBUSY;
1525 		goto err;
1526 	}
1527 	memset(req, 0, sizeof(*req));
1528 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1529 				OPCODE_COMMON_NTWK_RX_FILTER, sizeof(*req),
1530 				wrb, mem);
1531 
1532 	req->if_id = cpu_to_le32(adapter->if_handle);
1533 	if (flags & IFF_PROMISC) {
1534 		req->if_flags_mask = cpu_to_le32(BE_IF_FLAGS_PROMISCUOUS |
1535 					BE_IF_FLAGS_VLAN_PROMISCUOUS);
1536 		if (value == ON)
1537 			req->if_flags = cpu_to_le32(BE_IF_FLAGS_PROMISCUOUS |
1538 						BE_IF_FLAGS_VLAN_PROMISCUOUS);
1539 	} else if (flags & IFF_ALLMULTI) {
1540 		req->if_flags_mask = req->if_flags =
1541 				cpu_to_le32(BE_IF_FLAGS_MCAST_PROMISCUOUS);
1542 	} else {
1543 		struct netdev_hw_addr *ha;
1544 		int i = 0;
1545 
1546 		req->if_flags_mask = req->if_flags =
1547 				cpu_to_le32(BE_IF_FLAGS_MULTICAST);
1548 
1549 		/* Reset mcast promisc mode if already set by setting mask
1550 		 * and not setting flags field
1551 		 */
1552 		req->if_flags_mask |=
1553 				cpu_to_le32(BE_IF_FLAGS_MCAST_PROMISCUOUS);
1554 
1555 		req->mcast_num = cpu_to_le32(netdev_mc_count(adapter->netdev));
1556 		netdev_for_each_mc_addr(ha, adapter->netdev)
1557 			memcpy(req->mcast_mac[i++].byte, ha->addr, ETH_ALEN);
1558 	}
1559 
1560 	status = be_mcc_notify_wait(adapter);
1561 err:
1562 	spin_unlock_bh(&adapter->mcc_lock);
1563 	return status;
1564 }
1565 
1566 /* Uses synchrounous mcc */
be_cmd_set_flow_control(struct be_adapter * adapter,u32 tx_fc,u32 rx_fc)1567 int be_cmd_set_flow_control(struct be_adapter *adapter, u32 tx_fc, u32 rx_fc)
1568 {
1569 	struct be_mcc_wrb *wrb;
1570 	struct be_cmd_req_set_flow_control *req;
1571 	int status;
1572 
1573 	spin_lock_bh(&adapter->mcc_lock);
1574 
1575 	wrb = wrb_from_mccq(adapter);
1576 	if (!wrb) {
1577 		status = -EBUSY;
1578 		goto err;
1579 	}
1580 	req = embedded_payload(wrb);
1581 
1582 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1583 		OPCODE_COMMON_SET_FLOW_CONTROL, sizeof(*req), wrb, NULL);
1584 
1585 	req->tx_flow_control = cpu_to_le16((u16)tx_fc);
1586 	req->rx_flow_control = cpu_to_le16((u16)rx_fc);
1587 
1588 	status = be_mcc_notify_wait(adapter);
1589 
1590 err:
1591 	spin_unlock_bh(&adapter->mcc_lock);
1592 	return status;
1593 }
1594 
1595 /* Uses sycn mcc */
be_cmd_get_flow_control(struct be_adapter * adapter,u32 * tx_fc,u32 * rx_fc)1596 int be_cmd_get_flow_control(struct be_adapter *adapter, u32 *tx_fc, u32 *rx_fc)
1597 {
1598 	struct be_mcc_wrb *wrb;
1599 	struct be_cmd_req_get_flow_control *req;
1600 	int status;
1601 
1602 	spin_lock_bh(&adapter->mcc_lock);
1603 
1604 	wrb = wrb_from_mccq(adapter);
1605 	if (!wrb) {
1606 		status = -EBUSY;
1607 		goto err;
1608 	}
1609 	req = embedded_payload(wrb);
1610 
1611 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1612 		OPCODE_COMMON_GET_FLOW_CONTROL, sizeof(*req), wrb, NULL);
1613 
1614 	status = be_mcc_notify_wait(adapter);
1615 	if (!status) {
1616 		struct be_cmd_resp_get_flow_control *resp =
1617 						embedded_payload(wrb);
1618 		*tx_fc = le16_to_cpu(resp->tx_flow_control);
1619 		*rx_fc = le16_to_cpu(resp->rx_flow_control);
1620 	}
1621 
1622 err:
1623 	spin_unlock_bh(&adapter->mcc_lock);
1624 	return status;
1625 }
1626 
1627 /* Uses mbox */
be_cmd_query_fw_cfg(struct be_adapter * adapter,u32 * port_num,u32 * mode,u32 * caps)1628 int be_cmd_query_fw_cfg(struct be_adapter *adapter, u32 *port_num,
1629 		u32 *mode, u32 *caps)
1630 {
1631 	struct be_mcc_wrb *wrb;
1632 	struct be_cmd_req_query_fw_cfg *req;
1633 	int status;
1634 
1635 	if (mutex_lock_interruptible(&adapter->mbox_lock))
1636 		return -1;
1637 
1638 	wrb = wrb_from_mbox(adapter);
1639 	req = embedded_payload(wrb);
1640 
1641 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1642 		OPCODE_COMMON_QUERY_FIRMWARE_CONFIG, sizeof(*req), wrb, NULL);
1643 
1644 	status = be_mbox_notify_wait(adapter);
1645 	if (!status) {
1646 		struct be_cmd_resp_query_fw_cfg *resp = embedded_payload(wrb);
1647 		*port_num = le32_to_cpu(resp->phys_port);
1648 		*mode = le32_to_cpu(resp->function_mode);
1649 		*caps = le32_to_cpu(resp->function_caps);
1650 	}
1651 
1652 	mutex_unlock(&adapter->mbox_lock);
1653 	return status;
1654 }
1655 
1656 /* Uses mbox */
be_cmd_reset_function(struct be_adapter * adapter)1657 int be_cmd_reset_function(struct be_adapter *adapter)
1658 {
1659 	struct be_mcc_wrb *wrb;
1660 	struct be_cmd_req_hdr *req;
1661 	int status;
1662 
1663 	if (mutex_lock_interruptible(&adapter->mbox_lock))
1664 		return -1;
1665 
1666 	wrb = wrb_from_mbox(adapter);
1667 	req = embedded_payload(wrb);
1668 
1669 	be_wrb_cmd_hdr_prepare(req, CMD_SUBSYSTEM_COMMON,
1670 		OPCODE_COMMON_FUNCTION_RESET, sizeof(*req), wrb, NULL);
1671 
1672 	status = be_mbox_notify_wait(adapter);
1673 
1674 	mutex_unlock(&adapter->mbox_lock);
1675 	return status;
1676 }
1677 
be_cmd_rss_config(struct be_adapter * adapter,u8 * rsstable,u16 table_size)1678 int be_cmd_rss_config(struct be_adapter *adapter, u8 *rsstable, u16 table_size)
1679 {
1680 	struct be_mcc_wrb *wrb;
1681 	struct be_cmd_req_rss_config *req;
1682 	u32 myhash[10] = {0x15d43fa5, 0x2534685a, 0x5f87693a, 0x5668494e,
1683 			0x33cf6a53, 0x383334c6, 0x76ac4257, 0x59b242b2,
1684 			0x3ea83c02, 0x4a110304};
1685 	int status;
1686 
1687 	if (mutex_lock_interruptible(&adapter->mbox_lock))
1688 		return -1;
1689 
1690 	wrb = wrb_from_mbox(adapter);
1691 	req = embedded_payload(wrb);
1692 
1693 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,
1694 		OPCODE_ETH_RSS_CONFIG, sizeof(*req), wrb, NULL);
1695 
1696 	req->if_id = cpu_to_le32(adapter->if_handle);
1697 	req->enable_rss = cpu_to_le16(RSS_ENABLE_TCP_IPV4 | RSS_ENABLE_IPV4 |
1698 				      RSS_ENABLE_TCP_IPV6 | RSS_ENABLE_IPV6);
1699 	req->cpu_table_size_log2 = cpu_to_le16(fls(table_size) - 1);
1700 	memcpy(req->cpu_table, rsstable, table_size);
1701 	memcpy(req->hash, myhash, sizeof(myhash));
1702 	be_dws_cpu_to_le(req->hash, sizeof(req->hash));
1703 
1704 	status = be_mbox_notify_wait(adapter);
1705 
1706 	mutex_unlock(&adapter->mbox_lock);
1707 	return status;
1708 }
1709 
1710 /* Uses sync mcc */
be_cmd_set_beacon_state(struct be_adapter * adapter,u8 port_num,u8 bcn,u8 sts,u8 state)1711 int be_cmd_set_beacon_state(struct be_adapter *adapter, u8 port_num,
1712 			u8 bcn, u8 sts, u8 state)
1713 {
1714 	struct be_mcc_wrb *wrb;
1715 	struct be_cmd_req_enable_disable_beacon *req;
1716 	int status;
1717 
1718 	spin_lock_bh(&adapter->mcc_lock);
1719 
1720 	wrb = wrb_from_mccq(adapter);
1721 	if (!wrb) {
1722 		status = -EBUSY;
1723 		goto err;
1724 	}
1725 	req = embedded_payload(wrb);
1726 
1727 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1728 		OPCODE_COMMON_ENABLE_DISABLE_BEACON, sizeof(*req), wrb, NULL);
1729 
1730 	req->port_num = port_num;
1731 	req->beacon_state = state;
1732 	req->beacon_duration = bcn;
1733 	req->status_duration = sts;
1734 
1735 	status = be_mcc_notify_wait(adapter);
1736 
1737 err:
1738 	spin_unlock_bh(&adapter->mcc_lock);
1739 	return status;
1740 }
1741 
1742 /* Uses sync mcc */
be_cmd_get_beacon_state(struct be_adapter * adapter,u8 port_num,u32 * state)1743 int be_cmd_get_beacon_state(struct be_adapter *adapter, u8 port_num, u32 *state)
1744 {
1745 	struct be_mcc_wrb *wrb;
1746 	struct be_cmd_req_get_beacon_state *req;
1747 	int status;
1748 
1749 	spin_lock_bh(&adapter->mcc_lock);
1750 
1751 	wrb = wrb_from_mccq(adapter);
1752 	if (!wrb) {
1753 		status = -EBUSY;
1754 		goto err;
1755 	}
1756 	req = embedded_payload(wrb);
1757 
1758 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1759 		OPCODE_COMMON_GET_BEACON_STATE, sizeof(*req), wrb, NULL);
1760 
1761 	req->port_num = port_num;
1762 
1763 	status = be_mcc_notify_wait(adapter);
1764 	if (!status) {
1765 		struct be_cmd_resp_get_beacon_state *resp =
1766 						embedded_payload(wrb);
1767 		*state = resp->beacon_state;
1768 	}
1769 
1770 err:
1771 	spin_unlock_bh(&adapter->mcc_lock);
1772 	return status;
1773 }
1774 
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)1775 int lancer_cmd_write_object(struct be_adapter *adapter, struct be_dma_mem *cmd,
1776 			u32 data_size, u32 data_offset, const char *obj_name,
1777 			u32 *data_written, u8 *addn_status)
1778 {
1779 	struct be_mcc_wrb *wrb;
1780 	struct lancer_cmd_req_write_object *req;
1781 	struct lancer_cmd_resp_write_object *resp;
1782 	void *ctxt = NULL;
1783 	int status;
1784 
1785 	spin_lock_bh(&adapter->mcc_lock);
1786 	adapter->flash_status = 0;
1787 
1788 	wrb = wrb_from_mccq(adapter);
1789 	if (!wrb) {
1790 		status = -EBUSY;
1791 		goto err_unlock;
1792 	}
1793 
1794 	req = embedded_payload(wrb);
1795 
1796 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1797 				OPCODE_COMMON_WRITE_OBJECT,
1798 				sizeof(struct lancer_cmd_req_write_object), wrb,
1799 				NULL);
1800 
1801 	ctxt = &req->context;
1802 	AMAP_SET_BITS(struct amap_lancer_write_obj_context,
1803 			write_length, ctxt, data_size);
1804 
1805 	if (data_size == 0)
1806 		AMAP_SET_BITS(struct amap_lancer_write_obj_context,
1807 				eof, ctxt, 1);
1808 	else
1809 		AMAP_SET_BITS(struct amap_lancer_write_obj_context,
1810 				eof, ctxt, 0);
1811 
1812 	be_dws_cpu_to_le(ctxt, sizeof(req->context));
1813 	req->write_offset = cpu_to_le32(data_offset);
1814 	strcpy(req->object_name, obj_name);
1815 	req->descriptor_count = cpu_to_le32(1);
1816 	req->buf_len = cpu_to_le32(data_size);
1817 	req->addr_low = cpu_to_le32((cmd->dma +
1818 				sizeof(struct lancer_cmd_req_write_object))
1819 				& 0xFFFFFFFF);
1820 	req->addr_high = cpu_to_le32(upper_32_bits(cmd->dma +
1821 				sizeof(struct lancer_cmd_req_write_object)));
1822 
1823 	be_mcc_notify(adapter);
1824 	spin_unlock_bh(&adapter->mcc_lock);
1825 
1826 	if (!wait_for_completion_timeout(&adapter->flash_compl,
1827 			msecs_to_jiffies(12000)))
1828 		status = -1;
1829 	else
1830 		status = adapter->flash_status;
1831 
1832 	resp = embedded_payload(wrb);
1833 	if (!status) {
1834 		*data_written = le32_to_cpu(resp->actual_write_len);
1835 	} else {
1836 		*addn_status = resp->additional_status;
1837 		status = resp->status;
1838 	}
1839 
1840 	return status;
1841 
1842 err_unlock:
1843 	spin_unlock_bh(&adapter->mcc_lock);
1844 	return status;
1845 }
1846 
lancer_cmd_read_object(struct be_adapter * adapter,struct be_dma_mem * cmd,u32 data_size,u32 data_offset,const char * obj_name,u32 * data_read,u32 * eof,u8 * addn_status)1847 int lancer_cmd_read_object(struct be_adapter *adapter, struct be_dma_mem *cmd,
1848 		u32 data_size, u32 data_offset, const char *obj_name,
1849 		u32 *data_read, u32 *eof, u8 *addn_status)
1850 {
1851 	struct be_mcc_wrb *wrb;
1852 	struct lancer_cmd_req_read_object *req;
1853 	struct lancer_cmd_resp_read_object *resp;
1854 	int status;
1855 
1856 	spin_lock_bh(&adapter->mcc_lock);
1857 
1858 	wrb = wrb_from_mccq(adapter);
1859 	if (!wrb) {
1860 		status = -EBUSY;
1861 		goto err_unlock;
1862 	}
1863 
1864 	req = embedded_payload(wrb);
1865 
1866 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1867 			OPCODE_COMMON_READ_OBJECT,
1868 			sizeof(struct lancer_cmd_req_read_object), wrb,
1869 			NULL);
1870 
1871 	req->desired_read_len = cpu_to_le32(data_size);
1872 	req->read_offset = cpu_to_le32(data_offset);
1873 	strcpy(req->object_name, obj_name);
1874 	req->descriptor_count = cpu_to_le32(1);
1875 	req->buf_len = cpu_to_le32(data_size);
1876 	req->addr_low = cpu_to_le32((cmd->dma & 0xFFFFFFFF));
1877 	req->addr_high = cpu_to_le32(upper_32_bits(cmd->dma));
1878 
1879 	status = be_mcc_notify_wait(adapter);
1880 
1881 	resp = embedded_payload(wrb);
1882 	if (!status) {
1883 		*data_read = le32_to_cpu(resp->actual_read_len);
1884 		*eof = le32_to_cpu(resp->eof);
1885 	} else {
1886 		*addn_status = resp->additional_status;
1887 	}
1888 
1889 err_unlock:
1890 	spin_unlock_bh(&adapter->mcc_lock);
1891 	return status;
1892 }
1893 
be_cmd_write_flashrom(struct be_adapter * adapter,struct be_dma_mem * cmd,u32 flash_type,u32 flash_opcode,u32 buf_size)1894 int be_cmd_write_flashrom(struct be_adapter *adapter, struct be_dma_mem *cmd,
1895 			u32 flash_type, u32 flash_opcode, u32 buf_size)
1896 {
1897 	struct be_mcc_wrb *wrb;
1898 	struct be_cmd_write_flashrom *req;
1899 	int status;
1900 
1901 	spin_lock_bh(&adapter->mcc_lock);
1902 	adapter->flash_status = 0;
1903 
1904 	wrb = wrb_from_mccq(adapter);
1905 	if (!wrb) {
1906 		status = -EBUSY;
1907 		goto err_unlock;
1908 	}
1909 	req = cmd->va;
1910 
1911 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1912 		OPCODE_COMMON_WRITE_FLASHROM, cmd->size, wrb, cmd);
1913 
1914 	req->params.op_type = cpu_to_le32(flash_type);
1915 	req->params.op_code = cpu_to_le32(flash_opcode);
1916 	req->params.data_buf_size = cpu_to_le32(buf_size);
1917 
1918 	be_mcc_notify(adapter);
1919 	spin_unlock_bh(&adapter->mcc_lock);
1920 
1921 	if (!wait_for_completion_timeout(&adapter->flash_compl,
1922 			msecs_to_jiffies(40000)))
1923 		status = -1;
1924 	else
1925 		status = adapter->flash_status;
1926 
1927 	return status;
1928 
1929 err_unlock:
1930 	spin_unlock_bh(&adapter->mcc_lock);
1931 	return status;
1932 }
1933 
be_cmd_get_flash_crc(struct be_adapter * adapter,u8 * flashed_crc,int offset)1934 int be_cmd_get_flash_crc(struct be_adapter *adapter, u8 *flashed_crc,
1935 			 int offset)
1936 {
1937 	struct be_mcc_wrb *wrb;
1938 	struct be_cmd_write_flashrom *req;
1939 	int status;
1940 
1941 	spin_lock_bh(&adapter->mcc_lock);
1942 
1943 	wrb = wrb_from_mccq(adapter);
1944 	if (!wrb) {
1945 		status = -EBUSY;
1946 		goto err;
1947 	}
1948 	req = embedded_payload(wrb);
1949 
1950 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
1951 		OPCODE_COMMON_READ_FLASHROM, sizeof(*req)+4, wrb, NULL);
1952 
1953 	req->params.op_type = cpu_to_le32(IMG_TYPE_REDBOOT);
1954 	req->params.op_code = cpu_to_le32(FLASHROM_OPER_REPORT);
1955 	req->params.offset = cpu_to_le32(offset);
1956 	req->params.data_buf_size = cpu_to_le32(0x4);
1957 
1958 	status = be_mcc_notify_wait(adapter);
1959 	if (!status)
1960 		memcpy(flashed_crc, req->params.data_buf, 4);
1961 
1962 err:
1963 	spin_unlock_bh(&adapter->mcc_lock);
1964 	return status;
1965 }
1966 
be_cmd_enable_magic_wol(struct be_adapter * adapter,u8 * mac,struct be_dma_mem * nonemb_cmd)1967 int be_cmd_enable_magic_wol(struct be_adapter *adapter, u8 *mac,
1968 				struct be_dma_mem *nonemb_cmd)
1969 {
1970 	struct be_mcc_wrb *wrb;
1971 	struct be_cmd_req_acpi_wol_magic_config *req;
1972 	int status;
1973 
1974 	spin_lock_bh(&adapter->mcc_lock);
1975 
1976 	wrb = wrb_from_mccq(adapter);
1977 	if (!wrb) {
1978 		status = -EBUSY;
1979 		goto err;
1980 	}
1981 	req = nonemb_cmd->va;
1982 
1983 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,
1984 		OPCODE_ETH_ACPI_WOL_MAGIC_CONFIG, sizeof(*req), wrb,
1985 		nonemb_cmd);
1986 	memcpy(req->magic_mac, mac, ETH_ALEN);
1987 
1988 	status = be_mcc_notify_wait(adapter);
1989 
1990 err:
1991 	spin_unlock_bh(&adapter->mcc_lock);
1992 	return status;
1993 }
1994 
be_cmd_set_loopback(struct be_adapter * adapter,u8 port_num,u8 loopback_type,u8 enable)1995 int be_cmd_set_loopback(struct be_adapter *adapter, u8 port_num,
1996 			u8 loopback_type, u8 enable)
1997 {
1998 	struct be_mcc_wrb *wrb;
1999 	struct be_cmd_req_set_lmode *req;
2000 	int status;
2001 
2002 	spin_lock_bh(&adapter->mcc_lock);
2003 
2004 	wrb = wrb_from_mccq(adapter);
2005 	if (!wrb) {
2006 		status = -EBUSY;
2007 		goto err;
2008 	}
2009 
2010 	req = embedded_payload(wrb);
2011 
2012 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_LOWLEVEL,
2013 			OPCODE_LOWLEVEL_SET_LOOPBACK_MODE, sizeof(*req), wrb,
2014 			NULL);
2015 
2016 	req->src_port = port_num;
2017 	req->dest_port = port_num;
2018 	req->loopback_type = loopback_type;
2019 	req->loopback_state = enable;
2020 
2021 	status = be_mcc_notify_wait(adapter);
2022 err:
2023 	spin_unlock_bh(&adapter->mcc_lock);
2024 	return status;
2025 }
2026 
be_cmd_loopback_test(struct be_adapter * adapter,u32 port_num,u32 loopback_type,u32 pkt_size,u32 num_pkts,u64 pattern)2027 int be_cmd_loopback_test(struct be_adapter *adapter, u32 port_num,
2028 		u32 loopback_type, u32 pkt_size, u32 num_pkts, u64 pattern)
2029 {
2030 	struct be_mcc_wrb *wrb;
2031 	struct be_cmd_req_loopback_test *req;
2032 	int status;
2033 
2034 	spin_lock_bh(&adapter->mcc_lock);
2035 
2036 	wrb = wrb_from_mccq(adapter);
2037 	if (!wrb) {
2038 		status = -EBUSY;
2039 		goto err;
2040 	}
2041 
2042 	req = embedded_payload(wrb);
2043 
2044 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_LOWLEVEL,
2045 			OPCODE_LOWLEVEL_LOOPBACK_TEST, sizeof(*req), wrb, NULL);
2046 	req->hdr.timeout = cpu_to_le32(4);
2047 
2048 	req->pattern = cpu_to_le64(pattern);
2049 	req->src_port = cpu_to_le32(port_num);
2050 	req->dest_port = cpu_to_le32(port_num);
2051 	req->pkt_size = cpu_to_le32(pkt_size);
2052 	req->num_pkts = cpu_to_le32(num_pkts);
2053 	req->loopback_type = cpu_to_le32(loopback_type);
2054 
2055 	status = be_mcc_notify_wait(adapter);
2056 	if (!status) {
2057 		struct be_cmd_resp_loopback_test *resp = embedded_payload(wrb);
2058 		status = le32_to_cpu(resp->status);
2059 	}
2060 
2061 err:
2062 	spin_unlock_bh(&adapter->mcc_lock);
2063 	return status;
2064 }
2065 
be_cmd_ddr_dma_test(struct be_adapter * adapter,u64 pattern,u32 byte_cnt,struct be_dma_mem * cmd)2066 int be_cmd_ddr_dma_test(struct be_adapter *adapter, u64 pattern,
2067 				u32 byte_cnt, struct be_dma_mem *cmd)
2068 {
2069 	struct be_mcc_wrb *wrb;
2070 	struct be_cmd_req_ddrdma_test *req;
2071 	int status;
2072 	int i, j = 0;
2073 
2074 	spin_lock_bh(&adapter->mcc_lock);
2075 
2076 	wrb = wrb_from_mccq(adapter);
2077 	if (!wrb) {
2078 		status = -EBUSY;
2079 		goto err;
2080 	}
2081 	req = cmd->va;
2082 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_LOWLEVEL,
2083 			OPCODE_LOWLEVEL_HOST_DDR_DMA, cmd->size, wrb, cmd);
2084 
2085 	req->pattern = cpu_to_le64(pattern);
2086 	req->byte_count = cpu_to_le32(byte_cnt);
2087 	for (i = 0; i < byte_cnt; i++) {
2088 		req->snd_buff[i] = (u8)(pattern >> (j*8));
2089 		j++;
2090 		if (j > 7)
2091 			j = 0;
2092 	}
2093 
2094 	status = be_mcc_notify_wait(adapter);
2095 
2096 	if (!status) {
2097 		struct be_cmd_resp_ddrdma_test *resp;
2098 		resp = cmd->va;
2099 		if ((memcmp(resp->rcv_buff, req->snd_buff, byte_cnt) != 0) ||
2100 				resp->snd_err) {
2101 			status = -1;
2102 		}
2103 	}
2104 
2105 err:
2106 	spin_unlock_bh(&adapter->mcc_lock);
2107 	return status;
2108 }
2109 
be_cmd_get_seeprom_data(struct be_adapter * adapter,struct be_dma_mem * nonemb_cmd)2110 int be_cmd_get_seeprom_data(struct be_adapter *adapter,
2111 				struct be_dma_mem *nonemb_cmd)
2112 {
2113 	struct be_mcc_wrb *wrb;
2114 	struct be_cmd_req_seeprom_read *req;
2115 	struct be_sge *sge;
2116 	int status;
2117 
2118 	spin_lock_bh(&adapter->mcc_lock);
2119 
2120 	wrb = wrb_from_mccq(adapter);
2121 	if (!wrb) {
2122 		status = -EBUSY;
2123 		goto err;
2124 	}
2125 	req = nonemb_cmd->va;
2126 	sge = nonembedded_sgl(wrb);
2127 
2128 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
2129 			OPCODE_COMMON_SEEPROM_READ, sizeof(*req), wrb,
2130 			nonemb_cmd);
2131 
2132 	status = be_mcc_notify_wait(adapter);
2133 
2134 err:
2135 	spin_unlock_bh(&adapter->mcc_lock);
2136 	return status;
2137 }
2138 
be_cmd_get_phy_info(struct be_adapter * adapter,struct be_phy_info * phy_info)2139 int be_cmd_get_phy_info(struct be_adapter *adapter,
2140 				struct be_phy_info *phy_info)
2141 {
2142 	struct be_mcc_wrb *wrb;
2143 	struct be_cmd_req_get_phy_info *req;
2144 	struct be_dma_mem cmd;
2145 	int status;
2146 
2147 	spin_lock_bh(&adapter->mcc_lock);
2148 
2149 	wrb = wrb_from_mccq(adapter);
2150 	if (!wrb) {
2151 		status = -EBUSY;
2152 		goto err;
2153 	}
2154 	cmd.size = sizeof(struct be_cmd_req_get_phy_info);
2155 	cmd.va = pci_alloc_consistent(adapter->pdev, cmd.size,
2156 					&cmd.dma);
2157 	if (!cmd.va) {
2158 		dev_err(&adapter->pdev->dev, "Memory alloc failure\n");
2159 		status = -ENOMEM;
2160 		goto err;
2161 	}
2162 
2163 	req = cmd.va;
2164 
2165 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
2166 			OPCODE_COMMON_GET_PHY_DETAILS, sizeof(*req),
2167 			wrb, &cmd);
2168 
2169 	status = be_mcc_notify_wait(adapter);
2170 	if (!status) {
2171 		struct be_phy_info *resp_phy_info =
2172 				cmd.va + sizeof(struct be_cmd_req_hdr);
2173 		phy_info->phy_type = le16_to_cpu(resp_phy_info->phy_type);
2174 		phy_info->interface_type =
2175 			le16_to_cpu(resp_phy_info->interface_type);
2176 	}
2177 	pci_free_consistent(adapter->pdev, cmd.size,
2178 				cmd.va, cmd.dma);
2179 err:
2180 	spin_unlock_bh(&adapter->mcc_lock);
2181 	return status;
2182 }
2183 
be_cmd_set_qos(struct be_adapter * adapter,u32 bps,u32 domain)2184 int be_cmd_set_qos(struct be_adapter *adapter, u32 bps, u32 domain)
2185 {
2186 	struct be_mcc_wrb *wrb;
2187 	struct be_cmd_req_set_qos *req;
2188 	int status;
2189 
2190 	spin_lock_bh(&adapter->mcc_lock);
2191 
2192 	wrb = wrb_from_mccq(adapter);
2193 	if (!wrb) {
2194 		status = -EBUSY;
2195 		goto err;
2196 	}
2197 
2198 	req = embedded_payload(wrb);
2199 
2200 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
2201 			OPCODE_COMMON_SET_QOS, sizeof(*req), wrb, NULL);
2202 
2203 	req->hdr.domain = domain;
2204 	req->valid_bits = cpu_to_le32(BE_QOS_BITS_NIC);
2205 	req->max_bps_nic = cpu_to_le32(bps);
2206 
2207 	status = be_mcc_notify_wait(adapter);
2208 
2209 err:
2210 	spin_unlock_bh(&adapter->mcc_lock);
2211 	return status;
2212 }
2213 
be_cmd_get_cntl_attributes(struct be_adapter * adapter)2214 int be_cmd_get_cntl_attributes(struct be_adapter *adapter)
2215 {
2216 	struct be_mcc_wrb *wrb;
2217 	struct be_cmd_req_cntl_attribs *req;
2218 	struct be_cmd_resp_cntl_attribs *resp;
2219 	int status;
2220 	int payload_len = max(sizeof(*req), sizeof(*resp));
2221 	struct mgmt_controller_attrib *attribs;
2222 	struct be_dma_mem attribs_cmd;
2223 
2224 	memset(&attribs_cmd, 0, sizeof(struct be_dma_mem));
2225 	attribs_cmd.size = sizeof(struct be_cmd_resp_cntl_attribs);
2226 	attribs_cmd.va = pci_alloc_consistent(adapter->pdev, attribs_cmd.size,
2227 						&attribs_cmd.dma);
2228 	if (!attribs_cmd.va) {
2229 		dev_err(&adapter->pdev->dev,
2230 				"Memory allocation failure\n");
2231 		return -ENOMEM;
2232 	}
2233 
2234 	if (mutex_lock_interruptible(&adapter->mbox_lock))
2235 		return -1;
2236 
2237 	wrb = wrb_from_mbox(adapter);
2238 	if (!wrb) {
2239 		status = -EBUSY;
2240 		goto err;
2241 	}
2242 	req = attribs_cmd.va;
2243 
2244 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
2245 			 OPCODE_COMMON_GET_CNTL_ATTRIBUTES, payload_len, wrb,
2246 			&attribs_cmd);
2247 
2248 	status = be_mbox_notify_wait(adapter);
2249 	if (!status) {
2250 		attribs = attribs_cmd.va + sizeof(struct be_cmd_resp_hdr);
2251 		adapter->hba_port_num = attribs->hba_attribs.phy_port;
2252 	}
2253 
2254 err:
2255 	mutex_unlock(&adapter->mbox_lock);
2256 	pci_free_consistent(adapter->pdev, attribs_cmd.size, attribs_cmd.va,
2257 					attribs_cmd.dma);
2258 	return status;
2259 }
2260 
2261 /* Uses mbox */
be_cmd_req_native_mode(struct be_adapter * adapter)2262 int be_cmd_req_native_mode(struct be_adapter *adapter)
2263 {
2264 	struct be_mcc_wrb *wrb;
2265 	struct be_cmd_req_set_func_cap *req;
2266 	int status;
2267 
2268 	if (mutex_lock_interruptible(&adapter->mbox_lock))
2269 		return -1;
2270 
2271 	wrb = wrb_from_mbox(adapter);
2272 	if (!wrb) {
2273 		status = -EBUSY;
2274 		goto err;
2275 	}
2276 
2277 	req = embedded_payload(wrb);
2278 
2279 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
2280 		OPCODE_COMMON_SET_DRIVER_FUNCTION_CAP, sizeof(*req), wrb, NULL);
2281 
2282 	req->valid_cap_flags = cpu_to_le32(CAPABILITY_SW_TIMESTAMPS |
2283 				CAPABILITY_BE3_NATIVE_ERX_API);
2284 	req->cap_flags = cpu_to_le32(CAPABILITY_BE3_NATIVE_ERX_API);
2285 
2286 	status = be_mbox_notify_wait(adapter);
2287 	if (!status) {
2288 		struct be_cmd_resp_set_func_cap *resp = embedded_payload(wrb);
2289 		adapter->be3_native = le32_to_cpu(resp->cap_flags) &
2290 					CAPABILITY_BE3_NATIVE_ERX_API;
2291 	}
2292 err:
2293 	mutex_unlock(&adapter->mbox_lock);
2294 	return status;
2295 }
2296 
2297 /* Uses synchronous MCCQ */
be_cmd_get_mac_from_list(struct be_adapter * adapter,u32 domain,bool * pmac_id_active,u32 * pmac_id,u8 * mac)2298 int be_cmd_get_mac_from_list(struct be_adapter *adapter, u32 domain,
2299 			bool *pmac_id_active, u32 *pmac_id, u8 *mac)
2300 {
2301 	struct be_mcc_wrb *wrb;
2302 	struct be_cmd_req_get_mac_list *req;
2303 	int status;
2304 	int mac_count;
2305 	struct be_dma_mem get_mac_list_cmd;
2306 	int i;
2307 
2308 	memset(&get_mac_list_cmd, 0, sizeof(struct be_dma_mem));
2309 	get_mac_list_cmd.size = sizeof(struct be_cmd_resp_get_mac_list);
2310 	get_mac_list_cmd.va = pci_alloc_consistent(adapter->pdev,
2311 			get_mac_list_cmd.size,
2312 			&get_mac_list_cmd.dma);
2313 
2314 	if (!get_mac_list_cmd.va) {
2315 		dev_err(&adapter->pdev->dev,
2316 				"Memory allocation failure during GET_MAC_LIST\n");
2317 		return -ENOMEM;
2318 	}
2319 
2320 	spin_lock_bh(&adapter->mcc_lock);
2321 
2322 	wrb = wrb_from_mccq(adapter);
2323 	if (!wrb) {
2324 		status = -EBUSY;
2325 		goto out;
2326 	}
2327 
2328 	req = get_mac_list_cmd.va;
2329 
2330 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
2331 				OPCODE_COMMON_GET_MAC_LIST, sizeof(*req),
2332 				wrb, &get_mac_list_cmd);
2333 
2334 	req->hdr.domain = domain;
2335 	req->mac_type = MAC_ADDRESS_TYPE_NETWORK;
2336 	req->perm_override = 1;
2337 
2338 	status = be_mcc_notify_wait(adapter);
2339 	if (!status) {
2340 		struct be_cmd_resp_get_mac_list *resp =
2341 						get_mac_list_cmd.va;
2342 		mac_count = resp->true_mac_count + resp->pseudo_mac_count;
2343 		/* Mac list returned could contain one or more active mac_ids
2344 		 * or one or more pseudo permanant mac addresses. If an active
2345 		 * mac_id is present, return first active mac_id found
2346 		 */
2347 		for (i = 0; i < mac_count; i++) {
2348 			struct get_list_macaddr *mac_entry;
2349 			u16 mac_addr_size;
2350 			u32 mac_id;
2351 
2352 			mac_entry = &resp->macaddr_list[i];
2353 			mac_addr_size = le16_to_cpu(mac_entry->mac_addr_size);
2354 			/* mac_id is a 32 bit value and mac_addr size
2355 			 * is 6 bytes
2356 			 */
2357 			if (mac_addr_size == sizeof(u32)) {
2358 				*pmac_id_active = true;
2359 				mac_id = mac_entry->mac_addr_id.s_mac_id.mac_id;
2360 				*pmac_id = le32_to_cpu(mac_id);
2361 				goto out;
2362 			}
2363 		}
2364 		/* If no active mac_id found, return first pseudo mac addr */
2365 		*pmac_id_active = false;
2366 		memcpy(mac, resp->macaddr_list[0].mac_addr_id.macaddr,
2367 								ETH_ALEN);
2368 	}
2369 
2370 out:
2371 	spin_unlock_bh(&adapter->mcc_lock);
2372 	pci_free_consistent(adapter->pdev, get_mac_list_cmd.size,
2373 			get_mac_list_cmd.va, get_mac_list_cmd.dma);
2374 	return status;
2375 }
2376 
2377 /* Uses synchronous MCCQ */
be_cmd_set_mac_list(struct be_adapter * adapter,u8 * mac_array,u8 mac_count,u32 domain)2378 int be_cmd_set_mac_list(struct be_adapter *adapter, u8 *mac_array,
2379 			u8 mac_count, u32 domain)
2380 {
2381 	struct be_mcc_wrb *wrb;
2382 	struct be_cmd_req_set_mac_list *req;
2383 	int status;
2384 	struct be_dma_mem cmd;
2385 
2386 	memset(&cmd, 0, sizeof(struct be_dma_mem));
2387 	cmd.size = sizeof(struct be_cmd_req_set_mac_list);
2388 	cmd.va = dma_alloc_coherent(&adapter->pdev->dev, cmd.size,
2389 			&cmd.dma, GFP_KERNEL);
2390 	if (!cmd.va) {
2391 		dev_err(&adapter->pdev->dev, "Memory alloc failure\n");
2392 		return -ENOMEM;
2393 	}
2394 
2395 	spin_lock_bh(&adapter->mcc_lock);
2396 
2397 	wrb = wrb_from_mccq(adapter);
2398 	if (!wrb) {
2399 		status = -EBUSY;
2400 		goto err;
2401 	}
2402 
2403 	req = cmd.va;
2404 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
2405 				OPCODE_COMMON_SET_MAC_LIST, sizeof(*req),
2406 				wrb, &cmd);
2407 
2408 	req->hdr.domain = domain;
2409 	req->mac_count = mac_count;
2410 	if (mac_count)
2411 		memcpy(req->mac, mac_array, ETH_ALEN*mac_count);
2412 
2413 	status = be_mcc_notify_wait(adapter);
2414 
2415 err:
2416 	dma_free_coherent(&adapter->pdev->dev, cmd.size,
2417 				cmd.va, cmd.dma);
2418 	spin_unlock_bh(&adapter->mcc_lock);
2419 	return status;
2420 }
2421 
be_cmd_set_hsw_config(struct be_adapter * adapter,u16 pvid,u32 domain,u16 intf_id)2422 int be_cmd_set_hsw_config(struct be_adapter *adapter, u16 pvid,
2423 			u32 domain, u16 intf_id)
2424 {
2425 	struct be_mcc_wrb *wrb;
2426 	struct be_cmd_req_set_hsw_config *req;
2427 	void *ctxt;
2428 	int status;
2429 
2430 	spin_lock_bh(&adapter->mcc_lock);
2431 
2432 	wrb = wrb_from_mccq(adapter);
2433 	if (!wrb) {
2434 		status = -EBUSY;
2435 		goto err;
2436 	}
2437 
2438 	req = embedded_payload(wrb);
2439 	ctxt = &req->context;
2440 
2441 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
2442 			OPCODE_COMMON_SET_HSW_CONFIG, sizeof(*req), wrb, NULL);
2443 
2444 	req->hdr.domain = domain;
2445 	AMAP_SET_BITS(struct amap_set_hsw_context, interface_id, ctxt, intf_id);
2446 	if (pvid) {
2447 		AMAP_SET_BITS(struct amap_set_hsw_context, pvid_valid, ctxt, 1);
2448 		AMAP_SET_BITS(struct amap_set_hsw_context, pvid, ctxt, pvid);
2449 	}
2450 
2451 	be_dws_cpu_to_le(req->context, sizeof(req->context));
2452 	status = be_mcc_notify_wait(adapter);
2453 
2454 err:
2455 	spin_unlock_bh(&adapter->mcc_lock);
2456 	return status;
2457 }
2458 
2459 /* Get Hyper switch config */
be_cmd_get_hsw_config(struct be_adapter * adapter,u16 * pvid,u32 domain,u16 intf_id)2460 int be_cmd_get_hsw_config(struct be_adapter *adapter, u16 *pvid,
2461 			u32 domain, u16 intf_id)
2462 {
2463 	struct be_mcc_wrb *wrb;
2464 	struct be_cmd_req_get_hsw_config *req;
2465 	void *ctxt;
2466 	int status;
2467 	u16 vid;
2468 
2469 	spin_lock_bh(&adapter->mcc_lock);
2470 
2471 	wrb = wrb_from_mccq(adapter);
2472 	if (!wrb) {
2473 		status = -EBUSY;
2474 		goto err;
2475 	}
2476 
2477 	req = embedded_payload(wrb);
2478 	ctxt = &req->context;
2479 
2480 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON,
2481 			OPCODE_COMMON_GET_HSW_CONFIG, sizeof(*req), wrb, NULL);
2482 
2483 	req->hdr.domain = domain;
2484 	AMAP_SET_BITS(struct amap_get_hsw_req_context, interface_id, ctxt,
2485 								intf_id);
2486 	AMAP_SET_BITS(struct amap_get_hsw_req_context, pvid_valid, ctxt, 1);
2487 	be_dws_cpu_to_le(req->context, sizeof(req->context));
2488 
2489 	status = be_mcc_notify_wait(adapter);
2490 	if (!status) {
2491 		struct be_cmd_resp_get_hsw_config *resp =
2492 						embedded_payload(wrb);
2493 		be_dws_le_to_cpu(&resp->context,
2494 						sizeof(resp->context));
2495 		vid = AMAP_GET_BITS(struct amap_get_hsw_resp_context,
2496 							pvid, &resp->context);
2497 		*pvid = le16_to_cpu(vid);
2498 	}
2499 
2500 err:
2501 	spin_unlock_bh(&adapter->mcc_lock);
2502 	return status;
2503 }
2504 
be_cmd_get_acpi_wol_cap(struct be_adapter * adapter)2505 int be_cmd_get_acpi_wol_cap(struct be_adapter *adapter)
2506 {
2507 	struct be_mcc_wrb *wrb;
2508 	struct be_cmd_req_acpi_wol_magic_config_v1 *req;
2509 	int status;
2510 	int payload_len = sizeof(*req);
2511 	struct be_dma_mem cmd;
2512 
2513 	memset(&cmd, 0, sizeof(struct be_dma_mem));
2514 	cmd.size = sizeof(struct be_cmd_resp_acpi_wol_magic_config_v1);
2515 	cmd.va = pci_alloc_consistent(adapter->pdev, cmd.size,
2516 					       &cmd.dma);
2517 	if (!cmd.va) {
2518 		dev_err(&adapter->pdev->dev,
2519 				"Memory allocation failure\n");
2520 		return -ENOMEM;
2521 	}
2522 
2523 	if (mutex_lock_interruptible(&adapter->mbox_lock))
2524 		return -1;
2525 
2526 	wrb = wrb_from_mbox(adapter);
2527 	if (!wrb) {
2528 		status = -EBUSY;
2529 		goto err;
2530 	}
2531 
2532 	req = cmd.va;
2533 
2534 	be_wrb_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,
2535 			       OPCODE_ETH_ACPI_WOL_MAGIC_CONFIG,
2536 			       payload_len, wrb, &cmd);
2537 
2538 	req->hdr.version = 1;
2539 	req->query_options = BE_GET_WOL_CAP;
2540 
2541 	status = be_mbox_notify_wait(adapter);
2542 	if (!status) {
2543 		struct be_cmd_resp_acpi_wol_magic_config_v1 *resp;
2544 		resp = (struct be_cmd_resp_acpi_wol_magic_config_v1 *) cmd.va;
2545 
2546 		/* the command could succeed misleadingly on old f/w
2547 		 * which is not aware of the V1 version. fake an error. */
2548 		if (resp->hdr.response_length < payload_len) {
2549 			status = -1;
2550 			goto err;
2551 		}
2552 		adapter->wol_cap = resp->wol_settings;
2553 	}
2554 err:
2555 	mutex_unlock(&adapter->mbox_lock);
2556 	pci_free_consistent(adapter->pdev, cmd.size, cmd.va, cmd.dma);
2557 	return status;
2558 }
2559