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