linux/drivers/infiniband/hw/cxgb3/iwch_provider.c
<<
>>
Prefs
   1/*
   2 * Copyright (c) 2006 Chelsio, Inc. All rights reserved.
   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 <linux/module.h>
  33#include <linux/moduleparam.h>
  34#include <linux/device.h>
  35#include <linux/netdevice.h>
  36#include <linux/etherdevice.h>
  37#include <linux/delay.h>
  38#include <linux/errno.h>
  39#include <linux/list.h>
  40#include <linux/sched.h>
  41#include <linux/spinlock.h>
  42#include <linux/ethtool.h>
  43#include <linux/rtnetlink.h>
  44#include <linux/inetdevice.h>
  45#include <linux/slab.h>
  46
  47#include <asm/io.h>
  48#include <asm/irq.h>
  49#include <asm/byteorder.h>
  50
  51#include <rdma/iw_cm.h>
  52#include <rdma/ib_verbs.h>
  53#include <rdma/ib_smi.h>
  54#include <rdma/ib_umem.h>
  55#include <rdma/ib_user_verbs.h>
  56
  57#include "cxio_hal.h"
  58#include "iwch.h"
  59#include "iwch_provider.h"
  60#include "iwch_cm.h"
  61#include "iwch_user.h"
  62#include "common.h"
  63
  64static struct ib_ah *iwch_ah_create(struct ib_pd *pd,
  65                                    struct ib_ah_attr *ah_attr)
  66{
  67        return ERR_PTR(-ENOSYS);
  68}
  69
  70static int iwch_ah_destroy(struct ib_ah *ah)
  71{
  72        return -ENOSYS;
  73}
  74
  75static int iwch_multicast_attach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
  76{
  77        return -ENOSYS;
  78}
  79
  80static int iwch_multicast_detach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
  81{
  82        return -ENOSYS;
  83}
  84
  85static int iwch_process_mad(struct ib_device *ibdev,
  86                            int mad_flags,
  87                            u8 port_num,
  88                            struct ib_wc *in_wc,
  89                            struct ib_grh *in_grh,
  90                            struct ib_mad *in_mad, struct ib_mad *out_mad)
  91{
  92        return -ENOSYS;
  93}
  94
  95static int iwch_dealloc_ucontext(struct ib_ucontext *context)
  96{
  97        struct iwch_dev *rhp = to_iwch_dev(context->device);
  98        struct iwch_ucontext *ucontext = to_iwch_ucontext(context);
  99        struct iwch_mm_entry *mm, *tmp;
 100
 101        PDBG("%s context %p\n", __func__, context);
 102        list_for_each_entry_safe(mm, tmp, &ucontext->mmaps, entry)
 103                kfree(mm);
 104        cxio_release_ucontext(&rhp->rdev, &ucontext->uctx);
 105        kfree(ucontext);
 106        return 0;
 107}
 108
 109static struct ib_ucontext *iwch_alloc_ucontext(struct ib_device *ibdev,
 110                                        struct ib_udata *udata)
 111{
 112        struct iwch_ucontext *context;
 113        struct iwch_dev *rhp = to_iwch_dev(ibdev);
 114
 115        PDBG("%s ibdev %p\n", __func__, ibdev);
 116        context = kzalloc(sizeof(*context), GFP_KERNEL);
 117        if (!context)
 118                return ERR_PTR(-ENOMEM);
 119        cxio_init_ucontext(&rhp->rdev, &context->uctx);
 120        INIT_LIST_HEAD(&context->mmaps);
 121        spin_lock_init(&context->mmap_lock);
 122        return &context->ibucontext;
 123}
 124
 125static int iwch_destroy_cq(struct ib_cq *ib_cq)
 126{
 127        struct iwch_cq *chp;
 128
 129        PDBG("%s ib_cq %p\n", __func__, ib_cq);
 130        chp = to_iwch_cq(ib_cq);
 131
 132        remove_handle(chp->rhp, &chp->rhp->cqidr, chp->cq.cqid);
 133        atomic_dec(&chp->refcnt);
 134        wait_event(chp->wait, !atomic_read(&chp->refcnt));
 135
 136        cxio_destroy_cq(&chp->rhp->rdev, &chp->cq);
 137        kfree(chp);
 138        return 0;
 139}
 140
 141static struct ib_cq *iwch_create_cq(struct ib_device *ibdev, int entries, int vector,
 142                             struct ib_ucontext *ib_context,
 143                             struct ib_udata *udata)
 144{
 145        struct iwch_dev *rhp;
 146        struct iwch_cq *chp;
 147        struct iwch_create_cq_resp uresp;
 148        struct iwch_create_cq_req ureq;
 149        struct iwch_ucontext *ucontext = NULL;
 150        static int warned;
 151        size_t resplen;
 152
 153        PDBG("%s ib_dev %p entries %d\n", __func__, ibdev, entries);
 154        rhp = to_iwch_dev(ibdev);
 155        chp = kzalloc(sizeof(*chp), GFP_KERNEL);
 156        if (!chp)
 157                return ERR_PTR(-ENOMEM);
 158
 159        if (ib_context) {
 160                ucontext = to_iwch_ucontext(ib_context);
 161                if (!t3a_device(rhp)) {
 162                        if (ib_copy_from_udata(&ureq, udata, sizeof (ureq))) {
 163                                kfree(chp);
 164                                return ERR_PTR(-EFAULT);
 165                        }
 166                        chp->user_rptr_addr = (u32 __user *)(unsigned long)ureq.user_rptr_addr;
 167                }
 168        }
 169
 170        if (t3a_device(rhp)) {
 171
 172                /*
 173                 * T3A: Add some fluff to handle extra CQEs inserted
 174                 * for various errors.
 175                 * Additional CQE possibilities:
 176                 *      TERMINATE,
 177                 *      incoming RDMA WRITE Failures
 178                 *      incoming RDMA READ REQUEST FAILUREs
 179                 * NOTE: We cannot ensure the CQ won't overflow.
 180                 */
 181                entries += 16;
 182        }
 183        entries = roundup_pow_of_two(entries);
 184        chp->cq.size_log2 = ilog2(entries);
 185
 186        if (cxio_create_cq(&rhp->rdev, &chp->cq, !ucontext)) {
 187                kfree(chp);
 188                return ERR_PTR(-ENOMEM);
 189        }
 190        chp->rhp = rhp;
 191        chp->ibcq.cqe = 1 << chp->cq.size_log2;
 192        spin_lock_init(&chp->lock);
 193        spin_lock_init(&chp->comp_handler_lock);
 194        atomic_set(&chp->refcnt, 1);
 195        init_waitqueue_head(&chp->wait);
 196        if (insert_handle(rhp, &rhp->cqidr, chp, chp->cq.cqid)) {
 197                cxio_destroy_cq(&chp->rhp->rdev, &chp->cq);
 198                kfree(chp);
 199                return ERR_PTR(-ENOMEM);
 200        }
 201
 202        if (ucontext) {
 203                struct iwch_mm_entry *mm;
 204
 205                mm = kmalloc(sizeof *mm, GFP_KERNEL);
 206                if (!mm) {
 207                        iwch_destroy_cq(&chp->ibcq);
 208                        return ERR_PTR(-ENOMEM);
 209                }
 210                uresp.cqid = chp->cq.cqid;
 211                uresp.size_log2 = chp->cq.size_log2;
 212                spin_lock(&ucontext->mmap_lock);
 213                uresp.key = ucontext->key;
 214                ucontext->key += PAGE_SIZE;
 215                spin_unlock(&ucontext->mmap_lock);
 216                mm->key = uresp.key;
 217                mm->addr = virt_to_phys(chp->cq.queue);
 218                if (udata->outlen < sizeof uresp) {
 219                        if (!warned++)
 220                                printk(KERN_WARNING MOD "Warning - "
 221                                       "downlevel libcxgb3 (non-fatal).\n");
 222                        mm->len = PAGE_ALIGN((1UL << uresp.size_log2) *
 223                                             sizeof(struct t3_cqe));
 224                        resplen = sizeof(struct iwch_create_cq_resp_v0);
 225                } else {
 226                        mm->len = PAGE_ALIGN(((1UL << uresp.size_log2) + 1) *
 227                                             sizeof(struct t3_cqe));
 228                        uresp.memsize = mm->len;
 229                        uresp.reserved = 0;
 230                        resplen = sizeof uresp;
 231                }
 232                if (ib_copy_to_udata(udata, &uresp, resplen)) {
 233                        kfree(mm);
 234                        iwch_destroy_cq(&chp->ibcq);
 235                        return ERR_PTR(-EFAULT);
 236                }
 237                insert_mmap(ucontext, mm);
 238        }
 239        PDBG("created cqid 0x%0x chp %p size 0x%0x, dma_addr 0x%0llx\n",
 240             chp->cq.cqid, chp, (1 << chp->cq.size_log2),
 241             (unsigned long long) chp->cq.dma_addr);
 242        return &chp->ibcq;
 243}
 244
 245static int iwch_resize_cq(struct ib_cq *cq, int cqe, struct ib_udata *udata)
 246{
 247#ifdef notyet
 248        struct iwch_cq *chp = to_iwch_cq(cq);
 249        struct t3_cq oldcq, newcq;
 250        int ret;
 251
 252        PDBG("%s ib_cq %p cqe %d\n", __func__, cq, cqe);
 253
 254        /* We don't downsize... */
 255        if (cqe <= cq->cqe)
 256                return 0;
 257
 258        /* create new t3_cq with new size */
 259        cqe = roundup_pow_of_two(cqe+1);
 260        newcq.size_log2 = ilog2(cqe);
 261
 262        /* Dont allow resize to less than the current wce count */
 263        if (cqe < Q_COUNT(chp->cq.rptr, chp->cq.wptr)) {
 264                return -ENOMEM;
 265        }
 266
 267        /* Quiesce all QPs using this CQ */
 268        ret = iwch_quiesce_qps(chp);
 269        if (ret) {
 270                return ret;
 271        }
 272
 273        ret = cxio_create_cq(&chp->rhp->rdev, &newcq);
 274        if (ret) {
 275                return ret;
 276        }
 277
 278        /* copy CQEs */
 279        memcpy(newcq.queue, chp->cq.queue, (1 << chp->cq.size_log2) *
 280                                        sizeof(struct t3_cqe));
 281
 282        /* old iwch_qp gets new t3_cq but keeps old cqid */
 283        oldcq = chp->cq;
 284        chp->cq = newcq;
 285        chp->cq.cqid = oldcq.cqid;
 286
 287        /* resize new t3_cq to update the HW context */
 288        ret = cxio_resize_cq(&chp->rhp->rdev, &chp->cq);
 289        if (ret) {
 290                chp->cq = oldcq;
 291                return ret;
 292        }
 293        chp->ibcq.cqe = (1<<chp->cq.size_log2) - 1;
 294
 295        /* destroy old t3_cq */
 296        oldcq.cqid = newcq.cqid;
 297        ret = cxio_destroy_cq(&chp->rhp->rdev, &oldcq);
 298        if (ret) {
 299                printk(KERN_ERR MOD "%s - cxio_destroy_cq failed %d\n",
 300                        __func__, ret);
 301        }
 302
 303        /* add user hooks here */
 304
 305        /* resume qps */
 306        ret = iwch_resume_qps(chp);
 307        return ret;
 308#else
 309        return -ENOSYS;
 310#endif
 311}
 312
 313static int iwch_arm_cq(struct ib_cq *ibcq, enum ib_cq_notify_flags flags)
 314{
 315        struct iwch_dev *rhp;
 316        struct iwch_cq *chp;
 317        enum t3_cq_opcode cq_op;
 318        int err;
 319        unsigned long flag;
 320        u32 rptr;
 321
 322        chp = to_iwch_cq(ibcq);
 323        rhp = chp->rhp;
 324        if ((flags & IB_CQ_SOLICITED_MASK) == IB_CQ_SOLICITED)
 325                cq_op = CQ_ARM_SE;
 326        else
 327                cq_op = CQ_ARM_AN;
 328        if (chp->user_rptr_addr) {
 329                if (get_user(rptr, chp->user_rptr_addr))
 330                        return -EFAULT;
 331                spin_lock_irqsave(&chp->lock, flag);
 332                chp->cq.rptr = rptr;
 333        } else
 334                spin_lock_irqsave(&chp->lock, flag);
 335        PDBG("%s rptr 0x%x\n", __func__, chp->cq.rptr);
 336        err = cxio_hal_cq_op(&rhp->rdev, &chp->cq, cq_op, 0);
 337        spin_unlock_irqrestore(&chp->lock, flag);
 338        if (err < 0)
 339                printk(KERN_ERR MOD "Error %d rearming CQID 0x%x\n", err,
 340                       chp->cq.cqid);
 341        if (err > 0 && !(flags & IB_CQ_REPORT_MISSED_EVENTS))
 342                err = 0;
 343        return err;
 344}
 345
 346static int iwch_mmap(struct ib_ucontext *context, struct vm_area_struct *vma)
 347{
 348        int len = vma->vm_end - vma->vm_start;
 349        u32 key = vma->vm_pgoff << PAGE_SHIFT;
 350        struct cxio_rdev *rdev_p;
 351        int ret = 0;
 352        struct iwch_mm_entry *mm;
 353        struct iwch_ucontext *ucontext;
 354        u64 addr;
 355
 356        PDBG("%s pgoff 0x%lx key 0x%x len %d\n", __func__, vma->vm_pgoff,
 357             key, len);
 358
 359        if (vma->vm_start & (PAGE_SIZE-1)) {
 360                return -EINVAL;
 361        }
 362
 363        rdev_p = &(to_iwch_dev(context->device)->rdev);
 364        ucontext = to_iwch_ucontext(context);
 365
 366        mm = remove_mmap(ucontext, key, len);
 367        if (!mm)
 368                return -EINVAL;
 369        addr = mm->addr;
 370        kfree(mm);
 371
 372        if ((addr >= rdev_p->rnic_info.udbell_physbase) &&
 373            (addr < (rdev_p->rnic_info.udbell_physbase +
 374                       rdev_p->rnic_info.udbell_len))) {
 375
 376                /*
 377                 * Map T3 DB register.
 378                 */
 379                if (vma->vm_flags & VM_READ) {
 380                        return -EPERM;
 381                }
 382
 383                vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
 384                vma->vm_flags |= VM_DONTCOPY | VM_DONTEXPAND;
 385                vma->vm_flags &= ~VM_MAYREAD;
 386                ret = io_remap_pfn_range(vma, vma->vm_start,
 387                                         addr >> PAGE_SHIFT,
 388                                         len, vma->vm_page_prot);
 389        } else {
 390
 391                /*
 392                 * Map WQ or CQ contig dma memory...
 393                 */
 394                ret = remap_pfn_range(vma, vma->vm_start,
 395                                      addr >> PAGE_SHIFT,
 396                                      len, vma->vm_page_prot);
 397        }
 398
 399        return ret;
 400}
 401
 402static int iwch_deallocate_pd(struct ib_pd *pd)
 403{
 404        struct iwch_dev *rhp;
 405        struct iwch_pd *php;
 406
 407        php = to_iwch_pd(pd);
 408        rhp = php->rhp;
 409        PDBG("%s ibpd %p pdid 0x%x\n", __func__, pd, php->pdid);
 410        cxio_hal_put_pdid(rhp->rdev.rscp, php->pdid);
 411        kfree(php);
 412        return 0;
 413}
 414
 415static struct ib_pd *iwch_allocate_pd(struct ib_device *ibdev,
 416                               struct ib_ucontext *context,
 417                               struct ib_udata *udata)
 418{
 419        struct iwch_pd *php;
 420        u32 pdid;
 421        struct iwch_dev *rhp;
 422
 423        PDBG("%s ibdev %p\n", __func__, ibdev);
 424        rhp = (struct iwch_dev *) ibdev;
 425        pdid = cxio_hal_get_pdid(rhp->rdev.rscp);
 426        if (!pdid)
 427                return ERR_PTR(-EINVAL);
 428        php = kzalloc(sizeof(*php), GFP_KERNEL);
 429        if (!php) {
 430                cxio_hal_put_pdid(rhp->rdev.rscp, pdid);
 431                return ERR_PTR(-ENOMEM);
 432        }
 433        php->pdid = pdid;
 434        php->rhp = rhp;
 435        if (context) {
 436                if (ib_copy_to_udata(udata, &php->pdid, sizeof (__u32))) {
 437                        iwch_deallocate_pd(&php->ibpd);
 438                        return ERR_PTR(-EFAULT);
 439                }
 440        }
 441        PDBG("%s pdid 0x%0x ptr 0x%p\n", __func__, pdid, php);
 442        return &php->ibpd;
 443}
 444
 445static int iwch_dereg_mr(struct ib_mr *ib_mr)
 446{
 447        struct iwch_dev *rhp;
 448        struct iwch_mr *mhp;
 449        u32 mmid;
 450
 451        PDBG("%s ib_mr %p\n", __func__, ib_mr);
 452        /* There can be no memory windows */
 453        if (atomic_read(&ib_mr->usecnt))
 454                return -EINVAL;
 455
 456        mhp = to_iwch_mr(ib_mr);
 457        rhp = mhp->rhp;
 458        mmid = mhp->attr.stag >> 8;
 459        cxio_dereg_mem(&rhp->rdev, mhp->attr.stag, mhp->attr.pbl_size,
 460                       mhp->attr.pbl_addr);
 461        iwch_free_pbl(mhp);
 462        remove_handle(rhp, &rhp->mmidr, mmid);
 463        if (mhp->kva)
 464                kfree((void *) (unsigned long) mhp->kva);
 465        if (mhp->umem)
 466                ib_umem_release(mhp->umem);
 467        PDBG("%s mmid 0x%x ptr %p\n", __func__, mmid, mhp);
 468        kfree(mhp);
 469        return 0;
 470}
 471
 472static struct ib_mr *iwch_register_phys_mem(struct ib_pd *pd,
 473                                        struct ib_phys_buf *buffer_list,
 474                                        int num_phys_buf,
 475                                        int acc,
 476                                        u64 *iova_start)
 477{
 478        __be64 *page_list;
 479        int shift;
 480        u64 total_size;
 481        int npages;
 482        struct iwch_dev *rhp;
 483        struct iwch_pd *php;
 484        struct iwch_mr *mhp;
 485        int ret;
 486
 487        PDBG("%s ib_pd %p\n", __func__, pd);
 488        php = to_iwch_pd(pd);
 489        rhp = php->rhp;
 490
 491        mhp = kzalloc(sizeof(*mhp), GFP_KERNEL);
 492        if (!mhp)
 493                return ERR_PTR(-ENOMEM);
 494
 495        mhp->rhp = rhp;
 496
 497        /* First check that we have enough alignment */
 498        if ((*iova_start & ~PAGE_MASK) != (buffer_list[0].addr & ~PAGE_MASK)) {
 499                ret = -EINVAL;
 500                goto err;
 501        }
 502
 503        if (num_phys_buf > 1 &&
 504            ((buffer_list[0].addr + buffer_list[0].size) & ~PAGE_MASK)) {
 505                ret = -EINVAL;
 506                goto err;
 507        }
 508
 509        ret = build_phys_page_list(buffer_list, num_phys_buf, iova_start,
 510                                   &total_size, &npages, &shift, &page_list);
 511        if (ret)
 512                goto err;
 513
 514        ret = iwch_alloc_pbl(mhp, npages);
 515        if (ret) {
 516                kfree(page_list);
 517                goto err_pbl;
 518        }
 519
 520        ret = iwch_write_pbl(mhp, page_list, npages, 0);
 521        kfree(page_list);
 522        if (ret)
 523                goto err_pbl;
 524
 525        mhp->attr.pdid = php->pdid;
 526        mhp->attr.zbva = 0;
 527
 528        mhp->attr.perms = iwch_ib_to_tpt_access(acc);
 529        mhp->attr.va_fbo = *iova_start;
 530        mhp->attr.page_size = shift - 12;
 531
 532        mhp->attr.len = (u32) total_size;
 533        mhp->attr.pbl_size = npages;
 534        ret = iwch_register_mem(rhp, php, mhp, shift);
 535        if (ret)
 536                goto err_pbl;
 537
 538        return &mhp->ibmr;
 539
 540err_pbl:
 541        iwch_free_pbl(mhp);
 542
 543err:
 544        kfree(mhp);
 545        return ERR_PTR(ret);
 546
 547}
 548
 549static int iwch_reregister_phys_mem(struct ib_mr *mr,
 550                                     int mr_rereg_mask,
 551                                     struct ib_pd *pd,
 552                                     struct ib_phys_buf *buffer_list,
 553                                     int num_phys_buf,
 554                                     int acc, u64 * iova_start)
 555{
 556
 557        struct iwch_mr mh, *mhp;
 558        struct iwch_pd *php;
 559        struct iwch_dev *rhp;
 560        __be64 *page_list = NULL;
 561        int shift = 0;
 562        u64 total_size;
 563        int npages = 0;
 564        int ret;
 565
 566        PDBG("%s ib_mr %p ib_pd %p\n", __func__, mr, pd);
 567
 568        /* There can be no memory windows */
 569        if (atomic_read(&mr->usecnt))
 570                return -EINVAL;
 571
 572        mhp = to_iwch_mr(mr);
 573        rhp = mhp->rhp;
 574        php = to_iwch_pd(mr->pd);
 575
 576        /* make sure we are on the same adapter */
 577        if (rhp != php->rhp)
 578                return -EINVAL;
 579
 580        memcpy(&mh, mhp, sizeof *mhp);
 581
 582        if (mr_rereg_mask & IB_MR_REREG_PD)
 583                php = to_iwch_pd(pd);
 584        if (mr_rereg_mask & IB_MR_REREG_ACCESS)
 585                mh.attr.perms = iwch_ib_to_tpt_access(acc);
 586        if (mr_rereg_mask & IB_MR_REREG_TRANS) {
 587                ret = build_phys_page_list(buffer_list, num_phys_buf,
 588                                           iova_start,
 589                                           &total_size, &npages,
 590                                           &shift, &page_list);
 591                if (ret)
 592                        return ret;
 593        }
 594
 595        ret = iwch_reregister_mem(rhp, php, &mh, shift, npages);
 596        kfree(page_list);
 597        if (ret) {
 598                return ret;
 599        }
 600        if (mr_rereg_mask & IB_MR_REREG_PD)
 601                mhp->attr.pdid = php->pdid;
 602        if (mr_rereg_mask & IB_MR_REREG_ACCESS)
 603                mhp->attr.perms = iwch_ib_to_tpt_access(acc);
 604        if (mr_rereg_mask & IB_MR_REREG_TRANS) {
 605                mhp->attr.zbva = 0;
 606                mhp->attr.va_fbo = *iova_start;
 607                mhp->attr.page_size = shift - 12;
 608                mhp->attr.len = (u32) total_size;
 609                mhp->attr.pbl_size = npages;
 610        }
 611
 612        return 0;
 613}
 614
 615
 616static struct ib_mr *iwch_reg_user_mr(struct ib_pd *pd, u64 start, u64 length,
 617                                      u64 virt, int acc, struct ib_udata *udata)
 618{
 619        __be64 *pages;
 620        int shift, n, len;
 621        int i, j, k;
 622        int err = 0;
 623        struct ib_umem_chunk *chunk;
 624        struct iwch_dev *rhp;
 625        struct iwch_pd *php;
 626        struct iwch_mr *mhp;
 627        struct iwch_reg_user_mr_resp uresp;
 628
 629        PDBG("%s ib_pd %p\n", __func__, pd);
 630
 631        php = to_iwch_pd(pd);
 632        rhp = php->rhp;
 633        mhp = kzalloc(sizeof(*mhp), GFP_KERNEL);
 634        if (!mhp)
 635                return ERR_PTR(-ENOMEM);
 636
 637        mhp->rhp = rhp;
 638
 639        mhp->umem = ib_umem_get(pd->uobject->context, start, length, acc, 0);
 640        if (IS_ERR(mhp->umem)) {
 641                err = PTR_ERR(mhp->umem);
 642                kfree(mhp);
 643                return ERR_PTR(err);
 644        }
 645
 646        shift = ffs(mhp->umem->page_size) - 1;
 647
 648        n = 0;
 649        list_for_each_entry(chunk, &mhp->umem->chunk_list, list)
 650                n += chunk->nents;
 651
 652        err = iwch_alloc_pbl(mhp, n);
 653        if (err)
 654                goto err;
 655
 656        pages = (__be64 *) __get_free_page(GFP_KERNEL);
 657        if (!pages) {
 658                err = -ENOMEM;
 659                goto err_pbl;
 660        }
 661
 662        i = n = 0;
 663
 664        list_for_each_entry(chunk, &mhp->umem->chunk_list, list)
 665                for (j = 0; j < chunk->nmap; ++j) {
 666                        len = sg_dma_len(&chunk->page_list[j]) >> shift;
 667                        for (k = 0; k < len; ++k) {
 668                                pages[i++] = cpu_to_be64(sg_dma_address(
 669                                        &chunk->page_list[j]) +
 670                                        mhp->umem->page_size * k);
 671                                if (i == PAGE_SIZE / sizeof *pages) {
 672                                        err = iwch_write_pbl(mhp, pages, i, n);
 673                                        if (err)
 674                                                goto pbl_done;
 675                                        n += i;
 676                                        i = 0;
 677                                }
 678                        }
 679                }
 680
 681        if (i)
 682                err = iwch_write_pbl(mhp, pages, i, n);
 683
 684pbl_done:
 685        free_page((unsigned long) pages);
 686        if (err)
 687                goto err_pbl;
 688
 689        mhp->attr.pdid = php->pdid;
 690        mhp->attr.zbva = 0;
 691        mhp->attr.perms = iwch_ib_to_tpt_access(acc);
 692        mhp->attr.va_fbo = virt;
 693        mhp->attr.page_size = shift - 12;
 694        mhp->attr.len = (u32) length;
 695
 696        err = iwch_register_mem(rhp, php, mhp, shift);
 697        if (err)
 698                goto err_pbl;
 699
 700        if (udata && !t3a_device(rhp)) {
 701                uresp.pbl_addr = (mhp->attr.pbl_addr -
 702                                 rhp->rdev.rnic_info.pbl_base) >> 3;
 703                PDBG("%s user resp pbl_addr 0x%x\n", __func__,
 704                     uresp.pbl_addr);
 705
 706                if (ib_copy_to_udata(udata, &uresp, sizeof (uresp))) {
 707                        iwch_dereg_mr(&mhp->ibmr);
 708                        err = -EFAULT;
 709                        goto err;
 710                }
 711        }
 712
 713        return &mhp->ibmr;
 714
 715err_pbl:
 716        iwch_free_pbl(mhp);
 717
 718err:
 719        ib_umem_release(mhp->umem);
 720        kfree(mhp);
 721        return ERR_PTR(err);
 722}
 723
 724static struct ib_mr *iwch_get_dma_mr(struct ib_pd *pd, int acc)
 725{
 726        struct ib_phys_buf bl;
 727        u64 kva;
 728        struct ib_mr *ibmr;
 729
 730        PDBG("%s ib_pd %p\n", __func__, pd);
 731
 732        /*
 733         * T3 only supports 32 bits of size.
 734         */
 735        bl.size = 0xffffffff;
 736        bl.addr = 0;
 737        kva = 0;
 738        ibmr = iwch_register_phys_mem(pd, &bl, 1, acc, &kva);
 739        return ibmr;
 740}
 741
 742static struct ib_mw *iwch_alloc_mw(struct ib_pd *pd, enum ib_mw_type type)
 743{
 744        struct iwch_dev *rhp;
 745        struct iwch_pd *php;
 746        struct iwch_mw *mhp;
 747        u32 mmid;
 748        u32 stag = 0;
 749        int ret;
 750
 751        if (type != IB_MW_TYPE_1)
 752                return ERR_PTR(-EINVAL);
 753
 754        php = to_iwch_pd(pd);
 755        rhp = php->rhp;
 756        mhp = kzalloc(sizeof(*mhp), GFP_KERNEL);
 757        if (!mhp)
 758                return ERR_PTR(-ENOMEM);
 759        ret = cxio_allocate_window(&rhp->rdev, &stag, php->pdid);
 760        if (ret) {
 761                kfree(mhp);
 762                return ERR_PTR(ret);
 763        }
 764        mhp->rhp = rhp;
 765        mhp->attr.pdid = php->pdid;
 766        mhp->attr.type = TPT_MW;
 767        mhp->attr.stag = stag;
 768        mmid = (stag) >> 8;
 769        mhp->ibmw.rkey = stag;
 770        if (insert_handle(rhp, &rhp->mmidr, mhp, mmid)) {
 771                cxio_deallocate_window(&rhp->rdev, mhp->attr.stag);
 772                kfree(mhp);
 773                return ERR_PTR(-ENOMEM);
 774        }
 775        PDBG("%s mmid 0x%x mhp %p stag 0x%x\n", __func__, mmid, mhp, stag);
 776        return &(mhp->ibmw);
 777}
 778
 779static int iwch_dealloc_mw(struct ib_mw *mw)
 780{
 781        struct iwch_dev *rhp;
 782        struct iwch_mw *mhp;
 783        u32 mmid;
 784
 785        mhp = to_iwch_mw(mw);
 786        rhp = mhp->rhp;
 787        mmid = (mw->rkey) >> 8;
 788        cxio_deallocate_window(&rhp->rdev, mhp->attr.stag);
 789        remove_handle(rhp, &rhp->mmidr, mmid);
 790        PDBG("%s ib_mw %p mmid 0x%x ptr %p\n", __func__, mw, mmid, mhp);
 791        kfree(mhp);
 792        return 0;
 793}
 794
 795static struct ib_mr *iwch_alloc_fast_reg_mr(struct ib_pd *pd, int pbl_depth)
 796{
 797        struct iwch_dev *rhp;
 798        struct iwch_pd *php;
 799        struct iwch_mr *mhp;
 800        u32 mmid;
 801        u32 stag = 0;
 802        int ret = 0;
 803
 804        php = to_iwch_pd(pd);
 805        rhp = php->rhp;
 806        mhp = kzalloc(sizeof(*mhp), GFP_KERNEL);
 807        if (!mhp)
 808                goto err;
 809
 810        mhp->rhp = rhp;
 811        ret = iwch_alloc_pbl(mhp, pbl_depth);
 812        if (ret)
 813                goto err1;
 814        mhp->attr.pbl_size = pbl_depth;
 815        ret = cxio_allocate_stag(&rhp->rdev, &stag, php->pdid,
 816                                 mhp->attr.pbl_size, mhp->attr.pbl_addr);
 817        if (ret)
 818                goto err2;
 819        mhp->attr.pdid = php->pdid;
 820        mhp->attr.type = TPT_NON_SHARED_MR;
 821        mhp->attr.stag = stag;
 822        mhp->attr.state = 1;
 823        mmid = (stag) >> 8;
 824        mhp->ibmr.rkey = mhp->ibmr.lkey = stag;
 825        if (insert_handle(rhp, &rhp->mmidr, mhp, mmid))
 826                goto err3;
 827
 828        PDBG("%s mmid 0x%x mhp %p stag 0x%x\n", __func__, mmid, mhp, stag);
 829        return &(mhp->ibmr);
 830err3:
 831        cxio_dereg_mem(&rhp->rdev, stag, mhp->attr.pbl_size,
 832                       mhp->attr.pbl_addr);
 833err2:
 834        iwch_free_pbl(mhp);
 835err1:
 836        kfree(mhp);
 837err:
 838        return ERR_PTR(ret);
 839}
 840
 841static struct ib_fast_reg_page_list *iwch_alloc_fastreg_pbl(
 842                                        struct ib_device *device,
 843                                        int page_list_len)
 844{
 845        struct ib_fast_reg_page_list *page_list;
 846
 847        page_list = kmalloc(sizeof *page_list + page_list_len * sizeof(u64),
 848                            GFP_KERNEL);
 849        if (!page_list)
 850                return ERR_PTR(-ENOMEM);
 851
 852        page_list->page_list = (u64 *)(page_list + 1);
 853        page_list->max_page_list_len = page_list_len;
 854
 855        return page_list;
 856}
 857
 858static void iwch_free_fastreg_pbl(struct ib_fast_reg_page_list *page_list)
 859{
 860        kfree(page_list);
 861}
 862
 863static int iwch_destroy_qp(struct ib_qp *ib_qp)
 864{
 865        struct iwch_dev *rhp;
 866        struct iwch_qp *qhp;
 867        struct iwch_qp_attributes attrs;
 868        struct iwch_ucontext *ucontext;
 869
 870        qhp = to_iwch_qp(ib_qp);
 871        rhp = qhp->rhp;
 872
 873        attrs.next_state = IWCH_QP_STATE_ERROR;
 874        iwch_modify_qp(rhp, qhp, IWCH_QP_ATTR_NEXT_STATE, &attrs, 0);
 875        wait_event(qhp->wait, !qhp->ep);
 876
 877        remove_handle(rhp, &rhp->qpidr, qhp->wq.qpid);
 878
 879        atomic_dec(&qhp->refcnt);
 880        wait_event(qhp->wait, !atomic_read(&qhp->refcnt));
 881
 882        ucontext = ib_qp->uobject ? to_iwch_ucontext(ib_qp->uobject->context)
 883                                  : NULL;
 884        cxio_destroy_qp(&rhp->rdev, &qhp->wq,
 885                        ucontext ? &ucontext->uctx : &rhp->rdev.uctx);
 886
 887        PDBG("%s ib_qp %p qpid 0x%0x qhp %p\n", __func__,
 888             ib_qp, qhp->wq.qpid, qhp);
 889        kfree(qhp);
 890        return 0;
 891}
 892
 893static struct ib_qp *iwch_create_qp(struct ib_pd *pd,
 894                             struct ib_qp_init_attr *attrs,
 895                             struct ib_udata *udata)
 896{
 897        struct iwch_dev *rhp;
 898        struct iwch_qp *qhp;
 899        struct iwch_pd *php;
 900        struct iwch_cq *schp;
 901        struct iwch_cq *rchp;
 902        struct iwch_create_qp_resp uresp;
 903        int wqsize, sqsize, rqsize;
 904        struct iwch_ucontext *ucontext;
 905
 906        PDBG("%s ib_pd %p\n", __func__, pd);
 907        if (attrs->qp_type != IB_QPT_RC)
 908                return ERR_PTR(-EINVAL);
 909        php = to_iwch_pd(pd);
 910        rhp = php->rhp;
 911        schp = get_chp(rhp, ((struct iwch_cq *) attrs->send_cq)->cq.cqid);
 912        rchp = get_chp(rhp, ((struct iwch_cq *) attrs->recv_cq)->cq.cqid);
 913        if (!schp || !rchp)
 914                return ERR_PTR(-EINVAL);
 915
 916        /* The RQT size must be # of entries + 1 rounded up to a power of two */
 917        rqsize = roundup_pow_of_two(attrs->cap.max_recv_wr);
 918        if (rqsize == attrs->cap.max_recv_wr)
 919                rqsize = roundup_pow_of_two(attrs->cap.max_recv_wr+1);
 920
 921        /* T3 doesn't support RQT depth < 16 */
 922        if (rqsize < 16)
 923                rqsize = 16;
 924
 925        if (rqsize > T3_MAX_RQ_SIZE)
 926                return ERR_PTR(-EINVAL);
 927
 928        if (attrs->cap.max_inline_data > T3_MAX_INLINE)
 929                return ERR_PTR(-EINVAL);
 930
 931        /*
 932         * NOTE: The SQ and total WQ sizes don't need to be
 933         * a power of two.  However, all the code assumes
 934         * they are. EG: Q_FREECNT() and friends.
 935         */
 936        sqsize = roundup_pow_of_two(attrs->cap.max_send_wr);
 937        wqsize = roundup_pow_of_two(rqsize + sqsize);
 938
 939        /*
 940         * Kernel users need more wq space for fastreg WRs which can take
 941         * 2 WR fragments.
 942         */
 943        ucontext = pd->uobject ? to_iwch_ucontext(pd->uobject->context) : NULL;
 944        if (!ucontext && wqsize < (rqsize + (2 * sqsize)))
 945                wqsize = roundup_pow_of_two(rqsize +
 946                                roundup_pow_of_two(attrs->cap.max_send_wr * 2));
 947        PDBG("%s wqsize %d sqsize %d rqsize %d\n", __func__,
 948             wqsize, sqsize, rqsize);
 949        qhp = kzalloc(sizeof(*qhp), GFP_KERNEL);
 950        if (!qhp)
 951                return ERR_PTR(-ENOMEM);
 952        qhp->wq.size_log2 = ilog2(wqsize);
 953        qhp->wq.rq_size_log2 = ilog2(rqsize);
 954        qhp->wq.sq_size_log2 = ilog2(sqsize);
 955        if (cxio_create_qp(&rhp->rdev, !udata, &qhp->wq,
 956                           ucontext ? &ucontext->uctx : &rhp->rdev.uctx)) {
 957                kfree(qhp);
 958                return ERR_PTR(-ENOMEM);
 959        }
 960
 961        attrs->cap.max_recv_wr = rqsize - 1;
 962        attrs->cap.max_send_wr = sqsize;
 963        attrs->cap.max_inline_data = T3_MAX_INLINE;
 964
 965        qhp->rhp = rhp;
 966        qhp->attr.pd = php->pdid;
 967        qhp->attr.scq = ((struct iwch_cq *) attrs->send_cq)->cq.cqid;
 968        qhp->attr.rcq = ((struct iwch_cq *) attrs->recv_cq)->cq.cqid;
 969        qhp->attr.sq_num_entries = attrs->cap.max_send_wr;
 970        qhp->attr.rq_num_entries = attrs->cap.max_recv_wr;
 971        qhp->attr.sq_max_sges = attrs->cap.max_send_sge;
 972        qhp->attr.sq_max_sges_rdma_write = attrs->cap.max_send_sge;
 973        qhp->attr.rq_max_sges = attrs->cap.max_recv_sge;
 974        qhp->attr.state = IWCH_QP_STATE_IDLE;
 975        qhp->attr.next_state = IWCH_QP_STATE_IDLE;
 976
 977        /*
 978         * XXX - These don't get passed in from the openib user
 979         * at create time.  The CM sets them via a QP modify.
 980         * Need to fix...  I think the CM should
 981         */
 982        qhp->attr.enable_rdma_read = 1;
 983        qhp->attr.enable_rdma_write = 1;
 984        qhp->attr.enable_bind = 1;
 985        qhp->attr.max_ord = 1;
 986        qhp->attr.max_ird = 1;
 987
 988        spin_lock_init(&qhp->lock);
 989        init_waitqueue_head(&qhp->wait);
 990        atomic_set(&qhp->refcnt, 1);
 991
 992        if (insert_handle(rhp, &rhp->qpidr, qhp, qhp->wq.qpid)) {
 993                cxio_destroy_qp(&rhp->rdev, &qhp->wq,
 994                        ucontext ? &ucontext->uctx : &rhp->rdev.uctx);
 995                kfree(qhp);
 996                return ERR_PTR(-ENOMEM);
 997        }
 998
 999        if (udata) {
1000
1001                struct iwch_mm_entry *mm1, *mm2;
1002
1003                mm1 = kmalloc(sizeof *mm1, GFP_KERNEL);
1004                if (!mm1) {
1005                        iwch_destroy_qp(&qhp->ibqp);
1006                        return ERR_PTR(-ENOMEM);
1007                }
1008
1009                mm2 = kmalloc(sizeof *mm2, GFP_KERNEL);
1010                if (!mm2) {
1011                        kfree(mm1);
1012                        iwch_destroy_qp(&qhp->ibqp);
1013                        return ERR_PTR(-ENOMEM);
1014                }
1015
1016                uresp.qpid = qhp->wq.qpid;
1017                uresp.size_log2 = qhp->wq.size_log2;
1018                uresp.sq_size_log2 = qhp->wq.sq_size_log2;
1019                uresp.rq_size_log2 = qhp->wq.rq_size_log2;
1020                spin_lock(&ucontext->mmap_lock);
1021                uresp.key = ucontext->key;
1022                ucontext->key += PAGE_SIZE;
1023                uresp.db_key = ucontext->key;
1024                ucontext->key += PAGE_SIZE;
1025                spin_unlock(&ucontext->mmap_lock);
1026                if (ib_copy_to_udata(udata, &uresp, sizeof (uresp))) {
1027                        kfree(mm1);
1028                        kfree(mm2);
1029                        iwch_destroy_qp(&qhp->ibqp);
1030                        return ERR_PTR(-EFAULT);
1031                }
1032                mm1->key = uresp.key;
1033                mm1->addr = virt_to_phys(qhp->wq.queue);
1034                mm1->len = PAGE_ALIGN(wqsize * sizeof (union t3_wr));
1035                insert_mmap(ucontext, mm1);
1036                mm2->key = uresp.db_key;
1037                mm2->addr = qhp->wq.udb & PAGE_MASK;
1038                mm2->len = PAGE_SIZE;
1039                insert_mmap(ucontext, mm2);
1040        }
1041        qhp->ibqp.qp_num = qhp->wq.qpid;
1042        init_timer(&(qhp->timer));
1043        PDBG("%s sq_num_entries %d, rq_num_entries %d "
1044             "qpid 0x%0x qhp %p dma_addr 0x%llx size %d rq_addr 0x%x\n",
1045             __func__, qhp->attr.sq_num_entries, qhp->attr.rq_num_entries,
1046             qhp->wq.qpid, qhp, (unsigned long long) qhp->wq.dma_addr,
1047             1 << qhp->wq.size_log2, qhp->wq.rq_addr);
1048        return &qhp->ibqp;
1049}
1050
1051static int iwch_ib_modify_qp(struct ib_qp *ibqp, struct ib_qp_attr *attr,
1052                      int attr_mask, struct ib_udata *udata)
1053{
1054        struct iwch_dev *rhp;
1055        struct iwch_qp *qhp;
1056        enum iwch_qp_attr_mask mask = 0;
1057        struct iwch_qp_attributes attrs;
1058
1059        PDBG("%s ib_qp %p\n", __func__, ibqp);
1060
1061        /* iwarp does not support the RTR state */
1062        if ((attr_mask & IB_QP_STATE) && (attr->qp_state == IB_QPS_RTR))
1063                attr_mask &= ~IB_QP_STATE;
1064
1065        /* Make sure we still have something left to do */
1066        if (!attr_mask)
1067                return 0;
1068
1069        memset(&attrs, 0, sizeof attrs);
1070        qhp = to_iwch_qp(ibqp);
1071        rhp = qhp->rhp;
1072
1073        attrs.next_state = iwch_convert_state(attr->qp_state);
1074        attrs.enable_rdma_read = (attr->qp_access_flags &
1075                               IB_ACCESS_REMOTE_READ) ?  1 : 0;
1076        attrs.enable_rdma_write = (attr->qp_access_flags &
1077                                IB_ACCESS_REMOTE_WRITE) ? 1 : 0;
1078        attrs.enable_bind = (attr->qp_access_flags & IB_ACCESS_MW_BIND) ? 1 : 0;
1079
1080
1081        mask |= (attr_mask & IB_QP_STATE) ? IWCH_QP_ATTR_NEXT_STATE : 0;
1082        mask |= (attr_mask & IB_QP_ACCESS_FLAGS) ?
1083                        (IWCH_QP_ATTR_ENABLE_RDMA_READ |
1084                         IWCH_QP_ATTR_ENABLE_RDMA_WRITE |
1085                         IWCH_QP_ATTR_ENABLE_RDMA_BIND) : 0;
1086
1087        return iwch_modify_qp(rhp, qhp, mask, &attrs, 0);
1088}
1089
1090void iwch_qp_add_ref(struct ib_qp *qp)
1091{
1092        PDBG("%s ib_qp %p\n", __func__, qp);
1093        atomic_inc(&(to_iwch_qp(qp)->refcnt));
1094}
1095
1096void iwch_qp_rem_ref(struct ib_qp *qp)
1097{
1098        PDBG("%s ib_qp %p\n", __func__, qp);
1099        if (atomic_dec_and_test(&(to_iwch_qp(qp)->refcnt)))
1100                wake_up(&(to_iwch_qp(qp)->wait));
1101}
1102
1103static struct ib_qp *iwch_get_qp(struct ib_device *dev, int qpn)
1104{
1105        PDBG("%s ib_dev %p qpn 0x%x\n", __func__, dev, qpn);
1106        return (struct ib_qp *)get_qhp(to_iwch_dev(dev), qpn);
1107}
1108
1109
1110static int iwch_query_pkey(struct ib_device *ibdev,
1111                           u8 port, u16 index, u16 * pkey)
1112{
1113        PDBG("%s ibdev %p\n", __func__, ibdev);
1114        *pkey = 0;
1115        return 0;
1116}
1117
1118static int iwch_query_gid(struct ib_device *ibdev, u8 port,
1119                          int index, union ib_gid *gid)
1120{
1121        struct iwch_dev *dev;
1122
1123        PDBG("%s ibdev %p, port %d, index %d, gid %p\n",
1124               __func__, ibdev, port, index, gid);
1125        dev = to_iwch_dev(ibdev);
1126        BUG_ON(port == 0 || port > 2);
1127        memset(&(gid->raw[0]), 0, sizeof(gid->raw));
1128        memcpy(&(gid->raw[0]), dev->rdev.port_info.lldevs[port-1]->dev_addr, 6);
1129        return 0;
1130}
1131
1132static u64 fw_vers_string_to_u64(struct iwch_dev *iwch_dev)
1133{
1134        struct ethtool_drvinfo info;
1135        struct net_device *lldev = iwch_dev->rdev.t3cdev_p->lldev;
1136        char *cp, *next;
1137        unsigned fw_maj, fw_min, fw_mic;
1138
1139        lldev->ethtool_ops->get_drvinfo(lldev, &info);
1140
1141        next = info.fw_version + 1;
1142        cp = strsep(&next, ".");
1143        sscanf(cp, "%i", &fw_maj);
1144        cp = strsep(&next, ".");
1145        sscanf(cp, "%i", &fw_min);
1146        cp = strsep(&next, ".");
1147        sscanf(cp, "%i", &fw_mic);
1148
1149        return (((u64)fw_maj & 0xffff) << 32) | ((fw_min & 0xffff) << 16) |
1150               (fw_mic & 0xffff);
1151}
1152
1153static int iwch_query_device(struct ib_device *ibdev,
1154                             struct ib_device_attr *props)
1155{
1156
1157        struct iwch_dev *dev;
1158        PDBG("%s ibdev %p\n", __func__, ibdev);
1159
1160        dev = to_iwch_dev(ibdev);
1161        memset(props, 0, sizeof *props);
1162        memcpy(&props->sys_image_guid, dev->rdev.t3cdev_p->lldev->dev_addr, 6);
1163        props->hw_ver = dev->rdev.t3cdev_p->type;
1164        props->fw_ver = fw_vers_string_to_u64(dev);
1165        props->device_cap_flags = dev->device_cap_flags;
1166        props->page_size_cap = dev->attr.mem_pgsizes_bitmask;
1167        props->vendor_id = (u32)dev->rdev.rnic_info.pdev->vendor;
1168        props->vendor_part_id = (u32)dev->rdev.rnic_info.pdev->device;
1169        props->max_mr_size = dev->attr.max_mr_size;
1170        props->max_qp = dev->attr.max_qps;
1171        props->max_qp_wr = dev->attr.max_wrs;
1172        props->max_sge = dev->attr.max_sge_per_wr;
1173        props->max_sge_rd = 1;
1174        props->max_qp_rd_atom = dev->attr.max_rdma_reads_per_qp;
1175        props->max_qp_init_rd_atom = dev->attr.max_rdma_reads_per_qp;
1176        props->max_cq = dev->attr.max_cqs;
1177        props->max_cqe = dev->attr.max_cqes_per_cq;
1178        props->max_mr = dev->attr.max_mem_regs;
1179        props->max_pd = dev->attr.max_pds;
1180        props->local_ca_ack_delay = 0;
1181        props->max_fast_reg_page_list_len = T3_MAX_FASTREG_DEPTH;
1182
1183        return 0;
1184}
1185
1186static int iwch_query_port(struct ib_device *ibdev,
1187                           u8 port, struct ib_port_attr *props)
1188{
1189        struct iwch_dev *dev;
1190        struct net_device *netdev;
1191        struct in_device *inetdev;
1192
1193        PDBG("%s ibdev %p\n", __func__, ibdev);
1194
1195        dev = to_iwch_dev(ibdev);
1196        netdev = dev->rdev.port_info.lldevs[port-1];
1197
1198        memset(props, 0, sizeof(struct ib_port_attr));
1199        props->max_mtu = IB_MTU_4096;
1200        if (netdev->mtu >= 4096)
1201                props->active_mtu = IB_MTU_4096;
1202        else if (netdev->mtu >= 2048)
1203                props->active_mtu = IB_MTU_2048;
1204        else if (netdev->mtu >= 1024)
1205                props->active_mtu = IB_MTU_1024;
1206        else if (netdev->mtu >= 512)
1207                props->active_mtu = IB_MTU_512;
1208        else
1209                props->active_mtu = IB_MTU_256;
1210
1211        if (!netif_carrier_ok(netdev))
1212                props->state = IB_PORT_DOWN;
1213        else {
1214                inetdev = in_dev_get(netdev);
1215                if (inetdev) {
1216                        if (inetdev->ifa_list)
1217                                props->state = IB_PORT_ACTIVE;
1218                        else
1219                                props->state = IB_PORT_INIT;
1220                        in_dev_put(inetdev);
1221                } else
1222                        props->state = IB_PORT_INIT;
1223        }
1224
1225        props->port_cap_flags =
1226            IB_PORT_CM_SUP |
1227            IB_PORT_SNMP_TUNNEL_SUP |
1228            IB_PORT_REINIT_SUP |
1229            IB_PORT_DEVICE_MGMT_SUP |
1230            IB_PORT_VENDOR_CLASS_SUP | IB_PORT_BOOT_MGMT_SUP;
1231        props->gid_tbl_len = 1;
1232        props->pkey_tbl_len = 1;
1233        props->active_width = 2;
1234        props->active_speed = IB_SPEED_DDR;
1235        props->max_msg_sz = -1;
1236
1237        return 0;
1238}
1239
1240static ssize_t show_rev(struct device *dev, struct device_attribute *attr,
1241                        char *buf)
1242{
1243        struct iwch_dev *iwch_dev = container_of(dev, struct iwch_dev,
1244                                                 ibdev.dev);
1245        PDBG("%s dev 0x%p\n", __func__, dev);
1246        return sprintf(buf, "%d\n", iwch_dev->rdev.t3cdev_p->type);
1247}
1248
1249static ssize_t show_fw_ver(struct device *dev, struct device_attribute *attr, char *buf)
1250{
1251        struct iwch_dev *iwch_dev = container_of(dev, struct iwch_dev,
1252                                                 ibdev.dev);
1253        struct ethtool_drvinfo info;
1254        struct net_device *lldev = iwch_dev->rdev.t3cdev_p->lldev;
1255
1256        PDBG("%s dev 0x%p\n", __func__, dev);
1257        lldev->ethtool_ops->get_drvinfo(lldev, &info);
1258        return sprintf(buf, "%s\n", info.fw_version);
1259}
1260
1261static ssize_t show_hca(struct device *dev, struct device_attribute *attr,
1262                        char *buf)
1263{
1264        struct iwch_dev *iwch_dev = container_of(dev, struct iwch_dev,
1265                                                 ibdev.dev);
1266        struct ethtool_drvinfo info;
1267        struct net_device *lldev = iwch_dev->rdev.t3cdev_p->lldev;
1268
1269        PDBG("%s dev 0x%p\n", __func__, dev);
1270        lldev->ethtool_ops->get_drvinfo(lldev, &info);
1271        return sprintf(buf, "%s\n", info.driver);
1272}
1273
1274static ssize_t show_board(struct device *dev, struct device_attribute *attr,
1275                          char *buf)
1276{
1277        struct iwch_dev *iwch_dev = container_of(dev, struct iwch_dev,
1278                                                 ibdev.dev);
1279        PDBG("%s dev 0x%p\n", __func__, dev);
1280        return sprintf(buf, "%x.%x\n", iwch_dev->rdev.rnic_info.pdev->vendor,
1281                       iwch_dev->rdev.rnic_info.pdev->device);
1282}
1283
1284static int iwch_get_mib(struct ib_device *ibdev,
1285                        union rdma_protocol_stats *stats)
1286{
1287        struct iwch_dev *dev;
1288        struct tp_mib_stats m;
1289        int ret;
1290
1291        PDBG("%s ibdev %p\n", __func__, ibdev);
1292        dev = to_iwch_dev(ibdev);
1293        ret = dev->rdev.t3cdev_p->ctl(dev->rdev.t3cdev_p, RDMA_GET_MIB, &m);
1294        if (ret)
1295                return -ENOSYS;
1296
1297        memset(stats, 0, sizeof *stats);
1298        stats->iw.ipInReceives = ((u64) m.ipInReceive_hi << 32) +
1299                                m.ipInReceive_lo;
1300        stats->iw.ipInHdrErrors = ((u64) m.ipInHdrErrors_hi << 32) +
1301                                  m.ipInHdrErrors_lo;
1302        stats->iw.ipInAddrErrors = ((u64) m.ipInAddrErrors_hi << 32) +
1303                                   m.ipInAddrErrors_lo;
1304        stats->iw.ipInUnknownProtos = ((u64) m.ipInUnknownProtos_hi << 32) +
1305                                      m.ipInUnknownProtos_lo;
1306        stats->iw.ipInDiscards = ((u64) m.ipInDiscards_hi << 32) +
1307                                 m.ipInDiscards_lo;
1308        stats->iw.ipInDelivers = ((u64) m.ipInDelivers_hi << 32) +
1309                                 m.ipInDelivers_lo;
1310        stats->iw.ipOutRequests = ((u64) m.ipOutRequests_hi << 32) +
1311                                  m.ipOutRequests_lo;
1312        stats->iw.ipOutDiscards = ((u64) m.ipOutDiscards_hi << 32) +
1313                                  m.ipOutDiscards_lo;
1314        stats->iw.ipOutNoRoutes = ((u64) m.ipOutNoRoutes_hi << 32) +
1315                                  m.ipOutNoRoutes_lo;
1316        stats->iw.ipReasmTimeout = (u64) m.ipReasmTimeout;
1317        stats->iw.ipReasmReqds = (u64) m.ipReasmReqds;
1318        stats->iw.ipReasmOKs = (u64) m.ipReasmOKs;
1319        stats->iw.ipReasmFails = (u64) m.ipReasmFails;
1320        stats->iw.tcpActiveOpens = (u64) m.tcpActiveOpens;
1321        stats->iw.tcpPassiveOpens = (u64) m.tcpPassiveOpens;
1322        stats->iw.tcpAttemptFails = (u64) m.tcpAttemptFails;
1323        stats->iw.tcpEstabResets = (u64) m.tcpEstabResets;
1324        stats->iw.tcpOutRsts = (u64) m.tcpOutRsts;
1325        stats->iw.tcpCurrEstab = (u64) m.tcpCurrEstab;
1326        stats->iw.tcpInSegs = ((u64) m.tcpInSegs_hi << 32) +
1327                              m.tcpInSegs_lo;
1328        stats->iw.tcpOutSegs = ((u64) m.tcpOutSegs_hi << 32) +
1329                               m.tcpOutSegs_lo;
1330        stats->iw.tcpRetransSegs = ((u64) m.tcpRetransSeg_hi << 32) +
1331                                  m.tcpRetransSeg_lo;
1332        stats->iw.tcpInErrs = ((u64) m.tcpInErrs_hi << 32) +
1333                              m.tcpInErrs_lo;
1334        stats->iw.tcpRtoMin = (u64) m.tcpRtoMin;
1335        stats->iw.tcpRtoMax = (u64) m.tcpRtoMax;
1336        return 0;
1337}
1338
1339static DEVICE_ATTR(hw_rev, S_IRUGO, show_rev, NULL);
1340static DEVICE_ATTR(fw_ver, S_IRUGO, show_fw_ver, NULL);
1341static DEVICE_ATTR(hca_type, S_IRUGO, show_hca, NULL);
1342static DEVICE_ATTR(board_id, S_IRUGO, show_board, NULL);
1343
1344static struct device_attribute *iwch_class_attributes[] = {
1345        &dev_attr_hw_rev,
1346        &dev_attr_fw_ver,
1347        &dev_attr_hca_type,
1348        &dev_attr_board_id,
1349};
1350
1351int iwch_register_device(struct iwch_dev *dev)
1352{
1353        int ret;
1354        int i;
1355
1356        PDBG("%s iwch_dev %p\n", __func__, dev);
1357        strlcpy(dev->ibdev.name, "cxgb3_%d", IB_DEVICE_NAME_MAX);
1358        memset(&dev->ibdev.node_guid, 0, sizeof(dev->ibdev.node_guid));
1359        memcpy(&dev->ibdev.node_guid, dev->rdev.t3cdev_p->lldev->dev_addr, 6);
1360        dev->ibdev.owner = THIS_MODULE;
1361        dev->device_cap_flags = IB_DEVICE_LOCAL_DMA_LKEY |
1362                                IB_DEVICE_MEM_WINDOW |
1363                                IB_DEVICE_MEM_MGT_EXTENSIONS;
1364
1365        /* cxgb3 supports STag 0. */
1366        dev->ibdev.local_dma_lkey = 0;
1367
1368        dev->ibdev.uverbs_cmd_mask =
1369            (1ull << IB_USER_VERBS_CMD_GET_CONTEXT) |
1370            (1ull << IB_USER_VERBS_CMD_QUERY_DEVICE) |
1371            (1ull << IB_USER_VERBS_CMD_QUERY_PORT) |
1372            (1ull << IB_USER_VERBS_CMD_ALLOC_PD) |
1373            (1ull << IB_USER_VERBS_CMD_DEALLOC_PD) |
1374            (1ull << IB_USER_VERBS_CMD_REG_MR) |
1375            (1ull << IB_USER_VERBS_CMD_DEREG_MR) |
1376            (1ull << IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL) |
1377            (1ull << IB_USER_VERBS_CMD_CREATE_CQ) |
1378            (1ull << IB_USER_VERBS_CMD_DESTROY_CQ) |
1379            (1ull << IB_USER_VERBS_CMD_REQ_NOTIFY_CQ) |
1380            (1ull << IB_USER_VERBS_CMD_CREATE_QP) |
1381            (1ull << IB_USER_VERBS_CMD_MODIFY_QP) |
1382            (1ull << IB_USER_VERBS_CMD_POLL_CQ) |
1383            (1ull << IB_USER_VERBS_CMD_DESTROY_QP) |
1384            (1ull << IB_USER_VERBS_CMD_POST_SEND) |
1385            (1ull << IB_USER_VERBS_CMD_POST_RECV);
1386        dev->ibdev.node_type = RDMA_NODE_RNIC;
1387        memcpy(dev->ibdev.node_desc, IWCH_NODE_DESC, sizeof(IWCH_NODE_DESC));
1388        dev->ibdev.phys_port_cnt = dev->rdev.port_info.nports;
1389        dev->ibdev.num_comp_vectors = 1;
1390        dev->ibdev.dma_device = &(dev->rdev.rnic_info.pdev->dev);
1391        dev->ibdev.query_device = iwch_query_device;
1392        dev->ibdev.query_port = iwch_query_port;
1393        dev->ibdev.query_pkey = iwch_query_pkey;
1394        dev->ibdev.query_gid = iwch_query_gid;
1395        dev->ibdev.alloc_ucontext = iwch_alloc_ucontext;
1396        dev->ibdev.dealloc_ucontext = iwch_dealloc_ucontext;
1397        dev->ibdev.mmap = iwch_mmap;
1398        dev->ibdev.alloc_pd = iwch_allocate_pd;
1399        dev->ibdev.dealloc_pd = iwch_deallocate_pd;
1400        dev->ibdev.create_ah = iwch_ah_create;
1401        dev->ibdev.destroy_ah = iwch_ah_destroy;
1402        dev->ibdev.create_qp = iwch_create_qp;
1403        dev->ibdev.modify_qp = iwch_ib_modify_qp;
1404        dev->ibdev.destroy_qp = iwch_destroy_qp;
1405        dev->ibdev.create_cq = iwch_create_cq;
1406        dev->ibdev.destroy_cq = iwch_destroy_cq;
1407        dev->ibdev.resize_cq = iwch_resize_cq;
1408        dev->ibdev.poll_cq = iwch_poll_cq;
1409        dev->ibdev.get_dma_mr = iwch_get_dma_mr;
1410        dev->ibdev.reg_phys_mr = iwch_register_phys_mem;
1411        dev->ibdev.rereg_phys_mr = iwch_reregister_phys_mem;
1412        dev->ibdev.reg_user_mr = iwch_reg_user_mr;
1413        dev->ibdev.dereg_mr = iwch_dereg_mr;
1414        dev->ibdev.alloc_mw = iwch_alloc_mw;
1415        dev->ibdev.bind_mw = iwch_bind_mw;
1416        dev->ibdev.dealloc_mw = iwch_dealloc_mw;
1417        dev->ibdev.alloc_fast_reg_mr = iwch_alloc_fast_reg_mr;
1418        dev->ibdev.alloc_fast_reg_page_list = iwch_alloc_fastreg_pbl;
1419        dev->ibdev.free_fast_reg_page_list = iwch_free_fastreg_pbl;
1420        dev->ibdev.attach_mcast = iwch_multicast_attach;
1421        dev->ibdev.detach_mcast = iwch_multicast_detach;
1422        dev->ibdev.process_mad = iwch_process_mad;
1423        dev->ibdev.req_notify_cq = iwch_arm_cq;
1424        dev->ibdev.post_send = iwch_post_send;
1425        dev->ibdev.post_recv = iwch_post_receive;
1426        dev->ibdev.get_protocol_stats = iwch_get_mib;
1427        dev->ibdev.uverbs_abi_ver = IWCH_UVERBS_ABI_VERSION;
1428
1429        dev->ibdev.iwcm = kmalloc(sizeof(struct iw_cm_verbs), GFP_KERNEL);
1430        if (!dev->ibdev.iwcm)
1431                return -ENOMEM;
1432
1433        dev->ibdev.iwcm->connect = iwch_connect;
1434        dev->ibdev.iwcm->accept = iwch_accept_cr;
1435        dev->ibdev.iwcm->reject = iwch_reject_cr;
1436        dev->ibdev.iwcm->create_listen = iwch_create_listen;
1437        dev->ibdev.iwcm->destroy_listen = iwch_destroy_listen;
1438        dev->ibdev.iwcm->add_ref = iwch_qp_add_ref;
1439        dev->ibdev.iwcm->rem_ref = iwch_qp_rem_ref;
1440        dev->ibdev.iwcm->get_qp = iwch_get_qp;
1441
1442        ret = ib_register_device(&dev->ibdev, NULL);
1443        if (ret)
1444                goto bail1;
1445
1446        for (i = 0; i < ARRAY_SIZE(iwch_class_attributes); ++i) {
1447                ret = device_create_file(&dev->ibdev.dev,
1448                                         iwch_class_attributes[i]);
1449                if (ret) {
1450                        goto bail2;
1451                }
1452        }
1453        return 0;
1454bail2:
1455        ib_unregister_device(&dev->ibdev);
1456bail1:
1457        kfree(dev->ibdev.iwcm);
1458        return ret;
1459}
1460
1461void iwch_unregister_device(struct iwch_dev *dev)
1462{
1463        int i;
1464
1465        PDBG("%s iwch_dev %p\n", __func__, dev);
1466        for (i = 0; i < ARRAY_SIZE(iwch_class_attributes); ++i)
1467                device_remove_file(&dev->ibdev.dev,
1468                                   iwch_class_attributes[i]);
1469        ib_unregister_device(&dev->ibdev);
1470        kfree(dev->ibdev.iwcm);
1471        return;
1472}
1473