1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
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
54const struct usnic_vnic_res_spec min_transport_spec[USNIC_TRANSPORT_MAX] = {
55 {
56 .resources = {
57 {.type = USNIC_VNIC_RES_TYPE_EOL, .cnt = 0,},
58 },
59 },
60 {
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 {
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
78static void usnic_ib_fw_string_to_u64(char *fw_ver_str, u64 *fw_ver)
79{
80 *fw_ver = *((u64 *)fw_ver_str);
81}
82
83static 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
171static struct usnic_ib_qp_grp*
172find_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
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 = pci_get_drvdata(to_pci_dev(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 }
218
219
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);
228
229 spin_unlock(&vf->lock);
230 goto qp_grp_check;
231 }
232 spin_unlock(&vf->lock);
233 }
234
235 usnic_info("No free qp grp found on %s\n",
236 dev_name(&us_ibdev->ib_dev.dev));
237 return ERR_PTR(-ENOMEM);
238
239qp_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);
243 }
244 return qp_grp;
245}
246
247static void qp_grp_destroy(struct usnic_ib_qp_grp *qp_grp)
248{
249 struct usnic_ib_vf *vf = qp_grp->vf;
250
251 WARN_ON(qp_grp->state != IB_QPS_RESET);
252
253 spin_lock(&vf->lock);
254 usnic_ib_qp_grp_destroy(qp_grp);
255 spin_unlock(&vf->lock);
256}
257
258static int create_qp_validate_user_data(struct usnic_ib_create_qp_cmd cmd)
259{
260 if (cmd.spec.trans_type <= USNIC_TRANSPORT_UNKNOWN ||
261 cmd.spec.trans_type >= USNIC_TRANSPORT_MAX)
262 return -EINVAL;
263
264 return 0;
265}
266
267
268
269enum rdma_link_layer usnic_ib_port_link_layer(struct ib_device *device,
270 u8 port_num)
271{
272 return IB_LINK_LAYER_ETHERNET;
273}
274
275int usnic_ib_query_device(struct ib_device *ibdev,
276 struct ib_device_attr *props,
277 struct ib_udata *uhw)
278{
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;
283
284 usnic_dbg("\n");
285 if (uhw->inlen || uhw->outlen)
286 return -EINVAL;
287
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
327
328 mutex_unlock(&us_ibdev->usdev_lock);
329
330 return 0;
331}
332
333int usnic_ib_query_port(struct ib_device *ibdev, u8 port,
334 struct ib_port_attr *props)
335{
336 struct usnic_ib_dev *us_ibdev = to_usdev(ibdev);
337
338 usnic_dbg("\n");
339
340 if (ib_get_eth_speed(ibdev, port, &props->active_speed,
341 &props->active_width))
342 return -EINVAL;
343
344
345
346
347
348
349 mutex_lock(&us_ibdev->usdev_lock);
350
351
352 props->lid = 0;
353 props->lmc = 1;
354 props->sm_lid = 0;
355 props->sm_sl = 0;
356
357 if (!us_ibdev->ufdev->link_up) {
358 props->state = IB_PORT_DOWN;
359 props->phys_state = 3;
360 } else if (!us_ibdev->ufdev->inaddr) {
361 props->state = IB_PORT_INIT;
362 props->phys_state = 4;
363 } else {
364 props->state = IB_PORT_ACTIVE;
365 props->phys_state = 5;
366 }
367
368 props->port_cap_flags = 0;
369 props->gid_tbl_len = 1;
370 props->pkey_tbl_len = 1;
371 props->bad_pkey_cntr = 0;
372 props->qkey_viol_cntr = 0;
373 props->max_mtu = IB_MTU_4096;
374 props->active_mtu = iboe_get_mtu(us_ibdev->ufdev->mtu);
375
376 props->max_msg_sz = us_ibdev->ufdev->mtu;
377 props->max_vl_num = 1;
378 mutex_unlock(&us_ibdev->usdev_lock);
379
380 return 0;
381}
382
383int usnic_ib_query_qp(struct ib_qp *qp, struct ib_qp_attr *qp_attr,
384 int qp_attr_mask,
385 struct ib_qp_init_attr *qp_init_attr)
386{
387 struct usnic_ib_qp_grp *qp_grp;
388 struct usnic_ib_vf *vf;
389 int err;
390
391 usnic_dbg("\n");
392
393 memset(qp_attr, 0, sizeof(*qp_attr));
394 memset(qp_init_attr, 0, sizeof(*qp_init_attr));
395
396 qp_grp = to_uqp_grp(qp);
397 vf = qp_grp->vf;
398 mutex_lock(&vf->pf->usdev_lock);
399 usnic_dbg("\n");
400 qp_attr->qp_state = qp_grp->state;
401 qp_attr->cur_qp_state = qp_grp->state;
402
403 switch (qp_grp->ibqp.qp_type) {
404 case IB_QPT_UD:
405 qp_attr->qkey = 0;
406 break;
407 default:
408 usnic_err("Unexpected qp_type %d\n", qp_grp->ibqp.qp_type);
409 err = -EINVAL;
410 goto err_out;
411 }
412
413 mutex_unlock(&vf->pf->usdev_lock);
414 return 0;
415
416err_out:
417 mutex_unlock(&vf->pf->usdev_lock);
418 return err;
419}
420
421int usnic_ib_query_gid(struct ib_device *ibdev, u8 port, int index,
422 union ib_gid *gid)
423{
424
425 struct usnic_ib_dev *us_ibdev = to_usdev(ibdev);
426 usnic_dbg("\n");
427
428 if (index > 1)
429 return -EINVAL;
430
431 mutex_lock(&us_ibdev->usdev_lock);
432 memset(&(gid->raw[0]), 0, sizeof(gid->raw));
433 usnic_mac_ip_to_gid(us_ibdev->ufdev->mac, us_ibdev->ufdev->inaddr,
434 &gid->raw[0]);
435 mutex_unlock(&us_ibdev->usdev_lock);
436
437 return 0;
438}
439
440int usnic_ib_query_pkey(struct ib_device *ibdev, u8 port, u16 index,
441 u16 *pkey)
442{
443 if (index > 0)
444 return -EINVAL;
445
446 *pkey = 0xffff;
447 return 0;
448}
449
450int usnic_ib_alloc_pd(struct ib_pd *ibpd, struct ib_udata *udata)
451{
452 struct usnic_ib_pd *pd = to_upd(ibpd);
453 void *umem_pd;
454
455 umem_pd = pd->umem_pd = usnic_uiom_alloc_pd();
456 if (IS_ERR_OR_NULL(umem_pd)) {
457 return umem_pd ? PTR_ERR(umem_pd) : -ENOMEM;
458 }
459
460 return 0;
461}
462
463void usnic_ib_dealloc_pd(struct ib_pd *pd, struct ib_udata *udata)
464{
465 usnic_uiom_dealloc_pd((to_upd(pd))->umem_pd);
466}
467
468struct ib_qp *usnic_ib_create_qp(struct ib_pd *pd,
469 struct ib_qp_init_attr *init_attr,
470 struct ib_udata *udata)
471{
472 int err;
473 struct usnic_ib_dev *us_ibdev;
474 struct usnic_ib_qp_grp *qp_grp;
475 struct usnic_ib_ucontext *ucontext = rdma_udata_to_drv_context(
476 udata, struct usnic_ib_ucontext, ibucontext);
477 int cq_cnt;
478 struct usnic_vnic_res_spec res_spec;
479 struct usnic_ib_create_qp_cmd cmd;
480 struct usnic_transport_spec trans_spec;
481
482 usnic_dbg("\n");
483
484 us_ibdev = to_usdev(pd->device);
485
486 if (init_attr->create_flags)
487 return ERR_PTR(-EINVAL);
488
489 err = ib_copy_from_udata(&cmd, udata, sizeof(cmd));
490 if (err) {
491 usnic_err("%s: cannot copy udata for create_qp\n",
492 dev_name(&us_ibdev->ib_dev.dev));
493 return ERR_PTR(-EINVAL);
494 }
495
496 err = create_qp_validate_user_data(cmd);
497 if (err) {
498 usnic_err("%s: Failed to validate user data\n",
499 dev_name(&us_ibdev->ib_dev.dev));
500 return ERR_PTR(-EINVAL);
501 }
502
503 if (init_attr->qp_type != IB_QPT_UD) {
504 usnic_err("%s asked to make a non-UD QP: %d\n",
505 dev_name(&us_ibdev->ib_dev.dev), init_attr->qp_type);
506 return ERR_PTR(-EINVAL);
507 }
508
509 trans_spec = cmd.spec;
510 mutex_lock(&us_ibdev->usdev_lock);
511 cq_cnt = (init_attr->send_cq == init_attr->recv_cq) ? 1 : 2;
512 res_spec = min_transport_spec[trans_spec.trans_type];
513 usnic_vnic_res_spec_update(&res_spec, USNIC_VNIC_RES_TYPE_CQ, cq_cnt);
514 qp_grp = find_free_vf_and_create_qp_grp(us_ibdev, to_upd(pd),
515 &trans_spec,
516 &res_spec);
517 if (IS_ERR_OR_NULL(qp_grp)) {
518 err = qp_grp ? PTR_ERR(qp_grp) : -ENOMEM;
519 goto out_release_mutex;
520 }
521
522 err = usnic_ib_fill_create_qp_resp(qp_grp, udata);
523 if (err) {
524 err = -EBUSY;
525 goto out_release_qp_grp;
526 }
527
528 qp_grp->ctx = ucontext;
529 list_add_tail(&qp_grp->link, &ucontext->qp_grp_list);
530 usnic_ib_log_vf(qp_grp->vf);
531 mutex_unlock(&us_ibdev->usdev_lock);
532 return &qp_grp->ibqp;
533
534out_release_qp_grp:
535 qp_grp_destroy(qp_grp);
536out_release_mutex:
537 mutex_unlock(&us_ibdev->usdev_lock);
538 return ERR_PTR(err);
539}
540
541int usnic_ib_destroy_qp(struct ib_qp *qp, struct ib_udata *udata)
542{
543 struct usnic_ib_qp_grp *qp_grp;
544 struct usnic_ib_vf *vf;
545
546 usnic_dbg("\n");
547
548 qp_grp = to_uqp_grp(qp);
549 vf = qp_grp->vf;
550 mutex_lock(&vf->pf->usdev_lock);
551 if (usnic_ib_qp_grp_modify(qp_grp, IB_QPS_RESET, NULL)) {
552 usnic_err("Failed to move qp grp %u to reset\n",
553 qp_grp->grp_id);
554 }
555
556 list_del(&qp_grp->link);
557 qp_grp_destroy(qp_grp);
558 mutex_unlock(&vf->pf->usdev_lock);
559
560 return 0;
561}
562
563int usnic_ib_modify_qp(struct ib_qp *ibqp, struct ib_qp_attr *attr,
564 int attr_mask, struct ib_udata *udata)
565{
566 struct usnic_ib_qp_grp *qp_grp;
567 int status;
568 usnic_dbg("\n");
569
570 qp_grp = to_uqp_grp(ibqp);
571
572 mutex_lock(&qp_grp->vf->pf->usdev_lock);
573 if ((attr_mask & IB_QP_PORT) && attr->port_num != 1) {
574
575 status = -EINVAL;
576 goto out_unlock;
577 }
578 if (attr_mask & IB_QP_STATE) {
579 status = usnic_ib_qp_grp_modify(qp_grp, attr->qp_state, NULL);
580 } else {
581 usnic_err("Unhandled request, attr_mask=0x%x\n", attr_mask);
582 status = -EINVAL;
583 }
584
585out_unlock:
586 mutex_unlock(&qp_grp->vf->pf->usdev_lock);
587 return status;
588}
589
590int usnic_ib_create_cq(struct ib_cq *ibcq, const struct ib_cq_init_attr *attr,
591 struct ib_udata *udata)
592{
593 if (attr->flags)
594 return -EINVAL;
595
596 return 0;
597}
598
599void usnic_ib_destroy_cq(struct ib_cq *cq, struct ib_udata *udata)
600{
601 return;
602}
603
604struct ib_mr *usnic_ib_reg_mr(struct ib_pd *pd, u64 start, u64 length,
605 u64 virt_addr, int access_flags,
606 struct ib_udata *udata)
607{
608 struct usnic_ib_mr *mr;
609 int err;
610
611 usnic_dbg("start 0x%llx va 0x%llx length 0x%llx\n", start,
612 virt_addr, length);
613
614 mr = kzalloc(sizeof(*mr), GFP_KERNEL);
615 if (!mr)
616 return ERR_PTR(-ENOMEM);
617
618 mr->umem = usnic_uiom_reg_get(to_upd(pd)->umem_pd, start, length,
619 access_flags, 0);
620 if (IS_ERR_OR_NULL(mr->umem)) {
621 err = mr->umem ? PTR_ERR(mr->umem) : -EFAULT;
622 goto err_free;
623 }
624
625 mr->ibmr.lkey = mr->ibmr.rkey = 0;
626 return &mr->ibmr;
627
628err_free:
629 kfree(mr);
630 return ERR_PTR(err);
631}
632
633int usnic_ib_dereg_mr(struct ib_mr *ibmr, struct ib_udata *udata)
634{
635 struct usnic_ib_mr *mr = to_umr(ibmr);
636
637 usnic_dbg("va 0x%lx length 0x%zx\n", mr->umem->va, mr->umem->length);
638
639 usnic_uiom_reg_release(mr->umem);
640 kfree(mr);
641 return 0;
642}
643
644int usnic_ib_alloc_ucontext(struct ib_ucontext *uctx, struct ib_udata *udata)
645{
646 struct ib_device *ibdev = uctx->device;
647 struct usnic_ib_ucontext *context = to_ucontext(uctx);
648 struct usnic_ib_dev *us_ibdev = to_usdev(ibdev);
649 usnic_dbg("\n");
650
651 INIT_LIST_HEAD(&context->qp_grp_list);
652 mutex_lock(&us_ibdev->usdev_lock);
653 list_add_tail(&context->link, &us_ibdev->ctx_list);
654 mutex_unlock(&us_ibdev->usdev_lock);
655
656 return 0;
657}
658
659void usnic_ib_dealloc_ucontext(struct ib_ucontext *ibcontext)
660{
661 struct usnic_ib_ucontext *context = to_uucontext(ibcontext);
662 struct usnic_ib_dev *us_ibdev = to_usdev(ibcontext->device);
663 usnic_dbg("\n");
664
665 mutex_lock(&us_ibdev->usdev_lock);
666 WARN_ON_ONCE(!list_empty(&context->qp_grp_list));
667 list_del(&context->link);
668 mutex_unlock(&us_ibdev->usdev_lock);
669}
670
671int usnic_ib_mmap(struct ib_ucontext *context,
672 struct vm_area_struct *vma)
673{
674 struct usnic_ib_ucontext *uctx = to_ucontext(context);
675 struct usnic_ib_dev *us_ibdev;
676 struct usnic_ib_qp_grp *qp_grp;
677 struct usnic_ib_vf *vf;
678 struct vnic_dev_bar *bar;
679 dma_addr_t bus_addr;
680 unsigned int len;
681 unsigned int vfid;
682
683 usnic_dbg("\n");
684
685 us_ibdev = to_usdev(context->device);
686 vma->vm_flags |= VM_IO;
687 vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
688 vfid = vma->vm_pgoff;
689 usnic_dbg("Page Offset %lu PAGE_SHIFT %u VFID %u\n",
690 vma->vm_pgoff, PAGE_SHIFT, vfid);
691
692 mutex_lock(&us_ibdev->usdev_lock);
693 list_for_each_entry(qp_grp, &uctx->qp_grp_list, link) {
694 vf = qp_grp->vf;
695 if (usnic_vnic_get_index(vf->vnic) == vfid) {
696 bar = usnic_vnic_get_bar(vf->vnic, 0);
697 if ((vma->vm_end - vma->vm_start) != bar->len) {
698 usnic_err("Bar0 Len %lu - Request map %lu\n",
699 bar->len,
700 vma->vm_end - vma->vm_start);
701 mutex_unlock(&us_ibdev->usdev_lock);
702 return -EINVAL;
703 }
704 bus_addr = bar->bus_addr;
705 len = bar->len;
706 usnic_dbg("bus: %pa vaddr: %p size: %ld\n",
707 &bus_addr, bar->vaddr, bar->len);
708 mutex_unlock(&us_ibdev->usdev_lock);
709
710 return remap_pfn_range(vma,
711 vma->vm_start,
712 bus_addr >> PAGE_SHIFT,
713 len, vma->vm_page_prot);
714 }
715 }
716
717 mutex_unlock(&us_ibdev->usdev_lock);
718 usnic_err("No VF %u found\n", vfid);
719 return -EINVAL;
720}
721
722
