drivers/infiniband/hw/usnic/usnic_ib_verbs.c

   1 /*
   2  * Copyright (c) 2013, Cisco Systems, 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  * 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  */
  33 #include <linux/module.h>
  34 #include <linux/init.h>
  35 #include <linux/slab.h>
  36 #include <linux/errno.h>
  37
  38 #include <rdma/ib_user_verbs.h>
  39 #include <rdma/ib_addr.h>
  40 #include <rdma/uverbs_ioctl.h>
  41
  42 #include "usnic_abi.h"
  43 #include "usnic_ib.h"
  44 #include "usnic_common_util.h"
  45 #include "usnic_ib_qp_grp.h"
  46 #include "usnic_ib_verbs.h"
  47 #include "usnic_fwd.h"
  48 #include "usnic_log.h"
  49 #include "usnic_uiom.h"
  50 #include "usnic_transport.h"
  51
  52 #define USNIC_DEFAULT_TRANSPORT USNIC_TRANSPORT_ROCE_CUSTOM
  53
  54 const struct usnic_vnic_res_spec min_transport_spec[USNIC_TRANSPORT_MAX] = {
  55         { /*USNIC_TRANSPORT_UNKNOWN*/
  56                 .resources = {
  57                         {.type = USNIC_VNIC_RES_TYPE_EOL,       .cnt = 0,},
  58                 },
  59         },
  60         { /*USNIC_TRANSPORT_ROCE_CUSTOM*/
  61                 .resources = {
  62                         {.type = USNIC_VNIC_RES_TYPE_WQ,        .cnt = 1,},
  63                         {.type = USNIC_VNIC_RES_TYPE_RQ,        .cnt = 1,},
  64                         {.type = USNIC_VNIC_RES_TYPE_CQ,        .cnt = 1,},
  65                         {.type = USNIC_VNIC_RES_TYPE_EOL,       .cnt = 0,},
  66                 },
  67         },
  68         { /*USNIC_TRANSPORT_IPV4_UDP*/
  69                 .resources = {
  70                         {.type = USNIC_VNIC_RES_TYPE_WQ,        .cnt = 1,},
  71                         {.type = USNIC_VNIC_RES_TYPE_RQ,        .cnt = 1,},
  72                         {.type = USNIC_VNIC_RES_TYPE_CQ,        .cnt = 1,},
  73                         {.type = USNIC_VNIC_RES_TYPE_EOL,       .cnt = 0,},
  74                 },
  75         },
  76 };
  77
  78 static void usnic_ib_fw_string_to_u64(char *fw_ver_str, u64 *fw_ver)
  79 {
  80         *fw_ver = *((u64 *)fw_ver_str);
  81 }
  82
  83 static int usnic_ib_fill_create_qp_resp(struct usnic_ib_qp_grp *qp_grp,
  84                                         struct ib_udata *udata)
  85 {
  86         struct usnic_ib_dev *us_ibdev;
  87         struct usnic_ib_create_qp_resp resp;
  88         struct pci_dev *pdev;
  89         struct vnic_dev_bar *bar;
  90         struct usnic_vnic_res_chunk *chunk;
  91         struct usnic_ib_qp_grp_flow *default_flow;
  92         int i, err;
  93
  94         memset(&resp, 0, sizeof(resp));
  95
  96         us_ibdev = qp_grp->vf->pf;
  97         pdev = usnic_vnic_get_pdev(qp_grp->vf->vnic);
  98         if (!pdev) {
  99                 usnic_err("Failed to get pdev of qp_grp %d\n",
 100                                 qp_grp->grp_id);
 101                 return -EFAULT;
 102         }
 103
 104         bar = usnic_vnic_get_bar(qp_grp->vf->vnic, 0);
 105         if (!bar) {
 106                 usnic_err("Failed to get bar0 of qp_grp %d vf %s",
 107                                 qp_grp->grp_id, pci_name(pdev));
 108                 return -EFAULT;
 109         }
 110
 111         resp.vfid = usnic_vnic_get_index(qp_grp->vf->vnic);
 112         resp.bar_bus_addr = bar->bus_addr;
 113         resp.bar_len = bar->len;
 114
 115         chunk = usnic_ib_qp_grp_get_chunk(qp_grp, USNIC_VNIC_RES_TYPE_RQ);
 116         if (IS_ERR(chunk)) {
 117                 usnic_err("Failed to get chunk %s for qp_grp %d with err %ld\n",
 118                         usnic_vnic_res_type_to_str(USNIC_VNIC_RES_TYPE_RQ),
 119                         qp_grp->grp_id,
 120                         PTR_ERR(chunk));
 121                 return PTR_ERR(chunk);
 122         }
 123
 124         WARN_ON(chunk->type != USNIC_VNIC_RES_TYPE_RQ);
 125         resp.rq_cnt = chunk->cnt;
 126         for (i = 0; i < chunk->cnt; i++)
 127                 resp.rq_idx[i] = chunk->res[i]->vnic_idx;
 128
 129         chunk = usnic_ib_qp_grp_get_chunk(qp_grp, USNIC_VNIC_RES_TYPE_WQ);
 130         if (IS_ERR(chunk)) {
 131                 usnic_err("Failed to get chunk %s for qp_grp %d with err %ld\n",
 132                         usnic_vnic_res_type_to_str(USNIC_VNIC_RES_TYPE_WQ),
 133                         qp_grp->grp_id,
 134                         PTR_ERR(chunk));
 135                 return PTR_ERR(chunk);
 136         }
 137
 138         WARN_ON(chunk->type != USNIC_VNIC_RES_TYPE_WQ);
 139         resp.wq_cnt = chunk->cnt;
 140         for (i = 0; i < chunk->cnt; i++)
 141                 resp.wq_idx[i] = chunk->res[i]->vnic_idx;
 142
 143         chunk = usnic_ib_qp_grp_get_chunk(qp_grp, USNIC_VNIC_RES_TYPE_CQ);
 144         if (IS_ERR(chunk)) {
 145                 usnic_err("Failed to get chunk %s for qp_grp %d with err %ld\n",
 146                         usnic_vnic_res_type_to_str(USNIC_VNIC_RES_TYPE_CQ),
 147                         qp_grp->grp_id,
 148                         PTR_ERR(chunk));
 149                 return PTR_ERR(chunk);
 150         }
 151
 152         WARN_ON(chunk->type != USNIC_VNIC_RES_TYPE_CQ);
 153         resp.cq_cnt = chunk->cnt;
 154         for (i = 0; i < chunk->cnt; i++)
 155                 resp.cq_idx[i] = chunk->res[i]->vnic_idx;
 156
 157         default_flow = list_first_entry(&qp_grp->flows_lst,
 158                                         struct usnic_ib_qp_grp_flow, link);
 159         resp.transport = default_flow->trans_type;
 160
 161         err = ib_copy_to_udata(udata, &resp, sizeof(resp));
 162         if (err) {
 163                 usnic_err("Failed to copy udata for %s",
 164                           dev_name(&us_ibdev->ib_dev.dev));
 165                 return err;
 166         }
 167
 168         return 0;
 169 }
 170
 171 static struct usnic_ib_qp_grp*
 172 find_free_vf_and_create_qp_grp(struct usnic_ib_dev *us_ibdev,
 173                                 struct usnic_ib_pd *pd,
 174                                 struct usnic_transport_spec *trans_spec,
 175                                 struct usnic_vnic_res_spec *res_spec)
 176 {
 177         struct usnic_ib_vf *vf;
 178         struct usnic_vnic *vnic;
 179         struct usnic_ib_qp_grp *qp_grp;
 180         struct device *dev, **dev_list;
 181         int i;
 182
 183         BUG_ON(!mutex_is_locked(&us_ibdev->usdev_lock));
 184
 185         if (list_empty(&us_ibdev->vf_dev_list)) {
 186                 usnic_info("No vfs to allocate\n");
 187                 return NULL;
 188         }
 189
 190         if (usnic_ib_share_vf) {
 191                 /* Try to find resouces on a used vf which is in pd */
 192                 dev_list = usnic_uiom_get_dev_list(pd->umem_pd);
 193                 if (IS_ERR(dev_list))
 194                         return ERR_CAST(dev_list);
 195                 for (i = 0; dev_list[i]; i++) {
 196                         dev = dev_list[i];
 197                         vf = dev_get_drvdata(dev);
 198                         spin_lock(&vf->lock);
 199                         vnic = vf->vnic;
 200                         if (!usnic_vnic_check_room(vnic, res_spec)) {
 201                                 usnic_dbg("Found used vnic %s from %s\n",
 202                                                 dev_name(&us_ibdev->ib_dev.dev),
 203                                                 pci_name(usnic_vnic_get_pdev(
 204                                                                         vnic)));
 205                                 qp_grp = usnic_ib_qp_grp_create(us_ibdev->ufdev,
 206                                                                 vf, pd,
 207                                                                 res_spec,
 208                                                                 trans_spec);
 209
 210                                 spin_unlock(&vf->lock);
 211                                 goto qp_grp_check;
 212                         }
 213                         spin_unlock(&vf->lock);
 214
 215                 }
 216                 usnic_uiom_free_dev_list(dev_list);
 217                 dev_list = NULL;
 218         }
 219
 220         /* Try to find resources on an unused vf */
 221         list_for_each_entry(vf, &us_ibdev->vf_dev_list, link) {
 222                 spin_lock(&vf->lock);
 223                 vnic = vf->vnic;
 224                 if (vf->qp_grp_ref_cnt == 0 &&
 225                     usnic_vnic_check_room(vnic, res_spec) == 0) {
 226                         qp_grp = usnic_ib_qp_grp_create(us_ibdev->ufdev, vf,
 227                                                         pd, res_spec,
 228                                                         trans_spec);
 229
 230                         spin_unlock(&vf->lock);
 231                         goto qp_grp_check;
 232                 }
 233                 spin_unlock(&vf->lock);
 234         }
 235
 236         usnic_info("No free qp grp found on %s\n",
 237                    dev_name(&us_ibdev->ib_dev.dev));
 238         return ERR_PTR(-ENOMEM);
 239
 240 qp_grp_check:
 241         if (IS_ERR_OR_NULL(qp_grp)) {
 242                 usnic_err("Failed to allocate qp_grp\n");
 243                 if (usnic_ib_share_vf)
 244                         usnic_uiom_free_dev_list(dev_list);
 245                 return ERR_PTR(qp_grp ? PTR_ERR(qp_grp) : -ENOMEM);
 246         }
 247         return qp_grp;
 248 }
 249
 250 static void qp_grp_destroy(struct usnic_ib_qp_grp *qp_grp)
 251 {
 252         struct usnic_ib_vf *vf = qp_grp->vf;
 253
 254         WARN_ON(qp_grp->state != IB_QPS_RESET);
 255
 256         spin_lock(&vf->lock);
 257         usnic_ib_qp_grp_destroy(qp_grp);
 258         spin_unlock(&vf->lock);
 259 }
 260
 261 static int create_qp_validate_user_data(struct usnic_ib_create_qp_cmd cmd)
 262 {
 263         if (cmd.spec.trans_type <= USNIC_TRANSPORT_UNKNOWN ||
 264                         cmd.spec.trans_type >= USNIC_TRANSPORT_MAX)
 265                 return -EINVAL;
 266
 267         return 0;
 268 }
 269
 270 /* Start of ib callback functions */
 271
 272 enum rdma_link_layer usnic_ib_port_link_layer(struct ib_device *device,
 273                                               u32 port_num)
 274 {
 275         return IB_LINK_LAYER_ETHERNET;
 276 }
 277
 278 int usnic_ib_query_device(struct ib_device *ibdev,
 279                           struct ib_device_attr *props,
 280                           struct ib_udata *uhw)
 281 {
 282         struct usnic_ib_dev *us_ibdev = to_usdev(ibdev);
 283         union ib_gid gid;
 284         struct ethtool_drvinfo info;
 285         int qp_per_vf;
 286
 287         usnic_dbg("\n");
 288         if (uhw->inlen || uhw->outlen)
 289                 return -EINVAL;
 290
 291         mutex_lock(&us_ibdev->usdev_lock);
 292         us_ibdev->netdev->ethtool_ops->get_drvinfo(us_ibdev->netdev, &info);
 293         memset(props, 0, sizeof(*props));
 294         usnic_mac_ip_to_gid(us_ibdev->ufdev->mac, us_ibdev->ufdev->inaddr,
 295                         &gid.raw[0]);
 296         memcpy(&props->sys_image_guid, &gid.global.interface_id,
 297                 sizeof(gid.global.interface_id));
 298         usnic_ib_fw_string_to_u64(&info.fw_version[0], &props->fw_ver);
 299         props->max_mr_size = USNIC_UIOM_MAX_MR_SIZE;
 300         props->page_size_cap = USNIC_UIOM_PAGE_SIZE;
 301         props->vendor_id = PCI_VENDOR_ID_CISCO;
 302         props->vendor_part_id = PCI_DEVICE_ID_CISCO_VIC_USPACE_NIC;
 303         props->hw_ver = us_ibdev->pdev->subsystem_device;
 304         qp_per_vf = max(us_ibdev->vf_res_cnt[USNIC_VNIC_RES_TYPE_WQ],
 305                         us_ibdev->vf_res_cnt[USNIC_VNIC_RES_TYPE_RQ]);
 306         props->max_qp = qp_per_vf *
 307                 kref_read(&us_ibdev->vf_cnt);
 308         props->device_cap_flags = IB_DEVICE_PORT_ACTIVE_EVENT |
 309                 IB_DEVICE_SYS_IMAGE_GUID | IB_DEVICE_BLOCK_MULTICAST_LOOPBACK;
 310         props->max_cq = us_ibdev->vf_res_cnt[USNIC_VNIC_RES_TYPE_CQ] *
 311                 kref_read(&us_ibdev->vf_cnt);
 312         props->max_pd = USNIC_UIOM_MAX_PD_CNT;
 313         props->max_mr = USNIC_UIOM_MAX_MR_CNT;
 314         props->local_ca_ack_delay = 0;
 315         props->max_pkeys = 0;
 316         props->atomic_cap = IB_ATOMIC_NONE;
 317         props->masked_atomic_cap = props->atomic_cap;
 318         props->max_qp_rd_atom = 0;
 319         props->max_qp_init_rd_atom = 0;
 320         props->max_res_rd_atom = 0;
 321         props->max_srq = 0;
 322         props->max_srq_wr = 0;
 323         props->max_srq_sge = 0;
 324         props->max_fast_reg_page_list_len = 0;
 325         props->max_mcast_grp = 0;
 326         props->max_mcast_qp_attach = 0;
 327         props->max_total_mcast_qp_attach = 0;
 328         /* Owned by Userspace
 329          * max_qp_wr, max_sge, max_sge_rd, max_cqe */
 330         mutex_unlock(&us_ibdev->usdev_lock);
 331
 332         return 0;
 333 }
 334
 335 int usnic_ib_query_port(struct ib_device *ibdev, u32 port,
 336                                 struct ib_port_attr *props)
 337 {
 338         struct usnic_ib_dev *us_ibdev = to_usdev(ibdev);
 339
 340         usnic_dbg("\n");
 341
 342         if (ib_get_eth_speed(ibdev, port, &props->active_speed,
 343                              &props->active_width))
 344                 return -EINVAL;
 345
 346         /*
 347          * usdev_lock is acquired after (and not before) ib_get_eth_speed call
 348          * because acquiring rtnl_lock in ib_get_eth_speed, while holding
 349          * usdev_lock could lead to a deadlock.
 350          */
 351         mutex_lock(&us_ibdev->usdev_lock);
 352         /* props being zeroed by the caller, avoid zeroing it here */
 353
 354         props->lid = 0;
 355         props->lmc = 1;
 356         props->sm_lid = 0;
 357         props->sm_sl = 0;
 358
 359         if (!us_ibdev->ufdev->link_up) {
 360                 props->state = IB_PORT_DOWN;
 361                 props->phys_state = IB_PORT_PHYS_STATE_DISABLED;
 362         } else if (!us_ibdev->ufdev->inaddr) {
 363                 props->state = IB_PORT_INIT;
 364                 props->phys_state =
 365                         IB_PORT_PHYS_STATE_PORT_CONFIGURATION_TRAINING;
 366         } else {
 367                 props->state = IB_PORT_ACTIVE;
 368                 props->phys_state = IB_PORT_PHYS_STATE_LINK_UP;
 369         }
 370
 371         props->port_cap_flags = 0;
 372         props->gid_tbl_len = 1;
 373         props->bad_pkey_cntr = 0;
 374         props->qkey_viol_cntr = 0;
 375         props->max_mtu = IB_MTU_4096;
 376         props->active_mtu = iboe_get_mtu(us_ibdev->ufdev->mtu);
 377         /* Userspace will adjust for hdrs */
 378         props->max_msg_sz = us_ibdev->ufdev->mtu;
 379         props->max_vl_num = 1;
 380         mutex_unlock(&us_ibdev->usdev_lock);
 381
 382         return 0;
 383 }
 384
 385 int usnic_ib_query_qp(struct ib_qp *qp, struct ib_qp_attr *qp_attr,
 386                                 int qp_attr_mask,
 387                                 struct ib_qp_init_attr *qp_init_attr)
 388 {
 389         struct usnic_ib_qp_grp *qp_grp;
 390         struct usnic_ib_vf *vf;
 391         int err;
 392
 393         usnic_dbg("\n");
 394
 395         memset(qp_attr, 0, sizeof(*qp_attr));
 396         memset(qp_init_attr, 0, sizeof(*qp_init_attr));
 397
 398         qp_grp = to_uqp_grp(qp);
 399         vf = qp_grp->vf;
 400         mutex_lock(&vf->pf->usdev_lock);
 401         usnic_dbg("\n");
 402         qp_attr->qp_state = qp_grp->state;
 403         qp_attr->cur_qp_state = qp_grp->state;
 404
 405         switch (qp_grp->ibqp.qp_type) {
 406         case IB_QPT_UD:
 407                 qp_attr->qkey = 0;
 408                 break;
 409         default:
 410                 usnic_err("Unexpected qp_type %d\n", qp_grp->ibqp.qp_type);
 411                 err = -EINVAL;
 412                 goto err_out;
 413         }
 414
 415         mutex_unlock(&vf->pf->usdev_lock);
 416         return 0;
 417
 418 err_out:
 419         mutex_unlock(&vf->pf->usdev_lock);
 420         return err;
 421 }
 422
 423 int usnic_ib_query_gid(struct ib_device *ibdev, u32 port, int index,
 424                                 union ib_gid *gid)
 425 {
 426
 427         struct usnic_ib_dev *us_ibdev = to_usdev(ibdev);
 428         usnic_dbg("\n");
 429
 430         if (index > 1)
 431                 return -EINVAL;
 432
 433         mutex_lock(&us_ibdev->usdev_lock);
 434         memset(&(gid->raw[0]), 0, sizeof(gid->raw));
 435         usnic_mac_ip_to_gid(us_ibdev->ufdev->mac, us_ibdev->ufdev->inaddr,
 436                         &gid->raw[0]);
 437         mutex_unlock(&us_ibdev->usdev_lock);
 438
 439         return 0;
 440 }
 441
 442 int usnic_ib_alloc_pd(struct ib_pd *ibpd, struct ib_udata *udata)
 443 {
 444         struct usnic_ib_pd *pd = to_upd(ibpd);
 445         void *umem_pd;
 446
 447         umem_pd = pd->umem_pd = usnic_uiom_alloc_pd();
 448         if (IS_ERR_OR_NULL(umem_pd)) {
 449                 return umem_pd ? PTR_ERR(umem_pd) : -ENOMEM;
 450         }
 451
 452         return 0;
 453 }
 454
 455 int usnic_ib_dealloc_pd(struct ib_pd *pd, struct ib_udata *udata)
 456 {
 457         usnic_uiom_dealloc_pd((to_upd(pd))->umem_pd);
 458         return 0;
 459 }
 460
 461 struct ib_qp *usnic_ib_create_qp(struct ib_pd *pd,
 462                                         struct ib_qp_init_attr *init_attr,
 463                                         struct ib_udata *udata)
 464 {
 465         int err;
 466         struct usnic_ib_dev *us_ibdev;
 467         struct usnic_ib_qp_grp *qp_grp;
 468         struct usnic_ib_ucontext *ucontext = rdma_udata_to_drv_context(
 469                 udata, struct usnic_ib_ucontext, ibucontext);
 470         int cq_cnt;
 471         struct usnic_vnic_res_spec res_spec;
 472         struct usnic_ib_create_qp_cmd cmd;
 473         struct usnic_transport_spec trans_spec;
 474
 475         usnic_dbg("\n");
 476
 477         us_ibdev = to_usdev(pd->device);
 478
 479         if (init_attr->create_flags)
 480                 return ERR_PTR(-EOPNOTSUPP);
 481
 482         err = ib_copy_from_udata(&cmd, udata, sizeof(cmd));
 483         if (err) {
 484                 usnic_err("%s: cannot copy udata for create_qp\n",
 485                           dev_name(&us_ibdev->ib_dev.dev));
 486                 return ERR_PTR(-EINVAL);
 487         }
 488
 489         err = create_qp_validate_user_data(cmd);
 490         if (err) {
 491                 usnic_err("%s: Failed to validate user data\n",
 492                           dev_name(&us_ibdev->ib_dev.dev));
 493                 return ERR_PTR(-EINVAL);
 494         }
 495
 496         if (init_attr->qp_type != IB_QPT_UD) {
 497                 usnic_err("%s asked to make a non-UD QP: %d\n",
 498                           dev_name(&us_ibdev->ib_dev.dev), init_attr->qp_type);
 499                 return ERR_PTR(-EOPNOTSUPP);
 500         }
 501
 502         trans_spec = cmd.spec;
 503         mutex_lock(&us_ibdev->usdev_lock);
 504         cq_cnt = (init_attr->send_cq == init_attr->recv_cq) ? 1 : 2;
 505         res_spec = min_transport_spec[trans_spec.trans_type];
 506         usnic_vnic_res_spec_update(&res_spec, USNIC_VNIC_RES_TYPE_CQ, cq_cnt);
 507         qp_grp = find_free_vf_and_create_qp_grp(us_ibdev, to_upd(pd),
 508                                                 &trans_spec,
 509                                                 &res_spec);
 510         if (IS_ERR_OR_NULL(qp_grp)) {
 511                 err = qp_grp ? PTR_ERR(qp_grp) : -ENOMEM;
 512                 goto out_release_mutex;
 513         }
 514
 515         err = usnic_ib_fill_create_qp_resp(qp_grp, udata);
 516         if (err) {
 517                 err = -EBUSY;
 518                 goto out_release_qp_grp;
 519         }
 520
 521         qp_grp->ctx = ucontext;
 522         list_add_tail(&qp_grp->link, &ucontext->qp_grp_list);
 523         usnic_ib_log_vf(qp_grp->vf);
 524         mutex_unlock(&us_ibdev->usdev_lock);
 525         return &qp_grp->ibqp;
 526
 527 out_release_qp_grp:
 528         qp_grp_destroy(qp_grp);
 529 out_release_mutex:
 530         mutex_unlock(&us_ibdev->usdev_lock);
 531         return ERR_PTR(err);
 532 }
 533
 534 int usnic_ib_destroy_qp(struct ib_qp *qp, struct ib_udata *udata)
 535 {
 536         struct usnic_ib_qp_grp *qp_grp;
 537         struct usnic_ib_vf *vf;
 538
 539         usnic_dbg("\n");
 540
 541         qp_grp = to_uqp_grp(qp);
 542         vf = qp_grp->vf;
 543         mutex_lock(&vf->pf->usdev_lock);
 544         if (usnic_ib_qp_grp_modify(qp_grp, IB_QPS_RESET, NULL)) {
 545                 usnic_err("Failed to move qp grp %u to reset\n",
 546                                 qp_grp->grp_id);
 547         }
 548
 549         list_del(&qp_grp->link);
 550         qp_grp_destroy(qp_grp);
 551         mutex_unlock(&vf->pf->usdev_lock);
 552
 553         return 0;
 554 }
 555
 556 int usnic_ib_modify_qp(struct ib_qp *ibqp, struct ib_qp_attr *attr,
 557                                 int attr_mask, struct ib_udata *udata)
 558 {
 559         struct usnic_ib_qp_grp *qp_grp;
 560         int status;
 561         usnic_dbg("\n");
 562
 563         if (attr_mask & ~IB_QP_ATTR_STANDARD_BITS)
 564                 return -EOPNOTSUPP;
 565
 566         qp_grp = to_uqp_grp(ibqp);
 567
 568         mutex_lock(&qp_grp->vf->pf->usdev_lock);
 569         if ((attr_mask & IB_QP_PORT) && attr->port_num != 1) {
 570                 /* usnic devices only have one port */
 571                 status = -EINVAL;
 572                 goto out_unlock;
 573         }
 574         if (attr_mask & IB_QP_STATE) {
 575                 status = usnic_ib_qp_grp_modify(qp_grp, attr->qp_state, NULL);
 576         } else {
 577                 usnic_err("Unhandled request, attr_mask=0x%x\n", attr_mask);
 578                 status = -EINVAL;
 579         }
 580
 581 out_unlock:
 582         mutex_unlock(&qp_grp->vf->pf->usdev_lock);
 583         return status;
 584 }
 585
 586 int usnic_ib_create_cq(struct ib_cq *ibcq, const struct ib_cq_init_attr *attr,
 587                        struct ib_udata *udata)
 588 {
 589         if (attr->flags)
 590                 return -EOPNOTSUPP;
 591
 592         return 0;
 593 }
 594
 595 int usnic_ib_destroy_cq(struct ib_cq *cq, struct ib_udata *udata)
 596 {
 597         return 0;
 598 }
 599
 600 struct ib_mr *usnic_ib_reg_mr(struct ib_pd *pd, u64 start, u64 length,
 601                                         u64 virt_addr, int access_flags,
 602                                         struct ib_udata *udata)
 603 {
 604         struct usnic_ib_mr *mr;
 605         int err;
 606
 607         usnic_dbg("start 0x%llx va 0x%llx length 0x%llx\n", start,
 608                         virt_addr, length);
 609
 610         mr = kzalloc(sizeof(*mr), GFP_KERNEL);
 611         if (!mr)
 612                 return ERR_PTR(-ENOMEM);
 613
 614         mr->umem = usnic_uiom_reg_get(to_upd(pd)->umem_pd, start, length,
 615                                         access_flags, 0);
 616         if (IS_ERR_OR_NULL(mr->umem)) {
 617                 err = mr->umem ? PTR_ERR(mr->umem) : -EFAULT;
 618                 goto err_free;
 619         }
 620
 621         mr->ibmr.lkey = mr->ibmr.rkey = 0;
 622         return &mr->ibmr;
 623
 624 err_free:
 625         kfree(mr);
 626         return ERR_PTR(err);
 627 }
 628
 629 int usnic_ib_dereg_mr(struct ib_mr *ibmr, struct ib_udata *udata)
 630 {
 631         struct usnic_ib_mr *mr = to_umr(ibmr);
 632
 633         usnic_dbg("va 0x%lx length 0x%zx\n", mr->umem->va, mr->umem->length);
 634
 635         usnic_uiom_reg_release(mr->umem);
 636         kfree(mr);
 637         return 0;
 638 }
 639
 640 int usnic_ib_alloc_ucontext(struct ib_ucontext *uctx, struct ib_udata *udata)
 641 {
 642         struct ib_device *ibdev = uctx->device;
 643         struct usnic_ib_ucontext *context = to_ucontext(uctx);
 644         struct usnic_ib_dev *us_ibdev = to_usdev(ibdev);
 645         usnic_dbg("\n");
 646
 647         INIT_LIST_HEAD(&context->qp_grp_list);
 648         mutex_lock(&us_ibdev->usdev_lock);
 649         list_add_tail(&context->link, &us_ibdev->ctx_list);
 650         mutex_unlock(&us_ibdev->usdev_lock);
 651
 652         return 0;
 653 }
 654
 655 void usnic_ib_dealloc_ucontext(struct ib_ucontext *ibcontext)
 656 {
 657         struct usnic_ib_ucontext *context = to_uucontext(ibcontext);
 658         struct usnic_ib_dev *us_ibdev = to_usdev(ibcontext->device);
 659         usnic_dbg("\n");
 660
 661         mutex_lock(&us_ibdev->usdev_lock);
 662         WARN_ON_ONCE(!list_empty(&context->qp_grp_list));
 663         list_del(&context->link);
 664         mutex_unlock(&us_ibdev->usdev_lock);
 665 }
 666
 667 int usnic_ib_mmap(struct ib_ucontext *context,
 668                                 struct vm_area_struct *vma)
 669 {
 670         struct usnic_ib_ucontext *uctx = to_ucontext(context);
 671         struct usnic_ib_dev *us_ibdev;
 672         struct usnic_ib_qp_grp *qp_grp;
 673         struct usnic_ib_vf *vf;
 674         struct vnic_dev_bar *bar;
 675         dma_addr_t bus_addr;
 676         unsigned int len;
 677         unsigned int vfid;
 678
 679         usnic_dbg("\n");
 680
 681         us_ibdev = to_usdev(context->device);
 682         vma->vm_flags |= VM_IO;
 683         vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
 684         vfid = vma->vm_pgoff;
 685         usnic_dbg("Page Offset %lu PAGE_SHIFT %u VFID %u\n",
 686                         vma->vm_pgoff, PAGE_SHIFT, vfid);
 687
 688         mutex_lock(&us_ibdev->usdev_lock);
 689         list_for_each_entry(qp_grp, &uctx->qp_grp_list, link) {
 690                 vf = qp_grp->vf;
 691                 if (usnic_vnic_get_index(vf->vnic) == vfid) {
 692                         bar = usnic_vnic_get_bar(vf->vnic, 0);
 693                         if ((vma->vm_end - vma->vm_start) != bar->len) {
 694                                 usnic_err("Bar0 Len %lu - Request map %lu\n",
 695                                                 bar->len,
 696                                                 vma->vm_end - vma->vm_start);
 697                                 mutex_unlock(&us_ibdev->usdev_lock);
 698                                 return -EINVAL;
 699                         }
 700                         bus_addr = bar->bus_addr;
 701                         len = bar->len;
 702                         usnic_dbg("bus: %pa vaddr: %p size: %ld\n",
 703                                         &bus_addr, bar->vaddr, bar->len);
 704                         mutex_unlock(&us_ibdev->usdev_lock);
 705
 706                         return remap_pfn_range(vma,
 707                                                 vma->vm_start,
 708                                                 bus_addr >> PAGE_SHIFT,
 709                                                 len, vma->vm_page_prot);
 710                 }
 711         }
 712
 713         mutex_unlock(&us_ibdev->usdev_lock);
 714         usnic_err("No VF %u found\n", vfid);
 715         return -EINVAL;
 716 }
 717