Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2006 Chelsio, Inc. All rights reserved. |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 3 | * |
| 4 | * This software is available to you under a choice of one of two |
| 5 | * licenses. You may choose to be licensed under the terms of the GNU |
| 6 | * General Public License (GPL) Version 2, available from the file |
| 7 | * COPYING in the main directory of this source tree, or the |
| 8 | * OpenIB.org BSD license below: |
| 9 | * |
| 10 | * Redistribution and use in source and binary forms, with or |
| 11 | * without modification, are permitted provided that the following |
| 12 | * conditions are met: |
| 13 | * |
| 14 | * - Redistributions of source code must retain the above |
| 15 | * copyright notice, this list of conditions and the following |
| 16 | * disclaimer. |
| 17 | * |
| 18 | * - Redistributions in binary form must reproduce the above |
| 19 | * copyright notice, this list of conditions and the following |
| 20 | * disclaimer in the documentation and/or other materials |
| 21 | * provided with the distribution. |
| 22 | * |
| 23 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
| 24 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
| 25 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
| 26 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS |
| 27 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN |
| 28 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN |
| 29 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
| 30 | * SOFTWARE. |
| 31 | */ |
| 32 | #include <asm/delay.h> |
| 33 | |
| 34 | #include <linux/mutex.h> |
| 35 | #include <linux/netdevice.h> |
| 36 | #include <linux/sched.h> |
| 37 | #include <linux/spinlock.h> |
| 38 | #include <linux/pci.h> |
David Miller | c3bb109 | 2007-03-05 15:21:29 -0800 | [diff] [blame] | 39 | #include <linux/dma-mapping.h> |
Eric W. Biederman | 881d966 | 2007-09-17 11:56:21 -0700 | [diff] [blame] | 40 | #include <net/net_namespace.h> |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 41 | |
| 42 | #include "cxio_resource.h" |
| 43 | #include "cxio_hal.h" |
| 44 | #include "cxgb3_offload.h" |
| 45 | #include "sge_defs.h" |
| 46 | |
| 47 | static LIST_HEAD(rdev_list); |
| 48 | static cxio_hal_ev_callback_func_t cxio_ev_cb = NULL; |
| 49 | |
Adrian Bunk | 2b54035 | 2007-02-21 11:52:49 +0100 | [diff] [blame] | 50 | static struct cxio_rdev *cxio_hal_find_rdev_by_name(char *dev_name) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 51 | { |
| 52 | struct cxio_rdev *rdev; |
| 53 | |
| 54 | list_for_each_entry(rdev, &rdev_list, entry) |
| 55 | if (!strcmp(rdev->dev_name, dev_name)) |
| 56 | return rdev; |
| 57 | return NULL; |
| 58 | } |
| 59 | |
Adrian Bunk | 2b54035 | 2007-02-21 11:52:49 +0100 | [diff] [blame] | 60 | static struct cxio_rdev *cxio_hal_find_rdev_by_t3cdev(struct t3cdev *tdev) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 61 | { |
| 62 | struct cxio_rdev *rdev; |
| 63 | |
| 64 | list_for_each_entry(rdev, &rdev_list, entry) |
| 65 | if (rdev->t3cdev_p == tdev) |
| 66 | return rdev; |
| 67 | return NULL; |
| 68 | } |
| 69 | |
| 70 | int cxio_hal_cq_op(struct cxio_rdev *rdev_p, struct t3_cq *cq, |
| 71 | enum t3_cq_opcode op, u32 credit) |
| 72 | { |
| 73 | int ret; |
| 74 | struct t3_cqe *cqe; |
| 75 | u32 rptr; |
| 76 | |
| 77 | struct rdma_cq_op setup; |
| 78 | setup.id = cq->cqid; |
| 79 | setup.credits = (op == CQ_CREDIT_UPDATE) ? credit : 0; |
| 80 | setup.op = op; |
| 81 | ret = rdev_p->t3cdev_p->ctl(rdev_p->t3cdev_p, RDMA_CQ_OP, &setup); |
| 82 | |
| 83 | if ((ret < 0) || (op == CQ_CREDIT_UPDATE)) |
| 84 | return ret; |
| 85 | |
| 86 | /* |
| 87 | * If the rearm returned an index other than our current index, |
| 88 | * then there might be CQE's in flight (being DMA'd). We must wait |
| 89 | * here for them to complete or the consumer can miss a notification. |
| 90 | */ |
| 91 | if (Q_PTR2IDX((cq->rptr), cq->size_log2) != ret) { |
| 92 | int i=0; |
| 93 | |
| 94 | rptr = cq->rptr; |
| 95 | |
| 96 | /* |
| 97 | * Keep the generation correct by bumping rptr until it |
| 98 | * matches the index returned by the rearm - 1. |
| 99 | */ |
| 100 | while (Q_PTR2IDX((rptr+1), cq->size_log2) != ret) |
| 101 | rptr++; |
| 102 | |
| 103 | /* |
| 104 | * Now rptr is the index for the (last) cqe that was |
| 105 | * in-flight at the time the HW rearmed the CQ. We |
| 106 | * spin until that CQE is valid. |
| 107 | */ |
| 108 | cqe = cq->queue + Q_PTR2IDX(rptr, cq->size_log2); |
| 109 | while (!CQ_VLD_ENTRY(rptr, cq->size_log2, cqe)) { |
| 110 | udelay(1); |
| 111 | if (i++ > 1000000) { |
| 112 | BUG_ON(1); |
| 113 | printk(KERN_ERR "%s: stalled rnic\n", |
| 114 | rdev_p->dev_name); |
| 115 | return -EIO; |
| 116 | } |
| 117 | } |
Roland Dreier | ed23a72 | 2007-05-06 21:02:48 -0700 | [diff] [blame] | 118 | |
| 119 | return 1; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 120 | } |
Roland Dreier | ed23a72 | 2007-05-06 21:02:48 -0700 | [diff] [blame] | 121 | |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 122 | return 0; |
| 123 | } |
| 124 | |
Adrian Bunk | 2b54035 | 2007-02-21 11:52:49 +0100 | [diff] [blame] | 125 | static int cxio_hal_clear_cq_ctx(struct cxio_rdev *rdev_p, u32 cqid) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 126 | { |
| 127 | struct rdma_cq_setup setup; |
| 128 | setup.id = cqid; |
| 129 | setup.base_addr = 0; /* NULL address */ |
| 130 | setup.size = 0; /* disaable the CQ */ |
| 131 | setup.credits = 0; |
| 132 | setup.credit_thres = 0; |
| 133 | setup.ovfl_mode = 0; |
| 134 | return (rdev_p->t3cdev_p->ctl(rdev_p->t3cdev_p, RDMA_CQ_SETUP, &setup)); |
| 135 | } |
| 136 | |
Adrian Bunk | 2b54035 | 2007-02-21 11:52:49 +0100 | [diff] [blame] | 137 | static int cxio_hal_clear_qp_ctx(struct cxio_rdev *rdev_p, u32 qpid) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 138 | { |
| 139 | u64 sge_cmd; |
| 140 | struct t3_modify_qp_wr *wqe; |
| 141 | struct sk_buff *skb = alloc_skb(sizeof(*wqe), GFP_KERNEL); |
| 142 | if (!skb) { |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 143 | PDBG("%s alloc_skb failed\n", __func__); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 144 | return -ENOMEM; |
| 145 | } |
| 146 | wqe = (struct t3_modify_qp_wr *) skb_put(skb, sizeof(*wqe)); |
| 147 | memset(wqe, 0, sizeof(*wqe)); |
Steve Wise | e7e5582 | 2008-07-14 23:48:45 -0700 | [diff] [blame] | 148 | build_fw_riwrh((struct fw_riwrh *) wqe, T3_WR_QP_MOD, |
| 149 | T3_COMPLETION_FLAG | T3_NOTIFY_FLAG, 0, qpid, 7, |
| 150 | T3_SOPEOP); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 151 | wqe->flags = cpu_to_be32(MODQP_WRITE_EC); |
| 152 | sge_cmd = qpid << 8 | 3; |
| 153 | wqe->sge_cmd = cpu_to_be64(sge_cmd); |
| 154 | skb->priority = CPL_PRIORITY_CONTROL; |
Steve Wise | 04b5d02 | 2009-03-30 08:37:56 -0700 | [diff] [blame] | 155 | return iwch_cxgb3_ofld_send(rdev_p->t3cdev_p, skb); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 156 | } |
| 157 | |
| 158 | int cxio_create_cq(struct cxio_rdev *rdev_p, struct t3_cq *cq) |
| 159 | { |
| 160 | struct rdma_cq_setup setup; |
| 161 | int size = (1UL << (cq->size_log2)) * sizeof(struct t3_cqe); |
| 162 | |
| 163 | cq->cqid = cxio_hal_get_cqid(rdev_p->rscp); |
| 164 | if (!cq->cqid) |
| 165 | return -ENOMEM; |
| 166 | cq->sw_queue = kzalloc(size, GFP_KERNEL); |
| 167 | if (!cq->sw_queue) |
| 168 | return -ENOMEM; |
| 169 | cq->queue = dma_alloc_coherent(&(rdev_p->rnic_info.pdev->dev), |
| 170 | (1UL << (cq->size_log2)) * |
| 171 | sizeof(struct t3_cqe), |
| 172 | &(cq->dma_addr), GFP_KERNEL); |
| 173 | if (!cq->queue) { |
| 174 | kfree(cq->sw_queue); |
| 175 | return -ENOMEM; |
| 176 | } |
| 177 | pci_unmap_addr_set(cq, mapping, cq->dma_addr); |
| 178 | memset(cq->queue, 0, size); |
| 179 | setup.id = cq->cqid; |
| 180 | setup.base_addr = (u64) (cq->dma_addr); |
| 181 | setup.size = 1UL << cq->size_log2; |
| 182 | setup.credits = 65535; |
| 183 | setup.credit_thres = 1; |
Steve Wise | 8176d29 | 2008-01-24 16:30:16 -0600 | [diff] [blame] | 184 | if (rdev_p->t3cdev_p->type != T3A) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 185 | setup.ovfl_mode = 0; |
| 186 | else |
| 187 | setup.ovfl_mode = 1; |
| 188 | return (rdev_p->t3cdev_p->ctl(rdev_p->t3cdev_p, RDMA_CQ_SETUP, &setup)); |
| 189 | } |
| 190 | |
| 191 | int cxio_resize_cq(struct cxio_rdev *rdev_p, struct t3_cq *cq) |
| 192 | { |
| 193 | struct rdma_cq_setup setup; |
| 194 | setup.id = cq->cqid; |
| 195 | setup.base_addr = (u64) (cq->dma_addr); |
| 196 | setup.size = 1UL << cq->size_log2; |
| 197 | setup.credits = setup.size; |
| 198 | setup.credit_thres = setup.size; /* TBD: overflow recovery */ |
| 199 | setup.ovfl_mode = 1; |
| 200 | return (rdev_p->t3cdev_p->ctl(rdev_p->t3cdev_p, RDMA_CQ_SETUP, &setup)); |
| 201 | } |
| 202 | |
| 203 | static u32 get_qpid(struct cxio_rdev *rdev_p, struct cxio_ucontext *uctx) |
| 204 | { |
| 205 | struct cxio_qpid_list *entry; |
| 206 | u32 qpid; |
| 207 | int i; |
| 208 | |
| 209 | mutex_lock(&uctx->lock); |
| 210 | if (!list_empty(&uctx->qpids)) { |
| 211 | entry = list_entry(uctx->qpids.next, struct cxio_qpid_list, |
| 212 | entry); |
| 213 | list_del(&entry->entry); |
| 214 | qpid = entry->qpid; |
| 215 | kfree(entry); |
| 216 | } else { |
| 217 | qpid = cxio_hal_get_qpid(rdev_p->rscp); |
| 218 | if (!qpid) |
| 219 | goto out; |
| 220 | for (i = qpid+1; i & rdev_p->qpmask; i++) { |
| 221 | entry = kmalloc(sizeof *entry, GFP_KERNEL); |
| 222 | if (!entry) |
| 223 | break; |
| 224 | entry->qpid = i; |
| 225 | list_add_tail(&entry->entry, &uctx->qpids); |
| 226 | } |
| 227 | } |
| 228 | out: |
| 229 | mutex_unlock(&uctx->lock); |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 230 | PDBG("%s qpid 0x%x\n", __func__, qpid); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 231 | return qpid; |
| 232 | } |
| 233 | |
| 234 | static void put_qpid(struct cxio_rdev *rdev_p, u32 qpid, |
| 235 | struct cxio_ucontext *uctx) |
| 236 | { |
| 237 | struct cxio_qpid_list *entry; |
| 238 | |
| 239 | entry = kmalloc(sizeof *entry, GFP_KERNEL); |
| 240 | if (!entry) |
| 241 | return; |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 242 | PDBG("%s qpid 0x%x\n", __func__, qpid); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 243 | entry->qpid = qpid; |
| 244 | mutex_lock(&uctx->lock); |
| 245 | list_add_tail(&entry->entry, &uctx->qpids); |
| 246 | mutex_unlock(&uctx->lock); |
| 247 | } |
| 248 | |
| 249 | void cxio_release_ucontext(struct cxio_rdev *rdev_p, struct cxio_ucontext *uctx) |
| 250 | { |
| 251 | struct list_head *pos, *nxt; |
| 252 | struct cxio_qpid_list *entry; |
| 253 | |
| 254 | mutex_lock(&uctx->lock); |
| 255 | list_for_each_safe(pos, nxt, &uctx->qpids) { |
| 256 | entry = list_entry(pos, struct cxio_qpid_list, entry); |
| 257 | list_del_init(&entry->entry); |
| 258 | if (!(entry->qpid & rdev_p->qpmask)) |
| 259 | cxio_hal_put_qpid(rdev_p->rscp, entry->qpid); |
| 260 | kfree(entry); |
| 261 | } |
| 262 | mutex_unlock(&uctx->lock); |
| 263 | } |
| 264 | |
| 265 | void cxio_init_ucontext(struct cxio_rdev *rdev_p, struct cxio_ucontext *uctx) |
| 266 | { |
| 267 | INIT_LIST_HEAD(&uctx->qpids); |
| 268 | mutex_init(&uctx->lock); |
| 269 | } |
| 270 | |
| 271 | int cxio_create_qp(struct cxio_rdev *rdev_p, u32 kernel_domain, |
| 272 | struct t3_wq *wq, struct cxio_ucontext *uctx) |
| 273 | { |
| 274 | int depth = 1UL << wq->size_log2; |
| 275 | int rqsize = 1UL << wq->rq_size_log2; |
| 276 | |
| 277 | wq->qpid = get_qpid(rdev_p, uctx); |
| 278 | if (!wq->qpid) |
| 279 | return -ENOMEM; |
| 280 | |
Steve Wise | 4ab928f | 2008-07-14 23:48:53 -0700 | [diff] [blame] | 281 | wq->rq = kzalloc(depth * sizeof(struct t3_swrq), GFP_KERNEL); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 282 | if (!wq->rq) |
| 283 | goto err1; |
| 284 | |
| 285 | wq->rq_addr = cxio_hal_rqtpool_alloc(rdev_p, rqsize); |
| 286 | if (!wq->rq_addr) |
| 287 | goto err2; |
| 288 | |
| 289 | wq->sq = kzalloc(depth * sizeof(struct t3_swsq), GFP_KERNEL); |
| 290 | if (!wq->sq) |
| 291 | goto err3; |
| 292 | |
| 293 | wq->queue = dma_alloc_coherent(&(rdev_p->rnic_info.pdev->dev), |
| 294 | depth * sizeof(union t3_wr), |
| 295 | &(wq->dma_addr), GFP_KERNEL); |
| 296 | if (!wq->queue) |
| 297 | goto err4; |
| 298 | |
| 299 | memset(wq->queue, 0, depth * sizeof(union t3_wr)); |
| 300 | pci_unmap_addr_set(wq, mapping, wq->dma_addr); |
| 301 | wq->doorbell = (void __iomem *)rdev_p->rnic_info.kdb_addr; |
| 302 | if (!kernel_domain) |
| 303 | wq->udb = (u64)rdev_p->rnic_info.udbell_physbase + |
| 304 | (wq->qpid << rdev_p->qpshift); |
Steve Wise | 4ab928f | 2008-07-14 23:48:53 -0700 | [diff] [blame] | 305 | wq->rdev = rdev_p; |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 306 | PDBG("%s qpid 0x%x doorbell 0x%p udb 0x%llx\n", __func__, |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 307 | wq->qpid, wq->doorbell, (unsigned long long) wq->udb); |
| 308 | return 0; |
| 309 | err4: |
| 310 | kfree(wq->sq); |
| 311 | err3: |
| 312 | cxio_hal_rqtpool_free(rdev_p, wq->rq_addr, rqsize); |
| 313 | err2: |
| 314 | kfree(wq->rq); |
| 315 | err1: |
| 316 | put_qpid(rdev_p, wq->qpid, uctx); |
| 317 | return -ENOMEM; |
| 318 | } |
| 319 | |
| 320 | int cxio_destroy_cq(struct cxio_rdev *rdev_p, struct t3_cq *cq) |
| 321 | { |
| 322 | int err; |
| 323 | err = cxio_hal_clear_cq_ctx(rdev_p, cq->cqid); |
| 324 | kfree(cq->sw_queue); |
| 325 | dma_free_coherent(&(rdev_p->rnic_info.pdev->dev), |
| 326 | (1UL << (cq->size_log2)) |
| 327 | * sizeof(struct t3_cqe), cq->queue, |
| 328 | pci_unmap_addr(cq, mapping)); |
| 329 | cxio_hal_put_cqid(rdev_p->rscp, cq->cqid); |
| 330 | return err; |
| 331 | } |
| 332 | |
| 333 | int cxio_destroy_qp(struct cxio_rdev *rdev_p, struct t3_wq *wq, |
| 334 | struct cxio_ucontext *uctx) |
| 335 | { |
| 336 | dma_free_coherent(&(rdev_p->rnic_info.pdev->dev), |
| 337 | (1UL << (wq->size_log2)) |
| 338 | * sizeof(union t3_wr), wq->queue, |
| 339 | pci_unmap_addr(wq, mapping)); |
| 340 | kfree(wq->sq); |
| 341 | cxio_hal_rqtpool_free(rdev_p, wq->rq_addr, (1UL << wq->rq_size_log2)); |
| 342 | kfree(wq->rq); |
| 343 | put_qpid(rdev_p, wq->qpid, uctx); |
| 344 | return 0; |
| 345 | } |
| 346 | |
| 347 | static void insert_recv_cqe(struct t3_wq *wq, struct t3_cq *cq) |
| 348 | { |
| 349 | struct t3_cqe cqe; |
| 350 | |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 351 | PDBG("%s wq %p cq %p sw_rptr 0x%x sw_wptr 0x%x\n", __func__, |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 352 | wq, cq, cq->sw_rptr, cq->sw_wptr); |
| 353 | memset(&cqe, 0, sizeof(cqe)); |
| 354 | cqe.header = cpu_to_be32(V_CQE_STATUS(TPT_ERR_SWFLUSH) | |
| 355 | V_CQE_OPCODE(T3_SEND) | |
| 356 | V_CQE_TYPE(0) | |
| 357 | V_CQE_SWCQE(1) | |
| 358 | V_CQE_QPID(wq->qpid) | |
| 359 | V_CQE_GENBIT(Q_GENBIT(cq->sw_wptr, |
| 360 | cq->size_log2))); |
| 361 | *(cq->sw_queue + Q_PTR2IDX(cq->sw_wptr, cq->size_log2)) = cqe; |
| 362 | cq->sw_wptr++; |
| 363 | } |
| 364 | |
Steve Wise | c828694 | 2008-05-02 11:17:41 -0500 | [diff] [blame] | 365 | int cxio_flush_rq(struct t3_wq *wq, struct t3_cq *cq, int count) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 366 | { |
| 367 | u32 ptr; |
Steve Wise | c828694 | 2008-05-02 11:17:41 -0500 | [diff] [blame] | 368 | int flushed = 0; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 369 | |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 370 | PDBG("%s wq %p cq %p\n", __func__, wq, cq); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 371 | |
| 372 | /* flush RQ */ |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 373 | PDBG("%s rq_rptr %u rq_wptr %u skip count %u\n", __func__, |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 374 | wq->rq_rptr, wq->rq_wptr, count); |
| 375 | ptr = wq->rq_rptr + count; |
Steve Wise | c828694 | 2008-05-02 11:17:41 -0500 | [diff] [blame] | 376 | while (ptr++ != wq->rq_wptr) { |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 377 | insert_recv_cqe(wq, cq); |
Steve Wise | c828694 | 2008-05-02 11:17:41 -0500 | [diff] [blame] | 378 | flushed++; |
| 379 | } |
| 380 | return flushed; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 381 | } |
| 382 | |
| 383 | static void insert_sq_cqe(struct t3_wq *wq, struct t3_cq *cq, |
| 384 | struct t3_swsq *sqp) |
| 385 | { |
| 386 | struct t3_cqe cqe; |
| 387 | |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 388 | PDBG("%s wq %p cq %p sw_rptr 0x%x sw_wptr 0x%x\n", __func__, |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 389 | wq, cq, cq->sw_rptr, cq->sw_wptr); |
| 390 | memset(&cqe, 0, sizeof(cqe)); |
| 391 | cqe.header = cpu_to_be32(V_CQE_STATUS(TPT_ERR_SWFLUSH) | |
| 392 | V_CQE_OPCODE(sqp->opcode) | |
| 393 | V_CQE_TYPE(1) | |
| 394 | V_CQE_SWCQE(1) | |
| 395 | V_CQE_QPID(wq->qpid) | |
| 396 | V_CQE_GENBIT(Q_GENBIT(cq->sw_wptr, |
| 397 | cq->size_log2))); |
| 398 | cqe.u.scqe.wrid_hi = sqp->sq_wptr; |
| 399 | |
| 400 | *(cq->sw_queue + Q_PTR2IDX(cq->sw_wptr, cq->size_log2)) = cqe; |
| 401 | cq->sw_wptr++; |
| 402 | } |
| 403 | |
Steve Wise | c828694 | 2008-05-02 11:17:41 -0500 | [diff] [blame] | 404 | int cxio_flush_sq(struct t3_wq *wq, struct t3_cq *cq, int count) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 405 | { |
| 406 | __u32 ptr; |
Steve Wise | c828694 | 2008-05-02 11:17:41 -0500 | [diff] [blame] | 407 | int flushed = 0; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 408 | struct t3_swsq *sqp = wq->sq + Q_PTR2IDX(wq->sq_rptr, wq->sq_size_log2); |
| 409 | |
| 410 | ptr = wq->sq_rptr + count; |
Steve Wise | a58e58f | 2008-05-13 11:52:55 -0700 | [diff] [blame] | 411 | sqp = wq->sq + Q_PTR2IDX(ptr, wq->sq_size_log2); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 412 | while (ptr != wq->sq_wptr) { |
| 413 | insert_sq_cqe(wq, cq, sqp); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 414 | ptr++; |
Steve Wise | a58e58f | 2008-05-13 11:52:55 -0700 | [diff] [blame] | 415 | sqp = wq->sq + Q_PTR2IDX(ptr, wq->sq_size_log2); |
Steve Wise | c828694 | 2008-05-02 11:17:41 -0500 | [diff] [blame] | 416 | flushed++; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 417 | } |
Steve Wise | c828694 | 2008-05-02 11:17:41 -0500 | [diff] [blame] | 418 | return flushed; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 419 | } |
| 420 | |
| 421 | /* |
| 422 | * Move all CQEs from the HWCQ into the SWCQ. |
| 423 | */ |
| 424 | void cxio_flush_hw_cq(struct t3_cq *cq) |
| 425 | { |
| 426 | struct t3_cqe *cqe, *swcqe; |
| 427 | |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 428 | PDBG("%s cq %p cqid 0x%x\n", __func__, cq, cq->cqid); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 429 | cqe = cxio_next_hw_cqe(cq); |
| 430 | while (cqe) { |
| 431 | PDBG("%s flushing hwcq rptr 0x%x to swcq wptr 0x%x\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 432 | __func__, cq->rptr, cq->sw_wptr); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 433 | swcqe = cq->sw_queue + Q_PTR2IDX(cq->sw_wptr, cq->size_log2); |
| 434 | *swcqe = *cqe; |
| 435 | swcqe->header |= cpu_to_be32(V_CQE_SWCQE(1)); |
| 436 | cq->sw_wptr++; |
| 437 | cq->rptr++; |
| 438 | cqe = cxio_next_hw_cqe(cq); |
| 439 | } |
| 440 | } |
| 441 | |
Adrian Bunk | 2b54035 | 2007-02-21 11:52:49 +0100 | [diff] [blame] | 442 | static int cqe_completes_wr(struct t3_cqe *cqe, struct t3_wq *wq) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 443 | { |
| 444 | if (CQE_OPCODE(*cqe) == T3_TERMINATE) |
| 445 | return 0; |
| 446 | |
| 447 | if ((CQE_OPCODE(*cqe) == T3_RDMA_WRITE) && RQ_TYPE(*cqe)) |
| 448 | return 0; |
| 449 | |
| 450 | if ((CQE_OPCODE(*cqe) == T3_READ_RESP) && SQ_TYPE(*cqe)) |
| 451 | return 0; |
| 452 | |
Steve Wise | 42fb61f | 2009-02-10 16:38:57 -0800 | [diff] [blame] | 453 | if (CQE_SEND_OPCODE(*cqe) && RQ_TYPE(*cqe) && |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 454 | Q_EMPTY(wq->rq_rptr, wq->rq_wptr)) |
| 455 | return 0; |
| 456 | |
| 457 | return 1; |
| 458 | } |
| 459 | |
| 460 | void cxio_count_scqes(struct t3_cq *cq, struct t3_wq *wq, int *count) |
| 461 | { |
| 462 | struct t3_cqe *cqe; |
| 463 | u32 ptr; |
| 464 | |
| 465 | *count = 0; |
| 466 | ptr = cq->sw_rptr; |
| 467 | while (!Q_EMPTY(ptr, cq->sw_wptr)) { |
| 468 | cqe = cq->sw_queue + (Q_PTR2IDX(ptr, cq->size_log2)); |
Steve Wise | f8b0dfd | 2008-04-29 13:46:52 -0700 | [diff] [blame] | 469 | if ((SQ_TYPE(*cqe) || |
| 470 | ((CQE_OPCODE(*cqe) == T3_READ_RESP) && wq->oldest_read)) && |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 471 | (CQE_QPID(*cqe) == wq->qpid)) |
| 472 | (*count)++; |
| 473 | ptr++; |
| 474 | } |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 475 | PDBG("%s cq %p count %d\n", __func__, cq, *count); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 476 | } |
| 477 | |
| 478 | void cxio_count_rcqes(struct t3_cq *cq, struct t3_wq *wq, int *count) |
| 479 | { |
| 480 | struct t3_cqe *cqe; |
| 481 | u32 ptr; |
| 482 | |
| 483 | *count = 0; |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 484 | PDBG("%s count zero %d\n", __func__, *count); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 485 | ptr = cq->sw_rptr; |
| 486 | while (!Q_EMPTY(ptr, cq->sw_wptr)) { |
| 487 | cqe = cq->sw_queue + (Q_PTR2IDX(ptr, cq->size_log2)); |
| 488 | if (RQ_TYPE(*cqe) && (CQE_OPCODE(*cqe) != T3_READ_RESP) && |
| 489 | (CQE_QPID(*cqe) == wq->qpid) && cqe_completes_wr(cqe, wq)) |
| 490 | (*count)++; |
| 491 | ptr++; |
| 492 | } |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 493 | PDBG("%s cq %p count %d\n", __func__, cq, *count); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 494 | } |
| 495 | |
| 496 | static int cxio_hal_init_ctrl_cq(struct cxio_rdev *rdev_p) |
| 497 | { |
| 498 | struct rdma_cq_setup setup; |
| 499 | setup.id = 0; |
| 500 | setup.base_addr = 0; /* NULL address */ |
| 501 | setup.size = 1; /* enable the CQ */ |
| 502 | setup.credits = 0; |
| 503 | |
| 504 | /* force SGE to redirect to RspQ and interrupt */ |
| 505 | setup.credit_thres = 0; |
| 506 | setup.ovfl_mode = 1; |
| 507 | return (rdev_p->t3cdev_p->ctl(rdev_p->t3cdev_p, RDMA_CQ_SETUP, &setup)); |
| 508 | } |
| 509 | |
| 510 | static int cxio_hal_init_ctrl_qp(struct cxio_rdev *rdev_p) |
| 511 | { |
| 512 | int err; |
| 513 | u64 sge_cmd, ctx0, ctx1; |
| 514 | u64 base_addr; |
| 515 | struct t3_modify_qp_wr *wqe; |
Steve Wise | ed6ee51 | 2007-03-26 17:48:52 -0500 | [diff] [blame] | 516 | struct sk_buff *skb; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 517 | |
Steve Wise | ed6ee51 | 2007-03-26 17:48:52 -0500 | [diff] [blame] | 518 | skb = alloc_skb(sizeof(*wqe), GFP_KERNEL); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 519 | if (!skb) { |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 520 | PDBG("%s alloc_skb failed\n", __func__); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 521 | return -ENOMEM; |
| 522 | } |
| 523 | err = cxio_hal_init_ctrl_cq(rdev_p); |
| 524 | if (err) { |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 525 | PDBG("%s err %d initializing ctrl_cq\n", __func__, err); |
Steve Wise | ed6ee51 | 2007-03-26 17:48:52 -0500 | [diff] [blame] | 526 | goto err; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 527 | } |
| 528 | rdev_p->ctrl_qp.workq = dma_alloc_coherent( |
| 529 | &(rdev_p->rnic_info.pdev->dev), |
| 530 | (1 << T3_CTRL_QP_SIZE_LOG2) * |
| 531 | sizeof(union t3_wr), |
| 532 | &(rdev_p->ctrl_qp.dma_addr), |
| 533 | GFP_KERNEL); |
| 534 | if (!rdev_p->ctrl_qp.workq) { |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 535 | PDBG("%s dma_alloc_coherent failed\n", __func__); |
Steve Wise | ed6ee51 | 2007-03-26 17:48:52 -0500 | [diff] [blame] | 536 | err = -ENOMEM; |
| 537 | goto err; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 538 | } |
| 539 | pci_unmap_addr_set(&rdev_p->ctrl_qp, mapping, |
| 540 | rdev_p->ctrl_qp.dma_addr); |
| 541 | rdev_p->ctrl_qp.doorbell = (void __iomem *)rdev_p->rnic_info.kdb_addr; |
| 542 | memset(rdev_p->ctrl_qp.workq, 0, |
| 543 | (1 << T3_CTRL_QP_SIZE_LOG2) * sizeof(union t3_wr)); |
| 544 | |
| 545 | mutex_init(&rdev_p->ctrl_qp.lock); |
| 546 | init_waitqueue_head(&rdev_p->ctrl_qp.waitq); |
| 547 | |
| 548 | /* update HW Ctrl QP context */ |
| 549 | base_addr = rdev_p->ctrl_qp.dma_addr; |
| 550 | base_addr >>= 12; |
| 551 | ctx0 = (V_EC_SIZE((1 << T3_CTRL_QP_SIZE_LOG2)) | |
| 552 | V_EC_BASE_LO((u32) base_addr & 0xffff)); |
| 553 | ctx0 <<= 32; |
| 554 | ctx0 |= V_EC_CREDITS(FW_WR_NUM); |
| 555 | base_addr >>= 16; |
| 556 | ctx1 = (u32) base_addr; |
| 557 | base_addr >>= 32; |
| 558 | ctx1 |= ((u64) (V_EC_BASE_HI((u32) base_addr & 0xf) | V_EC_RESPQ(0) | |
| 559 | V_EC_TYPE(0) | V_EC_GEN(1) | |
| 560 | V_EC_UP_TOKEN(T3_CTL_QP_TID) | F_EC_VALID)) << 32; |
| 561 | wqe = (struct t3_modify_qp_wr *) skb_put(skb, sizeof(*wqe)); |
| 562 | memset(wqe, 0, sizeof(*wqe)); |
Steve Wise | 6eda48d | 2007-06-19 09:27:48 -0500 | [diff] [blame] | 563 | build_fw_riwrh((struct fw_riwrh *) wqe, T3_WR_QP_MOD, 0, 0, |
Steve Wise | e7e5582 | 2008-07-14 23:48:45 -0700 | [diff] [blame] | 564 | T3_CTL_QP_TID, 7, T3_SOPEOP); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 565 | wqe->flags = cpu_to_be32(MODQP_WRITE_EC); |
| 566 | sge_cmd = (3ULL << 56) | FW_RI_SGEEC_START << 8 | 3; |
| 567 | wqe->sge_cmd = cpu_to_be64(sge_cmd); |
| 568 | wqe->ctx1 = cpu_to_be64(ctx1); |
| 569 | wqe->ctx0 = cpu_to_be64(ctx0); |
| 570 | PDBG("CtrlQP dma_addr 0x%llx workq %p size %d\n", |
| 571 | (unsigned long long) rdev_p->ctrl_qp.dma_addr, |
| 572 | rdev_p->ctrl_qp.workq, 1 << T3_CTRL_QP_SIZE_LOG2); |
| 573 | skb->priority = CPL_PRIORITY_CONTROL; |
Steve Wise | 04b5d02 | 2009-03-30 08:37:56 -0700 | [diff] [blame] | 574 | return iwch_cxgb3_ofld_send(rdev_p->t3cdev_p, skb); |
Steve Wise | ed6ee51 | 2007-03-26 17:48:52 -0500 | [diff] [blame] | 575 | err: |
| 576 | kfree_skb(skb); |
| 577 | return err; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 578 | } |
| 579 | |
| 580 | static int cxio_hal_destroy_ctrl_qp(struct cxio_rdev *rdev_p) |
| 581 | { |
| 582 | dma_free_coherent(&(rdev_p->rnic_info.pdev->dev), |
| 583 | (1UL << T3_CTRL_QP_SIZE_LOG2) |
| 584 | * sizeof(union t3_wr), rdev_p->ctrl_qp.workq, |
| 585 | pci_unmap_addr(&rdev_p->ctrl_qp, mapping)); |
| 586 | return cxio_hal_clear_qp_ctx(rdev_p, T3_CTRL_QP_ID); |
| 587 | } |
| 588 | |
| 589 | /* write len bytes of data into addr (32B aligned address) |
| 590 | * If data is NULL, clear len byte of memory to zero. |
| 591 | * caller aquires the ctrl_qp lock before the call |
| 592 | */ |
| 593 | static int cxio_hal_ctrl_qp_write_mem(struct cxio_rdev *rdev_p, u32 addr, |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 594 | u32 len, void *data) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 595 | { |
| 596 | u32 i, nr_wqe, copy_len; |
| 597 | u8 *copy_data; |
Joe Perches | 94545e8 | 2007-12-17 11:30:36 -0800 | [diff] [blame] | 598 | u8 wr_len, utx_len; /* length in 8 byte flit */ |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 599 | enum t3_wr_flags flag; |
| 600 | __be64 *wqe; |
| 601 | u64 utx_cmd; |
| 602 | addr &= 0x7FFFFFF; |
| 603 | nr_wqe = len % 96 ? len / 96 + 1 : len / 96; /* 96B max per WQE */ |
| 604 | PDBG("%s wptr 0x%x rptr 0x%x len %d, nr_wqe %d data %p addr 0x%0x\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 605 | __func__, rdev_p->ctrl_qp.wptr, rdev_p->ctrl_qp.rptr, len, |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 606 | nr_wqe, data, addr); |
| 607 | utx_len = 3; /* in 32B unit */ |
| 608 | for (i = 0; i < nr_wqe; i++) { |
| 609 | if (Q_FULL(rdev_p->ctrl_qp.rptr, rdev_p->ctrl_qp.wptr, |
| 610 | T3_CTRL_QP_SIZE_LOG2)) { |
| 611 | PDBG("%s ctrl_qp full wtpr 0x%0x rptr 0x%0x, " |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 612 | "wait for more space i %d\n", __func__, |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 613 | rdev_p->ctrl_qp.wptr, rdev_p->ctrl_qp.rptr, i); |
| 614 | if (wait_event_interruptible(rdev_p->ctrl_qp.waitq, |
| 615 | !Q_FULL(rdev_p->ctrl_qp.rptr, |
| 616 | rdev_p->ctrl_qp.wptr, |
| 617 | T3_CTRL_QP_SIZE_LOG2))) { |
| 618 | PDBG("%s ctrl_qp workq interrupted\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 619 | __func__); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 620 | return -ERESTARTSYS; |
| 621 | } |
| 622 | PDBG("%s ctrl_qp wakeup, continue posting work request " |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 623 | "i %d\n", __func__, i); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 624 | } |
| 625 | wqe = (__be64 *)(rdev_p->ctrl_qp.workq + (rdev_p->ctrl_qp.wptr % |
| 626 | (1 << T3_CTRL_QP_SIZE_LOG2))); |
| 627 | flag = 0; |
| 628 | if (i == (nr_wqe - 1)) { |
| 629 | /* last WQE */ |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 630 | flag = T3_COMPLETION_FLAG; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 631 | if (len % 32) |
| 632 | utx_len = len / 32 + 1; |
| 633 | else |
| 634 | utx_len = len / 32; |
| 635 | } |
| 636 | |
| 637 | /* |
| 638 | * Force a CQE to return the credit to the workq in case |
| 639 | * we posted more than half the max QP size of WRs |
| 640 | */ |
| 641 | if ((i != 0) && |
| 642 | (i % (((1 << T3_CTRL_QP_SIZE_LOG2)) >> 1) == 0)) { |
| 643 | flag = T3_COMPLETION_FLAG; |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 644 | PDBG("%s force completion at i %d\n", __func__, i); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 645 | } |
| 646 | |
| 647 | /* build the utx mem command */ |
| 648 | wqe += (sizeof(struct t3_bypass_wr) >> 3); |
| 649 | utx_cmd = (T3_UTX_MEM_WRITE << 28) | (addr + i * 3); |
| 650 | utx_cmd <<= 32; |
| 651 | utx_cmd |= (utx_len << 28) | ((utx_len << 2) + 1); |
| 652 | *wqe = cpu_to_be64(utx_cmd); |
| 653 | wqe++; |
| 654 | copy_data = (u8 *) data + i * 96; |
| 655 | copy_len = len > 96 ? 96 : len; |
| 656 | |
| 657 | /* clear memory content if data is NULL */ |
| 658 | if (data) |
| 659 | memcpy(wqe, copy_data, copy_len); |
| 660 | else |
| 661 | memset(wqe, 0, copy_len); |
| 662 | if (copy_len % 32) |
| 663 | memset(((u8 *) wqe) + copy_len, 0, |
| 664 | 32 - (copy_len % 32)); |
| 665 | wr_len = ((sizeof(struct t3_bypass_wr)) >> 3) + 1 + |
| 666 | (utx_len << 2); |
| 667 | wqe = (__be64 *)(rdev_p->ctrl_qp.workq + (rdev_p->ctrl_qp.wptr % |
| 668 | (1 << T3_CTRL_QP_SIZE_LOG2))); |
| 669 | |
| 670 | /* wptr in the WRID[31:0] */ |
| 671 | ((union t3_wrid *)(wqe+1))->id0.low = rdev_p->ctrl_qp.wptr; |
| 672 | |
| 673 | /* |
| 674 | * This must be the last write with a memory barrier |
| 675 | * for the genbit |
| 676 | */ |
| 677 | build_fw_riwrh((struct fw_riwrh *) wqe, T3_WR_BP, flag, |
| 678 | Q_GENBIT(rdev_p->ctrl_qp.wptr, |
| 679 | T3_CTRL_QP_SIZE_LOG2), T3_CTRL_QP_ID, |
Steve Wise | e7e5582 | 2008-07-14 23:48:45 -0700 | [diff] [blame] | 680 | wr_len, T3_SOPEOP); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 681 | if (flag == T3_COMPLETION_FLAG) |
| 682 | ring_doorbell(rdev_p->ctrl_qp.doorbell, T3_CTRL_QP_ID); |
| 683 | len -= 96; |
| 684 | rdev_p->ctrl_qp.wptr++; |
| 685 | } |
| 686 | return 0; |
| 687 | } |
| 688 | |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 689 | /* IN: stag key, pdid, perm, zbva, to, len, page_size, pbl_size and pbl_addr |
| 690 | * OUT: stag index |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 691 | * TBD: shared memory region support |
| 692 | */ |
| 693 | static int __cxio_tpt_op(struct cxio_rdev *rdev_p, u32 reset_tpt_entry, |
| 694 | u32 *stag, u8 stag_state, u32 pdid, |
| 695 | enum tpt_mem_type type, enum tpt_mem_perm perm, |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 696 | u32 zbva, u64 to, u32 len, u8 page_size, |
| 697 | u32 pbl_size, u32 pbl_addr) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 698 | { |
| 699 | int err; |
| 700 | struct tpt_entry tpt; |
| 701 | u32 stag_idx; |
| 702 | u32 wptr; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 703 | |
Steve Wise | 04b5d02 | 2009-03-30 08:37:56 -0700 | [diff] [blame] | 704 | if (cxio_fatal_error(rdev_p)) |
Divy Le Ray | a73efd0 | 2009-01-26 22:22:19 -0800 | [diff] [blame] | 705 | return -EIO; |
| 706 | |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 707 | stag_state = stag_state > 0; |
| 708 | stag_idx = (*stag) >> 8; |
| 709 | |
| 710 | if ((!reset_tpt_entry) && !(*stag != T3_STAG_UNSET)) { |
| 711 | stag_idx = cxio_hal_get_stag(rdev_p->rscp); |
| 712 | if (!stag_idx) |
| 713 | return -ENOMEM; |
| 714 | *stag = (stag_idx << 8) | ((*stag) & 0xFF); |
| 715 | } |
| 716 | PDBG("%s stag_state 0x%0x type 0x%0x pdid 0x%0x, stag_idx 0x%x\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 717 | __func__, stag_state, type, pdid, stag_idx); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 718 | |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 719 | mutex_lock(&rdev_p->ctrl_qp.lock); |
| 720 | |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 721 | /* write TPT entry */ |
| 722 | if (reset_tpt_entry) |
| 723 | memset(&tpt, 0, sizeof(tpt)); |
| 724 | else { |
| 725 | tpt.valid_stag_pdid = cpu_to_be32(F_TPT_VALID | |
| 726 | V_TPT_STAG_KEY((*stag) & M_TPT_STAG_KEY) | |
| 727 | V_TPT_STAG_STATE(stag_state) | |
| 728 | V_TPT_STAG_TYPE(type) | V_TPT_PDID(pdid)); |
| 729 | BUG_ON(page_size >= 28); |
| 730 | tpt.flags_pagesize_qpid = cpu_to_be32(V_TPT_PERM(perm) | |
Steve Wise | 1c355a6 | 2008-08-04 11:05:43 -0700 | [diff] [blame] | 731 | ((perm & TPT_MW_BIND) ? F_TPT_MW_BIND_ENABLE : 0) | |
| 732 | V_TPT_ADDR_TYPE((zbva ? TPT_ZBTO : TPT_VATO)) | |
| 733 | V_TPT_PAGE_SIZE(page_size)); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 734 | tpt.rsvd_pbl_addr = reset_tpt_entry ? 0 : |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 735 | cpu_to_be32(V_TPT_PBL_ADDR(PBL_OFF(rdev_p, pbl_addr)>>3)); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 736 | tpt.len = cpu_to_be32(len); |
| 737 | tpt.va_hi = cpu_to_be32((u32) (to >> 32)); |
| 738 | tpt.va_low_or_fbo = cpu_to_be32((u32) (to & 0xFFFFFFFFULL)); |
| 739 | tpt.rsvd_bind_cnt_or_pstag = 0; |
| 740 | tpt.rsvd_pbl_size = reset_tpt_entry ? 0 : |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 741 | cpu_to_be32(V_TPT_PBL_SIZE(pbl_size >> 2)); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 742 | } |
| 743 | err = cxio_hal_ctrl_qp_write_mem(rdev_p, |
| 744 | stag_idx + |
| 745 | (rdev_p->rnic_info.tpt_base >> 5), |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 746 | sizeof(tpt), &tpt); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 747 | |
| 748 | /* release the stag index to free pool */ |
| 749 | if (reset_tpt_entry) |
| 750 | cxio_hal_put_stag(rdev_p->rscp, stag_idx); |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 751 | |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 752 | wptr = rdev_p->ctrl_qp.wptr; |
| 753 | mutex_unlock(&rdev_p->ctrl_qp.lock); |
| 754 | if (!err) |
| 755 | if (wait_event_interruptible(rdev_p->ctrl_qp.waitq, |
| 756 | SEQ32_GE(rdev_p->ctrl_qp.rptr, |
| 757 | wptr))) |
| 758 | return -ERESTARTSYS; |
| 759 | return err; |
| 760 | } |
| 761 | |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 762 | int cxio_write_pbl(struct cxio_rdev *rdev_p, __be64 *pbl, |
| 763 | u32 pbl_addr, u32 pbl_size) |
| 764 | { |
| 765 | u32 wptr; |
| 766 | int err; |
| 767 | |
| 768 | PDBG("%s *pdb_addr 0x%x, pbl_base 0x%x, pbl_size %d\n", |
| 769 | __func__, pbl_addr, rdev_p->rnic_info.pbl_base, |
| 770 | pbl_size); |
| 771 | |
| 772 | mutex_lock(&rdev_p->ctrl_qp.lock); |
| 773 | err = cxio_hal_ctrl_qp_write_mem(rdev_p, pbl_addr >> 5, pbl_size << 3, |
| 774 | pbl); |
| 775 | wptr = rdev_p->ctrl_qp.wptr; |
| 776 | mutex_unlock(&rdev_p->ctrl_qp.lock); |
| 777 | if (err) |
| 778 | return err; |
| 779 | |
| 780 | if (wait_event_interruptible(rdev_p->ctrl_qp.waitq, |
| 781 | SEQ32_GE(rdev_p->ctrl_qp.rptr, |
| 782 | wptr))) |
| 783 | return -ERESTARTSYS; |
| 784 | |
| 785 | return 0; |
| 786 | } |
| 787 | |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 788 | int cxio_register_phys_mem(struct cxio_rdev *rdev_p, u32 *stag, u32 pdid, |
| 789 | enum tpt_mem_perm perm, u32 zbva, u64 to, u32 len, |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 790 | u8 page_size, u32 pbl_size, u32 pbl_addr) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 791 | { |
| 792 | *stag = T3_STAG_UNSET; |
| 793 | return __cxio_tpt_op(rdev_p, 0, stag, 1, pdid, TPT_NON_SHARED_MR, perm, |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 794 | zbva, to, len, page_size, pbl_size, pbl_addr); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 795 | } |
| 796 | |
| 797 | int cxio_reregister_phys_mem(struct cxio_rdev *rdev_p, u32 *stag, u32 pdid, |
| 798 | enum tpt_mem_perm perm, u32 zbva, u64 to, u32 len, |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 799 | u8 page_size, u32 pbl_size, u32 pbl_addr) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 800 | { |
| 801 | return __cxio_tpt_op(rdev_p, 0, stag, 1, pdid, TPT_NON_SHARED_MR, perm, |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 802 | zbva, to, len, page_size, pbl_size, pbl_addr); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 803 | } |
| 804 | |
| 805 | int cxio_dereg_mem(struct cxio_rdev *rdev_p, u32 stag, u32 pbl_size, |
| 806 | u32 pbl_addr) |
| 807 | { |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 808 | return __cxio_tpt_op(rdev_p, 1, &stag, 0, 0, 0, 0, 0, 0ULL, 0, 0, |
| 809 | pbl_size, pbl_addr); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 810 | } |
| 811 | |
| 812 | int cxio_allocate_window(struct cxio_rdev *rdev_p, u32 * stag, u32 pdid) |
| 813 | { |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 814 | *stag = T3_STAG_UNSET; |
| 815 | return __cxio_tpt_op(rdev_p, 0, stag, 0, pdid, TPT_MW, 0, 0, 0ULL, 0, 0, |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 816 | 0, 0); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 817 | } |
| 818 | |
| 819 | int cxio_deallocate_window(struct cxio_rdev *rdev_p, u32 stag) |
| 820 | { |
Roland Dreier | 273748c | 2008-05-06 15:56:22 -0700 | [diff] [blame] | 821 | return __cxio_tpt_op(rdev_p, 1, &stag, 0, 0, 0, 0, 0, 0ULL, 0, 0, |
| 822 | 0, 0); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 823 | } |
| 824 | |
Steve Wise | e7e5582 | 2008-07-14 23:48:45 -0700 | [diff] [blame] | 825 | int cxio_allocate_stag(struct cxio_rdev *rdev_p, u32 *stag, u32 pdid, u32 pbl_size, u32 pbl_addr) |
| 826 | { |
| 827 | *stag = T3_STAG_UNSET; |
| 828 | return __cxio_tpt_op(rdev_p, 0, stag, 0, pdid, TPT_NON_SHARED_MR, |
| 829 | 0, 0, 0ULL, 0, 0, pbl_size, pbl_addr); |
| 830 | } |
| 831 | |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 832 | int cxio_rdma_init(struct cxio_rdev *rdev_p, struct t3_rdma_init_attr *attr) |
| 833 | { |
| 834 | struct t3_rdma_init_wr *wqe; |
| 835 | struct sk_buff *skb = alloc_skb(sizeof(*wqe), GFP_ATOMIC); |
| 836 | if (!skb) |
| 837 | return -ENOMEM; |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 838 | PDBG("%s rdev_p %p\n", __func__, rdev_p); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 839 | wqe = (struct t3_rdma_init_wr *) __skb_put(skb, sizeof(*wqe)); |
| 840 | wqe->wrh.op_seop_flags = cpu_to_be32(V_FW_RIWR_OP(T3_WR_INIT)); |
| 841 | wqe->wrh.gen_tid_len = cpu_to_be32(V_FW_RIWR_TID(attr->tid) | |
| 842 | V_FW_RIWR_LEN(sizeof(*wqe) >> 3)); |
| 843 | wqe->wrid.id1 = 0; |
| 844 | wqe->qpid = cpu_to_be32(attr->qpid); |
| 845 | wqe->pdid = cpu_to_be32(attr->pdid); |
| 846 | wqe->scqid = cpu_to_be32(attr->scqid); |
| 847 | wqe->rcqid = cpu_to_be32(attr->rcqid); |
| 848 | wqe->rq_addr = cpu_to_be32(attr->rq_addr - rdev_p->rnic_info.rqt_base); |
| 849 | wqe->rq_size = cpu_to_be32(attr->rq_size); |
| 850 | wqe->mpaattrs = attr->mpaattrs; |
| 851 | wqe->qpcaps = attr->qpcaps; |
| 852 | wqe->ulpdu_size = cpu_to_be16(attr->tcp_emss); |
Steve Wise | f8b0dfd | 2008-04-29 13:46:52 -0700 | [diff] [blame] | 853 | wqe->rqe_count = cpu_to_be16(attr->rqe_count); |
| 854 | wqe->flags_rtr_type = cpu_to_be16(attr->flags|V_RTR_TYPE(attr->rtr_type)); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 855 | wqe->ord = cpu_to_be32(attr->ord); |
| 856 | wqe->ird = cpu_to_be32(attr->ird); |
| 857 | wqe->qp_dma_addr = cpu_to_be64(attr->qp_dma_addr); |
| 858 | wqe->qp_dma_size = cpu_to_be32(attr->qp_dma_size); |
Steve Wise | de3d353 | 2007-05-14 13:27:27 -0500 | [diff] [blame] | 859 | wqe->irs = cpu_to_be32(attr->irs); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 860 | skb->priority = 0; /* 0=>ToeQ; 1=>CtrlQ */ |
Steve Wise | 04b5d02 | 2009-03-30 08:37:56 -0700 | [diff] [blame] | 861 | return iwch_cxgb3_ofld_send(rdev_p->t3cdev_p, skb); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 862 | } |
| 863 | |
| 864 | void cxio_register_ev_cb(cxio_hal_ev_callback_func_t ev_cb) |
| 865 | { |
| 866 | cxio_ev_cb = ev_cb; |
| 867 | } |
| 868 | |
| 869 | void cxio_unregister_ev_cb(cxio_hal_ev_callback_func_t ev_cb) |
| 870 | { |
| 871 | cxio_ev_cb = NULL; |
| 872 | } |
| 873 | |
| 874 | static int cxio_hal_ev_handler(struct t3cdev *t3cdev_p, struct sk_buff *skb) |
| 875 | { |
| 876 | static int cnt; |
| 877 | struct cxio_rdev *rdev_p = NULL; |
| 878 | struct respQ_msg_t *rsp_msg = (struct respQ_msg_t *) skb->data; |
| 879 | PDBG("%d: %s cq_id 0x%x cq_ptr 0x%x genbit %0x overflow %0x an %0x" |
| 880 | " se %0x notify %0x cqbranch %0x creditth %0x\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 881 | cnt, __func__, RSPQ_CQID(rsp_msg), RSPQ_CQPTR(rsp_msg), |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 882 | RSPQ_GENBIT(rsp_msg), RSPQ_OVERFLOW(rsp_msg), RSPQ_AN(rsp_msg), |
| 883 | RSPQ_SE(rsp_msg), RSPQ_NOTIFY(rsp_msg), RSPQ_CQBRANCH(rsp_msg), |
| 884 | RSPQ_CREDIT_THRESH(rsp_msg)); |
| 885 | PDBG("CQE: QPID 0x%0x genbit %0x type 0x%0x status 0x%0x opcode %d " |
| 886 | "len 0x%0x wrid_hi_stag 0x%x wrid_low_msn 0x%x\n", |
| 887 | CQE_QPID(rsp_msg->cqe), CQE_GENBIT(rsp_msg->cqe), |
| 888 | CQE_TYPE(rsp_msg->cqe), CQE_STATUS(rsp_msg->cqe), |
| 889 | CQE_OPCODE(rsp_msg->cqe), CQE_LEN(rsp_msg->cqe), |
| 890 | CQE_WRID_HI(rsp_msg->cqe), CQE_WRID_LOW(rsp_msg->cqe)); |
| 891 | rdev_p = (struct cxio_rdev *)t3cdev_p->ulp; |
| 892 | if (!rdev_p) { |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 893 | PDBG("%s called by t3cdev %p with null ulp\n", __func__, |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 894 | t3cdev_p); |
| 895 | return 0; |
| 896 | } |
| 897 | if (CQE_QPID(rsp_msg->cqe) == T3_CTRL_QP_ID) { |
| 898 | rdev_p->ctrl_qp.rptr = CQE_WRID_LOW(rsp_msg->cqe) + 1; |
| 899 | wake_up_interruptible(&rdev_p->ctrl_qp.waitq); |
| 900 | dev_kfree_skb_irq(skb); |
| 901 | } else if (CQE_QPID(rsp_msg->cqe) == 0xfff8) |
| 902 | dev_kfree_skb_irq(skb); |
| 903 | else if (cxio_ev_cb) |
| 904 | (*cxio_ev_cb) (rdev_p, skb); |
| 905 | else |
| 906 | dev_kfree_skb_irq(skb); |
| 907 | cnt++; |
| 908 | return 0; |
| 909 | } |
| 910 | |
| 911 | /* Caller takes care of locking if needed */ |
| 912 | int cxio_rdev_open(struct cxio_rdev *rdev_p) |
| 913 | { |
| 914 | struct net_device *netdev_p = NULL; |
| 915 | int err = 0; |
| 916 | if (strlen(rdev_p->dev_name)) { |
| 917 | if (cxio_hal_find_rdev_by_name(rdev_p->dev_name)) { |
| 918 | return -EBUSY; |
| 919 | } |
Eric W. Biederman | 881d966 | 2007-09-17 11:56:21 -0700 | [diff] [blame] | 920 | netdev_p = dev_get_by_name(&init_net, rdev_p->dev_name); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 921 | if (!netdev_p) { |
| 922 | return -EINVAL; |
| 923 | } |
| 924 | dev_put(netdev_p); |
| 925 | } else if (rdev_p->t3cdev_p) { |
| 926 | if (cxio_hal_find_rdev_by_t3cdev(rdev_p->t3cdev_p)) { |
| 927 | return -EBUSY; |
| 928 | } |
| 929 | netdev_p = rdev_p->t3cdev_p->lldev; |
| 930 | strncpy(rdev_p->dev_name, rdev_p->t3cdev_p->name, |
| 931 | T3_MAX_DEV_NAME_LEN); |
| 932 | } else { |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 933 | PDBG("%s t3cdev_p or dev_name must be set\n", __func__); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 934 | return -EINVAL; |
| 935 | } |
| 936 | |
| 937 | list_add_tail(&rdev_p->entry, &rdev_list); |
| 938 | |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 939 | PDBG("%s opening rnic dev %s\n", __func__, rdev_p->dev_name); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 940 | memset(&rdev_p->ctrl_qp, 0, sizeof(rdev_p->ctrl_qp)); |
| 941 | if (!rdev_p->t3cdev_p) |
Divy Le Ray | 5fbf816 | 2007-08-29 19:15:47 -0700 | [diff] [blame] | 942 | rdev_p->t3cdev_p = dev2t3cdev(netdev_p); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 943 | rdev_p->t3cdev_p->ulp = (void *) rdev_p; |
Steve Wise | d1fbe04 | 2009-03-24 20:44:18 -0700 | [diff] [blame] | 944 | |
| 945 | err = rdev_p->t3cdev_p->ctl(rdev_p->t3cdev_p, GET_EMBEDDED_INFO, |
| 946 | &(rdev_p->fw_info)); |
| 947 | if (err) { |
| 948 | printk(KERN_ERR "%s t3cdev_p(%p)->ctl returned error %d.\n", |
| 949 | __func__, rdev_p->t3cdev_p, err); |
| 950 | goto err1; |
| 951 | } |
| 952 | if (G_FW_VERSION_MAJOR(rdev_p->fw_info.fw_vers) != CXIO_FW_MAJ) { |
| 953 | printk(KERN_ERR MOD "fatal firmware version mismatch: " |
| 954 | "need version %u but adapter has version %u\n", |
| 955 | CXIO_FW_MAJ, |
| 956 | G_FW_VERSION_MAJOR(rdev_p->fw_info.fw_vers)); |
| 957 | err = -EINVAL; |
| 958 | goto err1; |
| 959 | } |
| 960 | |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 961 | err = rdev_p->t3cdev_p->ctl(rdev_p->t3cdev_p, RDMA_GET_PARAMS, |
| 962 | &(rdev_p->rnic_info)); |
| 963 | if (err) { |
| 964 | printk(KERN_ERR "%s t3cdev_p(%p)->ctl returned error %d.\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 965 | __func__, rdev_p->t3cdev_p, err); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 966 | goto err1; |
| 967 | } |
| 968 | err = rdev_p->t3cdev_p->ctl(rdev_p->t3cdev_p, GET_PORTS, |
| 969 | &(rdev_p->port_info)); |
| 970 | if (err) { |
| 971 | printk(KERN_ERR "%s t3cdev_p(%p)->ctl returned error %d.\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 972 | __func__, rdev_p->t3cdev_p, err); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 973 | goto err1; |
| 974 | } |
| 975 | |
| 976 | /* |
| 977 | * qpshift is the number of bits to shift the qpid left in order |
| 978 | * to get the correct address of the doorbell for that qp. |
| 979 | */ |
| 980 | cxio_init_ucontext(rdev_p, &rdev_p->uctx); |
| 981 | rdev_p->qpshift = PAGE_SHIFT - |
| 982 | ilog2(65536 >> |
| 983 | ilog2(rdev_p->rnic_info.udbell_len >> |
| 984 | PAGE_SHIFT)); |
| 985 | rdev_p->qpnr = rdev_p->rnic_info.udbell_len >> PAGE_SHIFT; |
| 986 | rdev_p->qpmask = (65536 >> ilog2(rdev_p->qpnr)) - 1; |
| 987 | PDBG("%s rnic %s info: tpt_base 0x%0x tpt_top 0x%0x num stags %d " |
| 988 | "pbl_base 0x%0x pbl_top 0x%0x rqt_base 0x%0x, rqt_top 0x%0x\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 989 | __func__, rdev_p->dev_name, rdev_p->rnic_info.tpt_base, |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 990 | rdev_p->rnic_info.tpt_top, cxio_num_stags(rdev_p), |
| 991 | rdev_p->rnic_info.pbl_base, |
| 992 | rdev_p->rnic_info.pbl_top, rdev_p->rnic_info.rqt_base, |
| 993 | rdev_p->rnic_info.rqt_top); |
| 994 | PDBG("udbell_len 0x%0x udbell_physbase 0x%lx kdb_addr %p qpshift %lu " |
| 995 | "qpnr %d qpmask 0x%x\n", |
| 996 | rdev_p->rnic_info.udbell_len, |
| 997 | rdev_p->rnic_info.udbell_physbase, rdev_p->rnic_info.kdb_addr, |
| 998 | rdev_p->qpshift, rdev_p->qpnr, rdev_p->qpmask); |
| 999 | |
| 1000 | err = cxio_hal_init_ctrl_qp(rdev_p); |
| 1001 | if (err) { |
| 1002 | printk(KERN_ERR "%s error %d initializing ctrl_qp.\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 1003 | __func__, err); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1004 | goto err1; |
| 1005 | } |
| 1006 | err = cxio_hal_init_resource(rdev_p, cxio_num_stags(rdev_p), 0, |
| 1007 | 0, T3_MAX_NUM_QP, T3_MAX_NUM_CQ, |
| 1008 | T3_MAX_NUM_PD); |
| 1009 | if (err) { |
| 1010 | printk(KERN_ERR "%s error %d initializing hal resources.\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 1011 | __func__, err); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1012 | goto err2; |
| 1013 | } |
| 1014 | err = cxio_hal_pblpool_create(rdev_p); |
| 1015 | if (err) { |
| 1016 | printk(KERN_ERR "%s error %d initializing pbl mem pool.\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 1017 | __func__, err); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1018 | goto err3; |
| 1019 | } |
| 1020 | err = cxio_hal_rqtpool_create(rdev_p); |
| 1021 | if (err) { |
| 1022 | printk(KERN_ERR "%s error %d initializing rqt mem pool.\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 1023 | __func__, err); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1024 | goto err4; |
| 1025 | } |
| 1026 | return 0; |
| 1027 | err4: |
| 1028 | cxio_hal_pblpool_destroy(rdev_p); |
| 1029 | err3: |
| 1030 | cxio_hal_destroy_resource(rdev_p->rscp); |
| 1031 | err2: |
| 1032 | cxio_hal_destroy_ctrl_qp(rdev_p); |
| 1033 | err1: |
| 1034 | list_del(&rdev_p->entry); |
| 1035 | return err; |
| 1036 | } |
| 1037 | |
| 1038 | void cxio_rdev_close(struct cxio_rdev *rdev_p) |
| 1039 | { |
| 1040 | if (rdev_p) { |
| 1041 | cxio_hal_pblpool_destroy(rdev_p); |
| 1042 | cxio_hal_rqtpool_destroy(rdev_p); |
| 1043 | list_del(&rdev_p->entry); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1044 | cxio_hal_destroy_ctrl_qp(rdev_p); |
| 1045 | cxio_hal_destroy_resource(rdev_p->rscp); |
Steve Wise | 04b5d02 | 2009-03-30 08:37:56 -0700 | [diff] [blame] | 1046 | rdev_p->t3cdev_p->ulp = NULL; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1047 | } |
| 1048 | } |
| 1049 | |
| 1050 | int __init cxio_hal_init(void) |
| 1051 | { |
| 1052 | if (cxio_hal_init_rhdl_resource(T3_MAX_NUM_RI)) |
| 1053 | return -ENOMEM; |
| 1054 | t3_register_cpl_handler(CPL_ASYNC_NOTIF, cxio_hal_ev_handler); |
| 1055 | return 0; |
| 1056 | } |
| 1057 | |
| 1058 | void __exit cxio_hal_exit(void) |
| 1059 | { |
| 1060 | struct cxio_rdev *rdev, *tmp; |
| 1061 | |
| 1062 | t3_register_cpl_handler(CPL_ASYNC_NOTIF, NULL); |
| 1063 | list_for_each_entry_safe(rdev, tmp, &rdev_list, entry) |
| 1064 | cxio_rdev_close(rdev); |
| 1065 | cxio_hal_destroy_rhdl_resource(); |
| 1066 | } |
| 1067 | |
Adrian Bunk | 2b54035 | 2007-02-21 11:52:49 +0100 | [diff] [blame] | 1068 | static void flush_completed_wrs(struct t3_wq *wq, struct t3_cq *cq) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1069 | { |
| 1070 | struct t3_swsq *sqp; |
| 1071 | __u32 ptr = wq->sq_rptr; |
| 1072 | int count = Q_COUNT(wq->sq_rptr, wq->sq_wptr); |
| 1073 | |
| 1074 | sqp = wq->sq + Q_PTR2IDX(ptr, wq->sq_size_log2); |
| 1075 | while (count--) |
| 1076 | if (!sqp->signaled) { |
| 1077 | ptr++; |
| 1078 | sqp = wq->sq + Q_PTR2IDX(ptr, wq->sq_size_log2); |
| 1079 | } else if (sqp->complete) { |
| 1080 | |
| 1081 | /* |
| 1082 | * Insert this completed cqe into the swcq. |
| 1083 | */ |
| 1084 | PDBG("%s moving cqe into swcq sq idx %ld cq idx %ld\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 1085 | __func__, Q_PTR2IDX(ptr, wq->sq_size_log2), |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1086 | Q_PTR2IDX(cq->sw_wptr, cq->size_log2)); |
| 1087 | sqp->cqe.header |= htonl(V_CQE_SWCQE(1)); |
| 1088 | *(cq->sw_queue + Q_PTR2IDX(cq->sw_wptr, cq->size_log2)) |
| 1089 | = sqp->cqe; |
| 1090 | cq->sw_wptr++; |
| 1091 | sqp->signaled = 0; |
| 1092 | break; |
| 1093 | } else |
| 1094 | break; |
| 1095 | } |
| 1096 | |
Adrian Bunk | 2b54035 | 2007-02-21 11:52:49 +0100 | [diff] [blame] | 1097 | static void create_read_req_cqe(struct t3_wq *wq, struct t3_cqe *hw_cqe, |
| 1098 | struct t3_cqe *read_cqe) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1099 | { |
| 1100 | read_cqe->u.scqe.wrid_hi = wq->oldest_read->sq_wptr; |
| 1101 | read_cqe->len = wq->oldest_read->read_len; |
| 1102 | read_cqe->header = htonl(V_CQE_QPID(CQE_QPID(*hw_cqe)) | |
| 1103 | V_CQE_SWCQE(SW_CQE(*hw_cqe)) | |
| 1104 | V_CQE_OPCODE(T3_READ_REQ) | |
| 1105 | V_CQE_TYPE(1)); |
| 1106 | } |
| 1107 | |
| 1108 | /* |
| 1109 | * Return a ptr to the next read wr in the SWSQ or NULL. |
| 1110 | */ |
Adrian Bunk | 2b54035 | 2007-02-21 11:52:49 +0100 | [diff] [blame] | 1111 | static void advance_oldest_read(struct t3_wq *wq) |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1112 | { |
| 1113 | |
| 1114 | u32 rptr = wq->oldest_read - wq->sq + 1; |
| 1115 | u32 wptr = Q_PTR2IDX(wq->sq_wptr, wq->sq_size_log2); |
| 1116 | |
| 1117 | while (Q_PTR2IDX(rptr, wq->sq_size_log2) != wptr) { |
| 1118 | wq->oldest_read = wq->sq + Q_PTR2IDX(rptr, wq->sq_size_log2); |
| 1119 | |
| 1120 | if (wq->oldest_read->opcode == T3_READ_REQ) |
| 1121 | return; |
| 1122 | rptr++; |
| 1123 | } |
| 1124 | wq->oldest_read = NULL; |
| 1125 | } |
| 1126 | |
| 1127 | /* |
| 1128 | * cxio_poll_cq |
| 1129 | * |
| 1130 | * Caller must: |
| 1131 | * check the validity of the first CQE, |
| 1132 | * supply the wq assicated with the qpid. |
| 1133 | * |
| 1134 | * credit: cq credit to return to sge. |
| 1135 | * cqe_flushed: 1 iff the CQE is flushed. |
| 1136 | * cqe: copy of the polled CQE. |
| 1137 | * |
| 1138 | * return value: |
| 1139 | * 0 CQE returned, |
| 1140 | * -1 CQE skipped, try again. |
| 1141 | */ |
| 1142 | int cxio_poll_cq(struct t3_wq *wq, struct t3_cq *cq, struct t3_cqe *cqe, |
| 1143 | u8 *cqe_flushed, u64 *cookie, u32 *credit) |
| 1144 | { |
| 1145 | int ret = 0; |
| 1146 | struct t3_cqe *hw_cqe, read_cqe; |
| 1147 | |
| 1148 | *cqe_flushed = 0; |
| 1149 | *credit = 0; |
| 1150 | hw_cqe = cxio_next_cqe(cq); |
| 1151 | |
| 1152 | PDBG("%s CQE OOO %d qpid 0x%0x genbit %d type %d status 0x%0x" |
| 1153 | " opcode 0x%0x len 0x%0x wrid_hi_stag 0x%x wrid_low_msn 0x%x\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 1154 | __func__, CQE_OOO(*hw_cqe), CQE_QPID(*hw_cqe), |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1155 | CQE_GENBIT(*hw_cqe), CQE_TYPE(*hw_cqe), CQE_STATUS(*hw_cqe), |
| 1156 | CQE_OPCODE(*hw_cqe), CQE_LEN(*hw_cqe), CQE_WRID_HI(*hw_cqe), |
| 1157 | CQE_WRID_LOW(*hw_cqe)); |
| 1158 | |
| 1159 | /* |
| 1160 | * skip cqe's not affiliated with a QP. |
| 1161 | */ |
| 1162 | if (wq == NULL) { |
| 1163 | ret = -1; |
| 1164 | goto skip_cqe; |
| 1165 | } |
| 1166 | |
| 1167 | /* |
| 1168 | * Gotta tweak READ completions: |
| 1169 | * 1) the cqe doesn't contain the sq_wptr from the wr. |
| 1170 | * 2) opcode not reflected from the wr. |
| 1171 | * 3) read_len not reflected from the wr. |
| 1172 | * 4) cq_type is RQ_TYPE not SQ_TYPE. |
| 1173 | */ |
| 1174 | if (RQ_TYPE(*hw_cqe) && (CQE_OPCODE(*hw_cqe) == T3_READ_RESP)) { |
| 1175 | |
| 1176 | /* |
Steve Wise | f8b0dfd | 2008-04-29 13:46:52 -0700 | [diff] [blame] | 1177 | * If this is an unsolicited read response, then the read |
| 1178 | * was generated by the kernel driver as part of peer-2-peer |
| 1179 | * connection setup. So ignore the completion. |
| 1180 | */ |
| 1181 | if (!wq->oldest_read) { |
| 1182 | if (CQE_STATUS(*hw_cqe)) |
| 1183 | wq->error = 1; |
| 1184 | ret = -1; |
| 1185 | goto skip_cqe; |
| 1186 | } |
| 1187 | |
| 1188 | /* |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1189 | * Don't write to the HWCQ, so create a new read req CQE |
| 1190 | * in local memory. |
| 1191 | */ |
| 1192 | create_read_req_cqe(wq, hw_cqe, &read_cqe); |
| 1193 | hw_cqe = &read_cqe; |
| 1194 | advance_oldest_read(wq); |
| 1195 | } |
| 1196 | |
| 1197 | /* |
| 1198 | * T3A: Discard TERMINATE CQEs. |
| 1199 | */ |
| 1200 | if (CQE_OPCODE(*hw_cqe) == T3_TERMINATE) { |
| 1201 | ret = -1; |
| 1202 | wq->error = 1; |
| 1203 | goto skip_cqe; |
| 1204 | } |
| 1205 | |
| 1206 | if (CQE_STATUS(*hw_cqe) || wq->error) { |
| 1207 | *cqe_flushed = wq->error; |
| 1208 | wq->error = 1; |
| 1209 | |
| 1210 | /* |
| 1211 | * T3A inserts errors into the CQE. We cannot return |
| 1212 | * these as work completions. |
| 1213 | */ |
| 1214 | /* incoming write failures */ |
| 1215 | if ((CQE_OPCODE(*hw_cqe) == T3_RDMA_WRITE) |
| 1216 | && RQ_TYPE(*hw_cqe)) { |
| 1217 | ret = -1; |
| 1218 | goto skip_cqe; |
| 1219 | } |
| 1220 | /* incoming read request failures */ |
| 1221 | if ((CQE_OPCODE(*hw_cqe) == T3_READ_RESP) && SQ_TYPE(*hw_cqe)) { |
| 1222 | ret = -1; |
| 1223 | goto skip_cqe; |
| 1224 | } |
| 1225 | |
| 1226 | /* incoming SEND with no receive posted failures */ |
Steve Wise | 42fb61f | 2009-02-10 16:38:57 -0800 | [diff] [blame] | 1227 | if (CQE_SEND_OPCODE(*hw_cqe) && RQ_TYPE(*hw_cqe) && |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1228 | Q_EMPTY(wq->rq_rptr, wq->rq_wptr)) { |
| 1229 | ret = -1; |
| 1230 | goto skip_cqe; |
| 1231 | } |
Steve Wise | 42fb61f | 2009-02-10 16:38:57 -0800 | [diff] [blame] | 1232 | BUG_ON((*cqe_flushed == 0) && !SW_CQE(*hw_cqe)); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1233 | goto proc_cqe; |
| 1234 | } |
| 1235 | |
| 1236 | /* |
| 1237 | * RECV completion. |
| 1238 | */ |
| 1239 | if (RQ_TYPE(*hw_cqe)) { |
| 1240 | |
| 1241 | /* |
| 1242 | * HW only validates 4 bits of MSN. So we must validate that |
| 1243 | * the MSN in the SEND is the next expected MSN. If its not, |
| 1244 | * then we complete this with TPT_ERR_MSN and mark the wq in |
| 1245 | * error. |
| 1246 | */ |
Steve Wise | 42fb61f | 2009-02-10 16:38:57 -0800 | [diff] [blame] | 1247 | |
| 1248 | if (Q_EMPTY(wq->rq_rptr, wq->rq_wptr)) { |
| 1249 | wq->error = 1; |
| 1250 | ret = -1; |
| 1251 | goto skip_cqe; |
| 1252 | } |
| 1253 | |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1254 | if (unlikely((CQE_WRID_MSN(*hw_cqe) != (wq->rq_rptr + 1)))) { |
| 1255 | wq->error = 1; |
| 1256 | hw_cqe->header |= htonl(V_CQE_STATUS(TPT_ERR_MSN)); |
| 1257 | goto proc_cqe; |
| 1258 | } |
| 1259 | goto proc_cqe; |
| 1260 | } |
| 1261 | |
| 1262 | /* |
| 1263 | * If we get here its a send completion. |
| 1264 | * |
| 1265 | * Handle out of order completion. These get stuffed |
| 1266 | * in the SW SQ. Then the SW SQ is walked to move any |
| 1267 | * now in-order completions into the SW CQ. This handles |
| 1268 | * 2 cases: |
| 1269 | * 1) reaping unsignaled WRs when the first subsequent |
| 1270 | * signaled WR is completed. |
| 1271 | * 2) out of order read completions. |
| 1272 | */ |
| 1273 | if (!SW_CQE(*hw_cqe) && (CQE_WRID_SQ_WPTR(*hw_cqe) != wq->sq_rptr)) { |
| 1274 | struct t3_swsq *sqp; |
| 1275 | |
| 1276 | PDBG("%s out of order completion going in swsq at idx %ld\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 1277 | __func__, |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1278 | Q_PTR2IDX(CQE_WRID_SQ_WPTR(*hw_cqe), wq->sq_size_log2)); |
| 1279 | sqp = wq->sq + |
| 1280 | Q_PTR2IDX(CQE_WRID_SQ_WPTR(*hw_cqe), wq->sq_size_log2); |
| 1281 | sqp->cqe = *hw_cqe; |
| 1282 | sqp->complete = 1; |
| 1283 | ret = -1; |
| 1284 | goto flush_wq; |
| 1285 | } |
| 1286 | |
| 1287 | proc_cqe: |
| 1288 | *cqe = *hw_cqe; |
| 1289 | |
| 1290 | /* |
| 1291 | * Reap the associated WR(s) that are freed up with this |
| 1292 | * completion. |
| 1293 | */ |
| 1294 | if (SQ_TYPE(*hw_cqe)) { |
| 1295 | wq->sq_rptr = CQE_WRID_SQ_WPTR(*hw_cqe); |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 1296 | PDBG("%s completing sq idx %ld\n", __func__, |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1297 | Q_PTR2IDX(wq->sq_rptr, wq->sq_size_log2)); |
Steve Wise | 4ab928f | 2008-07-14 23:48:53 -0700 | [diff] [blame] | 1298 | *cookie = wq->sq[Q_PTR2IDX(wq->sq_rptr, wq->sq_size_log2)].wr_id; |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1299 | wq->sq_rptr++; |
| 1300 | } else { |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 1301 | PDBG("%s completing rq idx %ld\n", __func__, |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1302 | Q_PTR2IDX(wq->rq_rptr, wq->rq_size_log2)); |
Steve Wise | 4ab928f | 2008-07-14 23:48:53 -0700 | [diff] [blame] | 1303 | *cookie = wq->rq[Q_PTR2IDX(wq->rq_rptr, wq->rq_size_log2)].wr_id; |
| 1304 | if (wq->rq[Q_PTR2IDX(wq->rq_rptr, wq->rq_size_log2)].pbl_addr) |
| 1305 | cxio_hal_pblpool_free(wq->rdev, |
| 1306 | wq->rq[Q_PTR2IDX(wq->rq_rptr, |
| 1307 | wq->rq_size_log2)].pbl_addr, T3_STAG0_PBL_SIZE); |
Steve Wise | 42fb61f | 2009-02-10 16:38:57 -0800 | [diff] [blame] | 1308 | BUG_ON(Q_EMPTY(wq->rq_rptr, wq->rq_wptr)); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1309 | wq->rq_rptr++; |
| 1310 | } |
| 1311 | |
| 1312 | flush_wq: |
| 1313 | /* |
| 1314 | * Flush any completed cqes that are now in-order. |
| 1315 | */ |
| 1316 | flush_completed_wrs(wq, cq); |
| 1317 | |
| 1318 | skip_cqe: |
| 1319 | if (SW_CQE(*hw_cqe)) { |
| 1320 | PDBG("%s cq %p cqid 0x%x skip sw cqe sw_rptr 0x%x\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 1321 | __func__, cq, cq->cqid, cq->sw_rptr); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1322 | ++cq->sw_rptr; |
| 1323 | } else { |
| 1324 | PDBG("%s cq %p cqid 0x%x skip hw cqe rptr 0x%x\n", |
Harvey Harrison | 3371836 | 2008-04-16 21:01:10 -0700 | [diff] [blame] | 1325 | __func__, cq, cq->cqid, cq->rptr); |
Steve Wise | b038ced | 2007-02-12 16:16:18 -0800 | [diff] [blame] | 1326 | ++cq->rptr; |
| 1327 | |
| 1328 | /* |
| 1329 | * T3A: compute credits. |
| 1330 | */ |
| 1331 | if (((cq->rptr - cq->wptr) > (1 << (cq->size_log2 - 1))) |
| 1332 | || ((cq->rptr - cq->wptr) >= 128)) { |
| 1333 | *credit = cq->rptr - cq->wptr; |
| 1334 | cq->wptr = cq->rptr; |
| 1335 | } |
| 1336 | } |
| 1337 | return ret; |
| 1338 | } |