2 * Copyright (c) 2004, 2005 Topspin Communications. All rights reserved.
3 * Copyright (c) 2005 Mellanox Technologies. All rights reserved.
5 * This software is available to you under a choice of one of two
6 * licenses. You may choose to be licensed under the terms of the GNU
7 * General Public License (GPL) Version 2, available from the file
8 * COPYING in the main directory of this source tree, or the
9 * OpenIB.org BSD license below:
11 * Redistribution and use in source and binary forms, with or
12 * without modification, are permitted provided that the following
15 * - Redistributions of source code must retain the above
16 * copyright notice, this list of conditions and the following
19 * - Redistributions in binary form must reproduce the above
20 * copyright notice, this list of conditions and the following
21 * disclaimer in the documentation and/or other materials
22 * provided with the distribution.
24 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
25 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
26 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
27 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
28 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
29 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
30 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
33 * $Id: mthca_eq.c 1382 2004-12-24 02:21:02Z roland $
36 #include <linux/init.h>
37 #include <linux/errno.h>
38 #include <linux/interrupt.h>
39 #include <linux/pci.h>
41 #include "mthca_dev.h"
42 #include "mthca_cmd.h"
43 #include "mthca_config_reg.h"
46 MTHCA_NUM_ASYNC_EQE
= 0x80,
47 MTHCA_NUM_CMD_EQE
= 0x80,
48 MTHCA_EQ_ENTRY_SIZE
= 0x20
52 * Must be packed because start is 64 bits but only aligned to 32 bits.
54 struct mthca_eq_context
{
57 __be32 logsize_usrpage
;
58 __be32 tavor_pd
; /* reserved for Arbel */
61 __be32 arbel_pd
; /* lost_count for Tavor */
64 __be32 consumer_index
;
65 __be32 producer_index
;
67 } __attribute__((packed
));
69 #define MTHCA_EQ_STATUS_OK ( 0 << 28)
70 #define MTHCA_EQ_STATUS_OVERFLOW ( 9 << 28)
71 #define MTHCA_EQ_STATUS_WRITE_FAIL (10 << 28)
72 #define MTHCA_EQ_OWNER_SW ( 0 << 24)
73 #define MTHCA_EQ_OWNER_HW ( 1 << 24)
74 #define MTHCA_EQ_FLAG_TR ( 1 << 18)
75 #define MTHCA_EQ_FLAG_OI ( 1 << 17)
76 #define MTHCA_EQ_STATE_ARMED ( 1 << 8)
77 #define MTHCA_EQ_STATE_FIRED ( 2 << 8)
78 #define MTHCA_EQ_STATE_ALWAYS_ARMED ( 3 << 8)
79 #define MTHCA_EQ_STATE_ARBEL ( 8 << 8)
82 MTHCA_EVENT_TYPE_COMP
= 0x00,
83 MTHCA_EVENT_TYPE_PATH_MIG
= 0x01,
84 MTHCA_EVENT_TYPE_COMM_EST
= 0x02,
85 MTHCA_EVENT_TYPE_SQ_DRAINED
= 0x03,
86 MTHCA_EVENT_TYPE_SRQ_QP_LAST_WQE
= 0x13,
87 MTHCA_EVENT_TYPE_SRQ_LIMIT
= 0x14,
88 MTHCA_EVENT_TYPE_CQ_ERROR
= 0x04,
89 MTHCA_EVENT_TYPE_WQ_CATAS_ERROR
= 0x05,
90 MTHCA_EVENT_TYPE_EEC_CATAS_ERROR
= 0x06,
91 MTHCA_EVENT_TYPE_PATH_MIG_FAILED
= 0x07,
92 MTHCA_EVENT_TYPE_WQ_INVAL_REQ_ERROR
= 0x10,
93 MTHCA_EVENT_TYPE_WQ_ACCESS_ERROR
= 0x11,
94 MTHCA_EVENT_TYPE_SRQ_CATAS_ERROR
= 0x12,
95 MTHCA_EVENT_TYPE_LOCAL_CATAS_ERROR
= 0x08,
96 MTHCA_EVENT_TYPE_PORT_CHANGE
= 0x09,
97 MTHCA_EVENT_TYPE_EQ_OVERFLOW
= 0x0f,
98 MTHCA_EVENT_TYPE_ECC_DETECT
= 0x0e,
99 MTHCA_EVENT_TYPE_CMD
= 0x0a
102 #define MTHCA_ASYNC_EVENT_MASK ((1ULL << MTHCA_EVENT_TYPE_PATH_MIG) | \
103 (1ULL << MTHCA_EVENT_TYPE_COMM_EST) | \
104 (1ULL << MTHCA_EVENT_TYPE_SQ_DRAINED) | \
105 (1ULL << MTHCA_EVENT_TYPE_CQ_ERROR) | \
106 (1ULL << MTHCA_EVENT_TYPE_WQ_CATAS_ERROR) | \
107 (1ULL << MTHCA_EVENT_TYPE_EEC_CATAS_ERROR) | \
108 (1ULL << MTHCA_EVENT_TYPE_PATH_MIG_FAILED) | \
109 (1ULL << MTHCA_EVENT_TYPE_WQ_INVAL_REQ_ERROR) | \
110 (1ULL << MTHCA_EVENT_TYPE_WQ_ACCESS_ERROR) | \
111 (1ULL << MTHCA_EVENT_TYPE_LOCAL_CATAS_ERROR) | \
112 (1ULL << MTHCA_EVENT_TYPE_PORT_CHANGE) | \
113 (1ULL << MTHCA_EVENT_TYPE_ECC_DETECT))
114 #define MTHCA_SRQ_EVENT_MASK ((1ULL << MTHCA_EVENT_TYPE_SRQ_CATAS_ERROR) | \
115 (1ULL << MTHCA_EVENT_TYPE_SRQ_QP_LAST_WQE) | \
116 (1ULL << MTHCA_EVENT_TYPE_SRQ_LIMIT))
117 #define MTHCA_CMD_EVENT_MASK (1ULL << MTHCA_EVENT_TYPE_CMD)
119 #define MTHCA_EQ_DB_INC_CI (1 << 24)
120 #define MTHCA_EQ_DB_REQ_NOT (2 << 24)
121 #define MTHCA_EQ_DB_DISARM_CQ (3 << 24)
122 #define MTHCA_EQ_DB_SET_CI (4 << 24)
123 #define MTHCA_EQ_DB_ALWAYS_ARM (5 << 24)
134 } __attribute__((packed
)) comp
;
142 } __attribute__((packed
)) cmd
;
145 } __attribute__((packed
)) qp
;
148 } __attribute__((packed
)) srq
;
154 } __attribute__((packed
)) cq_err
;
158 } __attribute__((packed
)) port_change
;
162 } __attribute__((packed
));
164 #define MTHCA_EQ_ENTRY_OWNER_SW (0 << 7)
165 #define MTHCA_EQ_ENTRY_OWNER_HW (1 << 7)
167 static inline u64
async_mask(struct mthca_dev
*dev
)
169 return dev
->mthca_flags
& MTHCA_FLAG_SRQ
?
170 MTHCA_ASYNC_EVENT_MASK
| MTHCA_SRQ_EVENT_MASK
:
171 MTHCA_ASYNC_EVENT_MASK
;
174 static inline void tavor_set_eq_ci(struct mthca_dev
*dev
, struct mthca_eq
*eq
, u32 ci
)
178 doorbell
[0] = cpu_to_be32(MTHCA_EQ_DB_SET_CI
| eq
->eqn
);
179 doorbell
[1] = cpu_to_be32(ci
& (eq
->nent
- 1));
182 * This barrier makes sure that all updates to ownership bits
183 * done by set_eqe_hw() hit memory before the consumer index
184 * is updated. set_eq_ci() allows the HCA to possibly write
185 * more EQ entries, and we want to avoid the exceedingly
186 * unlikely possibility of the HCA writing an entry and then
187 * having set_eqe_hw() overwrite the owner field.
190 mthca_write64(doorbell
,
191 dev
->kar
+ MTHCA_EQ_DOORBELL
,
192 MTHCA_GET_DOORBELL_LOCK(&dev
->doorbell_lock
));
195 static inline void arbel_set_eq_ci(struct mthca_dev
*dev
, struct mthca_eq
*eq
, u32 ci
)
197 /* See comment in tavor_set_eq_ci() above. */
199 __raw_writel((__force u32
) cpu_to_be32(ci
),
200 dev
->eq_regs
.arbel
.eq_set_ci_base
+ eq
->eqn
* 8);
201 /* We still want ordering, just not swabbing, so add a barrier */
205 static inline void set_eq_ci(struct mthca_dev
*dev
, struct mthca_eq
*eq
, u32 ci
)
207 if (mthca_is_memfree(dev
))
208 arbel_set_eq_ci(dev
, eq
, ci
);
210 tavor_set_eq_ci(dev
, eq
, ci
);
213 static inline void tavor_eq_req_not(struct mthca_dev
*dev
, int eqn
)
217 doorbell
[0] = cpu_to_be32(MTHCA_EQ_DB_REQ_NOT
| eqn
);
220 mthca_write64(doorbell
,
221 dev
->kar
+ MTHCA_EQ_DOORBELL
,
222 MTHCA_GET_DOORBELL_LOCK(&dev
->doorbell_lock
));
225 static inline void arbel_eq_req_not(struct mthca_dev
*dev
, u32 eqn_mask
)
227 writel(eqn_mask
, dev
->eq_regs
.arbel
.eq_arm
);
230 static inline void disarm_cq(struct mthca_dev
*dev
, int eqn
, int cqn
)
232 if (!mthca_is_memfree(dev
)) {
235 doorbell
[0] = cpu_to_be32(MTHCA_EQ_DB_DISARM_CQ
| eqn
);
236 doorbell
[1] = cpu_to_be32(cqn
);
238 mthca_write64(doorbell
,
239 dev
->kar
+ MTHCA_EQ_DOORBELL
,
240 MTHCA_GET_DOORBELL_LOCK(&dev
->doorbell_lock
));
244 static inline struct mthca_eqe
*get_eqe(struct mthca_eq
*eq
, u32 entry
)
246 unsigned long off
= (entry
& (eq
->nent
- 1)) * MTHCA_EQ_ENTRY_SIZE
;
247 return eq
->page_list
[off
/ PAGE_SIZE
].buf
+ off
% PAGE_SIZE
;
250 static inline struct mthca_eqe
* next_eqe_sw(struct mthca_eq
*eq
)
252 struct mthca_eqe
* eqe
;
253 eqe
= get_eqe(eq
, eq
->cons_index
);
254 return (MTHCA_EQ_ENTRY_OWNER_HW
& eqe
->owner
) ? NULL
: eqe
;
257 static inline void set_eqe_hw(struct mthca_eqe
*eqe
)
259 eqe
->owner
= MTHCA_EQ_ENTRY_OWNER_HW
;
262 static void port_change(struct mthca_dev
*dev
, int port
, int active
)
264 struct ib_event record
;
266 mthca_dbg(dev
, "Port change to %s for port %d\n",
267 active
? "active" : "down", port
);
269 record
.device
= &dev
->ib_dev
;
270 record
.event
= active
? IB_EVENT_PORT_ACTIVE
: IB_EVENT_PORT_ERR
;
271 record
.element
.port_num
= port
;
273 ib_dispatch_event(&record
);
276 static int mthca_eq_int(struct mthca_dev
*dev
, struct mthca_eq
*eq
)
278 struct mthca_eqe
*eqe
;
282 while ((eqe
= next_eqe_sw(eq
))) {
286 * Make sure we read EQ entry contents after we've
287 * checked the ownership bit.
292 case MTHCA_EVENT_TYPE_COMP
:
293 disarm_cqn
= be32_to_cpu(eqe
->event
.comp
.cqn
) & 0xffffff;
294 disarm_cq(dev
, eq
->eqn
, disarm_cqn
);
295 mthca_cq_completion(dev
, disarm_cqn
);
298 case MTHCA_EVENT_TYPE_PATH_MIG
:
299 mthca_qp_event(dev
, be32_to_cpu(eqe
->event
.qp
.qpn
) & 0xffffff,
303 case MTHCA_EVENT_TYPE_COMM_EST
:
304 mthca_qp_event(dev
, be32_to_cpu(eqe
->event
.qp
.qpn
) & 0xffffff,
308 case MTHCA_EVENT_TYPE_SQ_DRAINED
:
309 mthca_qp_event(dev
, be32_to_cpu(eqe
->event
.qp
.qpn
) & 0xffffff,
310 IB_EVENT_SQ_DRAINED
);
313 case MTHCA_EVENT_TYPE_SRQ_QP_LAST_WQE
:
314 mthca_qp_event(dev
, be32_to_cpu(eqe
->event
.qp
.qpn
) & 0xffffff,
315 IB_EVENT_QP_LAST_WQE_REACHED
);
318 case MTHCA_EVENT_TYPE_SRQ_LIMIT
:
319 mthca_srq_event(dev
, be32_to_cpu(eqe
->event
.srq
.srqn
) & 0xffffff,
320 IB_EVENT_SRQ_LIMIT_REACHED
);
323 case MTHCA_EVENT_TYPE_WQ_CATAS_ERROR
:
324 mthca_qp_event(dev
, be32_to_cpu(eqe
->event
.qp
.qpn
) & 0xffffff,
328 case MTHCA_EVENT_TYPE_PATH_MIG_FAILED
:
329 mthca_qp_event(dev
, be32_to_cpu(eqe
->event
.qp
.qpn
) & 0xffffff,
330 IB_EVENT_PATH_MIG_ERR
);
333 case MTHCA_EVENT_TYPE_WQ_INVAL_REQ_ERROR
:
334 mthca_qp_event(dev
, be32_to_cpu(eqe
->event
.qp
.qpn
) & 0xffffff,
335 IB_EVENT_QP_REQ_ERR
);
338 case MTHCA_EVENT_TYPE_WQ_ACCESS_ERROR
:
339 mthca_qp_event(dev
, be32_to_cpu(eqe
->event
.qp
.qpn
) & 0xffffff,
340 IB_EVENT_QP_ACCESS_ERR
);
343 case MTHCA_EVENT_TYPE_CMD
:
345 be16_to_cpu(eqe
->event
.cmd
.token
),
346 eqe
->event
.cmd
.status
,
347 be64_to_cpu(eqe
->event
.cmd
.out_param
));
349 * cmd_event() may add more commands.
350 * The card will think the queue has overflowed if
351 * we don't tell it we've been processing events.
356 case MTHCA_EVENT_TYPE_PORT_CHANGE
:
358 (be32_to_cpu(eqe
->event
.port_change
.port
) >> 28) & 3,
359 eqe
->subtype
== 0x4);
362 case MTHCA_EVENT_TYPE_CQ_ERROR
:
363 mthca_warn(dev
, "CQ %s on CQN %06x\n",
364 eqe
->event
.cq_err
.syndrome
== 1 ?
365 "overrun" : "access violation",
366 be32_to_cpu(eqe
->event
.cq_err
.cqn
) & 0xffffff);
367 mthca_cq_event(dev
, be32_to_cpu(eqe
->event
.cq_err
.cqn
),
371 case MTHCA_EVENT_TYPE_EQ_OVERFLOW
:
372 mthca_warn(dev
, "EQ overrun on EQN %d\n", eq
->eqn
);
375 case MTHCA_EVENT_TYPE_EEC_CATAS_ERROR
:
376 case MTHCA_EVENT_TYPE_SRQ_CATAS_ERROR
:
377 case MTHCA_EVENT_TYPE_LOCAL_CATAS_ERROR
:
378 case MTHCA_EVENT_TYPE_ECC_DETECT
:
380 mthca_warn(dev
, "Unhandled event %02x(%02x) on EQ %d\n",
381 eqe
->type
, eqe
->subtype
, eq
->eqn
);
389 if (unlikely(set_ci
)) {
391 * Conditional on hca_type is OK here because
392 * this is a rare case, not the fast path.
394 set_eq_ci(dev
, eq
, eq
->cons_index
);
400 * Rely on caller to set consumer index so that we don't have
401 * to test hca_type in our interrupt handling fast path.
406 static irqreturn_t
mthca_tavor_interrupt(int irq
, void *dev_ptr
, struct pt_regs
*regs
)
408 struct mthca_dev
*dev
= dev_ptr
;
412 if (dev
->eq_table
.clr_mask
)
413 writel(dev
->eq_table
.clr_mask
, dev
->eq_table
.clr_int
);
415 ecr
= readl(dev
->eq_regs
.tavor
.ecr_base
+ 4);
419 writel(ecr
, dev
->eq_regs
.tavor
.ecr_base
+
420 MTHCA_ECR_CLR_BASE
- MTHCA_ECR_BASE
+ 4);
422 for (i
= 0; i
< MTHCA_NUM_EQ
; ++i
)
423 if (ecr
& dev
->eq_table
.eq
[i
].eqn_mask
) {
424 if (mthca_eq_int(dev
, &dev
->eq_table
.eq
[i
]))
425 tavor_set_eq_ci(dev
, &dev
->eq_table
.eq
[i
],
426 dev
->eq_table
.eq
[i
].cons_index
);
427 tavor_eq_req_not(dev
, dev
->eq_table
.eq
[i
].eqn
);
433 static irqreturn_t
mthca_tavor_msi_x_interrupt(int irq
, void *eq_ptr
,
434 struct pt_regs
*regs
)
436 struct mthca_eq
*eq
= eq_ptr
;
437 struct mthca_dev
*dev
= eq
->dev
;
439 mthca_eq_int(dev
, eq
);
440 tavor_set_eq_ci(dev
, eq
, eq
->cons_index
);
441 tavor_eq_req_not(dev
, eq
->eqn
);
443 /* MSI-X vectors always belong to us */
447 static irqreturn_t
mthca_arbel_interrupt(int irq
, void *dev_ptr
, struct pt_regs
*regs
)
449 struct mthca_dev
*dev
= dev_ptr
;
453 if (dev
->eq_table
.clr_mask
)
454 writel(dev
->eq_table
.clr_mask
, dev
->eq_table
.clr_int
);
456 for (i
= 0; i
< MTHCA_NUM_EQ
; ++i
)
457 if (mthca_eq_int(dev
, &dev
->eq_table
.eq
[i
])) {
459 arbel_set_eq_ci(dev
, &dev
->eq_table
.eq
[i
],
460 dev
->eq_table
.eq
[i
].cons_index
);
463 arbel_eq_req_not(dev
, dev
->eq_table
.arm_mask
);
465 return IRQ_RETVAL(work
);
468 static irqreturn_t
mthca_arbel_msi_x_interrupt(int irq
, void *eq_ptr
,
469 struct pt_regs
*regs
)
471 struct mthca_eq
*eq
= eq_ptr
;
472 struct mthca_dev
*dev
= eq
->dev
;
474 mthca_eq_int(dev
, eq
);
475 arbel_set_eq_ci(dev
, eq
, eq
->cons_index
);
476 arbel_eq_req_not(dev
, eq
->eqn_mask
);
478 /* MSI-X vectors always belong to us */
482 static int __devinit
mthca_create_eq(struct mthca_dev
*dev
,
487 int npages
= (nent
* MTHCA_EQ_ENTRY_SIZE
+ PAGE_SIZE
- 1) /
489 u64
*dma_list
= NULL
;
491 struct mthca_mailbox
*mailbox
;
492 struct mthca_eq_context
*eq_context
;
498 eq
->nent
= roundup_pow_of_two(max(nent
, 2));
500 eq
->page_list
= kmalloc(npages
* sizeof *eq
->page_list
,
505 for (i
= 0; i
< npages
; ++i
)
506 eq
->page_list
[i
].buf
= NULL
;
508 dma_list
= kmalloc(npages
* sizeof *dma_list
, GFP_KERNEL
);
512 mailbox
= mthca_alloc_mailbox(dev
, GFP_KERNEL
);
515 eq_context
= mailbox
->buf
;
517 for (i
= 0; i
< npages
; ++i
) {
518 eq
->page_list
[i
].buf
= dma_alloc_coherent(&dev
->pdev
->dev
,
519 PAGE_SIZE
, &t
, GFP_KERNEL
);
520 if (!eq
->page_list
[i
].buf
)
521 goto err_out_free_pages
;
524 pci_unmap_addr_set(&eq
->page_list
[i
], mapping
, t
);
526 memset(eq
->page_list
[i
].buf
, 0, PAGE_SIZE
);
529 for (i
= 0; i
< eq
->nent
; ++i
)
530 set_eqe_hw(get_eqe(eq
, i
));
532 eq
->eqn
= mthca_alloc(&dev
->eq_table
.alloc
);
534 goto err_out_free_pages
;
536 err
= mthca_mr_alloc_phys(dev
, dev
->driver_pd
.pd_num
,
537 dma_list
, PAGE_SHIFT
, npages
,
538 0, npages
* PAGE_SIZE
,
539 MTHCA_MPT_FLAG_LOCAL_WRITE
|
540 MTHCA_MPT_FLAG_LOCAL_READ
,
543 goto err_out_free_eq
;
545 memset(eq_context
, 0, sizeof *eq_context
);
546 eq_context
->flags
= cpu_to_be32(MTHCA_EQ_STATUS_OK
|
548 MTHCA_EQ_STATE_ARMED
|
550 if (mthca_is_memfree(dev
))
551 eq_context
->flags
|= cpu_to_be32(MTHCA_EQ_STATE_ARBEL
);
553 eq_context
->logsize_usrpage
= cpu_to_be32((ffs(eq
->nent
) - 1) << 24);
554 if (mthca_is_memfree(dev
)) {
555 eq_context
->arbel_pd
= cpu_to_be32(dev
->driver_pd
.pd_num
);
557 eq_context
->logsize_usrpage
|= cpu_to_be32(dev
->driver_uar
.index
);
558 eq_context
->tavor_pd
= cpu_to_be32(dev
->driver_pd
.pd_num
);
560 eq_context
->intr
= intr
;
561 eq_context
->lkey
= cpu_to_be32(eq
->mr
.ibmr
.lkey
);
563 err
= mthca_SW2HW_EQ(dev
, mailbox
, eq
->eqn
, &status
);
565 mthca_warn(dev
, "SW2HW_EQ failed (%d)\n", err
);
566 goto err_out_free_mr
;
569 mthca_warn(dev
, "SW2HW_EQ returned status 0x%02x\n",
572 goto err_out_free_mr
;
576 mthca_free_mailbox(dev
, mailbox
);
578 eq
->eqn_mask
= swab32(1 << eq
->eqn
);
581 dev
->eq_table
.arm_mask
|= eq
->eqn_mask
;
583 mthca_dbg(dev
, "Allocated EQ %d with %d entries\n",
589 mthca_free_mr(dev
, &eq
->mr
);
592 mthca_free(&dev
->eq_table
.alloc
, eq
->eqn
);
595 for (i
= 0; i
< npages
; ++i
)
596 if (eq
->page_list
[i
].buf
)
597 dma_free_coherent(&dev
->pdev
->dev
, PAGE_SIZE
,
598 eq
->page_list
[i
].buf
,
599 pci_unmap_addr(&eq
->page_list
[i
],
602 mthca_free_mailbox(dev
, mailbox
);
605 kfree(eq
->page_list
);
612 static void mthca_free_eq(struct mthca_dev
*dev
,
615 struct mthca_mailbox
*mailbox
;
618 int npages
= (eq
->nent
* MTHCA_EQ_ENTRY_SIZE
+ PAGE_SIZE
- 1) /
622 mailbox
= mthca_alloc_mailbox(dev
, GFP_KERNEL
);
626 err
= mthca_HW2SW_EQ(dev
, mailbox
, eq
->eqn
, &status
);
628 mthca_warn(dev
, "HW2SW_EQ failed (%d)\n", err
);
630 mthca_warn(dev
, "HW2SW_EQ returned status 0x%02x\n", status
);
632 dev
->eq_table
.arm_mask
&= ~eq
->eqn_mask
;
635 mthca_dbg(dev
, "Dumping EQ context %02x:\n", eq
->eqn
);
636 for (i
= 0; i
< sizeof (struct mthca_eq_context
) / 4; ++i
) {
638 printk("[%02x] ", i
* 4);
639 printk(" %08x", be32_to_cpup(mailbox
->buf
+ i
* 4));
640 if ((i
+ 1) % 4 == 0)
645 mthca_free_mr(dev
, &eq
->mr
);
646 for (i
= 0; i
< npages
; ++i
)
647 pci_free_consistent(dev
->pdev
, PAGE_SIZE
,
648 eq
->page_list
[i
].buf
,
649 pci_unmap_addr(&eq
->page_list
[i
], mapping
));
651 kfree(eq
->page_list
);
652 mthca_free_mailbox(dev
, mailbox
);
655 static void mthca_free_irqs(struct mthca_dev
*dev
)
659 if (dev
->eq_table
.have_irq
)
660 free_irq(dev
->pdev
->irq
, dev
);
661 for (i
= 0; i
< MTHCA_NUM_EQ
; ++i
)
662 if (dev
->eq_table
.eq
[i
].have_irq
)
663 free_irq(dev
->eq_table
.eq
[i
].msi_x_vector
,
664 dev
->eq_table
.eq
+ i
);
667 static int __devinit
mthca_map_reg(struct mthca_dev
*dev
,
668 unsigned long offset
, unsigned long size
,
671 unsigned long base
= pci_resource_start(dev
->pdev
, 0);
673 if (!request_mem_region(base
+ offset
, size
, DRV_NAME
))
676 *map
= ioremap(base
+ offset
, size
);
678 release_mem_region(base
+ offset
, size
);
685 static void mthca_unmap_reg(struct mthca_dev
*dev
, unsigned long offset
,
686 unsigned long size
, void __iomem
*map
)
688 unsigned long base
= pci_resource_start(dev
->pdev
, 0);
690 release_mem_region(base
+ offset
, size
);
694 static int __devinit
mthca_map_eq_regs(struct mthca_dev
*dev
)
696 unsigned long mthca_base
;
698 mthca_base
= pci_resource_start(dev
->pdev
, 0);
700 if (mthca_is_memfree(dev
)) {
702 * We assume that the EQ arm and EQ set CI registers
703 * fall within the first BAR. We can't trust the
704 * values firmware gives us, since those addresses are
705 * valid on the HCA's side of the PCI bus but not
706 * necessarily the host side.
708 if (mthca_map_reg(dev
, (pci_resource_len(dev
->pdev
, 0) - 1) &
709 dev
->fw
.arbel
.clr_int_base
, MTHCA_CLR_INT_SIZE
,
711 mthca_err(dev
, "Couldn't map interrupt clear register, "
717 * Add 4 because we limit ourselves to EQs 0 ... 31,
718 * so we only need the low word of the register.
720 if (mthca_map_reg(dev
, ((pci_resource_len(dev
->pdev
, 0) - 1) &
721 dev
->fw
.arbel
.eq_arm_base
) + 4, 4,
722 &dev
->eq_regs
.arbel
.eq_arm
)) {
723 mthca_err(dev
, "Couldn't map EQ arm register, aborting.\n");
724 mthca_unmap_reg(dev
, (pci_resource_len(dev
->pdev
, 0) - 1) &
725 dev
->fw
.arbel
.clr_int_base
, MTHCA_CLR_INT_SIZE
,
730 if (mthca_map_reg(dev
, (pci_resource_len(dev
->pdev
, 0) - 1) &
731 dev
->fw
.arbel
.eq_set_ci_base
,
732 MTHCA_EQ_SET_CI_SIZE
,
733 &dev
->eq_regs
.arbel
.eq_set_ci_base
)) {
734 mthca_err(dev
, "Couldn't map EQ CI register, aborting.\n");
735 mthca_unmap_reg(dev
, ((pci_resource_len(dev
->pdev
, 0) - 1) &
736 dev
->fw
.arbel
.eq_arm_base
) + 4, 4,
737 dev
->eq_regs
.arbel
.eq_arm
);
738 mthca_unmap_reg(dev
, (pci_resource_len(dev
->pdev
, 0) - 1) &
739 dev
->fw
.arbel
.clr_int_base
, MTHCA_CLR_INT_SIZE
,
744 if (mthca_map_reg(dev
, MTHCA_CLR_INT_BASE
, MTHCA_CLR_INT_SIZE
,
746 mthca_err(dev
, "Couldn't map interrupt clear register, "
751 if (mthca_map_reg(dev
, MTHCA_ECR_BASE
,
752 MTHCA_ECR_SIZE
+ MTHCA_ECR_CLR_SIZE
,
753 &dev
->eq_regs
.tavor
.ecr_base
)) {
754 mthca_err(dev
, "Couldn't map ecr register, "
756 mthca_unmap_reg(dev
, MTHCA_CLR_INT_BASE
, MTHCA_CLR_INT_SIZE
,
766 static void __devexit
mthca_unmap_eq_regs(struct mthca_dev
*dev
)
768 if (mthca_is_memfree(dev
)) {
769 mthca_unmap_reg(dev
, (pci_resource_len(dev
->pdev
, 0) - 1) &
770 dev
->fw
.arbel
.eq_set_ci_base
,
771 MTHCA_EQ_SET_CI_SIZE
,
772 dev
->eq_regs
.arbel
.eq_set_ci_base
);
773 mthca_unmap_reg(dev
, ((pci_resource_len(dev
->pdev
, 0) - 1) &
774 dev
->fw
.arbel
.eq_arm_base
) + 4, 4,
775 dev
->eq_regs
.arbel
.eq_arm
);
776 mthca_unmap_reg(dev
, (pci_resource_len(dev
->pdev
, 0) - 1) &
777 dev
->fw
.arbel
.clr_int_base
, MTHCA_CLR_INT_SIZE
,
780 mthca_unmap_reg(dev
, MTHCA_ECR_BASE
,
781 MTHCA_ECR_SIZE
+ MTHCA_ECR_CLR_SIZE
,
782 dev
->eq_regs
.tavor
.ecr_base
);
783 mthca_unmap_reg(dev
, MTHCA_CLR_INT_BASE
, MTHCA_CLR_INT_SIZE
,
788 int __devinit
mthca_map_eq_icm(struct mthca_dev
*dev
, u64 icm_virt
)
794 * We assume that mapping one page is enough for the whole EQ
795 * context table. This is fine with all current HCAs, because
796 * we only use 32 EQs and each EQ uses 32 bytes of context
797 * memory, or 1 KB total.
799 dev
->eq_table
.icm_virt
= icm_virt
;
800 dev
->eq_table
.icm_page
= alloc_page(GFP_HIGHUSER
);
801 if (!dev
->eq_table
.icm_page
)
803 dev
->eq_table
.icm_dma
= pci_map_page(dev
->pdev
, dev
->eq_table
.icm_page
, 0,
804 PAGE_SIZE
, PCI_DMA_BIDIRECTIONAL
);
805 if (pci_dma_mapping_error(dev
->eq_table
.icm_dma
)) {
806 __free_page(dev
->eq_table
.icm_page
);
810 ret
= mthca_MAP_ICM_page(dev
, dev
->eq_table
.icm_dma
, icm_virt
, &status
);
814 pci_unmap_page(dev
->pdev
, dev
->eq_table
.icm_dma
, PAGE_SIZE
,
815 PCI_DMA_BIDIRECTIONAL
);
816 __free_page(dev
->eq_table
.icm_page
);
822 void __devexit
mthca_unmap_eq_icm(struct mthca_dev
*dev
)
826 mthca_UNMAP_ICM(dev
, dev
->eq_table
.icm_virt
, PAGE_SIZE
/ 4096, &status
);
827 pci_unmap_page(dev
->pdev
, dev
->eq_table
.icm_dma
, PAGE_SIZE
,
828 PCI_DMA_BIDIRECTIONAL
);
829 __free_page(dev
->eq_table
.icm_page
);
832 int __devinit
mthca_init_eq_table(struct mthca_dev
*dev
)
839 err
= mthca_alloc_init(&dev
->eq_table
.alloc
,
841 dev
->limits
.num_eqs
- 1,
842 dev
->limits
.reserved_eqs
);
846 err
= mthca_map_eq_regs(dev
);
850 if (dev
->mthca_flags
& MTHCA_FLAG_MSI
||
851 dev
->mthca_flags
& MTHCA_FLAG_MSI_X
) {
852 dev
->eq_table
.clr_mask
= 0;
854 dev
->eq_table
.clr_mask
=
855 swab32(1 << (dev
->eq_table
.inta_pin
& 31));
856 dev
->eq_table
.clr_int
= dev
->clr_base
+
857 (dev
->eq_table
.inta_pin
< 32 ? 4 : 0);
860 dev
->eq_table
.arm_mask
= 0;
862 intr
= (dev
->mthca_flags
& MTHCA_FLAG_MSI
) ?
863 128 : dev
->eq_table
.inta_pin
;
865 err
= mthca_create_eq(dev
, dev
->limits
.num_cqs
,
866 (dev
->mthca_flags
& MTHCA_FLAG_MSI_X
) ? 128 : intr
,
867 &dev
->eq_table
.eq
[MTHCA_EQ_COMP
]);
871 err
= mthca_create_eq(dev
, MTHCA_NUM_ASYNC_EQE
,
872 (dev
->mthca_flags
& MTHCA_FLAG_MSI_X
) ? 129 : intr
,
873 &dev
->eq_table
.eq
[MTHCA_EQ_ASYNC
]);
877 err
= mthca_create_eq(dev
, MTHCA_NUM_CMD_EQE
,
878 (dev
->mthca_flags
& MTHCA_FLAG_MSI_X
) ? 130 : intr
,
879 &dev
->eq_table
.eq
[MTHCA_EQ_CMD
]);
883 if (dev
->mthca_flags
& MTHCA_FLAG_MSI_X
) {
884 static const char *eq_name
[] = {
885 [MTHCA_EQ_COMP
] = DRV_NAME
" (comp)",
886 [MTHCA_EQ_ASYNC
] = DRV_NAME
" (async)",
887 [MTHCA_EQ_CMD
] = DRV_NAME
" (cmd)"
890 for (i
= 0; i
< MTHCA_NUM_EQ
; ++i
) {
891 err
= request_irq(dev
->eq_table
.eq
[i
].msi_x_vector
,
892 mthca_is_memfree(dev
) ?
893 mthca_arbel_msi_x_interrupt
:
894 mthca_tavor_msi_x_interrupt
,
895 0, eq_name
[i
], dev
->eq_table
.eq
+ i
);
898 dev
->eq_table
.eq
[i
].have_irq
= 1;
901 err
= request_irq(dev
->pdev
->irq
,
902 mthca_is_memfree(dev
) ?
903 mthca_arbel_interrupt
:
904 mthca_tavor_interrupt
,
905 SA_SHIRQ
, DRV_NAME
, dev
);
908 dev
->eq_table
.have_irq
= 1;
911 err
= mthca_MAP_EQ(dev
, async_mask(dev
),
912 0, dev
->eq_table
.eq
[MTHCA_EQ_ASYNC
].eqn
, &status
);
914 mthca_warn(dev
, "MAP_EQ for async EQ %d failed (%d)\n",
915 dev
->eq_table
.eq
[MTHCA_EQ_ASYNC
].eqn
, err
);
917 mthca_warn(dev
, "MAP_EQ for async EQ %d returned status 0x%02x\n",
918 dev
->eq_table
.eq
[MTHCA_EQ_ASYNC
].eqn
, status
);
920 err
= mthca_MAP_EQ(dev
, MTHCA_CMD_EVENT_MASK
,
921 0, dev
->eq_table
.eq
[MTHCA_EQ_CMD
].eqn
, &status
);
923 mthca_warn(dev
, "MAP_EQ for cmd EQ %d failed (%d)\n",
924 dev
->eq_table
.eq
[MTHCA_EQ_CMD
].eqn
, err
);
926 mthca_warn(dev
, "MAP_EQ for cmd EQ %d returned status 0x%02x\n",
927 dev
->eq_table
.eq
[MTHCA_EQ_CMD
].eqn
, status
);
929 for (i
= 0; i
< MTHCA_EQ_CMD
; ++i
)
930 if (mthca_is_memfree(dev
))
931 arbel_eq_req_not(dev
, dev
->eq_table
.eq
[i
].eqn_mask
);
933 tavor_eq_req_not(dev
, dev
->eq_table
.eq
[i
].eqn
);
938 mthca_free_irqs(dev
);
939 mthca_free_eq(dev
, &dev
->eq_table
.eq
[MTHCA_EQ_CMD
]);
942 mthca_free_eq(dev
, &dev
->eq_table
.eq
[MTHCA_EQ_ASYNC
]);
945 mthca_free_eq(dev
, &dev
->eq_table
.eq
[MTHCA_EQ_COMP
]);
948 mthca_unmap_eq_regs(dev
);
951 mthca_alloc_cleanup(&dev
->eq_table
.alloc
);
955 void __devexit
mthca_cleanup_eq_table(struct mthca_dev
*dev
)
960 mthca_free_irqs(dev
);
962 mthca_MAP_EQ(dev
, async_mask(dev
),
963 1, dev
->eq_table
.eq
[MTHCA_EQ_ASYNC
].eqn
, &status
);
964 mthca_MAP_EQ(dev
, MTHCA_CMD_EVENT_MASK
,
965 1, dev
->eq_table
.eq
[MTHCA_EQ_CMD
].eqn
, &status
);
967 for (i
= 0; i
< MTHCA_NUM_EQ
; ++i
)
968 mthca_free_eq(dev
, &dev
->eq_table
.eq
[i
]);
970 mthca_unmap_eq_regs(dev
);
972 mthca_alloc_cleanup(&dev
->eq_table
.alloc
);