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
34#include <linux/dma-mapping.h>
35#include <net/addrconf.h>
36#include "rxe.h"
37#include "rxe_loc.h"
38#include "rxe_queue.h"
39#include "rxe_hw_counters.h"
40
41static int rxe_query_device(struct ib_device *dev,
42 struct ib_device_attr *attr,
43 struct ib_udata *uhw)
44{
45 struct rxe_dev *rxe = to_rdev(dev);
46
47 if (uhw->inlen || uhw->outlen)
48 return -EINVAL;
49
50 *attr = rxe->attr;
51 return 0;
52}
53
54static int rxe_query_port(struct ib_device *dev,
55 u8 port_num, struct ib_port_attr *attr)
56{
57 struct rxe_dev *rxe = to_rdev(dev);
58 struct rxe_port *port;
59 int rc = -EINVAL;
60
61 if (unlikely(port_num != 1)) {
62 pr_warn("invalid port_number %d\n", port_num);
63 goto out;
64 }
65
66 port = &rxe->port;
67
68
69 *attr = port->attr;
70
71 mutex_lock(&rxe->usdev_lock);
72 rc = ib_get_eth_speed(dev, port_num, &attr->active_speed,
73 &attr->active_width);
74 mutex_unlock(&rxe->usdev_lock);
75
76out:
77 return rc;
78}
79
80static int rxe_query_gid(struct ib_device *device,
81 u8 port_num, int index, union ib_gid *gid)
82{
83 int ret;
84
85 if (index > RXE_PORT_GID_TBL_LEN)
86 return -EINVAL;
87
88 ret = ib_get_cached_gid(device, port_num, index, gid, NULL);
89 if (ret == -EAGAIN) {
90 memcpy(gid, &zgid, sizeof(*gid));
91 return 0;
92 }
93
94 return ret;
95}
96
97static int rxe_add_gid(struct ib_device *device, u8 port_num, unsigned int
98 index, const union ib_gid *gid,
99 const struct ib_gid_attr *attr, void **context)
100{
101 if (index >= RXE_PORT_GID_TBL_LEN)
102 return -EINVAL;
103 return 0;
104}
105
106static int rxe_del_gid(struct ib_device *device, u8 port_num, unsigned int
107 index, void **context)
108{
109 if (index >= RXE_PORT_GID_TBL_LEN)
110 return -EINVAL;
111 return 0;
112}
113
114static struct net_device *rxe_get_netdev(struct ib_device *device,
115 u8 port_num)
116{
117 struct rxe_dev *rxe = to_rdev(device);
118
119 if (rxe->ndev) {
120 dev_hold(rxe->ndev);
121 return rxe->ndev;
122 }
123
124 return NULL;
125}
126
127static int rxe_query_pkey(struct ib_device *device,
128 u8 port_num, u16 index, u16 *pkey)
129{
130 struct rxe_dev *rxe = to_rdev(device);
131 struct rxe_port *port;
132
133 if (unlikely(port_num != 1)) {
134 dev_warn(device->dev.parent, "invalid port_num = %d\n",
135 port_num);
136 goto err1;
137 }
138
139 port = &rxe->port;
140
141 if (unlikely(index >= port->attr.pkey_tbl_len)) {
142 dev_warn(device->dev.parent, "invalid index = %d\n",
143 index);
144 goto err1;
145 }
146
147 *pkey = port->pkey_tbl[index];
148 return 0;
149
150err1:
151 return -EINVAL;
152}
153
154static int rxe_modify_device(struct ib_device *dev,
155 int mask, struct ib_device_modify *attr)
156{
157 struct rxe_dev *rxe = to_rdev(dev);
158
159 if (mask & IB_DEVICE_MODIFY_SYS_IMAGE_GUID)
160 rxe->attr.sys_image_guid = cpu_to_be64(attr->sys_image_guid);
161
162 if (mask & IB_DEVICE_MODIFY_NODE_DESC) {
163 memcpy(rxe->ib_dev.node_desc,
164 attr->node_desc, sizeof(rxe->ib_dev.node_desc));
165 }
166
167 return 0;
168}
169
170static int rxe_modify_port(struct ib_device *dev,
171 u8 port_num, int mask, struct ib_port_modify *attr)
172{
173 struct rxe_dev *rxe = to_rdev(dev);
174 struct rxe_port *port;
175
176 if (unlikely(port_num != 1)) {
177 pr_warn("invalid port_num = %d\n", port_num);
178 goto err1;
179 }
180
181 port = &rxe->port;
182
183 port->attr.port_cap_flags |= attr->set_port_cap_mask;
184 port->attr.port_cap_flags &= ~attr->clr_port_cap_mask;
185
186 if (mask & IB_PORT_RESET_QKEY_CNTR)
187 port->attr.qkey_viol_cntr = 0;
188
189 return 0;
190
191err1:
192 return -EINVAL;
193}
194
195static enum rdma_link_layer rxe_get_link_layer(struct ib_device *dev,
196 u8 port_num)
197{
198 struct rxe_dev *rxe = to_rdev(dev);
199
200 return rxe_link_layer(rxe, port_num);
201}
202
203static struct ib_ucontext *rxe_alloc_ucontext(struct ib_device *dev,
204 struct ib_udata *udata)
205{
206 struct rxe_dev *rxe = to_rdev(dev);
207 struct rxe_ucontext *uc;
208
209 uc = rxe_alloc(&rxe->uc_pool);
210 return uc ? &uc->ibuc : ERR_PTR(-ENOMEM);
211}
212
213static int rxe_dealloc_ucontext(struct ib_ucontext *ibuc)
214{
215 struct rxe_ucontext *uc = to_ruc(ibuc);
216
217 rxe_drop_ref(uc);
218 return 0;
219}
220
221static int rxe_port_immutable(struct ib_device *dev, u8 port_num,
222 struct ib_port_immutable *immutable)
223{
224 int err;
225 struct ib_port_attr attr;
226
227 immutable->core_cap_flags = RDMA_CORE_PORT_IBA_ROCE_UDP_ENCAP;
228
229 err = ib_query_port(dev, port_num, &attr);
230 if (err)
231 return err;
232
233 immutable->pkey_tbl_len = attr.pkey_tbl_len;
234 immutable->gid_tbl_len = attr.gid_tbl_len;
235 immutable->max_mad_size = IB_MGMT_MAD_SIZE;
236
237 return 0;
238}
239
240static struct ib_pd *rxe_alloc_pd(struct ib_device *dev,
241 struct ib_ucontext *context,
242 struct ib_udata *udata)
243{
244 struct rxe_dev *rxe = to_rdev(dev);
245 struct rxe_pd *pd;
246
247 pd = rxe_alloc(&rxe->pd_pool);
248 return pd ? &pd->ibpd : ERR_PTR(-ENOMEM);
249}
250
251static int rxe_dealloc_pd(struct ib_pd *ibpd)
252{
253 struct rxe_pd *pd = to_rpd(ibpd);
254
255 rxe_drop_ref(pd);
256 return 0;
257}
258
259static int rxe_init_av(struct rxe_dev *rxe, struct rdma_ah_attr *attr,
260 struct rxe_av *av)
261{
262 int err;
263 union ib_gid sgid;
264 struct ib_gid_attr sgid_attr;
265
266 err = ib_get_cached_gid(&rxe->ib_dev, rdma_ah_get_port_num(attr),
267 rdma_ah_read_grh(attr)->sgid_index, &sgid,
268 &sgid_attr);
269 if (err) {
270 pr_err("Failed to query sgid. err = %d\n", err);
271 return err;
272 }
273
274 rxe_av_from_attr(rdma_ah_get_port_num(attr), av, attr);
275 rxe_av_fill_ip_info(av, attr, &sgid_attr, &sgid);
276
277 if (sgid_attr.ndev)
278 dev_put(sgid_attr.ndev);
279 return 0;
280}
281
282static struct ib_ah *rxe_create_ah(struct ib_pd *ibpd,
283 struct rdma_ah_attr *attr,
284 struct ib_udata *udata)
285
286{
287 int err;
288 struct rxe_dev *rxe = to_rdev(ibpd->device);
289 struct rxe_pd *pd = to_rpd(ibpd);
290 struct rxe_ah *ah;
291
292 err = rxe_av_chk_attr(rxe, attr);
293 if (err)
294 goto err1;
295
296 ah = rxe_alloc(&rxe->ah_pool);
297 if (!ah) {
298 err = -ENOMEM;
299 goto err1;
300 }
301
302 rxe_add_ref(pd);
303 ah->pd = pd;
304
305 err = rxe_init_av(rxe, attr, &ah->av);
306 if (err)
307 goto err2;
308
309 return &ah->ibah;
310
311err2:
312 rxe_drop_ref(pd);
313 rxe_drop_ref(ah);
314err1:
315 return ERR_PTR(err);
316}
317
318static int rxe_modify_ah(struct ib_ah *ibah, struct rdma_ah_attr *attr)
319{
320 int err;
321 struct rxe_dev *rxe = to_rdev(ibah->device);
322 struct rxe_ah *ah = to_rah(ibah);
323
324 err = rxe_av_chk_attr(rxe, attr);
325 if (err)
326 return err;
327
328 err = rxe_init_av(rxe, attr, &ah->av);
329 if (err)
330 return err;
331
332 return 0;
333}
334
335static int rxe_query_ah(struct ib_ah *ibah, struct rdma_ah_attr *attr)
336{
337 struct rxe_ah *ah = to_rah(ibah);
338
339 memset(attr, 0, sizeof(*attr));
340 attr->type = ibah->type;
341 rxe_av_to_attr(&ah->av, attr);
342 return 0;
343}
344
345static int rxe_destroy_ah(struct ib_ah *ibah)
346{
347 struct rxe_ah *ah = to_rah(ibah);
348
349 rxe_drop_ref(ah->pd);
350 rxe_drop_ref(ah);
351 return 0;
352}
353
354static int post_one_recv(struct rxe_rq *rq, struct ib_recv_wr *ibwr)
355{
356 int err;
357 int i;
358 u32 length;
359 struct rxe_recv_wqe *recv_wqe;
360 int num_sge = ibwr->num_sge;
361
362 if (unlikely(queue_full(rq->queue))) {
363 err = -ENOMEM;
364 goto err1;
365 }
366
367 if (unlikely(num_sge > rq->max_sge)) {
368 err = -EINVAL;
369 goto err1;
370 }
371
372 length = 0;
373 for (i = 0; i < num_sge; i++)
374 length += ibwr->sg_list[i].length;
375
376 recv_wqe = producer_addr(rq->queue);
377 recv_wqe->wr_id = ibwr->wr_id;
378 recv_wqe->num_sge = num_sge;
379
380 memcpy(recv_wqe->dma.sge, ibwr->sg_list,
381 num_sge * sizeof(struct ib_sge));
382
383 recv_wqe->dma.length = length;
384 recv_wqe->dma.resid = length;
385 recv_wqe->dma.num_sge = num_sge;
386 recv_wqe->dma.cur_sge = 0;
387 recv_wqe->dma.sge_offset = 0;
388
389
390
391
392 smp_wmb();
393
394 advance_producer(rq->queue);
395 return 0;
396
397err1:
398 return err;
399}
400
401static struct ib_srq *rxe_create_srq(struct ib_pd *ibpd,
402 struct ib_srq_init_attr *init,
403 struct ib_udata *udata)
404{
405 int err;
406 struct rxe_dev *rxe = to_rdev(ibpd->device);
407 struct rxe_pd *pd = to_rpd(ibpd);
408 struct rxe_srq *srq;
409 struct ib_ucontext *context = udata ? ibpd->uobject->context : NULL;
410
411 err = rxe_srq_chk_attr(rxe, NULL, &init->attr, IB_SRQ_INIT_MASK);
412 if (err)
413 goto err1;
414
415 srq = rxe_alloc(&rxe->srq_pool);
416 if (!srq) {
417 err = -ENOMEM;
418 goto err1;
419 }
420
421 rxe_add_index(srq);
422 rxe_add_ref(pd);
423 srq->pd = pd;
424
425 err = rxe_srq_from_init(rxe, srq, init, context, udata);
426 if (err)
427 goto err2;
428
429 return &srq->ibsrq;
430
431err2:
432 rxe_drop_ref(pd);
433 rxe_drop_index(srq);
434 rxe_drop_ref(srq);
435err1:
436 return ERR_PTR(err);
437}
438
439static int rxe_modify_srq(struct ib_srq *ibsrq, struct ib_srq_attr *attr,
440 enum ib_srq_attr_mask mask,
441 struct ib_udata *udata)
442{
443 int err;
444 struct rxe_srq *srq = to_rsrq(ibsrq);
445 struct rxe_dev *rxe = to_rdev(ibsrq->device);
446
447 err = rxe_srq_chk_attr(rxe, srq, attr, mask);
448 if (err)
449 goto err1;
450
451 err = rxe_srq_from_attr(rxe, srq, attr, mask, udata);
452 if (err)
453 goto err1;
454
455 return 0;
456
457err1:
458 return err;
459}
460
461static int rxe_query_srq(struct ib_srq *ibsrq, struct ib_srq_attr *attr)
462{
463 struct rxe_srq *srq = to_rsrq(ibsrq);
464
465 if (srq->error)
466 return -EINVAL;
467
468 attr->max_wr = srq->rq.queue->buf->index_mask;
469 attr->max_sge = srq->rq.max_sge;
470 attr->srq_limit = srq->limit;
471 return 0;
472}
473
474static int rxe_destroy_srq(struct ib_srq *ibsrq)
475{
476 struct rxe_srq *srq = to_rsrq(ibsrq);
477
478 if (srq->rq.queue)
479 rxe_queue_cleanup(srq->rq.queue);
480
481 rxe_drop_ref(srq->pd);
482 rxe_drop_index(srq);
483 rxe_drop_ref(srq);
484
485 return 0;
486}
487
488static int rxe_post_srq_recv(struct ib_srq *ibsrq, struct ib_recv_wr *wr,
489 struct ib_recv_wr **bad_wr)
490{
491 int err = 0;
492 unsigned long flags;
493 struct rxe_srq *srq = to_rsrq(ibsrq);
494
495 spin_lock_irqsave(&srq->rq.producer_lock, flags);
496
497 while (wr) {
498 err = post_one_recv(&srq->rq, wr);
499 if (unlikely(err))
500 break;
501 wr = wr->next;
502 }
503
504 spin_unlock_irqrestore(&srq->rq.producer_lock, flags);
505
506 if (err)
507 *bad_wr = wr;
508
509 return err;
510}
511
512static struct ib_qp *rxe_create_qp(struct ib_pd *ibpd,
513 struct ib_qp_init_attr *init,
514 struct ib_udata *udata)
515{
516 int err;
517 struct rxe_dev *rxe = to_rdev(ibpd->device);
518 struct rxe_pd *pd = to_rpd(ibpd);
519 struct rxe_qp *qp;
520
521 err = rxe_qp_chk_init(rxe, init);
522 if (err)
523 goto err1;
524
525 qp = rxe_alloc(&rxe->qp_pool);
526 if (!qp) {
527 err = -ENOMEM;
528 goto err1;
529 }
530
531 if (udata) {
532 if (udata->inlen) {
533 err = -EINVAL;
534 goto err2;
535 }
536 qp->is_user = 1;
537 }
538
539 rxe_add_index(qp);
540
541 err = rxe_qp_from_init(rxe, qp, pd, init, udata, ibpd);
542 if (err)
543 goto err3;
544
545 return &qp->ibqp;
546
547err3:
548 rxe_drop_index(qp);
549err2:
550 rxe_drop_ref(qp);
551err1:
552 return ERR_PTR(err);
553}
554
555static int rxe_modify_qp(struct ib_qp *ibqp, struct ib_qp_attr *attr,
556 int mask, struct ib_udata *udata)
557{
558 int err;
559 struct rxe_dev *rxe = to_rdev(ibqp->device);
560 struct rxe_qp *qp = to_rqp(ibqp);
561
562 err = rxe_qp_chk_attr(rxe, qp, attr, mask);
563 if (err)
564 goto err1;
565
566 err = rxe_qp_from_attr(qp, attr, mask, udata);
567 if (err)
568 goto err1;
569
570 return 0;
571
572err1:
573 return err;
574}
575
576static int rxe_query_qp(struct ib_qp *ibqp, struct ib_qp_attr *attr,
577 int mask, struct ib_qp_init_attr *init)
578{
579 struct rxe_qp *qp = to_rqp(ibqp);
580
581 rxe_qp_to_init(qp, init);
582 rxe_qp_to_attr(qp, attr, mask);
583
584 return 0;
585}
586
587static int rxe_destroy_qp(struct ib_qp *ibqp)
588{
589 struct rxe_qp *qp = to_rqp(ibqp);
590
591 rxe_qp_destroy(qp);
592 rxe_drop_index(qp);
593 rxe_drop_ref(qp);
594 return 0;
595}
596
597static int validate_send_wr(struct rxe_qp *qp, struct ib_send_wr *ibwr,
598 unsigned int mask, unsigned int length)
599{
600 int num_sge = ibwr->num_sge;
601 struct rxe_sq *sq = &qp->sq;
602
603 if (unlikely(num_sge > sq->max_sge))
604 goto err1;
605
606 if (unlikely(mask & WR_ATOMIC_MASK)) {
607 if (length < 8)
608 goto err1;
609
610 if (atomic_wr(ibwr)->remote_addr & 0x7)
611 goto err1;
612 }
613
614 if (unlikely((ibwr->send_flags & IB_SEND_INLINE) &&
615 (length > sq->max_inline)))
616 goto err1;
617
618 return 0;
619
620err1:
621 return -EINVAL;
622}
623
624static void init_send_wr(struct rxe_qp *qp, struct rxe_send_wr *wr,
625 struct ib_send_wr *ibwr)
626{
627 wr->wr_id = ibwr->wr_id;
628 wr->num_sge = ibwr->num_sge;
629 wr->opcode = ibwr->opcode;
630 wr->send_flags = ibwr->send_flags;
631
632 if (qp_type(qp) == IB_QPT_UD ||
633 qp_type(qp) == IB_QPT_SMI ||
634 qp_type(qp) == IB_QPT_GSI) {
635 wr->wr.ud.remote_qpn = ud_wr(ibwr)->remote_qpn;
636 wr->wr.ud.remote_qkey = ud_wr(ibwr)->remote_qkey;
637 if (qp_type(qp) == IB_QPT_GSI)
638 wr->wr.ud.pkey_index = ud_wr(ibwr)->pkey_index;
639 if (wr->opcode == IB_WR_SEND_WITH_IMM)
640 wr->ex.imm_data = ibwr->ex.imm_data;
641 } else {
642 switch (wr->opcode) {
643 case IB_WR_RDMA_WRITE_WITH_IMM:
644 wr->ex.imm_data = ibwr->ex.imm_data;
645
646 case IB_WR_RDMA_READ:
647 case IB_WR_RDMA_WRITE:
648 wr->wr.rdma.remote_addr = rdma_wr(ibwr)->remote_addr;
649 wr->wr.rdma.rkey = rdma_wr(ibwr)->rkey;
650 break;
651 case IB_WR_SEND_WITH_IMM:
652 wr->ex.imm_data = ibwr->ex.imm_data;
653 break;
654 case IB_WR_SEND_WITH_INV:
655 wr->ex.invalidate_rkey = ibwr->ex.invalidate_rkey;
656 break;
657 case IB_WR_ATOMIC_CMP_AND_SWP:
658 case IB_WR_ATOMIC_FETCH_AND_ADD:
659 wr->wr.atomic.remote_addr =
660 atomic_wr(ibwr)->remote_addr;
661 wr->wr.atomic.compare_add =
662 atomic_wr(ibwr)->compare_add;
663 wr->wr.atomic.swap = atomic_wr(ibwr)->swap;
664 wr->wr.atomic.rkey = atomic_wr(ibwr)->rkey;
665 break;
666 case IB_WR_LOCAL_INV:
667 wr->ex.invalidate_rkey = ibwr->ex.invalidate_rkey;
668 break;
669 case IB_WR_REG_MR:
670 wr->wr.reg.mr = reg_wr(ibwr)->mr;
671 wr->wr.reg.key = reg_wr(ibwr)->key;
672 wr->wr.reg.access = reg_wr(ibwr)->access;
673 break;
674 default:
675 break;
676 }
677 }
678}
679
680static int init_send_wqe(struct rxe_qp *qp, struct ib_send_wr *ibwr,
681 unsigned int mask, unsigned int length,
682 struct rxe_send_wqe *wqe)
683{
684 int num_sge = ibwr->num_sge;
685 struct ib_sge *sge;
686 int i;
687 u8 *p;
688
689 init_send_wr(qp, &wqe->wr, ibwr);
690
691 if (qp_type(qp) == IB_QPT_UD ||
692 qp_type(qp) == IB_QPT_SMI ||
693 qp_type(qp) == IB_QPT_GSI)
694 memcpy(&wqe->av, &to_rah(ud_wr(ibwr)->ah)->av, sizeof(wqe->av));
695
696 if (unlikely(ibwr->send_flags & IB_SEND_INLINE)) {
697 p = wqe->dma.inline_data;
698
699 sge = ibwr->sg_list;
700 for (i = 0; i < num_sge; i++, sge++) {
701 memcpy(p, (void *)(uintptr_t)sge->addr,
702 sge->length);
703
704 p += sge->length;
705 }
706 } else if (mask & WR_REG_MASK) {
707 wqe->mask = mask;
708 wqe->state = wqe_state_posted;
709 return 0;
710 } else
711 memcpy(wqe->dma.sge, ibwr->sg_list,
712 num_sge * sizeof(struct ib_sge));
713
714 wqe->iova = (mask & WR_ATOMIC_MASK) ?
715 atomic_wr(ibwr)->remote_addr :
716 rdma_wr(ibwr)->remote_addr;
717 wqe->mask = mask;
718 wqe->dma.length = length;
719 wqe->dma.resid = length;
720 wqe->dma.num_sge = num_sge;
721 wqe->dma.cur_sge = 0;
722 wqe->dma.sge_offset = 0;
723 wqe->state = wqe_state_posted;
724 wqe->ssn = atomic_add_return(1, &qp->ssn);
725
726 return 0;
727}
728
729static int post_one_send(struct rxe_qp *qp, struct ib_send_wr *ibwr,
730 unsigned int mask, u32 length)
731{
732 int err;
733 struct rxe_sq *sq = &qp->sq;
734 struct rxe_send_wqe *send_wqe;
735 unsigned long flags;
736
737 err = validate_send_wr(qp, ibwr, mask, length);
738 if (err)
739 return err;
740
741 spin_lock_irqsave(&qp->sq.sq_lock, flags);
742
743 if (unlikely(queue_full(sq->queue))) {
744 err = -ENOMEM;
745 goto err1;
746 }
747
748 send_wqe = producer_addr(sq->queue);
749
750 err = init_send_wqe(qp, ibwr, mask, length, send_wqe);
751 if (unlikely(err))
752 goto err1;
753
754
755
756
757
758 smp_wmb();
759
760 advance_producer(sq->queue);
761 spin_unlock_irqrestore(&qp->sq.sq_lock, flags);
762
763 return 0;
764
765err1:
766 spin_unlock_irqrestore(&qp->sq.sq_lock, flags);
767 return err;
768}
769
770static int rxe_post_send_kernel(struct rxe_qp *qp, struct ib_send_wr *wr,
771 struct ib_send_wr **bad_wr)
772{
773 int err = 0;
774 unsigned int mask;
775 unsigned int length = 0;
776 int i;
777 int must_sched;
778
779 while (wr) {
780 mask = wr_opcode_mask(wr->opcode, qp);
781 if (unlikely(!mask)) {
782 err = -EINVAL;
783 *bad_wr = wr;
784 break;
785 }
786
787 if (unlikely((wr->send_flags & IB_SEND_INLINE) &&
788 !(mask & WR_INLINE_MASK))) {
789 err = -EINVAL;
790 *bad_wr = wr;
791 break;
792 }
793
794 length = 0;
795 for (i = 0; i < wr->num_sge; i++)
796 length += wr->sg_list[i].length;
797
798 err = post_one_send(qp, wr, mask, length);
799
800 if (err) {
801 *bad_wr = wr;
802 break;
803 }
804 wr = wr->next;
805 }
806
807
808
809
810
811 must_sched = (qp_type(qp) == IB_QPT_GSI) ||
812 (queue_count(qp->sq.queue) > 1);
813
814 rxe_run_task(&qp->req.task, must_sched);
815 if (unlikely(qp->req.state == QP_STATE_ERROR))
816 rxe_run_task(&qp->comp.task, 1);
817
818 return err;
819}
820
821static int rxe_post_send(struct ib_qp *ibqp, struct ib_send_wr *wr,
822 struct ib_send_wr **bad_wr)
823{
824 struct rxe_qp *qp = to_rqp(ibqp);
825
826 if (unlikely(!qp->valid)) {
827 *bad_wr = wr;
828 return -EINVAL;
829 }
830
831 if (unlikely(qp->req.state < QP_STATE_READY)) {
832 *bad_wr = wr;
833 return -EINVAL;
834 }
835
836 if (qp->is_user) {
837
838 rxe_run_task(&qp->req.task, 0);
839 return 0;
840 } else
841 return rxe_post_send_kernel(qp, wr, bad_wr);
842}
843
844static int rxe_post_recv(struct ib_qp *ibqp, struct ib_recv_wr *wr,
845 struct ib_recv_wr **bad_wr)
846{
847 int err = 0;
848 struct rxe_qp *qp = to_rqp(ibqp);
849 struct rxe_rq *rq = &qp->rq;
850 unsigned long flags;
851
852 if (unlikely((qp_state(qp) < IB_QPS_INIT) || !qp->valid)) {
853 *bad_wr = wr;
854 err = -EINVAL;
855 goto err1;
856 }
857
858 if (unlikely(qp->srq)) {
859 *bad_wr = wr;
860 err = -EINVAL;
861 goto err1;
862 }
863
864 spin_lock_irqsave(&rq->producer_lock, flags);
865
866 while (wr) {
867 err = post_one_recv(rq, wr);
868 if (unlikely(err)) {
869 *bad_wr = wr;
870 break;
871 }
872 wr = wr->next;
873 }
874
875 spin_unlock_irqrestore(&rq->producer_lock, flags);
876
877 if (qp->resp.state == QP_STATE_ERROR)
878 rxe_run_task(&qp->resp.task, 1);
879
880err1:
881 return err;
882}
883
884static struct ib_cq *rxe_create_cq(struct ib_device *dev,
885 const struct ib_cq_init_attr *attr,
886 struct ib_ucontext *context,
887 struct ib_udata *udata)
888{
889 int err;
890 struct rxe_dev *rxe = to_rdev(dev);
891 struct rxe_cq *cq;
892
893 if (attr->flags)
894 return ERR_PTR(-EINVAL);
895
896 err = rxe_cq_chk_attr(rxe, NULL, attr->cqe, attr->comp_vector, udata);
897 if (err)
898 goto err1;
899
900 cq = rxe_alloc(&rxe->cq_pool);
901 if (!cq) {
902 err = -ENOMEM;
903 goto err1;
904 }
905
906 err = rxe_cq_from_init(rxe, cq, attr->cqe, attr->comp_vector,
907 context, udata);
908 if (err)
909 goto err2;
910
911 return &cq->ibcq;
912
913err2:
914 rxe_drop_ref(cq);
915err1:
916 return ERR_PTR(err);
917}
918
919static int rxe_destroy_cq(struct ib_cq *ibcq)
920{
921 struct rxe_cq *cq = to_rcq(ibcq);
922
923 rxe_cq_disable(cq);
924
925 rxe_drop_ref(cq);
926 return 0;
927}
928
929static int rxe_resize_cq(struct ib_cq *ibcq, int cqe, struct ib_udata *udata)
930{
931 int err;
932 struct rxe_cq *cq = to_rcq(ibcq);
933 struct rxe_dev *rxe = to_rdev(ibcq->device);
934
935 err = rxe_cq_chk_attr(rxe, cq, cqe, 0, udata);
936 if (err)
937 goto err1;
938
939 err = rxe_cq_resize_queue(cq, cqe, udata);
940 if (err)
941 goto err1;
942
943 return 0;
944
945err1:
946 return err;
947}
948
949static int rxe_poll_cq(struct ib_cq *ibcq, int num_entries, struct ib_wc *wc)
950{
951 int i;
952 struct rxe_cq *cq = to_rcq(ibcq);
953 struct rxe_cqe *cqe;
954 unsigned long flags;
955
956 spin_lock_irqsave(&cq->cq_lock, flags);
957 for (i = 0; i < num_entries; i++) {
958 cqe = queue_head(cq->queue);
959 if (!cqe)
960 break;
961
962 memcpy(wc++, &cqe->ibwc, sizeof(*wc));
963 advance_consumer(cq->queue);
964 }
965 spin_unlock_irqrestore(&cq->cq_lock, flags);
966
967 return i;
968}
969
970static int rxe_peek_cq(struct ib_cq *ibcq, int wc_cnt)
971{
972 struct rxe_cq *cq = to_rcq(ibcq);
973 int count = queue_count(cq->queue);
974
975 return (count > wc_cnt) ? wc_cnt : count;
976}
977
978static int rxe_req_notify_cq(struct ib_cq *ibcq, enum ib_cq_notify_flags flags)
979{
980 struct rxe_cq *cq = to_rcq(ibcq);
981 unsigned long irq_flags;
982 int ret = 0;
983
984 spin_lock_irqsave(&cq->cq_lock, irq_flags);
985 if (cq->notify != IB_CQ_NEXT_COMP)
986 cq->notify = flags & IB_CQ_SOLICITED_MASK;
987
988 if ((flags & IB_CQ_REPORT_MISSED_EVENTS) && !queue_empty(cq->queue))
989 ret = 1;
990
991 spin_unlock_irqrestore(&cq->cq_lock, irq_flags);
992
993 return ret;
994}
995
996static struct ib_mr *rxe_get_dma_mr(struct ib_pd *ibpd, int access)
997{
998 struct rxe_dev *rxe = to_rdev(ibpd->device);
999 struct rxe_pd *pd = to_rpd(ibpd);
1000 struct rxe_mem *mr;
1001 int err;
1002
1003 mr = rxe_alloc(&rxe->mr_pool);
1004 if (!mr) {
1005 err = -ENOMEM;
1006 goto err1;
1007 }
1008
1009 rxe_add_index(mr);
1010
1011 rxe_add_ref(pd);
1012
1013 err = rxe_mem_init_dma(rxe, pd, access, mr);
1014 if (err)
1015 goto err2;
1016
1017 return &mr->ibmr;
1018
1019err2:
1020 rxe_drop_ref(pd);
1021 rxe_drop_index(mr);
1022 rxe_drop_ref(mr);
1023err1:
1024 return ERR_PTR(err);
1025}
1026
1027static struct ib_mr *rxe_reg_user_mr(struct ib_pd *ibpd,
1028 u64 start,
1029 u64 length,
1030 u64 iova,
1031 int access, struct ib_udata *udata)
1032{
1033 int err;
1034 struct rxe_dev *rxe = to_rdev(ibpd->device);
1035 struct rxe_pd *pd = to_rpd(ibpd);
1036 struct rxe_mem *mr;
1037
1038 mr = rxe_alloc(&rxe->mr_pool);
1039 if (!mr) {
1040 err = -ENOMEM;
1041 goto err2;
1042 }
1043
1044 rxe_add_index(mr);
1045
1046 rxe_add_ref(pd);
1047
1048 err = rxe_mem_init_user(rxe, pd, start, length, iova,
1049 access, udata, mr);
1050 if (err)
1051 goto err3;
1052
1053 return &mr->ibmr;
1054
1055err3:
1056 rxe_drop_ref(pd);
1057 rxe_drop_index(mr);
1058 rxe_drop_ref(mr);
1059err2:
1060 return ERR_PTR(err);
1061}
1062
1063static int rxe_dereg_mr(struct ib_mr *ibmr)
1064{
1065 struct rxe_mem *mr = to_rmr(ibmr);
1066
1067 mr->state = RXE_MEM_STATE_ZOMBIE;
1068 rxe_drop_ref(mr->pd);
1069 rxe_drop_index(mr);
1070 rxe_drop_ref(mr);
1071 return 0;
1072}
1073
1074static struct ib_mr *rxe_alloc_mr(struct ib_pd *ibpd,
1075 enum ib_mr_type mr_type,
1076 u32 max_num_sg)
1077{
1078 struct rxe_dev *rxe = to_rdev(ibpd->device);
1079 struct rxe_pd *pd = to_rpd(ibpd);
1080 struct rxe_mem *mr;
1081 int err;
1082
1083 if (mr_type != IB_MR_TYPE_MEM_REG)
1084 return ERR_PTR(-EINVAL);
1085
1086 mr = rxe_alloc(&rxe->mr_pool);
1087 if (!mr) {
1088 err = -ENOMEM;
1089 goto err1;
1090 }
1091
1092 rxe_add_index(mr);
1093
1094 rxe_add_ref(pd);
1095
1096 err = rxe_mem_init_fast(rxe, pd, max_num_sg, mr);
1097 if (err)
1098 goto err2;
1099
1100 return &mr->ibmr;
1101
1102err2:
1103 rxe_drop_ref(pd);
1104 rxe_drop_index(mr);
1105 rxe_drop_ref(mr);
1106err1:
1107 return ERR_PTR(err);
1108}
1109
1110static int rxe_set_page(struct ib_mr *ibmr, u64 addr)
1111{
1112 struct rxe_mem *mr = to_rmr(ibmr);
1113 struct rxe_map *map;
1114 struct rxe_phys_buf *buf;
1115
1116 if (unlikely(mr->nbuf == mr->num_buf))
1117 return -ENOMEM;
1118
1119 map = mr->map[mr->nbuf / RXE_BUF_PER_MAP];
1120 buf = &map->buf[mr->nbuf % RXE_BUF_PER_MAP];
1121
1122 buf->addr = addr;
1123 buf->size = ibmr->page_size;
1124 mr->nbuf++;
1125
1126 return 0;
1127}
1128
1129static int rxe_map_mr_sg(struct ib_mr *ibmr, struct scatterlist *sg,
1130 int sg_nents, unsigned int *sg_offset)
1131{
1132 struct rxe_mem *mr = to_rmr(ibmr);
1133 int n;
1134
1135 mr->nbuf = 0;
1136
1137 n = ib_sg_to_pages(ibmr, sg, sg_nents, sg_offset, rxe_set_page);
1138
1139 mr->va = ibmr->iova;
1140 mr->iova = ibmr->iova;
1141 mr->length = ibmr->length;
1142 mr->page_shift = ilog2(ibmr->page_size);
1143 mr->page_mask = ibmr->page_size - 1;
1144 mr->offset = mr->iova & mr->page_mask;
1145
1146 return n;
1147}
1148
1149static int rxe_attach_mcast(struct ib_qp *ibqp, union ib_gid *mgid, u16 mlid)
1150{
1151 int err;
1152 struct rxe_dev *rxe = to_rdev(ibqp->device);
1153 struct rxe_qp *qp = to_rqp(ibqp);
1154 struct rxe_mc_grp *grp;
1155
1156
1157 err = rxe_mcast_get_grp(rxe, mgid, &grp);
1158 if (err)
1159 return err;
1160
1161 err = rxe_mcast_add_grp_elem(rxe, qp, grp);
1162
1163 rxe_drop_ref(grp);
1164 return err;
1165}
1166
1167static int rxe_detach_mcast(struct ib_qp *ibqp, union ib_gid *mgid, u16 mlid)
1168{
1169 struct rxe_dev *rxe = to_rdev(ibqp->device);
1170 struct rxe_qp *qp = to_rqp(ibqp);
1171
1172 return rxe_mcast_drop_grp_elem(rxe, qp, mgid);
1173}
1174
1175static ssize_t parent_show(struct device *device,
1176 struct device_attribute *attr, char *buf)
1177{
1178 struct rxe_dev *rxe = container_of(device, struct rxe_dev,
1179 ib_dev.dev);
1180
1181 return snprintf(buf, 16, "%s\n", rxe_parent_name(rxe, 1));
1182}
1183
1184static DEVICE_ATTR_RO(parent);
1185
1186static struct device_attribute *rxe_dev_attributes[] = {
1187 &dev_attr_parent,
1188};
1189
1190int rxe_register_device(struct rxe_dev *rxe)
1191{
1192 int err;
1193 int i;
1194 struct ib_device *dev = &rxe->ib_dev;
1195 struct crypto_shash *tfm;
1196
1197 strlcpy(dev->name, "rxe%d", IB_DEVICE_NAME_MAX);
1198 strlcpy(dev->node_desc, "rxe", sizeof(dev->node_desc));
1199
1200 dev->owner = THIS_MODULE;
1201 dev->node_type = RDMA_NODE_IB_CA;
1202 dev->phys_port_cnt = 1;
1203 dev->num_comp_vectors = num_possible_cpus();
1204 dev->dev.parent = rxe_dma_device(rxe);
1205 dev->local_dma_lkey = 0;
1206 addrconf_addr_eui48((unsigned char *)&dev->node_guid,
1207 rxe->ndev->dev_addr);
1208 dev->dev.dma_ops = &dma_virt_ops;
1209 dma_coerce_mask_and_coherent(&dev->dev,
1210 dma_get_required_mask(dev->dev.parent));
1211
1212 dev->uverbs_abi_ver = RXE_UVERBS_ABI_VERSION;
1213 dev->uverbs_cmd_mask = BIT_ULL(IB_USER_VERBS_CMD_GET_CONTEXT)
1214 | BIT_ULL(IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL)
1215 | BIT_ULL(IB_USER_VERBS_CMD_QUERY_DEVICE)
1216 | BIT_ULL(IB_USER_VERBS_CMD_QUERY_PORT)
1217 | BIT_ULL(IB_USER_VERBS_CMD_ALLOC_PD)
1218 | BIT_ULL(IB_USER_VERBS_CMD_DEALLOC_PD)
1219 | BIT_ULL(IB_USER_VERBS_CMD_CREATE_SRQ)
1220 | BIT_ULL(IB_USER_VERBS_CMD_MODIFY_SRQ)
1221 | BIT_ULL(IB_USER_VERBS_CMD_QUERY_SRQ)
1222 | BIT_ULL(IB_USER_VERBS_CMD_DESTROY_SRQ)
1223 | BIT_ULL(IB_USER_VERBS_CMD_POST_SRQ_RECV)
1224 | BIT_ULL(IB_USER_VERBS_CMD_CREATE_QP)
1225 | BIT_ULL(IB_USER_VERBS_CMD_MODIFY_QP)
1226 | BIT_ULL(IB_USER_VERBS_CMD_QUERY_QP)
1227 | BIT_ULL(IB_USER_VERBS_CMD_DESTROY_QP)
1228 | BIT_ULL(IB_USER_VERBS_CMD_POST_SEND)
1229 | BIT_ULL(IB_USER_VERBS_CMD_POST_RECV)
1230 | BIT_ULL(IB_USER_VERBS_CMD_CREATE_CQ)
1231 | BIT_ULL(IB_USER_VERBS_CMD_RESIZE_CQ)
1232 | BIT_ULL(IB_USER_VERBS_CMD_DESTROY_CQ)
1233 | BIT_ULL(IB_USER_VERBS_CMD_POLL_CQ)
1234 | BIT_ULL(IB_USER_VERBS_CMD_PEEK_CQ)
1235 | BIT_ULL(IB_USER_VERBS_CMD_REQ_NOTIFY_CQ)
1236 | BIT_ULL(IB_USER_VERBS_CMD_REG_MR)
1237 | BIT_ULL(IB_USER_VERBS_CMD_DEREG_MR)
1238 | BIT_ULL(IB_USER_VERBS_CMD_CREATE_AH)
1239 | BIT_ULL(IB_USER_VERBS_CMD_MODIFY_AH)
1240 | BIT_ULL(IB_USER_VERBS_CMD_QUERY_AH)
1241 | BIT_ULL(IB_USER_VERBS_CMD_DESTROY_AH)
1242 | BIT_ULL(IB_USER_VERBS_CMD_ATTACH_MCAST)
1243 | BIT_ULL(IB_USER_VERBS_CMD_DETACH_MCAST)
1244 ;
1245
1246 dev->query_device = rxe_query_device;
1247 dev->modify_device = rxe_modify_device;
1248 dev->query_port = rxe_query_port;
1249 dev->modify_port = rxe_modify_port;
1250 dev->get_link_layer = rxe_get_link_layer;
1251 dev->query_gid = rxe_query_gid;
1252 dev->get_netdev = rxe_get_netdev;
1253 dev->add_gid = rxe_add_gid;
1254 dev->del_gid = rxe_del_gid;
1255 dev->query_pkey = rxe_query_pkey;
1256 dev->alloc_ucontext = rxe_alloc_ucontext;
1257 dev->dealloc_ucontext = rxe_dealloc_ucontext;
1258 dev->mmap = rxe_mmap;
1259 dev->get_port_immutable = rxe_port_immutable;
1260 dev->alloc_pd = rxe_alloc_pd;
1261 dev->dealloc_pd = rxe_dealloc_pd;
1262 dev->create_ah = rxe_create_ah;
1263 dev->modify_ah = rxe_modify_ah;
1264 dev->query_ah = rxe_query_ah;
1265 dev->destroy_ah = rxe_destroy_ah;
1266 dev->create_srq = rxe_create_srq;
1267 dev->modify_srq = rxe_modify_srq;
1268 dev->query_srq = rxe_query_srq;
1269 dev->destroy_srq = rxe_destroy_srq;
1270 dev->post_srq_recv = rxe_post_srq_recv;
1271 dev->create_qp = rxe_create_qp;
1272 dev->modify_qp = rxe_modify_qp;
1273 dev->query_qp = rxe_query_qp;
1274 dev->destroy_qp = rxe_destroy_qp;
1275 dev->post_send = rxe_post_send;
1276 dev->post_recv = rxe_post_recv;
1277 dev->create_cq = rxe_create_cq;
1278 dev->destroy_cq = rxe_destroy_cq;
1279 dev->resize_cq = rxe_resize_cq;
1280 dev->poll_cq = rxe_poll_cq;
1281 dev->peek_cq = rxe_peek_cq;
1282 dev->req_notify_cq = rxe_req_notify_cq;
1283 dev->get_dma_mr = rxe_get_dma_mr;
1284 dev->reg_user_mr = rxe_reg_user_mr;
1285 dev->dereg_mr = rxe_dereg_mr;
1286 dev->alloc_mr = rxe_alloc_mr;
1287 dev->map_mr_sg = rxe_map_mr_sg;
1288 dev->attach_mcast = rxe_attach_mcast;
1289 dev->detach_mcast = rxe_detach_mcast;
1290 dev->get_hw_stats = rxe_ib_get_hw_stats;
1291 dev->alloc_hw_stats = rxe_ib_alloc_hw_stats;
1292
1293 tfm = crypto_alloc_shash("crc32", 0, 0);
1294 if (IS_ERR(tfm)) {
1295 pr_err("failed to allocate crc algorithm err:%ld\n",
1296 PTR_ERR(tfm));
1297 return PTR_ERR(tfm);
1298 }
1299 rxe->tfm = tfm;
1300
1301 err = ib_register_device(dev, NULL);
1302 if (err) {
1303 pr_warn("%s failed with error %d\n", __func__, err);
1304 goto err1;
1305 }
1306
1307 for (i = 0; i < ARRAY_SIZE(rxe_dev_attributes); ++i) {
1308 err = device_create_file(&dev->dev, rxe_dev_attributes[i]);
1309 if (err) {
1310 pr_warn("%s failed with error %d for attr number %d\n",
1311 __func__, err, i);
1312 goto err2;
1313 }
1314 }
1315
1316 return 0;
1317
1318err2:
1319 ib_unregister_device(dev);
1320err1:
1321 crypto_free_shash(rxe->tfm);
1322
1323 return err;
1324}
1325
1326int rxe_unregister_device(struct rxe_dev *rxe)
1327{
1328 int i;
1329 struct ib_device *dev = &rxe->ib_dev;
1330
1331 for (i = 0; i < ARRAY_SIZE(rxe_dev_attributes); ++i)
1332 device_remove_file(&dev->dev, rxe_dev_attributes[i]);
1333
1334 ib_unregister_device(dev);
1335
1336 return 0;
1337}
1338
