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