treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / infiniband / hw / usnic / usnic_ib_verbs.c
blob556b8e44a51c49e103b195d3619818b133c9bd7e
1 /*
2 * Copyright (c) 2013, Cisco Systems, Inc. All rights reserved.
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:
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
12 * conditions are met:
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
16 * disclaimer.
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.
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.
33 #include <linux/module.h>
34 #include <linux/init.h>
35 #include <linux/slab.h>
36 #include <linux/errno.h>
38 #include <rdma/ib_user_verbs.h>
39 #include <rdma/ib_addr.h>
40 #include <rdma/uverbs_ioctl.h>
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"
52 #define USNIC_DEFAULT_TRANSPORT USNIC_TRANSPORT_ROCE_CUSTOM
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,},
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,},
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,},
78 static void usnic_ib_fw_string_to_u64(char *fw_ver_str, u64 *fw_ver)
80 *fw_ver = *((u64 *)fw_ver_str);
83 static int usnic_ib_fill_create_qp_resp(struct usnic_ib_qp_grp *qp_grp,
84 struct ib_udata *udata)
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;
94 memset(&resp, 0, sizeof(resp));
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;
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;
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;
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);
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;
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);
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;
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);
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;
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;
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;
168 return 0;
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)
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;
183 BUG_ON(!mutex_is_locked(&us_ibdev->usdev_lock));
185 if (list_empty(&us_ibdev->vf_dev_list)) {
186 usnic_info("No vfs to allocate\n");
187 return NULL;
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);
210 spin_unlock(&vf->lock);
211 goto qp_grp_check;
213 spin_unlock(&vf->lock);
216 usnic_uiom_free_dev_list(dev_list);
219 /* Try to find resources on an unused vf */
220 list_for_each_entry(vf, &us_ibdev->vf_dev_list, link) {
221 spin_lock(&vf->lock);
222 vnic = vf->vnic;
223 if (vf->qp_grp_ref_cnt == 0 &&
224 usnic_vnic_check_room(vnic, res_spec) == 0) {
225 qp_grp = usnic_ib_qp_grp_create(us_ibdev->ufdev, vf,
226 pd, res_spec,
227 trans_spec);
229 spin_unlock(&vf->lock);
230 goto qp_grp_check;
232 spin_unlock(&vf->lock);
235 usnic_info("No free qp grp found on %s\n",
236 dev_name(&us_ibdev->ib_dev.dev));
237 return ERR_PTR(-ENOMEM);
239 qp_grp_check:
240 if (IS_ERR_OR_NULL(qp_grp)) {
241 usnic_err("Failed to allocate qp_grp\n");
242 return ERR_PTR(qp_grp ? PTR_ERR(qp_grp) : -ENOMEM);
244 return qp_grp;
247 static void qp_grp_destroy(struct usnic_ib_qp_grp *qp_grp)
249 struct usnic_ib_vf *vf = qp_grp->vf;
251 WARN_ON(qp_grp->state != IB_QPS_RESET);
253 spin_lock(&vf->lock);
254 usnic_ib_qp_grp_destroy(qp_grp);
255 spin_unlock(&vf->lock);
258 static int create_qp_validate_user_data(struct usnic_ib_create_qp_cmd cmd)
260 if (cmd.spec.trans_type <= USNIC_TRANSPORT_UNKNOWN ||
261 cmd.spec.trans_type >= USNIC_TRANSPORT_MAX)
262 return -EINVAL;
264 return 0;
267 /* Start of ib callback functions */
269 enum rdma_link_layer usnic_ib_port_link_layer(struct ib_device *device,
270 u8 port_num)
272 return IB_LINK_LAYER_ETHERNET;
275 int usnic_ib_query_device(struct ib_device *ibdev,
276 struct ib_device_attr *props,
277 struct ib_udata *uhw)
279 struct usnic_ib_dev *us_ibdev = to_usdev(ibdev);
280 union ib_gid gid;
281 struct ethtool_drvinfo info;
282 int qp_per_vf;
284 usnic_dbg("\n");
285 if (uhw->inlen || uhw->outlen)
286 return -EINVAL;
288 mutex_lock(&us_ibdev->usdev_lock);
289 us_ibdev->netdev->ethtool_ops->get_drvinfo(us_ibdev->netdev, &info);
290 memset(props, 0, sizeof(*props));
291 usnic_mac_ip_to_gid(us_ibdev->ufdev->mac, us_ibdev->ufdev->inaddr,
292 &gid.raw[0]);
293 memcpy(&props->sys_image_guid, &gid.global.interface_id,
294 sizeof(gid.global.interface_id));
295 usnic_ib_fw_string_to_u64(&info.fw_version[0], &props->fw_ver);
296 props->max_mr_size = USNIC_UIOM_MAX_MR_SIZE;
297 props->page_size_cap = USNIC_UIOM_PAGE_SIZE;
298 props->vendor_id = PCI_VENDOR_ID_CISCO;
299 props->vendor_part_id = PCI_DEVICE_ID_CISCO_VIC_USPACE_NIC;
300 props->hw_ver = us_ibdev->pdev->subsystem_device;
301 qp_per_vf = max(us_ibdev->vf_res_cnt[USNIC_VNIC_RES_TYPE_WQ],
302 us_ibdev->vf_res_cnt[USNIC_VNIC_RES_TYPE_RQ]);
303 props->max_qp = qp_per_vf *
304 kref_read(&us_ibdev->vf_cnt);
305 props->device_cap_flags = IB_DEVICE_PORT_ACTIVE_EVENT |
306 IB_DEVICE_SYS_IMAGE_GUID | IB_DEVICE_BLOCK_MULTICAST_LOOPBACK;
307 props->max_cq = us_ibdev->vf_res_cnt[USNIC_VNIC_RES_TYPE_CQ] *
308 kref_read(&us_ibdev->vf_cnt);
309 props->max_pd = USNIC_UIOM_MAX_PD_CNT;
310 props->max_mr = USNIC_UIOM_MAX_MR_CNT;
311 props->local_ca_ack_delay = 0;
312 props->max_pkeys = 0;
313 props->atomic_cap = IB_ATOMIC_NONE;
314 props->masked_atomic_cap = props->atomic_cap;
315 props->max_qp_rd_atom = 0;
316 props->max_qp_init_rd_atom = 0;
317 props->max_res_rd_atom = 0;
318 props->max_srq = 0;
319 props->max_srq_wr = 0;
320 props->max_srq_sge = 0;
321 props->max_fast_reg_page_list_len = 0;
322 props->max_mcast_grp = 0;
323 props->max_mcast_qp_attach = 0;
324 props->max_total_mcast_qp_attach = 0;
325 props->max_map_per_fmr = 0;
326 /* Owned by Userspace
327 * max_qp_wr, max_sge, max_sge_rd, max_cqe */
328 mutex_unlock(&us_ibdev->usdev_lock);
330 return 0;
333 int usnic_ib_query_port(struct ib_device *ibdev, u8 port,
334 struct ib_port_attr *props)
336 struct usnic_ib_dev *us_ibdev = to_usdev(ibdev);
338 usnic_dbg("\n");
340 if (ib_get_eth_speed(ibdev, port, &props->active_speed,
341 &props->active_width))
342 return -EINVAL;
345 * usdev_lock is acquired after (and not before) ib_get_eth_speed call
346 * because acquiring rtnl_lock in ib_get_eth_speed, while holding
347 * usdev_lock could lead to a deadlock.
349 mutex_lock(&us_ibdev->usdev_lock);
350 /* props being zeroed by the caller, avoid zeroing it here */
352 props->lid = 0;
353 props->lmc = 1;
354 props->sm_lid = 0;
355 props->sm_sl = 0;
357 if (!us_ibdev->ufdev->link_up) {
358 props->state = IB_PORT_DOWN;
359 props->phys_state = IB_PORT_PHYS_STATE_DISABLED;
360 } else if (!us_ibdev->ufdev->inaddr) {
361 props->state = IB_PORT_INIT;
362 props->phys_state =
363 IB_PORT_PHYS_STATE_PORT_CONFIGURATION_TRAINING;
364 } else {
365 props->state = IB_PORT_ACTIVE;
366 props->phys_state = IB_PORT_PHYS_STATE_LINK_UP;
369 props->port_cap_flags = 0;
370 props->gid_tbl_len = 1;
371 props->pkey_tbl_len = 1;
372 props->bad_pkey_cntr = 0;
373 props->qkey_viol_cntr = 0;
374 props->max_mtu = IB_MTU_4096;
375 props->active_mtu = iboe_get_mtu(us_ibdev->ufdev->mtu);
376 /* Userspace will adjust for hdrs */
377 props->max_msg_sz = us_ibdev->ufdev->mtu;
378 props->max_vl_num = 1;
379 mutex_unlock(&us_ibdev->usdev_lock);
381 return 0;
384 int usnic_ib_query_qp(struct ib_qp *qp, struct ib_qp_attr *qp_attr,
385 int qp_attr_mask,
386 struct ib_qp_init_attr *qp_init_attr)
388 struct usnic_ib_qp_grp *qp_grp;
389 struct usnic_ib_vf *vf;
390 int err;
392 usnic_dbg("\n");
394 memset(qp_attr, 0, sizeof(*qp_attr));
395 memset(qp_init_attr, 0, sizeof(*qp_init_attr));
397 qp_grp = to_uqp_grp(qp);
398 vf = qp_grp->vf;
399 mutex_lock(&vf->pf->usdev_lock);
400 usnic_dbg("\n");
401 qp_attr->qp_state = qp_grp->state;
402 qp_attr->cur_qp_state = qp_grp->state;
404 switch (qp_grp->ibqp.qp_type) {
405 case IB_QPT_UD:
406 qp_attr->qkey = 0;
407 break;
408 default:
409 usnic_err("Unexpected qp_type %d\n", qp_grp->ibqp.qp_type);
410 err = -EINVAL;
411 goto err_out;
414 mutex_unlock(&vf->pf->usdev_lock);
415 return 0;
417 err_out:
418 mutex_unlock(&vf->pf->usdev_lock);
419 return err;
422 int usnic_ib_query_gid(struct ib_device *ibdev, u8 port, int index,
423 union ib_gid *gid)
426 struct usnic_ib_dev *us_ibdev = to_usdev(ibdev);
427 usnic_dbg("\n");
429 if (index > 1)
430 return -EINVAL;
432 mutex_lock(&us_ibdev->usdev_lock);
433 memset(&(gid->raw[0]), 0, sizeof(gid->raw));
434 usnic_mac_ip_to_gid(us_ibdev->ufdev->mac, us_ibdev->ufdev->inaddr,
435 &gid->raw[0]);
436 mutex_unlock(&us_ibdev->usdev_lock);
438 return 0;
441 int usnic_ib_query_pkey(struct ib_device *ibdev, u8 port, u16 index,
442 u16 *pkey)
444 if (index > 0)
445 return -EINVAL;
447 *pkey = 0xffff;
448 return 0;
451 int usnic_ib_alloc_pd(struct ib_pd *ibpd, struct ib_udata *udata)
453 struct usnic_ib_pd *pd = to_upd(ibpd);
454 void *umem_pd;
456 umem_pd = pd->umem_pd = usnic_uiom_alloc_pd();
457 if (IS_ERR_OR_NULL(umem_pd)) {
458 return umem_pd ? PTR_ERR(umem_pd) : -ENOMEM;
461 return 0;
464 void usnic_ib_dealloc_pd(struct ib_pd *pd, struct ib_udata *udata)
466 usnic_uiom_dealloc_pd((to_upd(pd))->umem_pd);
469 struct ib_qp *usnic_ib_create_qp(struct ib_pd *pd,
470 struct ib_qp_init_attr *init_attr,
471 struct ib_udata *udata)
473 int err;
474 struct usnic_ib_dev *us_ibdev;
475 struct usnic_ib_qp_grp *qp_grp;
476 struct usnic_ib_ucontext *ucontext = rdma_udata_to_drv_context(
477 udata, struct usnic_ib_ucontext, ibucontext);
478 int cq_cnt;
479 struct usnic_vnic_res_spec res_spec;
480 struct usnic_ib_create_qp_cmd cmd;
481 struct usnic_transport_spec trans_spec;
483 usnic_dbg("\n");
485 us_ibdev = to_usdev(pd->device);
487 if (init_attr->create_flags)
488 return ERR_PTR(-EINVAL);
490 err = ib_copy_from_udata(&cmd, udata, sizeof(cmd));
491 if (err) {
492 usnic_err("%s: cannot copy udata for create_qp\n",
493 dev_name(&us_ibdev->ib_dev.dev));
494 return ERR_PTR(-EINVAL);
497 err = create_qp_validate_user_data(cmd);
498 if (err) {
499 usnic_err("%s: Failed to validate user data\n",
500 dev_name(&us_ibdev->ib_dev.dev));
501 return ERR_PTR(-EINVAL);
504 if (init_attr->qp_type != IB_QPT_UD) {
505 usnic_err("%s asked to make a non-UD QP: %d\n",
506 dev_name(&us_ibdev->ib_dev.dev), init_attr->qp_type);
507 return ERR_PTR(-EINVAL);
510 trans_spec = cmd.spec;
511 mutex_lock(&us_ibdev->usdev_lock);
512 cq_cnt = (init_attr->send_cq == init_attr->recv_cq) ? 1 : 2;
513 res_spec = min_transport_spec[trans_spec.trans_type];
514 usnic_vnic_res_spec_update(&res_spec, USNIC_VNIC_RES_TYPE_CQ, cq_cnt);
515 qp_grp = find_free_vf_and_create_qp_grp(us_ibdev, to_upd(pd),
516 &trans_spec,
517 &res_spec);
518 if (IS_ERR_OR_NULL(qp_grp)) {
519 err = qp_grp ? PTR_ERR(qp_grp) : -ENOMEM;
520 goto out_release_mutex;
523 err = usnic_ib_fill_create_qp_resp(qp_grp, udata);
524 if (err) {
525 err = -EBUSY;
526 goto out_release_qp_grp;
529 qp_grp->ctx = ucontext;
530 list_add_tail(&qp_grp->link, &ucontext->qp_grp_list);
531 usnic_ib_log_vf(qp_grp->vf);
532 mutex_unlock(&us_ibdev->usdev_lock);
533 return &qp_grp->ibqp;
535 out_release_qp_grp:
536 qp_grp_destroy(qp_grp);
537 out_release_mutex:
538 mutex_unlock(&us_ibdev->usdev_lock);
539 return ERR_PTR(err);
542 int usnic_ib_destroy_qp(struct ib_qp *qp, struct ib_udata *udata)
544 struct usnic_ib_qp_grp *qp_grp;
545 struct usnic_ib_vf *vf;
547 usnic_dbg("\n");
549 qp_grp = to_uqp_grp(qp);
550 vf = qp_grp->vf;
551 mutex_lock(&vf->pf->usdev_lock);
552 if (usnic_ib_qp_grp_modify(qp_grp, IB_QPS_RESET, NULL)) {
553 usnic_err("Failed to move qp grp %u to reset\n",
554 qp_grp->grp_id);
557 list_del(&qp_grp->link);
558 qp_grp_destroy(qp_grp);
559 mutex_unlock(&vf->pf->usdev_lock);
561 return 0;
564 int usnic_ib_modify_qp(struct ib_qp *ibqp, struct ib_qp_attr *attr,
565 int attr_mask, struct ib_udata *udata)
567 struct usnic_ib_qp_grp *qp_grp;
568 int status;
569 usnic_dbg("\n");
571 qp_grp = to_uqp_grp(ibqp);
573 mutex_lock(&qp_grp->vf->pf->usdev_lock);
574 if ((attr_mask & IB_QP_PORT) && attr->port_num != 1) {
575 /* usnic devices only have one port */
576 status = -EINVAL;
577 goto out_unlock;
579 if (attr_mask & IB_QP_STATE) {
580 status = usnic_ib_qp_grp_modify(qp_grp, attr->qp_state, NULL);
581 } else {
582 usnic_err("Unhandled request, attr_mask=0x%x\n", attr_mask);
583 status = -EINVAL;
586 out_unlock:
587 mutex_unlock(&qp_grp->vf->pf->usdev_lock);
588 return status;
591 int usnic_ib_create_cq(struct ib_cq *ibcq, const struct ib_cq_init_attr *attr,
592 struct ib_udata *udata)
594 if (attr->flags)
595 return -EINVAL;
597 return 0;
600 void usnic_ib_destroy_cq(struct ib_cq *cq, struct ib_udata *udata)
602 return;
605 struct ib_mr *usnic_ib_reg_mr(struct ib_pd *pd, u64 start, u64 length,
606 u64 virt_addr, int access_flags,
607 struct ib_udata *udata)
609 struct usnic_ib_mr *mr;
610 int err;
612 usnic_dbg("start 0x%llx va 0x%llx length 0x%llx\n", start,
613 virt_addr, length);
615 mr = kzalloc(sizeof(*mr), GFP_KERNEL);
616 if (!mr)
617 return ERR_PTR(-ENOMEM);
619 mr->umem = usnic_uiom_reg_get(to_upd(pd)->umem_pd, start, length,
620 access_flags, 0);
621 if (IS_ERR_OR_NULL(mr->umem)) {
622 err = mr->umem ? PTR_ERR(mr->umem) : -EFAULT;
623 goto err_free;
626 mr->ibmr.lkey = mr->ibmr.rkey = 0;
627 return &mr->ibmr;
629 err_free:
630 kfree(mr);
631 return ERR_PTR(err);
634 int usnic_ib_dereg_mr(struct ib_mr *ibmr, struct ib_udata *udata)
636 struct usnic_ib_mr *mr = to_umr(ibmr);
638 usnic_dbg("va 0x%lx length 0x%zx\n", mr->umem->va, mr->umem->length);
640 usnic_uiom_reg_release(mr->umem);
641 kfree(mr);
642 return 0;
645 int usnic_ib_alloc_ucontext(struct ib_ucontext *uctx, struct ib_udata *udata)
647 struct ib_device *ibdev = uctx->device;
648 struct usnic_ib_ucontext *context = to_ucontext(uctx);
649 struct usnic_ib_dev *us_ibdev = to_usdev(ibdev);
650 usnic_dbg("\n");
652 INIT_LIST_HEAD(&context->qp_grp_list);
653 mutex_lock(&us_ibdev->usdev_lock);
654 list_add_tail(&context->link, &us_ibdev->ctx_list);
655 mutex_unlock(&us_ibdev->usdev_lock);
657 return 0;
660 void usnic_ib_dealloc_ucontext(struct ib_ucontext *ibcontext)
662 struct usnic_ib_ucontext *context = to_uucontext(ibcontext);
663 struct usnic_ib_dev *us_ibdev = to_usdev(ibcontext->device);
664 usnic_dbg("\n");
666 mutex_lock(&us_ibdev->usdev_lock);
667 WARN_ON_ONCE(!list_empty(&context->qp_grp_list));
668 list_del(&context->link);
669 mutex_unlock(&us_ibdev->usdev_lock);
672 int usnic_ib_mmap(struct ib_ucontext *context,
673 struct vm_area_struct *vma)
675 struct usnic_ib_ucontext *uctx = to_ucontext(context);
676 struct usnic_ib_dev *us_ibdev;
677 struct usnic_ib_qp_grp *qp_grp;
678 struct usnic_ib_vf *vf;
679 struct vnic_dev_bar *bar;
680 dma_addr_t bus_addr;
681 unsigned int len;
682 unsigned int vfid;
684 usnic_dbg("\n");
686 us_ibdev = to_usdev(context->device);
687 vma->vm_flags |= VM_IO;
688 vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
689 vfid = vma->vm_pgoff;
690 usnic_dbg("Page Offset %lu PAGE_SHIFT %u VFID %u\n",
691 vma->vm_pgoff, PAGE_SHIFT, vfid);
693 mutex_lock(&us_ibdev->usdev_lock);
694 list_for_each_entry(qp_grp, &uctx->qp_grp_list, link) {
695 vf = qp_grp->vf;
696 if (usnic_vnic_get_index(vf->vnic) == vfid) {
697 bar = usnic_vnic_get_bar(vf->vnic, 0);
698 if ((vma->vm_end - vma->vm_start) != bar->len) {
699 usnic_err("Bar0 Len %lu - Request map %lu\n",
700 bar->len,
701 vma->vm_end - vma->vm_start);
702 mutex_unlock(&us_ibdev->usdev_lock);
703 return -EINVAL;
705 bus_addr = bar->bus_addr;
706 len = bar->len;
707 usnic_dbg("bus: %pa vaddr: %p size: %ld\n",
708 &bus_addr, bar->vaddr, bar->len);
709 mutex_unlock(&us_ibdev->usdev_lock);
711 return remap_pfn_range(vma,
712 vma->vm_start,
713 bus_addr >> PAGE_SHIFT,
714 len, vma->vm_page_prot);
718 mutex_unlock(&us_ibdev->usdev_lock);
719 usnic_err("No VF %u found\n", vfid);
720 return -EINVAL;