source: src/linux/universal/linux-4.9/drivers/infiniband/hw/mlx5/srq.c @ 31662

Last change on this file since 31662 was 31662, checked in by brainslayer, 2 months ago

use new squashfs in all kernels

File size: 12.3 KB
Line 
1/*
2 * Copyright (c) 2013-2015, Mellanox Technologies. 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 * OpenIB.org 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/mlx5/qp.h>
35#include <linux/mlx5/srq.h>
36#include <linux/slab.h>
37#include <rdma/ib_umem.h>
38#include <rdma/ib_user_verbs.h>
39
40#include "mlx5_ib.h"
41
42/* not supported currently */
43static int srq_signature;
44
45static void *get_wqe(struct mlx5_ib_srq *srq, int n)
46{
47        return mlx5_buf_offset(&srq->buf, n << srq->msrq.wqe_shift);
48}
49
50static void mlx5_ib_srq_event(struct mlx5_core_srq *srq, enum mlx5_event type)
51{
52        struct ib_event event;
53        struct ib_srq *ibsrq = &to_mibsrq(srq)->ibsrq;
54
55        if (ibsrq->event_handler) {
56                event.device      = ibsrq->device;
57                event.element.srq = ibsrq;
58                switch (type) {
59                case MLX5_EVENT_TYPE_SRQ_RQ_LIMIT:
60                        event.event = IB_EVENT_SRQ_LIMIT_REACHED;
61                        break;
62                case MLX5_EVENT_TYPE_SRQ_CATAS_ERROR:
63                        event.event = IB_EVENT_SRQ_ERR;
64                        break;
65                default:
66                        pr_warn("mlx5_ib: Unexpected event type %d on SRQ %06x\n",
67                                type, srq->srqn);
68                        return;
69                }
70
71                ibsrq->event_handler(&event, ibsrq->srq_context);
72        }
73}
74
75static int create_srq_user(struct ib_pd *pd, struct mlx5_ib_srq *srq,
76                           struct mlx5_srq_attr *in,
77                           struct ib_udata *udata, int buf_size)
78{
79        struct mlx5_ib_dev *dev = to_mdev(pd->device);
80        struct mlx5_ib_create_srq ucmd = {};
81        size_t ucmdlen;
82        int err;
83        int npages;
84        int page_shift;
85        int ncont;
86        u32 offset;
87        u32 uidx = MLX5_IB_DEFAULT_UIDX;
88
89        ucmdlen = min(udata->inlen, sizeof(ucmd));
90
91        if (ib_copy_from_udata(&ucmd, udata, ucmdlen)) {
92                mlx5_ib_dbg(dev, "failed copy udata\n");
93                return -EFAULT;
94        }
95
96        if (ucmd.reserved0 || ucmd.reserved1)
97                return -EINVAL;
98
99        if (udata->inlen > sizeof(ucmd) &&
100            !ib_is_udata_cleared(udata, sizeof(ucmd),
101                                 udata->inlen - sizeof(ucmd)))
102                return -EINVAL;
103
104        if (in->type == IB_SRQT_XRC) {
105                err = get_srq_user_index(to_mucontext(pd->uobject->context),
106                                         &ucmd, udata->inlen, &uidx);
107                if (err)
108                        return err;
109        }
110
111        srq->wq_sig = !!(ucmd.flags & MLX5_SRQ_FLAG_SIGNATURE);
112
113        srq->umem = ib_umem_get(pd->uobject->context, ucmd.buf_addr, buf_size,
114                                0, 0);
115        if (IS_ERR(srq->umem)) {
116                mlx5_ib_dbg(dev, "failed umem get, size %d\n", buf_size);
117                err = PTR_ERR(srq->umem);
118                return err;
119        }
120
121        mlx5_ib_cont_pages(srq->umem, ucmd.buf_addr, &npages,
122                           &page_shift, &ncont, NULL);
123        err = mlx5_ib_get_buf_offset(ucmd.buf_addr, page_shift,
124                                     &offset);
125        if (err) {
126                mlx5_ib_warn(dev, "bad offset\n");
127                goto err_umem;
128        }
129
130        in->pas = mlx5_vzalloc(sizeof(*in->pas) * ncont);
131        if (!in->pas) {
132                err = -ENOMEM;
133                goto err_umem;
134        }
135
136        mlx5_ib_populate_pas(dev, srq->umem, page_shift, in->pas, 0);
137
138        err = mlx5_ib_db_map_user(to_mucontext(pd->uobject->context),
139                                  ucmd.db_addr, &srq->db);
140        if (err) {
141                mlx5_ib_dbg(dev, "map doorbell failed\n");
142                goto err_in;
143        }
144
145        in->log_page_size = page_shift - MLX5_ADAPTER_PAGE_SHIFT;
146        in->page_offset = offset;
147        if (MLX5_CAP_GEN(dev->mdev, cqe_version) == MLX5_CQE_VERSION_V1 &&
148            in->type == IB_SRQT_XRC)
149                in->user_index = uidx;
150
151        return 0;
152
153err_in:
154        kvfree(in->pas);
155
156err_umem:
157        ib_umem_release(srq->umem);
158
159        return err;
160}
161
162static int create_srq_kernel(struct mlx5_ib_dev *dev, struct mlx5_ib_srq *srq,
163                             struct mlx5_srq_attr *in, int buf_size)
164{
165        int err;
166        int i;
167        struct mlx5_wqe_srq_next_seg *next;
168
169        err = mlx5_db_alloc(dev->mdev, &srq->db);
170        if (err) {
171                mlx5_ib_warn(dev, "alloc dbell rec failed\n");
172                return err;
173        }
174
175        if (mlx5_buf_alloc(dev->mdev, buf_size, &srq->buf)) {
176                mlx5_ib_dbg(dev, "buf alloc failed\n");
177                err = -ENOMEM;
178                goto err_db;
179        }
180
181        srq->head    = 0;
182        srq->tail    = srq->msrq.max - 1;
183        srq->wqe_ctr = 0;
184
185        for (i = 0; i < srq->msrq.max; i++) {
186                next = get_wqe(srq, i);
187                next->next_wqe_index =
188                        cpu_to_be16((i + 1) & (srq->msrq.max - 1));
189        }
190
191        mlx5_ib_dbg(dev, "srq->buf.page_shift = %d\n", srq->buf.page_shift);
192        in->pas = mlx5_vzalloc(sizeof(*in->pas) * srq->buf.npages);
193        if (!in->pas) {
194                err = -ENOMEM;
195                goto err_buf;
196        }
197        mlx5_fill_page_array(&srq->buf, in->pas);
198
199        srq->wrid = kmalloc(srq->msrq.max * sizeof(u64), GFP_KERNEL);
200        if (!srq->wrid) {
201                mlx5_ib_dbg(dev, "kmalloc failed %lu\n",
202                            (unsigned long)(srq->msrq.max * sizeof(u64)));
203                err = -ENOMEM;
204                goto err_in;
205        }
206        srq->wq_sig = !!srq_signature;
207
208        in->log_page_size = srq->buf.page_shift - MLX5_ADAPTER_PAGE_SHIFT;
209        if (MLX5_CAP_GEN(dev->mdev, cqe_version) == MLX5_CQE_VERSION_V1 &&
210            in->type == IB_SRQT_XRC)
211                in->user_index = MLX5_IB_DEFAULT_UIDX;
212
213        return 0;
214
215err_in:
216        kvfree(in->pas);
217
218err_buf:
219        mlx5_buf_free(dev->mdev, &srq->buf);
220
221err_db:
222        mlx5_db_free(dev->mdev, &srq->db);
223        return err;
224}
225
226static void destroy_srq_user(struct ib_pd *pd, struct mlx5_ib_srq *srq)
227{
228        mlx5_ib_db_unmap_user(to_mucontext(pd->uobject->context), &srq->db);
229        ib_umem_release(srq->umem);
230}
231
232
233static void destroy_srq_kernel(struct mlx5_ib_dev *dev, struct mlx5_ib_srq *srq)
234{
235        kfree(srq->wrid);
236        mlx5_buf_free(dev->mdev, &srq->buf);
237        mlx5_db_free(dev->mdev, &srq->db);
238}
239
240struct ib_srq *mlx5_ib_create_srq(struct ib_pd *pd,
241                                  struct ib_srq_init_attr *init_attr,
242                                  struct ib_udata *udata)
243{
244        struct mlx5_ib_dev *dev = to_mdev(pd->device);
245        struct mlx5_ib_srq *srq;
246        int desc_size;
247        int buf_size;
248        int err;
249        struct mlx5_srq_attr in = {0};
250        __u32 max_srq_wqes = 1 << MLX5_CAP_GEN(dev->mdev, log_max_srq_sz);
251
252        /* Sanity check SRQ size before proceeding */
253        if (init_attr->attr.max_wr >= max_srq_wqes) {
254                mlx5_ib_dbg(dev, "max_wr %d, cap %d\n",
255                            init_attr->attr.max_wr,
256                            max_srq_wqes);
257                return ERR_PTR(-EINVAL);
258        }
259
260        srq = kmalloc(sizeof(*srq), GFP_KERNEL);
261        if (!srq)
262                return ERR_PTR(-ENOMEM);
263
264        mutex_init(&srq->mutex);
265        spin_lock_init(&srq->lock);
266        srq->msrq.max    = roundup_pow_of_two(init_attr->attr.max_wr + 1);
267        srq->msrq.max_gs = init_attr->attr.max_sge;
268
269        desc_size = sizeof(struct mlx5_wqe_srq_next_seg) +
270                    srq->msrq.max_gs * sizeof(struct mlx5_wqe_data_seg);
271        desc_size = roundup_pow_of_two(desc_size);
272        desc_size = max_t(int, 32, desc_size);
273        srq->msrq.max_avail_gather = (desc_size - sizeof(struct mlx5_wqe_srq_next_seg)) /
274                sizeof(struct mlx5_wqe_data_seg);
275        srq->msrq.wqe_shift = ilog2(desc_size);
276        buf_size = srq->msrq.max * desc_size;
277        mlx5_ib_dbg(dev, "desc_size 0x%x, req wr 0x%x, srq size 0x%x, max_gs 0x%x, max_avail_gather 0x%x\n",
278                    desc_size, init_attr->attr.max_wr, srq->msrq.max, srq->msrq.max_gs,
279                    srq->msrq.max_avail_gather);
280        in.type = init_attr->srq_type;
281
282        if (pd->uobject)
283                err = create_srq_user(pd, srq, &in, udata, buf_size);
284        else
285                err = create_srq_kernel(dev, srq, &in, buf_size);
286
287        if (err) {
288                mlx5_ib_warn(dev, "create srq %s failed, err %d\n",
289                             pd->uobject ? "user" : "kernel", err);
290                goto err_srq;
291        }
292
293        in.log_size = ilog2(srq->msrq.max);
294        in.wqe_shift = srq->msrq.wqe_shift - 4;
295        if (srq->wq_sig)
296                in.flags |= MLX5_SRQ_FLAG_WQ_SIG;
297        if (init_attr->srq_type == IB_SRQT_XRC) {
298                in.xrcd = to_mxrcd(init_attr->ext.xrc.xrcd)->xrcdn;
299                in.cqn = to_mcq(init_attr->ext.xrc.cq)->mcq.cqn;
300        } else if (init_attr->srq_type == IB_SRQT_BASIC) {
301                in.xrcd = to_mxrcd(dev->devr.x0)->xrcdn;
302                in.cqn = to_mcq(dev->devr.c0)->mcq.cqn;
303        }
304
305        in.pd = to_mpd(pd)->pdn;
306        in.db_record = srq->db.dma;
307        err = mlx5_core_create_srq(dev->mdev, &srq->msrq, &in);
308        kvfree(in.pas);
309        if (err) {
310                mlx5_ib_dbg(dev, "create SRQ failed, err %d\n", err);
311                goto err_usr_kern_srq;
312        }
313
314        mlx5_ib_dbg(dev, "create SRQ with srqn 0x%x\n", srq->msrq.srqn);
315
316        srq->msrq.event = mlx5_ib_srq_event;
317        srq->ibsrq.ext.xrc.srq_num = srq->msrq.srqn;
318
319        if (pd->uobject)
320                if (ib_copy_to_udata(udata, &srq->msrq.srqn, sizeof(__u32))) {
321                        mlx5_ib_dbg(dev, "copy to user failed\n");
322                        err = -EFAULT;
323                        goto err_core;
324                }
325
326        init_attr->attr.max_wr = srq->msrq.max - 1;
327
328        return &srq->ibsrq;
329
330err_core:
331        mlx5_core_destroy_srq(dev->mdev, &srq->msrq);
332
333err_usr_kern_srq:
334        if (pd->uobject)
335                destroy_srq_user(pd, srq);
336        else
337                destroy_srq_kernel(dev, srq);
338
339err_srq:
340        kfree(srq);
341
342        return ERR_PTR(err);
343}
344
345int mlx5_ib_modify_srq(struct ib_srq *ibsrq, struct ib_srq_attr *attr,
346                       enum ib_srq_attr_mask attr_mask, struct ib_udata *udata)
347{
348        struct mlx5_ib_dev *dev = to_mdev(ibsrq->device);
349        struct mlx5_ib_srq *srq = to_msrq(ibsrq);
350        int ret;
351
352        /* We don't support resizing SRQs yet */
353        if (attr_mask & IB_SRQ_MAX_WR)
354                return -EINVAL;
355
356        if (attr_mask & IB_SRQ_LIMIT) {
357                if (attr->srq_limit >= srq->msrq.max)
358                        return -EINVAL;
359
360                mutex_lock(&srq->mutex);
361                ret = mlx5_core_arm_srq(dev->mdev, &srq->msrq, attr->srq_limit, 1);
362                mutex_unlock(&srq->mutex);
363
364                if (ret)
365                        return ret;
366        }
367
368        return 0;
369}
370
371int mlx5_ib_query_srq(struct ib_srq *ibsrq, struct ib_srq_attr *srq_attr)
372{
373        struct mlx5_ib_dev *dev = to_mdev(ibsrq->device);
374        struct mlx5_ib_srq *srq = to_msrq(ibsrq);
375        int ret;
376        struct mlx5_srq_attr *out;
377
378        out = kzalloc(sizeof(*out), GFP_KERNEL);
379        if (!out)
380                return -ENOMEM;
381
382        ret = mlx5_core_query_srq(dev->mdev, &srq->msrq, out);
383        if (ret)
384                goto out_box;
385
386        srq_attr->srq_limit = out->lwm;
387        srq_attr->max_wr    = srq->msrq.max - 1;
388        srq_attr->max_sge   = srq->msrq.max_gs;
389
390out_box:
391        kfree(out);
392        return ret;
393}
394
395int mlx5_ib_destroy_srq(struct ib_srq *srq)
396{
397        struct mlx5_ib_dev *dev = to_mdev(srq->device);
398        struct mlx5_ib_srq *msrq = to_msrq(srq);
399
400        mlx5_core_destroy_srq(dev->mdev, &msrq->msrq);
401
402        if (srq->uobject) {
403                mlx5_ib_db_unmap_user(to_mucontext(srq->uobject->context), &msrq->db);
404                ib_umem_release(msrq->umem);
405        } else {
406                destroy_srq_kernel(dev, msrq);
407        }
408
409        kfree(srq);
410        return 0;
411}
412
413void mlx5_ib_free_srq_wqe(struct mlx5_ib_srq *srq, int wqe_index)
414{
415        struct mlx5_wqe_srq_next_seg *next;
416
417        /* always called with interrupts disabled. */
418        spin_lock(&srq->lock);
419
420        next = get_wqe(srq, srq->tail);
421        next->next_wqe_index = cpu_to_be16(wqe_index);
422        srq->tail = wqe_index;
423
424        spin_unlock(&srq->lock);
425}
426
427int mlx5_ib_post_srq_recv(struct ib_srq *ibsrq, struct ib_recv_wr *wr,
428                          struct ib_recv_wr **bad_wr)
429{
430        struct mlx5_ib_srq *srq = to_msrq(ibsrq);
431        struct mlx5_wqe_srq_next_seg *next;
432        struct mlx5_wqe_data_seg *scat;
433        struct mlx5_ib_dev *dev = to_mdev(ibsrq->device);
434        struct mlx5_core_dev *mdev = dev->mdev;
435        unsigned long flags;
436        int err = 0;
437        int nreq;
438        int i;
439
440        spin_lock_irqsave(&srq->lock, flags);
441
442        if (mdev->state == MLX5_DEVICE_STATE_INTERNAL_ERROR) {
443                err = -EIO;
444                *bad_wr = wr;
445                goto out;
446        }
447
448        for (nreq = 0; wr; nreq++, wr = wr->next) {
449                if (unlikely(wr->num_sge > srq->msrq.max_gs)) {
450                        err = -EINVAL;
451                        *bad_wr = wr;
452                        break;
453                }
454
455                if (unlikely(srq->head == srq->tail)) {
456                        err = -ENOMEM;
457                        *bad_wr = wr;
458                        break;
459                }
460
461                srq->wrid[srq->head] = wr->wr_id;
462
463                next      = get_wqe(srq, srq->head);
464                srq->head = be16_to_cpu(next->next_wqe_index);
465                scat      = (struct mlx5_wqe_data_seg *)(next + 1);
466
467                for (i = 0; i < wr->num_sge; i++) {
468                        scat[i].byte_count = cpu_to_be32(wr->sg_list[i].length);
469                        scat[i].lkey       = cpu_to_be32(wr->sg_list[i].lkey);
470                        scat[i].addr       = cpu_to_be64(wr->sg_list[i].addr);
471                }
472
473                if (i < srq->msrq.max_avail_gather) {
474                        scat[i].byte_count = 0;
475                        scat[i].lkey       = cpu_to_be32(MLX5_INVALID_LKEY);
476                        scat[i].addr       = 0;
477                }
478        }
479
480        if (likely(nreq)) {
481                srq->wqe_ctr += nreq;
482
483                /* Make sure that descriptors are written before
484                 * doorbell record.
485                 */
486                wmb();
487
488                *srq->db.db = cpu_to_be32(srq->wqe_ctr);
489        }
490out:
491        spin_unlock_irqrestore(&srq->lock, flags);
492
493        return err;
494}
Note: See TracBrowser for help on using the repository browser.