sys/dev/irdma/irdma_kcompat.c

   1 /*-
   2  * SPDX-License-Identifier: GPL-2.0 or Linux-OpenIB
   3  *
   4  * Copyright (c) 2018 - 2022 Intel Corporation
   5  *
   6  * This software is available to you under a choice of one of two
   7  * licenses.  You may choose to be licensed under the terms of the GNU
   8  * General Public License (GPL) Version 2, available from the file
   9  * COPYING in the main directory of this source tree, or the
  10  * OpenFabrics.org BSD license below:
  11  *
  12  *   Redistribution and use in source and binary forms, with or
  13  *   without modification, are permitted provided that the following
  14  *   conditions are met:
  15  *
  16  *    - Redistributions of source code must retain the above
  17  *      copyright notice, this list of conditions and the following
  18  *      disclaimer.
  19  *
  20  *    - Redistributions in binary form must reproduce the above
  21  *      copyright notice, this list of conditions and the following
  22  *      disclaimer in the documentation and/or other materials
  23  *      provided with the distribution.
  24  *
  25  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  26  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  27  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  28  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  29  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  30  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  31  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  32  * SOFTWARE.
  33  */
  34 /*$FreeBSD$*/
  35
  36 #include "irdma_main.h"
  37
  38 void
  39 irdma_get_dev_fw_str(struct ib_device *dev,
  40                      char *str,
  41                      size_t str_len)
  42 {
  43         struct irdma_device *iwdev = to_iwdev(dev);
  44
  45         snprintf(str, str_len, "%u.%u",
  46                  irdma_fw_major_ver(&iwdev->rf->sc_dev),
  47                  irdma_fw_minor_ver(&iwdev->rf->sc_dev));
  48 }
  49
  50 int
  51 irdma_add_gid(struct ib_device *device,
  52               u8 port_num,
  53               unsigned int index,
  54               const union ib_gid *gid,
  55               const struct ib_gid_attr *attr,
  56               void **context)
  57 {
  58         return 0;
  59 }
  60
  61 int
  62 irdma_del_gid(struct ib_device *device,
  63               u8 port_num,
  64               unsigned int index,
  65               void **context)
  66 {
  67         return 0;
  68 }
  69
  70 /**
  71  * irdma_alloc_mr - register stag for fast memory registration
  72  * @pd: ibpd pointer
  73  * @mr_type: memory for stag registrion
  74  * @max_num_sg: man number of pages
  75  * @udata: user data
  76  */
  77 struct ib_mr *
  78 irdma_alloc_mr(struct ib_pd *pd, enum ib_mr_type mr_type,
  79                u32 max_num_sg, struct ib_udata *udata)
  80 {
  81         struct irdma_device *iwdev = to_iwdev(pd->device);
  82         struct irdma_pble_alloc *palloc;
  83         struct irdma_pbl *iwpbl;
  84         struct irdma_mr *iwmr;
  85         int status;
  86         u32 stag;
  87         int err_code = -ENOMEM;
  88
  89         iwmr = kzalloc(sizeof(*iwmr), GFP_KERNEL);
  90         if (!iwmr)
  91                 return ERR_PTR(-ENOMEM);
  92
  93         stag = irdma_create_stag(iwdev);
  94         if (!stag) {
  95                 err_code = -ENOMEM;
  96                 goto err;
  97         }
  98
  99         iwmr->stag = stag;
 100         iwmr->ibmr.rkey = stag;
 101         iwmr->ibmr.lkey = stag;
 102         iwmr->ibmr.pd = pd;
 103         iwmr->ibmr.device = pd->device;
 104         iwpbl = &iwmr->iwpbl;
 105         iwpbl->iwmr = iwmr;
 106         iwmr->type = IRDMA_MEMREG_TYPE_MEM;
 107         palloc = &iwpbl->pble_alloc;
 108         iwmr->page_cnt = max_num_sg;
 109         status = irdma_get_pble(iwdev->rf->pble_rsrc, palloc, iwmr->page_cnt,
 110                                 true);
 111         if (status)
 112                 goto err_get_pble;
 113
 114         err_code = irdma_hw_alloc_stag(iwdev, iwmr);
 115         if (err_code)
 116                 goto err_alloc_stag;
 117
 118         iwpbl->pbl_allocated = true;
 119
 120         return &iwmr->ibmr;
 121 err_alloc_stag:
 122         irdma_free_pble(iwdev->rf->pble_rsrc, palloc);
 123 err_get_pble:
 124         irdma_free_stag(iwdev, stag);
 125 err:
 126         kfree(iwmr);
 127
 128         return ERR_PTR(err_code);
 129 }
 130
 131 /**
 132  * irdma_alloc_ucontext - Allocate the user context data structure
 133  * @uctx: context
 134  * @udata: user data
 135  *
 136  * This keeps track of all objects associated with a particular
 137  * user-mode client.
 138  */
 139 int
 140 irdma_alloc_ucontext(struct ib_ucontext *uctx, struct ib_udata *udata)
 141 {
 142         struct ib_device *ibdev = uctx->device;
 143         struct irdma_device *iwdev = to_iwdev(ibdev);
 144         struct irdma_alloc_ucontext_req req;
 145         struct irdma_alloc_ucontext_resp uresp = {0};
 146         struct irdma_ucontext *ucontext = to_ucontext(uctx);
 147         struct irdma_uk_attrs *uk_attrs;
 148
 149         if (ib_copy_from_udata(&req, udata, min(sizeof(req), udata->inlen)))
 150                 return -EINVAL;
 151
 152         if (req.userspace_ver < 4 || req.userspace_ver > IRDMA_ABI_VER)
 153                 goto ver_error;
 154
 155         ucontext->iwdev = iwdev;
 156         ucontext->abi_ver = req.userspace_ver;
 157
 158         uk_attrs = &iwdev->rf->sc_dev.hw_attrs.uk_attrs;
 159         /* GEN_1 support for libi40iw */
 160         if (udata->outlen < sizeof(uresp)) {
 161                 if (uk_attrs->hw_rev != IRDMA_GEN_1)
 162                         return -EOPNOTSUPP;
 163
 164                 ucontext->legacy_mode = true;
 165                 uresp.max_qps = iwdev->rf->max_qp;
 166                 uresp.max_pds = iwdev->rf->sc_dev.hw_attrs.max_hw_pds;
 167                 uresp.wq_size = iwdev->rf->sc_dev.hw_attrs.max_qp_wr * 2;
 168                 uresp.kernel_ver = req.userspace_ver;
 169                 if (ib_copy_to_udata(udata, &uresp, min(sizeof(uresp), udata->outlen)))
 170                         return -EFAULT;
 171         } else {
 172                 u64 bar_off =
 173                 (uintptr_t)iwdev->rf->sc_dev.hw_regs[IRDMA_DB_ADDR_OFFSET];
 174                 ucontext->db_mmap_entry =
 175                     irdma_user_mmap_entry_insert(ucontext, bar_off,
 176                                                  IRDMA_MMAP_IO_NC,
 177                                                  &uresp.db_mmap_key);
 178                 if (!ucontext->db_mmap_entry) {
 179                         return -ENOMEM;
 180                 }
 181                 uresp.kernel_ver = IRDMA_ABI_VER;
 182                 uresp.feature_flags = uk_attrs->feature_flags;
 183                 uresp.max_hw_wq_frags = uk_attrs->max_hw_wq_frags;
 184                 uresp.max_hw_read_sges = uk_attrs->max_hw_read_sges;
 185                 uresp.max_hw_inline = uk_attrs->max_hw_inline;
 186                 uresp.max_hw_rq_quanta = uk_attrs->max_hw_rq_quanta;
 187                 uresp.max_hw_wq_quanta = uk_attrs->max_hw_wq_quanta;
 188                 uresp.max_hw_sq_chunk = uk_attrs->max_hw_sq_chunk;
 189                 uresp.max_hw_cq_size = uk_attrs->max_hw_cq_size;
 190                 uresp.min_hw_cq_size = uk_attrs->min_hw_cq_size;
 191                 uresp.hw_rev = uk_attrs->hw_rev;
 192                 if (ib_copy_to_udata(udata, &uresp,
 193                                      min(sizeof(uresp), udata->outlen))) {
 194                         rdma_user_mmap_entry_remove(ucontext->db_mmap_entry);
 195                         return -EFAULT;
 196                 }
 197         }
 198
 199         INIT_LIST_HEAD(&ucontext->cq_reg_mem_list);
 200         spin_lock_init(&ucontext->cq_reg_mem_list_lock);
 201         INIT_LIST_HEAD(&ucontext->qp_reg_mem_list);
 202         spin_lock_init(&ucontext->qp_reg_mem_list_lock);
 203         INIT_LIST_HEAD(&ucontext->vma_list);
 204         mutex_init(&ucontext->vma_list_mutex);
 205
 206         return 0;
 207
 208 ver_error:
 209         irdma_dev_err(&iwdev->rf->sc_dev,
 210                       "Invalid userspace driver version detected. Detected version %d, should be %d\n",
 211                       req.userspace_ver, IRDMA_ABI_VER);
 212         return -EINVAL;
 213 }
 214
 215 /**
 216  * irdma_dealloc_ucontext - deallocate the user context data structure
 217  * @context: user context created during alloc
 218  */
 219 void
 220 irdma_dealloc_ucontext(struct ib_ucontext *context)
 221 {
 222         struct irdma_ucontext *ucontext = to_ucontext(context);
 223
 224         rdma_user_mmap_entry_remove(ucontext->db_mmap_entry);
 225
 226         return;
 227 }
 228
 229 /**
 230  * irdma_alloc_pd - allocate protection domain
 231  * @pd: protection domain
 232  * @udata: user data
 233  */
 234 int
 235 irdma_alloc_pd(struct ib_pd *pd, struct ib_udata *udata)
 236 {
 237         struct irdma_pd *iwpd = to_iwpd(pd);
 238         struct irdma_device *iwdev = to_iwdev(pd->device);
 239         struct irdma_sc_dev *dev = &iwdev->rf->sc_dev;
 240         struct irdma_pci_f *rf = iwdev->rf;
 241         struct irdma_alloc_pd_resp uresp = {0};
 242         struct irdma_sc_pd *sc_pd;
 243         u32 pd_id = 0;
 244         int err;
 245
 246         err = irdma_alloc_rsrc(rf, rf->allocated_pds, rf->max_pd, &pd_id,
 247                                &rf->next_pd);
 248         if (err)
 249                 return err;
 250
 251         sc_pd = &iwpd->sc_pd;
 252         if (udata) {
 253                 struct irdma_ucontext *ucontext =
 254                 rdma_udata_to_drv_context(udata, struct irdma_ucontext,
 255                                           ibucontext);
 256
 257                 irdma_sc_pd_init(dev, sc_pd, pd_id, ucontext->abi_ver);
 258                 uresp.pd_id = pd_id;
 259                 if (ib_copy_to_udata(udata, &uresp,
 260                                      min(sizeof(uresp), udata->outlen))) {
 261                         err = -EFAULT;
 262                         goto error;
 263                 }
 264         } else {
 265                 irdma_sc_pd_init(dev, sc_pd, pd_id, IRDMA_ABI_VER);
 266         }
 267
 268         return 0;
 269
 270 error:
 271
 272         irdma_free_rsrc(rf, rf->allocated_pds, pd_id);
 273
 274         return err;
 275 }
 276
 277 void
 278 irdma_dealloc_pd(struct ib_pd *ibpd, struct ib_udata *udata)
 279 {
 280         struct irdma_pd *iwpd = to_iwpd(ibpd);
 281         struct irdma_device *iwdev = to_iwdev(ibpd->device);
 282
 283         irdma_free_rsrc(iwdev->rf, iwdev->rf->allocated_pds, iwpd->sc_pd.pd_id);
 284 }
 285
 286 static void
 287 irdma_fill_ah_info(struct irdma_ah_info *ah_info,
 288                    const struct ib_gid_attr *sgid_attr,
 289                    struct sockaddr *sgid_addr, struct sockaddr *dgid_addr,
 290                    u8 *dmac, u8 net_type)
 291 {
 292         if (net_type == RDMA_NETWORK_IPV4) {
 293                 ah_info->ipv4_valid = true;
 294                 ah_info->dest_ip_addr[0] =
 295                     ntohl(((struct sockaddr_in *)dgid_addr)->sin_addr.s_addr);
 296                 ah_info->src_ip_addr[0] =
 297                     ntohl(((struct sockaddr_in *)sgid_addr)->sin_addr.s_addr);
 298                 ah_info->do_lpbk = irdma_ipv4_is_lpb(ah_info->src_ip_addr[0],
 299                                                      ah_info->dest_ip_addr[0]);
 300                 if (ipv4_is_multicast(((struct sockaddr_in *)dgid_addr)->sin_addr.s_addr)) {
 301                         irdma_mcast_mac_v4(ah_info->dest_ip_addr, dmac);
 302                 }
 303         } else {
 304                 irdma_copy_ip_ntohl(ah_info->dest_ip_addr,
 305                                     ((struct sockaddr_in6 *)dgid_addr)->sin6_addr.__u6_addr.__u6_addr32);
 306                 irdma_copy_ip_ntohl(ah_info->src_ip_addr,
 307                                     ((struct sockaddr_in6 *)sgid_addr)->sin6_addr.__u6_addr.__u6_addr32);
 308                 ah_info->do_lpbk = irdma_ipv6_is_lpb(ah_info->src_ip_addr,
 309                                                      ah_info->dest_ip_addr);
 310                 if (rdma_is_multicast_addr(&((struct sockaddr_in6 *)dgid_addr)->sin6_addr)) {
 311                         irdma_mcast_mac_v6(ah_info->dest_ip_addr, dmac);
 312                 }
 313         }
 314 }
 315
 316 static int
 317 irdma_create_ah_vlan_tag(struct irdma_device *iwdev,
 318                          struct irdma_ah_info *ah_info,
 319                          const struct ib_gid_attr *sgid_attr,
 320                          u8 *dmac)
 321 {
 322         if (sgid_attr->ndev && is_vlan_dev(sgid_attr->ndev))
 323                 ah_info->vlan_tag = vlan_dev_vlan_id(sgid_attr->ndev);
 324         else
 325                 ah_info->vlan_tag = VLAN_N_VID;
 326
 327         ah_info->dst_arpindex = irdma_add_arp(iwdev->rf, ah_info->dest_ip_addr, dmac);
 328
 329         if (ah_info->dst_arpindex == -1)
 330                 return -EINVAL;
 331
 332         if (ah_info->vlan_tag >= VLAN_N_VID && iwdev->dcb_vlan_mode)
 333                 ah_info->vlan_tag = 0;
 334
 335         if (ah_info->vlan_tag < VLAN_N_VID) {
 336                 ah_info->insert_vlan_tag = true;
 337                 ah_info->vlan_tag |=
 338                     rt_tos2priority(ah_info->tc_tos) << VLAN_PRIO_SHIFT;
 339         }
 340         return 0;
 341 }
 342
 343 static int
 344 irdma_create_ah_wait(struct irdma_pci_f *rf,
 345                      struct irdma_sc_ah *sc_ah, bool sleep)
 346 {
 347         if (!sleep) {
 348                 int cnt = CQP_COMPL_WAIT_TIME_MS * CQP_TIMEOUT_THRESHOLD;
 349
 350                 do {
 351                         irdma_cqp_ce_handler(rf, &rf->ccq.sc_cq);
 352                         mdelay(1);
 353                 } while (!sc_ah->ah_info.ah_valid && --cnt);
 354
 355                 if (!cnt)
 356                         return -ETIMEDOUT;
 357         }
 358         return 0;
 359 }
 360
 361 /**
 362  * irdma_create_ah - create address handle
 363  * @ib_ah: ptr to AH
 364  * @attr: address handle attributes
 365  * @flags: AH flags to wait
 366  * @udata: user data
 367  *
 368  * returns 0 on success, error otherwise
 369  */
 370 int
 371 irdma_create_ah(struct ib_ah *ib_ah,
 372                 struct ib_ah_attr *attr, u32 flags,
 373                 struct ib_udata *udata)
 374 {
 375         struct irdma_pd *pd = to_iwpd(ib_ah->pd);
 376         struct irdma_ah *ah = container_of(ib_ah, struct irdma_ah, ibah);
 377         struct irdma_device *iwdev = to_iwdev(ib_ah->pd->device);
 378         union ib_gid sgid;
 379         struct ib_gid_attr sgid_attr;
 380         struct irdma_pci_f *rf = iwdev->rf;
 381         struct irdma_sc_ah *sc_ah;
 382         u32 ah_id = 0;
 383         struct irdma_ah_info *ah_info;
 384         struct irdma_create_ah_resp uresp;
 385         union {
 386                 struct sockaddr saddr;
 387                 struct sockaddr_in saddr_in;
 388                 struct sockaddr_in6 saddr_in6;
 389         } sgid_addr, dgid_addr;
 390         int err;
 391         u8 dmac[ETH_ALEN];
 392         bool sleep;
 393
 394         err = irdma_alloc_rsrc(rf, rf->allocated_ahs,
 395                                rf->max_ah, &ah_id, &rf->next_ah);
 396
 397         if (err)
 398                 return err;
 399
 400         ah->pd = pd;
 401         sc_ah = &ah->sc_ah;
 402         sc_ah->ah_info.ah_idx = ah_id;
 403         sc_ah->ah_info.vsi = &iwdev->vsi;
 404         irdma_sc_init_ah(&rf->sc_dev, sc_ah);
 405         ah->sgid_index = attr->grh.sgid_index;
 406         memcpy(&ah->dgid, &attr->grh.dgid, sizeof(ah->dgid));
 407         rcu_read_lock();
 408         err = ib_get_cached_gid(&iwdev->ibdev, attr->port_num,
 409                                 attr->grh.sgid_index, &sgid, &sgid_attr);
 410         rcu_read_unlock();
 411         if (err) {
 412                 irdma_debug(iwdev_to_idev(iwdev), IRDMA_DEBUG_VERBS,
 413                             "GID lookup at idx=%d with port=%d failed\n",
 414                             attr->grh.sgid_index, attr->port_num);
 415                 err = -EINVAL;
 416                 goto error;
 417         }
 418         rdma_gid2ip((struct sockaddr *)&sgid_addr, &sgid);
 419         rdma_gid2ip((struct sockaddr *)&dgid_addr, &attr->grh.dgid);
 420         ah->av.attrs = *attr;
 421         ah->av.net_type = kc_rdma_gid_attr_network_type(sgid_attr,
 422                                                         sgid_attr.gid_type,
 423                                                         &sgid);
 424
 425         if (sgid_attr.ndev)
 426                 dev_put(sgid_attr.ndev);
 427
 428         ah->av.sgid_addr.saddr = sgid_addr.saddr;
 429         ah->av.dgid_addr.saddr = dgid_addr.saddr;
 430         ah_info = &sc_ah->ah_info;
 431         ah_info->ah_idx = ah_id;
 432         ah_info->pd_idx = pd->sc_pd.pd_id;
 433         ether_addr_copy(ah_info->mac_addr, IF_LLADDR(iwdev->netdev));
 434
 435         if (attr->ah_flags & IB_AH_GRH) {
 436                 ah_info->flow_label = attr->grh.flow_label;
 437                 ah_info->hop_ttl = attr->grh.hop_limit;
 438                 ah_info->tc_tos = attr->grh.traffic_class;
 439         }
 440
 441         ether_addr_copy(dmac, attr->dmac);
 442
 443         irdma_fill_ah_info(ah_info, &sgid_attr, &sgid_addr.saddr, &dgid_addr.saddr,
 444                            dmac, ah->av.net_type);
 445
 446         err = irdma_create_ah_vlan_tag(iwdev, ah_info, &sgid_attr, dmac);
 447         if (err)
 448                 goto error;
 449
 450         sleep = flags & RDMA_CREATE_AH_SLEEPABLE;
 451
 452         err = irdma_ah_cqp_op(iwdev->rf, sc_ah, IRDMA_OP_AH_CREATE,
 453                               sleep, irdma_gsi_ud_qp_ah_cb, sc_ah);
 454         if (err) {
 455                 irdma_debug(iwdev_to_idev(iwdev), IRDMA_DEBUG_VERBS,
 456                             "CQP-OP Create AH fail");
 457                 goto error;
 458         }
 459
 460         err = irdma_create_ah_wait(rf, sc_ah, sleep);
 461         if (err) {
 462                 irdma_debug(iwdev_to_idev(iwdev), IRDMA_DEBUG_VERBS,
 463                             "CQP create AH timed out");
 464                 goto error;
 465         }
 466
 467         if (udata) {
 468                 uresp.ah_id = ah->sc_ah.ah_info.ah_idx;
 469                 err = ib_copy_to_udata(udata, &uresp, sizeof(uresp));
 470         }
 471         return 0;
 472 error:
 473         irdma_free_rsrc(iwdev->rf, iwdev->rf->allocated_ahs, ah_id);
 474         return err;
 475 }
 476
 477 void
 478 irdma_ether_copy(u8 *dmac, struct ib_ah_attr *attr)
 479 {
 480         ether_addr_copy(dmac, attr->dmac);
 481 }
 482
 483 int
 484 irdma_create_ah_stub(struct ib_ah *ib_ah,
 485                      struct ib_ah_attr *attr, u32 flags,
 486                      struct ib_udata *udata)
 487 {
 488         return -ENOSYS;
 489 }
 490
 491 void
 492 irdma_destroy_ah_stub(struct ib_ah *ibah, u32 flags)
 493 {
 494         return;
 495 }
 496
 497 /**
 498  * irdma_free_qp_rsrc - free up memory resources for qp
 499  * @iwqp: qp ptr (user or kernel)
 500  */
 501 void
 502 irdma_free_qp_rsrc(struct irdma_qp *iwqp)
 503 {
 504         struct irdma_device *iwdev = iwqp->iwdev;
 505         struct irdma_pci_f *rf = iwdev->rf;
 506         u32 qp_num = iwqp->ibqp.qp_num;
 507
 508         irdma_ieq_cleanup_qp(iwdev->vsi.ieq, &iwqp->sc_qp);
 509         irdma_dealloc_push_page(rf, &iwqp->sc_qp);
 510         if (iwqp->sc_qp.vsi) {
 511                 irdma_qp_rem_qos(&iwqp->sc_qp);
 512                 iwqp->sc_qp.dev->ws_remove(iwqp->sc_qp.vsi,
 513                                            iwqp->sc_qp.user_pri);
 514         }
 515
 516         if (qp_num > 2)
 517                 irdma_free_rsrc(rf, rf->allocated_qps, qp_num);
 518         irdma_free_dma_mem(rf->sc_dev.hw, &iwqp->q2_ctx_mem);
 519         irdma_free_dma_mem(rf->sc_dev.hw, &iwqp->kqp.dma_mem);
 520         kfree(iwqp->kqp.sig_trk_mem);
 521         iwqp->kqp.sig_trk_mem = NULL;
 522         kfree(iwqp->kqp.sq_wrid_mem);
 523         kfree(iwqp->kqp.rq_wrid_mem);
 524         kfree(iwqp->sg_list);
 525         kfree(iwqp);
 526 }
 527
 528 /**
 529  * irdma_create_qp - create qp
 530  * @ibpd: ptr of pd
 531  * @init_attr: attributes for qp
 532  * @udata: user data for create qp
 533  */
 534 struct ib_qp *
 535 irdma_create_qp(struct ib_pd *ibpd,
 536                 struct ib_qp_init_attr *init_attr,
 537                 struct ib_udata *udata)
 538 {
 539         struct irdma_pd *iwpd = to_iwpd(ibpd);
 540         struct irdma_device *iwdev = to_iwdev(ibpd->device);
 541         struct irdma_pci_f *rf = iwdev->rf;
 542         struct irdma_qp *iwqp;
 543         struct irdma_create_qp_req req;
 544         struct irdma_create_qp_resp uresp = {0};
 545         u32 qp_num = 0;
 546         int ret;
 547         int err_code;
 548         int sq_size;
 549         int rq_size;
 550         struct irdma_sc_qp *qp;
 551         struct irdma_sc_dev *dev = &rf->sc_dev;
 552         struct irdma_uk_attrs *uk_attrs = &dev->hw_attrs.uk_attrs;
 553         struct irdma_qp_init_info init_info = {{0}};
 554         struct irdma_qp_host_ctx_info *ctx_info;
 555         unsigned long flags;
 556
 557         err_code = irdma_validate_qp_attrs(init_attr, iwdev);
 558         if (err_code)
 559                 return ERR_PTR(err_code);
 560
 561         sq_size = init_attr->cap.max_send_wr;
 562         rq_size = init_attr->cap.max_recv_wr;
 563
 564         init_info.vsi = &iwdev->vsi;
 565         init_info.qp_uk_init_info.uk_attrs = uk_attrs;
 566         init_info.qp_uk_init_info.sq_size = sq_size;
 567         init_info.qp_uk_init_info.rq_size = rq_size;
 568         init_info.qp_uk_init_info.max_sq_frag_cnt = init_attr->cap.max_send_sge;
 569         init_info.qp_uk_init_info.max_rq_frag_cnt = init_attr->cap.max_recv_sge;
 570         init_info.qp_uk_init_info.max_inline_data = init_attr->cap.max_inline_data;
 571
 572         iwqp = kzalloc(sizeof(*iwqp), GFP_KERNEL);
 573         if (!iwqp)
 574                 return ERR_PTR(-ENOMEM);
 575
 576         iwqp->sg_list = kcalloc(uk_attrs->max_hw_wq_frags, sizeof(*iwqp->sg_list),
 577                                 GFP_KERNEL);
 578         if (!iwqp->sg_list) {
 579                 kfree(iwqp);
 580                 return ERR_PTR(-ENOMEM);
 581         }
 582
 583         qp = &iwqp->sc_qp;
 584         qp->qp_uk.back_qp = iwqp;
 585         qp->qp_uk.lock = &iwqp->lock;
 586         qp->push_idx = IRDMA_INVALID_PUSH_PAGE_INDEX;
 587
 588         iwqp->iwdev = iwdev;
 589         iwqp->q2_ctx_mem.size = IRDMA_Q2_BUF_SIZE + IRDMA_QP_CTX_SIZE;
 590         iwqp->q2_ctx_mem.va = irdma_allocate_dma_mem(dev->hw, &iwqp->q2_ctx_mem,
 591                                                      iwqp->q2_ctx_mem.size,
 592                                                      256);
 593         if (!iwqp->q2_ctx_mem.va) {
 594                 kfree(iwqp->sg_list);
 595                 kfree(iwqp);
 596                 return ERR_PTR(-ENOMEM);
 597         }
 598
 599         init_info.q2 = iwqp->q2_ctx_mem.va;
 600         init_info.q2_pa = iwqp->q2_ctx_mem.pa;
 601         init_info.host_ctx = (__le64 *) (init_info.q2 + IRDMA_Q2_BUF_SIZE);
 602         init_info.host_ctx_pa = init_info.q2_pa + IRDMA_Q2_BUF_SIZE;
 603
 604         if (init_attr->qp_type == IB_QPT_GSI)
 605                 qp_num = 1;
 606         else
 607                 err_code = irdma_alloc_rsrc(rf, rf->allocated_qps, rf->max_qp,
 608                                             &qp_num, &rf->next_qp);
 609         if (err_code)
 610                 goto error;
 611
 612         iwqp->iwpd = iwpd;
 613         iwqp->ibqp.qp_num = qp_num;
 614         qp = &iwqp->sc_qp;
 615         iwqp->iwscq = to_iwcq(init_attr->send_cq);
 616         iwqp->iwrcq = to_iwcq(init_attr->recv_cq);
 617         iwqp->host_ctx.va = init_info.host_ctx;
 618         iwqp->host_ctx.pa = init_info.host_ctx_pa;
 619         iwqp->host_ctx.size = IRDMA_QP_CTX_SIZE;
 620
 621         init_info.pd = &iwpd->sc_pd;
 622         init_info.qp_uk_init_info.qp_id = iwqp->ibqp.qp_num;
 623         if (!rdma_protocol_roce(&iwdev->ibdev, 1))
 624                 init_info.qp_uk_init_info.first_sq_wq = 1;
 625         iwqp->ctx_info.qp_compl_ctx = (uintptr_t)qp;
 626         init_waitqueue_head(&iwqp->waitq);
 627         init_waitqueue_head(&iwqp->mod_qp_waitq);
 628
 629         if (udata) {
 630                 err_code = ib_copy_from_udata(&req, udata,
 631                                               min(sizeof(req), udata->inlen));
 632                 if (err_code) {
 633                         irdma_debug(iwdev_to_idev(iwdev), IRDMA_DEBUG_VERBS,
 634                                     "ib_copy_from_data fail\n");
 635                         goto error;
 636                 }
 637
 638                 iwqp->ctx_info.qp_compl_ctx = req.user_compl_ctx;
 639                 iwqp->user_mode = 1;
 640                 if (req.user_wqe_bufs) {
 641                         struct irdma_ucontext *ucontext = to_ucontext(ibpd->uobject->context);
 642
 643                         init_info.qp_uk_init_info.legacy_mode = ucontext->legacy_mode;
 644                         spin_lock_irqsave(&ucontext->qp_reg_mem_list_lock, flags);
 645                         iwqp->iwpbl = irdma_get_pbl((unsigned long)req.user_wqe_bufs,
 646                                                     &ucontext->qp_reg_mem_list);
 647                         spin_unlock_irqrestore(&ucontext->qp_reg_mem_list_lock, flags);
 648
 649                         if (!iwqp->iwpbl) {
 650                                 err_code = -ENODATA;
 651                                 irdma_debug(iwdev_to_idev(iwdev),
 652                                             IRDMA_DEBUG_VERBS,
 653                                             "no pbl info\n");
 654                                 goto error;
 655                         }
 656                 }
 657                 init_info.qp_uk_init_info.abi_ver = iwpd->sc_pd.abi_ver;
 658                 irdma_setup_virt_qp(iwdev, iwqp, &init_info);
 659         } else {
 660                 INIT_DELAYED_WORK(&iwqp->dwork_flush, irdma_flush_worker);
 661                 init_info.qp_uk_init_info.abi_ver = IRDMA_ABI_VER;
 662                 err_code = irdma_setup_kmode_qp(iwdev, iwqp, &init_info, init_attr);
 663         }
 664
 665         if (err_code) {
 666                 irdma_debug(iwdev_to_idev(iwdev), IRDMA_DEBUG_VERBS,
 667                             "setup qp failed\n");
 668                 goto error;
 669         }
 670
 671         if (rdma_protocol_roce(&iwdev->ibdev, 1)) {
 672                 if (init_attr->qp_type == IB_QPT_RC) {
 673                         init_info.qp_uk_init_info.type = IRDMA_QP_TYPE_ROCE_RC;
 674                         init_info.qp_uk_init_info.qp_caps = IRDMA_SEND_WITH_IMM |
 675                             IRDMA_WRITE_WITH_IMM |
 676                             IRDMA_ROCE;
 677                 } else {
 678                         init_info.qp_uk_init_info.type = IRDMA_QP_TYPE_ROCE_UD;
 679                         init_info.qp_uk_init_info.qp_caps = IRDMA_SEND_WITH_IMM |
 680                             IRDMA_ROCE;
 681                 }
 682         } else {
 683                 init_info.qp_uk_init_info.type = IRDMA_QP_TYPE_IWARP;
 684                 init_info.qp_uk_init_info.qp_caps = IRDMA_WRITE_WITH_IMM;
 685         }
 686
 687         ret = irdma_sc_qp_init(qp, &init_info);
 688         if (ret) {
 689                 err_code = -EPROTO;
 690                 irdma_debug(iwdev_to_idev(iwdev), IRDMA_DEBUG_VERBS,
 691                             "qp_init fail\n");
 692                 goto error;
 693         }
 694
 695         ctx_info = &iwqp->ctx_info;
 696         ctx_info->send_cq_num = iwqp->iwscq->sc_cq.cq_uk.cq_id;
 697         ctx_info->rcv_cq_num = iwqp->iwrcq->sc_cq.cq_uk.cq_id;
 698
 699         if (rdma_protocol_roce(&iwdev->ibdev, 1))
 700                 irdma_roce_fill_and_set_qpctx_info(iwqp, ctx_info);
 701         else
 702                 irdma_iw_fill_and_set_qpctx_info(iwqp, ctx_info);
 703
 704         err_code = irdma_cqp_create_qp_cmd(iwqp);
 705         if (err_code)
 706                 goto error;
 707
 708         atomic_set(&iwqp->refcnt, 1);
 709         spin_lock_init(&iwqp->lock);
 710         spin_lock_init(&iwqp->sc_qp.pfpdu.lock);
 711         iwqp->sig_all = (init_attr->sq_sig_type == IB_SIGNAL_ALL_WR) ? 1 : 0;
 712         rf->qp_table[qp_num] = iwqp;
 713         iwqp->max_send_wr = sq_size;
 714         iwqp->max_recv_wr = rq_size;
 715
 716         if (rdma_protocol_roce(&iwdev->ibdev, 1)) {
 717                 if (dev->ws_add(&iwdev->vsi, 0)) {
 718                         irdma_cqp_qp_destroy_cmd(&rf->sc_dev, &iwqp->sc_qp);
 719                         err_code = -EINVAL;
 720                         goto error;
 721                 }
 722
 723                 irdma_qp_add_qos(&iwqp->sc_qp);
 724         }
 725
 726         if (udata) {
 727                 /* GEN_1 legacy support with libi40iw does not have expanded uresp struct */
 728                 if (udata->outlen < sizeof(uresp)) {
 729                         uresp.lsmm = 1;
 730                         uresp.push_idx = IRDMA_INVALID_PUSH_PAGE_INDEX_GEN_1;
 731                 } else {
 732                         if (rdma_protocol_iwarp(&iwdev->ibdev, 1))
 733                                 uresp.lsmm = 1;
 734                 }
 735                 uresp.actual_sq_size = sq_size;
 736                 uresp.actual_rq_size = rq_size;
 737                 uresp.qp_id = qp_num;
 738                 uresp.qp_caps = qp->qp_uk.qp_caps;
 739
 740                 err_code = ib_copy_to_udata(udata, &uresp,
 741                                             min(sizeof(uresp), udata->outlen));
 742                 if (err_code) {
 743                         irdma_debug(iwdev_to_idev(iwdev), IRDMA_DEBUG_VERBS,
 744                                     "copy_to_udata failed\n");
 745                         kc_irdma_destroy_qp(&iwqp->ibqp, udata);
 746                         return ERR_PTR(err_code);
 747                 }
 748         }
 749
 750         init_completion(&iwqp->free_qp);
 751         return &iwqp->ibqp;
 752
 753 error:
 754         irdma_free_qp_rsrc(iwqp);
 755
 756         return ERR_PTR(err_code);
 757 }
 758
 759 /**
 760  * irdma_destroy_qp - destroy qp
 761  * @ibqp: qp's ib pointer also to get to device's qp address
 762  * @udata: user data
 763  */
 764 int
 765 irdma_destroy_qp(struct ib_qp *ibqp, struct ib_udata *udata)
 766 {
 767         struct irdma_qp *iwqp = to_iwqp(ibqp);
 768         struct irdma_device *iwdev = iwqp->iwdev;
 769
 770         if (iwqp->sc_qp.qp_uk.destroy_pending)
 771                 goto free_rsrc;
 772         iwqp->sc_qp.qp_uk.destroy_pending = true;
 773         if (iwqp->iwarp_state == IRDMA_QP_STATE_RTS)
 774                 irdma_modify_qp_to_err(&iwqp->sc_qp);
 775
 776         if (!iwqp->user_mode)
 777                 cancel_delayed_work_sync(&iwqp->dwork_flush);
 778
 779         irdma_qp_rem_ref(&iwqp->ibqp);
 780         wait_for_completion(&iwqp->free_qp);
 781         irdma_free_lsmm_rsrc(iwqp);
 782         if (!iwdev->rf->reset &&
 783             irdma_cqp_qp_destroy_cmd(&iwdev->rf->sc_dev, &iwqp->sc_qp))
 784                 return -ENOTRECOVERABLE;
 785 free_rsrc:
 786         if (!iwqp->user_mode) {
 787                 if (iwqp->iwscq) {
 788                         irdma_clean_cqes(iwqp, iwqp->iwscq);
 789                         if (iwqp->iwrcq != iwqp->iwscq)
 790                                 irdma_clean_cqes(iwqp, iwqp->iwrcq);
 791                 }
 792         }
 793         irdma_remove_push_mmap_entries(iwqp);
 794         irdma_free_qp_rsrc(iwqp);
 795
 796         return 0;
 797 }
 798
 799 /**
 800  * irdma_create_cq - create cq
 801  * @ibcq: CQ allocated
 802  * @attr: attributes for cq
 803  * @udata: user data
 804  */
 805 int
 806 irdma_create_cq(struct ib_cq *ibcq,
 807                 const struct ib_cq_init_attr *attr,
 808                 struct ib_udata *udata)
 809 {
 810         struct ib_device *ibdev = ibcq->device;
 811         struct irdma_device *iwdev = to_iwdev(ibdev);
 812         struct irdma_pci_f *rf = iwdev->rf;
 813         struct irdma_cq *iwcq = to_iwcq(ibcq);
 814         u32 cq_num = 0;
 815         struct irdma_sc_cq *cq;
 816         struct irdma_sc_dev *dev = &rf->sc_dev;
 817         struct irdma_cq_init_info info = {0};
 818         int status;
 819         struct irdma_cqp_request *cqp_request;
 820         struct cqp_cmds_info *cqp_info;
 821         struct irdma_cq_uk_init_info *ukinfo = &info.cq_uk_init_info;
 822         unsigned long flags;
 823         int err_code;
 824         int entries = attr->cqe;
 825
 826         err_code = cq_validate_flags(attr->flags, dev->hw_attrs.uk_attrs.hw_rev);
 827         if (err_code)
 828                 return err_code;
 829         err_code = irdma_alloc_rsrc(rf, rf->allocated_cqs, rf->max_cq, &cq_num,
 830                                     &rf->next_cq);
 831         if (err_code)
 832                 return err_code;
 833         cq = &iwcq->sc_cq;
 834         cq->back_cq = iwcq;
 835         atomic_set(&iwcq->refcnt, 1);
 836         spin_lock_init(&iwcq->lock);
 837         INIT_LIST_HEAD(&iwcq->resize_list);
 838         INIT_LIST_HEAD(&iwcq->cmpl_generated);
 839         info.dev = dev;
 840         ukinfo->cq_size = max(entries, 4);
 841         ukinfo->cq_id = cq_num;
 842         iwcq->ibcq.cqe = info.cq_uk_init_info.cq_size;
 843         if (attr->comp_vector < rf->ceqs_count)
 844                 info.ceq_id = attr->comp_vector;
 845         info.ceq_id_valid = true;
 846         info.ceqe_mask = 1;
 847         info.type = IRDMA_CQ_TYPE_IWARP;
 848         info.vsi = &iwdev->vsi;
 849
 850         if (udata) {
 851                 struct irdma_ucontext *ucontext;
 852                 struct irdma_create_cq_req req = {0};
 853                 struct irdma_cq_mr *cqmr;
 854                 struct irdma_pbl *iwpbl;
 855                 struct irdma_pbl *iwpbl_shadow;
 856                 struct irdma_cq_mr *cqmr_shadow;
 857
 858                 iwcq->user_mode = true;
 859                 ucontext = rdma_udata_to_drv_context(udata, struct irdma_ucontext, ibucontext);
 860                 if (ib_copy_from_udata(&req, udata,
 861                                        min(sizeof(req), udata->inlen))) {
 862                         err_code = -EFAULT;
 863                         goto cq_free_rsrc;
 864                 }
 865
 866                 spin_lock_irqsave(&ucontext->cq_reg_mem_list_lock, flags);
 867                 iwpbl = irdma_get_pbl((unsigned long)req.user_cq_buf,
 868                                       &ucontext->cq_reg_mem_list);
 869                 spin_unlock_irqrestore(&ucontext->cq_reg_mem_list_lock, flags);
 870                 if (!iwpbl) {
 871                         err_code = -EPROTO;
 872                         goto cq_free_rsrc;
 873                 }
 874                 iwcq->iwpbl = iwpbl;
 875                 iwcq->cq_mem_size = 0;
 876                 cqmr = &iwpbl->cq_mr;
 877
 878                 if (rf->sc_dev.hw_attrs.uk_attrs.feature_flags &
 879                     IRDMA_FEATURE_CQ_RESIZE && !ucontext->legacy_mode) {
 880                         spin_lock_irqsave(&ucontext->cq_reg_mem_list_lock, flags);
 881                         iwpbl_shadow = irdma_get_pbl((unsigned long)req.user_shadow_area,
 882                                                      &ucontext->cq_reg_mem_list);
 883                         spin_unlock_irqrestore(&ucontext->cq_reg_mem_list_lock, flags);
 884
 885                         if (!iwpbl_shadow) {
 886                                 err_code = -EPROTO;
 887                                 goto cq_free_rsrc;
 888                         }
 889                         iwcq->iwpbl_shadow = iwpbl_shadow;
 890                         cqmr_shadow = &iwpbl_shadow->cq_mr;
 891                         info.shadow_area_pa = cqmr_shadow->cq_pbl.addr;
 892                         cqmr->split = true;
 893                 } else {
 894                         info.shadow_area_pa = cqmr->shadow;
 895                 }
 896                 if (iwpbl->pbl_allocated) {
 897                         info.virtual_map = true;
 898                         info.pbl_chunk_size = 1;
 899                         info.first_pm_pbl_idx = cqmr->cq_pbl.idx;
 900                 } else {
 901                         info.cq_base_pa = cqmr->cq_pbl.addr;
 902                 }
 903         } else {
 904                 /* Kmode allocations */
 905                 int rsize;
 906
 907                 if (entries < 1 || entries > rf->max_cqe) {
 908                         err_code = -EINVAL;
 909                         goto cq_free_rsrc;
 910                 }
 911
 912                 entries++;
 913                 if (dev->hw_attrs.uk_attrs.hw_rev >= IRDMA_GEN_2)
 914                         entries *= 2;
 915                 ukinfo->cq_size = entries;
 916
 917                 rsize = info.cq_uk_init_info.cq_size * sizeof(struct irdma_cqe);
 918                 iwcq->kmem.size = round_up(rsize, 256);
 919                 iwcq->kmem.va = irdma_allocate_dma_mem(dev->hw, &iwcq->kmem,
 920                                                        iwcq->kmem.size, 256);
 921                 if (!iwcq->kmem.va) {
 922                         err_code = -ENOMEM;
 923                         goto cq_free_rsrc;
 924                 }
 925
 926                 iwcq->kmem_shadow.size = IRDMA_SHADOW_AREA_SIZE << 3;
 927                 iwcq->kmem_shadow.va = irdma_allocate_dma_mem(dev->hw,
 928                                                               &iwcq->kmem_shadow,
 929                                                               iwcq->kmem_shadow.size,
 930                                                               64);
 931
 932                 if (!iwcq->kmem_shadow.va) {
 933                         err_code = -ENOMEM;
 934                         goto cq_free_rsrc;
 935                 }
 936                 info.shadow_area_pa = iwcq->kmem_shadow.pa;
 937                 ukinfo->shadow_area = iwcq->kmem_shadow.va;
 938                 ukinfo->cq_base = iwcq->kmem.va;
 939                 info.cq_base_pa = iwcq->kmem.pa;
 940         }
 941
 942         if (dev->hw_attrs.uk_attrs.hw_rev >= IRDMA_GEN_2)
 943                 info.shadow_read_threshold = min(info.cq_uk_init_info.cq_size / 2,
 944                                                  (u32)IRDMA_MAX_CQ_READ_THRESH);
 945         if (irdma_sc_cq_init(cq, &info)) {
 946                 irdma_debug(iwdev_to_idev(iwdev), IRDMA_DEBUG_VERBS,
 947                             "init cq fail\n");
 948                 err_code = -EPROTO;
 949                 goto cq_free_rsrc;
 950         }
 951
 952         cqp_request = irdma_alloc_and_get_cqp_request(&rf->cqp, true);
 953         if (!cqp_request) {
 954                 err_code = -ENOMEM;
 955                 goto cq_free_rsrc;
 956         }
 957         cqp_info = &cqp_request->info;
 958         cqp_info->cqp_cmd = IRDMA_OP_CQ_CREATE;
 959         cqp_info->post_sq = 1;
 960         cqp_info->in.u.cq_create.cq = cq;
 961         cqp_info->in.u.cq_create.check_overflow = true;
 962         cqp_info->in.u.cq_create.scratch = (uintptr_t)cqp_request;
 963         status = irdma_handle_cqp_op(rf, cqp_request);
 964         irdma_put_cqp_request(&rf->cqp, cqp_request);
 965         if (status) {
 966                 err_code = -ENOMEM;
 967                 goto cq_free_rsrc;
 968         }
 969
 970         if (udata) {
 971                 struct irdma_create_cq_resp resp = {0};
 972
 973                 resp.cq_id = info.cq_uk_init_info.cq_id;
 974                 resp.cq_size = info.cq_uk_init_info.cq_size;
 975                 if (ib_copy_to_udata(udata, &resp,
 976                                      min(sizeof(resp), udata->outlen))) {
 977                         irdma_debug(iwdev_to_idev(iwdev), IRDMA_DEBUG_VERBS,
 978                                     "copy to user data\n");
 979                         err_code = -EPROTO;
 980                         goto cq_destroy;
 981                 }
 982         }
 983
 984         rf->cq_table[cq_num] = iwcq;
 985         init_completion(&iwcq->free_cq);
 986
 987         return 0;
 988 cq_destroy:
 989         irdma_cq_wq_destroy(rf, cq);
 990 cq_free_rsrc:
 991         irdma_cq_free_rsrc(rf, iwcq);
 992         return err_code;
 993 }
 994
 995 /**
 996  * irdma_copy_user_pgaddrs - copy user page address to pble's os locally
 997  * @iwmr: iwmr for IB's user page addresses
 998  * @pbl: ple pointer to save 1 level or 0 level pble
 999  * @level: indicated level 0, 1 or 2
1000  */
1001
1002 void
1003 irdma_copy_user_pgaddrs(struct irdma_mr *iwmr, u64 *pbl,
1004                         enum irdma_pble_level level)
1005 {
1006         struct ib_umem *region = iwmr->region;
1007         struct irdma_pbl *iwpbl = &iwmr->iwpbl;
1008         int chunk_pages, entry, i;
1009         struct scatterlist *sg;
1010         u64 pg_addr = 0;
1011         struct irdma_pble_alloc *palloc = &iwpbl->pble_alloc;
1012         struct irdma_pble_info *pinfo;
1013         u32 idx = 0;
1014         u32 pbl_cnt = 0;
1015
1016         pinfo = (level == PBLE_LEVEL_1) ? NULL : palloc->level2.leaf;
1017         for_each_sg(region->sg_head.sgl, sg, region->nmap, entry) {
1018                 chunk_pages = DIV_ROUND_UP(sg_dma_len(sg), iwmr->page_size);
1019                 if (iwmr->type == IRDMA_MEMREG_TYPE_QP && !iwpbl->qp_mr.sq_page)
1020                         iwpbl->qp_mr.sq_page = sg_page(sg);
1021                 for (i = 0; i < chunk_pages; i++) {
1022                         pg_addr = sg_dma_address(sg) + (i * iwmr->page_size);
1023                         if ((entry + i) == 0)
1024                                 *pbl = pg_addr & iwmr->page_msk;
1025                         else if (!(pg_addr & ~iwmr->page_msk))
1026                                 *pbl = pg_addr;
1027                         else
1028                                 continue;
1029                         if (++pbl_cnt == palloc->total_cnt)
1030                                 break;
1031                         pbl = irdma_next_pbl_addr(pbl, &pinfo, &idx);
1032                 }
1033         }
1034 }
1035
1036 /**
1037  * irdma_destroy_ah - Destroy address handle
1038  * @ibah: pointer to address handle
1039  * @ah_flags: destroy flags
1040  */
1041
1042 void
1043 irdma_destroy_ah(struct ib_ah *ibah, u32 ah_flags)
1044 {
1045         struct irdma_device *iwdev = to_iwdev(ibah->device);
1046         struct irdma_ah *ah = to_iwah(ibah);
1047
1048         irdma_ah_cqp_op(iwdev->rf, &ah->sc_ah, IRDMA_OP_AH_DESTROY,
1049                         false, NULL, ah);
1050
1051         irdma_free_rsrc(iwdev->rf, iwdev->rf->allocated_ahs,
1052                         ah->sc_ah.ah_info.ah_idx);
1053 }
1054
1055 int
1056 irdma_dereg_mr(struct ib_mr *ib_mr, struct ib_udata *udata)
1057 {
1058         struct ib_pd *ibpd = ib_mr->pd;
1059         struct irdma_pd *iwpd = to_iwpd(ibpd);
1060         struct irdma_mr *iwmr = to_iwmr(ib_mr);
1061         struct irdma_device *iwdev = to_iwdev(ib_mr->device);
1062         struct irdma_dealloc_stag_info *info;
1063         struct irdma_pbl *iwpbl = &iwmr->iwpbl;
1064         struct irdma_pble_alloc *palloc = &iwpbl->pble_alloc;
1065         struct irdma_cqp_request *cqp_request;
1066         struct cqp_cmds_info *cqp_info;
1067         int status;
1068
1069         if (iwmr->type != IRDMA_MEMREG_TYPE_MEM) {
1070                 if (iwmr->region) {
1071                         struct irdma_ucontext *ucontext;
1072
1073                         ucontext = rdma_udata_to_drv_context(udata, struct irdma_ucontext, ibucontext);
1074                         irdma_del_memlist(iwmr, ucontext);
1075                 }
1076                 goto done;
1077         }
1078
1079         cqp_request = irdma_alloc_and_get_cqp_request(&iwdev->rf->cqp, true);
1080         if (!cqp_request)
1081                 return -ENOMEM;
1082
1083         cqp_info = &cqp_request->info;
1084         info = &cqp_info->in.u.dealloc_stag.info;
1085         memset(info, 0, sizeof(*info));
1086         info->pd_id = iwpd->sc_pd.pd_id & 0x00007fff;
1087         info->stag_idx = RS_64_1(ib_mr->rkey, IRDMA_CQPSQ_STAG_IDX_S);
1088         info->mr = true;
1089         if (iwpbl->pbl_allocated)
1090                 info->dealloc_pbl = true;
1091
1092         cqp_info->cqp_cmd = IRDMA_OP_DEALLOC_STAG;
1093         cqp_info->post_sq = 1;
1094         cqp_info->in.u.dealloc_stag.dev = &iwdev->rf->sc_dev;
1095         cqp_info->in.u.dealloc_stag.scratch = (uintptr_t)cqp_request;
1096         status = irdma_handle_cqp_op(iwdev->rf, cqp_request);
1097         irdma_put_cqp_request(&iwdev->rf->cqp, cqp_request);
1098         if (status)
1099                 return status;
1100
1101         irdma_free_stag(iwdev, iwmr->stag);
1102 done:
1103         if (iwpbl->pbl_allocated)
1104                 irdma_free_pble(iwdev->rf->pble_rsrc, palloc);
1105
1106         if (iwmr->region)
1107                 ib_umem_release(iwmr->region);
1108         kfree(iwmr);
1109
1110         return 0;
1111 }
1112
1113 int
1114 kc_irdma_set_roce_cm_info(struct irdma_qp *iwqp, struct ib_qp_attr *attr,
1115                           u16 *vlan_id)
1116 {
1117         int ret;
1118         union ib_gid sgid;
1119         struct ib_gid_attr sgid_attr;
1120         struct irdma_av *av = &iwqp->roce_ah.av;
1121
1122         ret = ib_get_cached_gid(iwqp->ibqp.device, attr->ah_attr.port_num,
1123                                 attr->ah_attr.grh.sgid_index, &sgid,
1124                                 &sgid_attr);
1125         if (ret)
1126                 return ret;
1127
1128         if (sgid_attr.ndev) {
1129                 *vlan_id = rdma_vlan_dev_vlan_id(sgid_attr.ndev);
1130                 ether_addr_copy(iwqp->ctx_info.roce_info->mac_addr, IF_LLADDR(sgid_attr.ndev));
1131         }
1132
1133         rdma_gid2ip((struct sockaddr *)&av->sgid_addr, &sgid);
1134
1135         dev_put(sgid_attr.ndev);
1136
1137         return 0;
1138 }
1139
1140 /**
1141  * irdma_destroy_cq - destroy cq
1142  * @ib_cq: cq pointer
1143  * @udata: user data
1144  */
1145 void
1146 irdma_destroy_cq(struct ib_cq *ib_cq, struct ib_udata *udata)
1147 {
1148         struct irdma_device *iwdev = to_iwdev(ib_cq->device);
1149         struct irdma_cq *iwcq = to_iwcq(ib_cq);
1150         struct irdma_sc_cq *cq = &iwcq->sc_cq;
1151         struct irdma_sc_dev *dev = cq->dev;
1152         struct irdma_sc_ceq *ceq = dev->ceq[cq->ceq_id];
1153         struct irdma_ceq *iwceq = container_of(ceq, struct irdma_ceq, sc_ceq);
1154         unsigned long flags;
1155
1156         spin_lock_irqsave(&iwcq->lock, flags);
1157         if (!list_empty(&iwcq->cmpl_generated))
1158                 irdma_remove_cmpls_list(iwcq);
1159         if (!list_empty(&iwcq->resize_list))
1160                 irdma_process_resize_list(iwcq, iwdev, NULL);
1161         spin_unlock_irqrestore(&iwcq->lock, flags);
1162
1163         irdma_cq_rem_ref(ib_cq);
1164         wait_for_completion(&iwcq->free_cq);
1165
1166         irdma_cq_wq_destroy(iwdev->rf, cq);
1167         irdma_cq_free_rsrc(iwdev->rf, iwcq);
1168
1169         spin_lock_irqsave(&iwceq->ce_lock, flags);
1170         irdma_sc_cleanup_ceqes(cq, ceq);
1171         spin_unlock_irqrestore(&iwceq->ce_lock, flags);
1172 }
1173
1174 /**
1175  * irdma_alloc_mw - Allocate memory window
1176  * @pd: Protection domain
1177  * @type: Window type
1178  * @udata: user data pointer
1179  */
1180 struct ib_mw *
1181 irdma_alloc_mw(struct ib_pd *pd, enum ib_mw_type type,
1182                struct ib_udata *udata)
1183 {
1184         struct irdma_device *iwdev = to_iwdev(pd->device);
1185         struct irdma_mr *iwmr;
1186         int err_code;
1187         u32 stag;
1188
1189         iwmr = kzalloc(sizeof(*iwmr), GFP_KERNEL);
1190         if (!iwmr)
1191                 return ERR_PTR(-ENOMEM);
1192
1193         stag = irdma_create_stag(iwdev);
1194         if (!stag) {
1195                 kfree(iwmr);
1196                 return ERR_PTR(-ENOMEM);
1197         }
1198
1199         iwmr->stag = stag;
1200         iwmr->ibmw.rkey = stag;
1201         iwmr->ibmw.pd = pd;
1202         iwmr->ibmw.type = type;
1203         iwmr->ibmw.device = pd->device;
1204
1205         err_code = irdma_hw_alloc_mw(iwdev, iwmr);
1206         if (err_code) {
1207                 irdma_free_stag(iwdev, stag);
1208                 kfree(iwmr);
1209                 return ERR_PTR(err_code);
1210         }
1211
1212         return &iwmr->ibmw;
1213 }
1214
1215 /**
1216  * kc_set_loc_seq_num_mss - Set local seq number and mss
1217  * @cm_node: cm node info
1218  */
1219 void
1220 kc_set_loc_seq_num_mss(struct irdma_cm_node *cm_node)
1221 {
1222         struct timespec ts;
1223
1224         getnanotime(&ts);
1225         cm_node->tcp_cntxt.loc_seq_num = ts.tv_nsec;
1226         if (cm_node->iwdev->vsi.mtu > 1500 &&
1227             2 * cm_node->iwdev->vsi.mtu > cm_node->iwdev->rcv_wnd)
1228                 cm_node->tcp_cntxt.mss = (cm_node->ipv4) ?
1229                     (1500 - IRDMA_MTU_TO_MSS_IPV4) :
1230                     (1500 - IRDMA_MTU_TO_MSS_IPV6);
1231         else
1232                 cm_node->tcp_cntxt.mss = (cm_node->ipv4) ?
1233                     (cm_node->iwdev->vsi.mtu - IRDMA_MTU_TO_MSS_IPV4) :
1234                     (cm_node->iwdev->vsi.mtu - IRDMA_MTU_TO_MSS_IPV6);
1235 }
1236
1237 /**
1238  * irdma_disassociate_ucontext - Disassociate user context
1239  * @context: ib user context
1240  */
1241 void
1242 irdma_disassociate_ucontext(struct ib_ucontext *context)
1243 {
1244 }
1245
1246 struct ib_device *
1247 ib_device_get_by_netdev(struct ifnet *netdev, int driver_id)
1248 {
1249         struct irdma_device *iwdev;
1250         struct irdma_handler *hdl;
1251         unsigned long flags;
1252
1253         spin_lock_irqsave(&irdma_handler_lock, flags);
1254         list_for_each_entry(hdl, &irdma_handlers, list) {
1255                 iwdev = hdl->iwdev;
1256                 if (netdev == iwdev->netdev) {
1257                         spin_unlock_irqrestore(&irdma_handler_lock,
1258                                                flags);
1259                         return &iwdev->ibdev;
1260                 }
1261         }
1262         spin_unlock_irqrestore(&irdma_handler_lock, flags);
1263
1264         return NULL;
1265 }
1266
1267 void
1268 ib_unregister_device_put(struct ib_device *device)
1269 {
1270         ib_unregister_device(device);
1271 }
1272
1273 /**
1274  * irdma_query_gid_roce - Query port GID for Roce
1275  * @ibdev: device pointer from stack
1276  * @port: port number
1277  * @index: Entry index
1278  * @gid: Global ID
1279  */
1280 int
1281 irdma_query_gid_roce(struct ib_device *ibdev, u8 port, int index,
1282                      union ib_gid *gid)
1283 {
1284         int ret;
1285
1286         ret = rdma_query_gid(ibdev, port, index, gid);
1287         if (ret == -EAGAIN) {
1288                 memcpy(gid, &zgid, sizeof(*gid));
1289                 return 0;
1290         }
1291
1292         return ret;
1293 }
1294
1295 /**
1296  * irdma_modify_port - modify port attributes
1297  * @ibdev: device pointer from stack
1298  * @port: port number for query
1299  * @mask: Property mask
1300  * @props: returning device attributes
1301  */
1302 int
1303 irdma_modify_port(struct ib_device *ibdev, u8 port, int mask,
1304                   struct ib_port_modify *props)
1305 {
1306         if (port > 1)
1307                 return -EINVAL;
1308
1309         return 0;
1310 }
1311
1312 /**
1313  * irdma_query_pkey - Query partition key
1314  * @ibdev: device pointer from stack
1315  * @port: port number
1316  * @index: index of pkey
1317  * @pkey: pointer to store the pkey
1318  */
1319 int
1320 irdma_query_pkey(struct ib_device *ibdev, u8 port, u16 index,
1321                  u16 *pkey)
1322 {
1323         if (index >= IRDMA_PKEY_TBL_SZ)
1324                 return -EINVAL;
1325
1326         *pkey = IRDMA_DEFAULT_PKEY;
1327         return 0;
1328 }
1329
1330 int
1331 irdma_roce_port_immutable(struct ib_device *ibdev, u8 port_num,
1332                           struct ib_port_immutable *immutable)
1333 {
1334         struct ib_port_attr attr;
1335         int err;
1336
1337         immutable->core_cap_flags = RDMA_CORE_PORT_IBA_ROCE_UDP_ENCAP;
1338         err = ib_query_port(ibdev, port_num, &attr);
1339         if (err)
1340                 return err;
1341
1342         immutable->max_mad_size = IB_MGMT_MAD_SIZE;
1343         immutable->pkey_tbl_len = attr.pkey_tbl_len;
1344         immutable->gid_tbl_len = attr.gid_tbl_len;
1345
1346         return 0;
1347 }
1348
1349 int
1350 irdma_iw_port_immutable(struct ib_device *ibdev, u8 port_num,
1351                         struct ib_port_immutable *immutable)
1352 {
1353         struct ib_port_attr attr;
1354         int err;
1355
1356         immutable->core_cap_flags = RDMA_CORE_PORT_IWARP;
1357         err = ib_query_port(ibdev, port_num, &attr);
1358         if (err)
1359                 return err;
1360         immutable->gid_tbl_len = 1;
1361
1362         return 0;
1363 }
1364
1365 /**
1366  * irdma_get_eth_speed_and_width - Get IB port speed and width from netdev speed
1367  * @link_speed: netdev phy link speed
1368  * @active_speed: IB port speed
1369  * @active_width: IB port width
1370  */
1371 void
1372 irdma_get_eth_speed_and_width(u32 link_speed, u8 *active_speed,
1373                               u8 *active_width)
1374 {
1375         if (link_speed <= SPEED_1000) {
1376                 *active_width = IB_WIDTH_1X;
1377                 *active_speed = IB_SPEED_SDR;
1378         } else if (link_speed <= SPEED_10000) {
1379                 *active_width = IB_WIDTH_1X;
1380                 *active_speed = IB_SPEED_FDR10;
1381         } else if (link_speed <= SPEED_20000) {
1382                 *active_width = IB_WIDTH_4X;
1383                 *active_speed = IB_SPEED_DDR;
1384         } else if (link_speed <= SPEED_25000) {
1385                 *active_width = IB_WIDTH_1X;
1386                 *active_speed = IB_SPEED_EDR;
1387         } else if (link_speed <= SPEED_40000) {
1388                 *active_width = IB_WIDTH_4X;
1389                 *active_speed = IB_SPEED_FDR10;
1390         } else {
1391                 *active_width = IB_WIDTH_4X;
1392                 *active_speed = IB_SPEED_EDR;
1393         }
1394 }
1395
1396 /**
1397  * irdma_query_port - get port attributes
1398  * @ibdev: device pointer from stack
1399  * @port: port number for query
1400  * @props: returning device attributes
1401  */
1402 int
1403 irdma_query_port(struct ib_device *ibdev, u8 port,
1404                  struct ib_port_attr *props)
1405 {
1406         struct irdma_device *iwdev = to_iwdev(ibdev);
1407         struct ifnet *netdev = iwdev->netdev;
1408
1409         /* no need to zero out pros here. done by caller */
1410
1411         props->max_mtu = IB_MTU_4096;
1412         props->active_mtu = ib_mtu_int_to_enum(netdev->if_mtu);
1413         props->lid = 1;
1414         props->lmc = 0;
1415         props->sm_lid = 0;
1416         props->sm_sl = 0;
1417         if ((netdev->if_link_state == LINK_STATE_UP) && (netdev->if_drv_flags & IFF_DRV_RUNNING)) {
1418                 props->state = IB_PORT_ACTIVE;
1419                 props->phys_state = IB_PORT_PHYS_STATE_LINK_UP;
1420         } else {
1421                 props->state = IB_PORT_DOWN;
1422                 props->phys_state = IB_PORT_PHYS_STATE_DISABLED;
1423         }
1424         irdma_get_eth_speed_and_width(SPEED_100000, &props->active_speed,
1425                                       &props->active_width);
1426
1427         if (rdma_protocol_roce(ibdev, 1)) {
1428                 props->gid_tbl_len = 32;
1429                 kc_set_props_ip_gid_caps(props);
1430                 props->pkey_tbl_len = IRDMA_PKEY_TBL_SZ;
1431         } else {
1432                 props->gid_tbl_len = 1;
1433         }
1434         props->qkey_viol_cntr = 0;
1435         props->port_cap_flags |= IB_PORT_CM_SUP | IB_PORT_REINIT_SUP;
1436         props->max_msg_sz = iwdev->rf->sc_dev.hw_attrs.max_hw_outbound_msg_size;
1437
1438         return 0;
1439 }
1440
1441 extern const char *const irdma_hw_stat_names[];
1442
1443 /**
1444  * irdma_alloc_hw_stats - Allocate a hw stats structure
1445  * @ibdev: device pointer from stack
1446  * @port_num: port number
1447  */
1448 struct rdma_hw_stats *
1449 irdma_alloc_hw_stats(struct ib_device *ibdev,
1450                      u8 port_num)
1451 {
1452         struct irdma_device *iwdev = to_iwdev(ibdev);
1453         struct irdma_sc_dev *dev = &iwdev->rf->sc_dev;
1454
1455         int num_counters = dev->hw_attrs.max_stat_idx;
1456         unsigned long lifespan = RDMA_HW_STATS_DEFAULT_LIFESPAN;
1457
1458         return rdma_alloc_hw_stats_struct(irdma_hw_stat_names, num_counters,
1459                                           lifespan);
1460 }
1461
1462 /**
1463  * irdma_get_hw_stats - Populates the rdma_hw_stats structure
1464  * @ibdev: device pointer from stack
1465  * @stats: stats pointer from stack
1466  * @port_num: port number
1467  * @index: which hw counter the stack is requesting we update
1468  */
1469 int
1470 irdma_get_hw_stats(struct ib_device *ibdev,
1471                    struct rdma_hw_stats *stats, u8 port_num,
1472                    int index)
1473 {
1474         struct irdma_device *iwdev = to_iwdev(ibdev);
1475         struct irdma_dev_hw_stats *hw_stats = &iwdev->vsi.pestat->hw_stats;
1476
1477         if (iwdev->rf->rdma_ver >= IRDMA_GEN_2)
1478                 irdma_cqp_gather_stats_cmd(&iwdev->rf->sc_dev, iwdev->vsi.pestat, true);
1479
1480         memcpy(&stats->value[0], hw_stats, sizeof(u64)* stats->num_counters);
1481
1482         return stats->num_counters;
1483 }
1484
1485 /**
1486  * irdma_query_gid - Query port GID
1487  * @ibdev: device pointer from stack
1488  * @port: port number
1489  * @index: Entry index
1490  * @gid: Global ID
1491  */
1492 int
1493 irdma_query_gid(struct ib_device *ibdev, u8 port, int index,
1494                 union ib_gid *gid)
1495 {
1496         struct irdma_device *iwdev = to_iwdev(ibdev);
1497
1498         memset(gid->raw, 0, sizeof(gid->raw));
1499         ether_addr_copy(gid->raw, IF_LLADDR(iwdev->netdev));
1500
1501         return 0;
1502 }
1503
1504 enum rdma_link_layer
1505 irdma_get_link_layer(struct ib_device *ibdev,
1506                      u8 port_num)
1507 {
1508         return IB_LINK_LAYER_ETHERNET;
1509 }
1510
1511 inline enum ib_mtu
1512 ib_mtu_int_to_enum(int mtu)
1513 {
1514         if (mtu >= 4096)
1515                 return IB_MTU_4096;
1516         else if (mtu >= 2048)
1517                 return IB_MTU_2048;
1518         else if (mtu >= 1024)
1519                 return IB_MTU_1024;
1520         else if (mtu >= 512)
1521                 return IB_MTU_512;
1522         else
1523                 return IB_MTU_256;
1524 }
1525
1526 inline void
1527 kc_set_roce_uverbs_cmd_mask(struct irdma_device *iwdev)
1528 {
1529         iwdev->ibdev.uverbs_cmd_mask |=
1530             BIT_ULL(IB_USER_VERBS_CMD_ATTACH_MCAST) |
1531             BIT_ULL(IB_USER_VERBS_CMD_CREATE_AH) |
1532             BIT_ULL(IB_USER_VERBS_CMD_DESTROY_AH) |
1533             BIT_ULL(IB_USER_VERBS_CMD_DETACH_MCAST);
1534 }
1535
1536 inline void
1537 kc_set_rdma_uverbs_cmd_mask(struct irdma_device *iwdev)
1538 {
1539         iwdev->ibdev.uverbs_cmd_mask =
1540             BIT_ULL(IB_USER_VERBS_CMD_GET_CONTEXT) |
1541             BIT_ULL(IB_USER_VERBS_CMD_QUERY_DEVICE) |
1542             BIT_ULL(IB_USER_VERBS_CMD_QUERY_PORT) |
1543             BIT_ULL(IB_USER_VERBS_CMD_ALLOC_PD) |
1544             BIT_ULL(IB_USER_VERBS_CMD_DEALLOC_PD) |
1545             BIT_ULL(IB_USER_VERBS_CMD_REG_MR) |
1546             BIT_ULL(IB_USER_VERBS_CMD_DEREG_MR) |
1547             BIT_ULL(IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL) |
1548             BIT_ULL(IB_USER_VERBS_CMD_CREATE_CQ) |
1549             BIT_ULL(IB_USER_VERBS_CMD_RESIZE_CQ) |
1550             BIT_ULL(IB_USER_VERBS_CMD_DESTROY_CQ) |
1551             BIT_ULL(IB_USER_VERBS_CMD_REQ_NOTIFY_CQ) |
1552             BIT_ULL(IB_USER_VERBS_CMD_CREATE_QP) |
1553             BIT_ULL(IB_USER_VERBS_CMD_MODIFY_QP) |
1554             BIT_ULL(IB_USER_VERBS_CMD_QUERY_QP) |
1555             BIT_ULL(IB_USER_VERBS_CMD_POLL_CQ) |
1556             BIT_ULL(IB_USER_VERBS_CMD_DESTROY_QP) |
1557             BIT_ULL(IB_USER_VERBS_CMD_ALLOC_MW) |
1558             BIT_ULL(IB_USER_VERBS_CMD_BIND_MW) |
1559             BIT_ULL(IB_USER_VERBS_CMD_DEALLOC_MW) |
1560             BIT_ULL(IB_USER_VERBS_CMD_POST_RECV) |
1561             BIT_ULL(IB_USER_VERBS_CMD_POST_SEND);
1562         iwdev->ibdev.uverbs_ex_cmd_mask =
1563             BIT_ULL(IB_USER_VERBS_EX_CMD_MODIFY_QP) |
1564             BIT_ULL(IB_USER_VERBS_EX_CMD_QUERY_DEVICE);
1565
1566         if (iwdev->rf->rdma_ver >= IRDMA_GEN_2)
1567                 iwdev->ibdev.uverbs_ex_cmd_mask |= BIT_ULL(IB_USER_VERBS_EX_CMD_CREATE_CQ);
1568 }