drivers/infiniband/hw/hns/hns_roce_srq.c

   1 // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
   2 /*
   3  * Copyright (c) 2018 Hisilicon Limited.
   4  */
   5
   6 #include <linux/pci.h>
   7 #include <rdma/ib_umem.h>
   8 #include "hns_roce_device.h"
   9 #include "hns_roce_cmd.h"
  10 #include "hns_roce_hem.h"
  11
  12 void hns_roce_srq_event(struct hns_roce_dev *hr_dev, u32 srqn, int event_type)
  13 {
  14         struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;
  15         struct hns_roce_srq *srq;
  16
  17         xa_lock(&srq_table->xa);
  18         srq = xa_load(&srq_table->xa, srqn & (hr_dev->caps.num_srqs - 1));
  19         if (srq)
  20                 refcount_inc(&srq->refcount);
  21         xa_unlock(&srq_table->xa);
  22
  23         if (!srq) {
  24                 dev_warn(hr_dev->dev, "Async event for bogus SRQ %08x\n", srqn);
  25                 return;
  26         }
  27
  28         srq->event(srq, event_type);
  29
  30         if (refcount_dec_and_test(&srq->refcount))
  31                 complete(&srq->free);
  32 }
  33
  34 static void hns_roce_ib_srq_event(struct hns_roce_srq *srq,
  35                                   enum hns_roce_event event_type)
  36 {
  37         struct hns_roce_dev *hr_dev = to_hr_dev(srq->ibsrq.device);
  38         struct ib_srq *ibsrq = &srq->ibsrq;
  39         struct ib_event event;
  40
  41         if (ibsrq->event_handler) {
  42                 event.device      = ibsrq->device;
  43                 event.element.srq = ibsrq;
  44                 switch (event_type) {
  45                 case HNS_ROCE_EVENT_TYPE_SRQ_LIMIT_REACH:
  46                         event.event = IB_EVENT_SRQ_LIMIT_REACHED;
  47                         break;
  48                 case HNS_ROCE_EVENT_TYPE_SRQ_CATAS_ERROR:
  49                         event.event = IB_EVENT_SRQ_ERR;
  50                         break;
  51                 default:
  52                         dev_err(hr_dev->dev,
  53                            "hns_roce:Unexpected event type 0x%x on SRQ %06lx\n",
  54                            event_type, srq->srqn);
  55                         return;
  56                 }
  57
  58                 ibsrq->event_handler(&event, ibsrq->srq_context);
  59         }
  60 }
  61
  62 static int hns_roce_hw_create_srq(struct hns_roce_dev *dev,
  63                                   struct hns_roce_cmd_mailbox *mailbox,
  64                                   unsigned long srq_num)
  65 {
  66         return hns_roce_cmd_mbox(dev, mailbox->dma, 0, srq_num, 0,
  67                                  HNS_ROCE_CMD_CREATE_SRQ,
  68                                  HNS_ROCE_CMD_TIMEOUT_MSECS);
  69 }
  70
  71 static int hns_roce_hw_destroy_srq(struct hns_roce_dev *dev,
  72                                    struct hns_roce_cmd_mailbox *mailbox,
  73                                    unsigned long srq_num)
  74 {
  75         return hns_roce_cmd_mbox(dev, 0, mailbox ? mailbox->dma : 0, srq_num,
  76                                  mailbox ? 0 : 1, HNS_ROCE_CMD_DESTROY_SRQ,
  77                                  HNS_ROCE_CMD_TIMEOUT_MSECS);
  78 }
  79
  80 static int alloc_srqc(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq)
  81 {
  82         struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;
  83         struct hns_roce_ida *srq_ida = &hr_dev->srq_table.srq_ida;
  84         struct ib_device *ibdev = &hr_dev->ib_dev;
  85         struct hns_roce_cmd_mailbox *mailbox;
  86         int ret;
  87         int id;
  88
  89         id = ida_alloc_range(&srq_ida->ida, srq_ida->min, srq_ida->max,
  90                              GFP_KERNEL);
  91         if (id < 0) {
  92                 ibdev_err(ibdev, "failed to alloc srq(%d).\n", id);
  93                 return -ENOMEM;
  94         }
  95         srq->srqn = (unsigned long)id;
  96
  97         ret = hns_roce_table_get(hr_dev, &srq_table->table, srq->srqn);
  98         if (ret) {
  99                 ibdev_err(ibdev, "failed to get SRQC table, ret = %d.\n", ret);
 100                 goto err_out;
 101         }
 102
 103         ret = xa_err(xa_store(&srq_table->xa, srq->srqn, srq, GFP_KERNEL));
 104         if (ret) {
 105                 ibdev_err(ibdev, "failed to store SRQC, ret = %d.\n", ret);
 106                 goto err_put;
 107         }
 108
 109         mailbox = hns_roce_alloc_cmd_mailbox(hr_dev);
 110         if (IS_ERR_OR_NULL(mailbox)) {
 111                 ibdev_err(ibdev, "failed to alloc mailbox for SRQC.\n");
 112                 ret = -ENOMEM;
 113                 goto err_xa;
 114         }
 115
 116         ret = hr_dev->hw->write_srqc(srq, mailbox->buf);
 117         if (ret) {
 118                 ibdev_err(ibdev, "failed to write SRQC.\n");
 119                 goto err_mbox;
 120         }
 121
 122         ret = hns_roce_hw_create_srq(hr_dev, mailbox, srq->srqn);
 123         if (ret) {
 124                 ibdev_err(ibdev, "failed to config SRQC, ret = %d.\n", ret);
 125                 goto err_mbox;
 126         }
 127
 128         hns_roce_free_cmd_mailbox(hr_dev, mailbox);
 129
 130         return 0;
 131
 132 err_mbox:
 133         hns_roce_free_cmd_mailbox(hr_dev, mailbox);
 134 err_xa:
 135         xa_erase(&srq_table->xa, srq->srqn);
 136 err_put:
 137         hns_roce_table_put(hr_dev, &srq_table->table, srq->srqn);
 138 err_out:
 139         ida_free(&srq_ida->ida, id);
 140
 141         return ret;
 142 }
 143
 144 static void free_srqc(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq)
 145 {
 146         struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;
 147         int ret;
 148
 149         ret = hns_roce_hw_destroy_srq(hr_dev, NULL, srq->srqn);
 150         if (ret)
 151                 dev_err(hr_dev->dev, "DESTROY_SRQ failed (%d) for SRQN %06lx\n",
 152                         ret, srq->srqn);
 153
 154         xa_erase(&srq_table->xa, srq->srqn);
 155
 156         if (refcount_dec_and_test(&srq->refcount))
 157                 complete(&srq->free);
 158         wait_for_completion(&srq->free);
 159
 160         hns_roce_table_put(hr_dev, &srq_table->table, srq->srqn);
 161         ida_free(&srq_table->srq_ida.ida, (int)srq->srqn);
 162 }
 163
 164 static int alloc_srq_idx(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq,
 165                          struct ib_udata *udata, unsigned long addr)
 166 {
 167         struct hns_roce_idx_que *idx_que = &srq->idx_que;
 168         struct ib_device *ibdev = &hr_dev->ib_dev;
 169         struct hns_roce_buf_attr buf_attr = {};
 170         int ret;
 171
 172         srq->idx_que.entry_shift = ilog2(HNS_ROCE_IDX_QUE_ENTRY_SZ);
 173
 174         buf_attr.page_shift = hr_dev->caps.idx_buf_pg_sz + PAGE_SHIFT;
 175         buf_attr.region[0].size = to_hr_hem_entries_size(srq->wqe_cnt,
 176                                         srq->idx_que.entry_shift);
 177         buf_attr.region[0].hopnum = hr_dev->caps.idx_hop_num;
 178         buf_attr.region_count = 1;
 179
 180         ret = hns_roce_mtr_create(hr_dev, &idx_que->mtr, &buf_attr,
 181                                   hr_dev->caps.idx_ba_pg_sz + PAGE_SHIFT,
 182                                   udata, addr);
 183         if (ret) {
 184                 ibdev_err(ibdev,
 185                           "failed to alloc SRQ idx mtr, ret = %d.\n", ret);
 186                 return ret;
 187         }
 188
 189         if (!udata) {
 190                 idx_que->bitmap = bitmap_zalloc(srq->wqe_cnt, GFP_KERNEL);
 191                 if (!idx_que->bitmap) {
 192                         ibdev_err(ibdev, "failed to alloc SRQ idx bitmap.\n");
 193                         ret = -ENOMEM;
 194                         goto err_idx_mtr;
 195                 }
 196         }
 197
 198         idx_que->head = 0;
 199         idx_que->tail = 0;
 200
 201         return 0;
 202 err_idx_mtr:
 203         hns_roce_mtr_destroy(hr_dev, &idx_que->mtr);
 204
 205         return ret;
 206 }
 207
 208 static void free_srq_idx(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq)
 209 {
 210         struct hns_roce_idx_que *idx_que = &srq->idx_que;
 211
 212         bitmap_free(idx_que->bitmap);
 213         idx_que->bitmap = NULL;
 214         hns_roce_mtr_destroy(hr_dev, &idx_que->mtr);
 215 }
 216
 217 static int alloc_srq_wqe_buf(struct hns_roce_dev *hr_dev,
 218                              struct hns_roce_srq *srq,
 219                              struct ib_udata *udata, unsigned long addr)
 220 {
 221         struct ib_device *ibdev = &hr_dev->ib_dev;
 222         struct hns_roce_buf_attr buf_attr = {};
 223         int ret;
 224
 225         srq->wqe_shift = ilog2(roundup_pow_of_two(max(HNS_ROCE_SGE_SIZE,
 226                                                       HNS_ROCE_SGE_SIZE *
 227                                                       srq->max_gs)));
 228
 229         buf_attr.page_shift = hr_dev->caps.srqwqe_buf_pg_sz + PAGE_SHIFT;
 230         buf_attr.region[0].size = to_hr_hem_entries_size(srq->wqe_cnt,
 231                                                          srq->wqe_shift);
 232         buf_attr.region[0].hopnum = hr_dev->caps.srqwqe_hop_num;
 233         buf_attr.region_count = 1;
 234
 235         ret = hns_roce_mtr_create(hr_dev, &srq->buf_mtr, &buf_attr,
 236                                   hr_dev->caps.srqwqe_ba_pg_sz + PAGE_SHIFT,
 237                                   udata, addr);
 238         if (ret)
 239                 ibdev_err(ibdev,
 240                           "failed to alloc SRQ buf mtr, ret = %d.\n", ret);
 241
 242         return ret;
 243 }
 244
 245 static void free_srq_wqe_buf(struct hns_roce_dev *hr_dev,
 246                              struct hns_roce_srq *srq)
 247 {
 248         hns_roce_mtr_destroy(hr_dev, &srq->buf_mtr);
 249 }
 250
 251 static int alloc_srq_wrid(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq)
 252 {
 253         srq->wrid = kvmalloc_array(srq->wqe_cnt, sizeof(u64), GFP_KERNEL);
 254         if (!srq->wrid)
 255                 return -ENOMEM;
 256
 257         return 0;
 258 }
 259
 260 static void free_srq_wrid(struct hns_roce_srq *srq)
 261 {
 262         kfree(srq->wrid);
 263         srq->wrid = NULL;
 264 }
 265
 266 static u32 proc_srq_sge(struct hns_roce_dev *dev, struct hns_roce_srq *hr_srq,
 267                         bool user)
 268 {
 269         u32 max_sge = dev->caps.max_srq_sges;
 270
 271         if (dev->pci_dev->revision >= PCI_REVISION_ID_HIP09)
 272                 return max_sge;
 273
 274         /* Reserve SGEs only for HIP08 in kernel; The userspace driver will
 275          * calculate number of max_sge with reserved SGEs when allocating wqe
 276          * buf, so there is no need to do this again in kernel. But the number
 277          * may exceed the capacity of SGEs recorded in the firmware, so the
 278          * kernel driver should just adapt the value accordingly.
 279          */
 280         if (user)
 281                 max_sge = roundup_pow_of_two(max_sge + 1);
 282         else
 283                 hr_srq->rsv_sge = 1;
 284
 285         return max_sge;
 286 }
 287
 288 static int set_srq_basic_param(struct hns_roce_srq *srq,
 289                                struct ib_srq_init_attr *init_attr,
 290                                struct ib_udata *udata)
 291 {
 292         struct hns_roce_dev *hr_dev = to_hr_dev(srq->ibsrq.device);
 293         struct ib_srq_attr *attr = &init_attr->attr;
 294         u32 max_sge;
 295
 296         max_sge = proc_srq_sge(hr_dev, srq, !!udata);
 297         if (attr->max_wr > hr_dev->caps.max_srq_wrs ||
 298             attr->max_sge > max_sge) {
 299                 ibdev_err(&hr_dev->ib_dev,
 300                           "invalid SRQ attr, depth = %u, sge = %u.\n",
 301                           attr->max_wr, attr->max_sge);
 302                 return -EINVAL;
 303         }
 304
 305         attr->max_wr = max_t(u32, attr->max_wr, HNS_ROCE_MIN_SRQ_WQE_NUM);
 306         srq->wqe_cnt = roundup_pow_of_two(attr->max_wr);
 307         srq->max_gs = roundup_pow_of_two(attr->max_sge + srq->rsv_sge);
 308
 309         attr->max_wr = srq->wqe_cnt;
 310         attr->max_sge = srq->max_gs - srq->rsv_sge;
 311         attr->srq_limit = 0;
 312
 313         return 0;
 314 }
 315
 316 static void set_srq_ext_param(struct hns_roce_srq *srq,
 317                               struct ib_srq_init_attr *init_attr)
 318 {
 319         srq->cqn = ib_srq_has_cq(init_attr->srq_type) ?
 320                    to_hr_cq(init_attr->ext.cq)->cqn : 0;
 321
 322         srq->xrcdn = (init_attr->srq_type == IB_SRQT_XRC) ?
 323                      to_hr_xrcd(init_attr->ext.xrc.xrcd)->xrcdn : 0;
 324 }
 325
 326 static int set_srq_param(struct hns_roce_srq *srq,
 327                          struct ib_srq_init_attr *init_attr,
 328                          struct ib_udata *udata)
 329 {
 330         int ret;
 331
 332         ret = set_srq_basic_param(srq, init_attr, udata);
 333         if (ret)
 334                 return ret;
 335
 336         set_srq_ext_param(srq, init_attr);
 337
 338         return 0;
 339 }
 340
 341 static int alloc_srq_buf(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq,
 342                          struct ib_udata *udata)
 343 {
 344         struct hns_roce_ib_create_srq ucmd = {};
 345         int ret;
 346
 347         if (udata) {
 348                 ret = ib_copy_from_udata(&ucmd, udata,
 349                                          min(udata->inlen, sizeof(ucmd)));
 350                 if (ret) {
 351                         ibdev_err(&hr_dev->ib_dev,
 352                                   "failed to copy SRQ udata, ret = %d.\n",
 353                                   ret);
 354                         return ret;
 355                 }
 356         }
 357
 358         ret = alloc_srq_idx(hr_dev, srq, udata, ucmd.que_addr);
 359         if (ret)
 360                 return ret;
 361
 362         ret = alloc_srq_wqe_buf(hr_dev, srq, udata, ucmd.buf_addr);
 363         if (ret)
 364                 goto err_idx;
 365
 366         if (!udata) {
 367                 ret = alloc_srq_wrid(hr_dev, srq);
 368                 if (ret)
 369                         goto err_wqe_buf;
 370         }
 371
 372         return 0;
 373
 374 err_wqe_buf:
 375         free_srq_wqe_buf(hr_dev, srq);
 376 err_idx:
 377         free_srq_idx(hr_dev, srq);
 378
 379         return ret;
 380 }
 381
 382 static void free_srq_buf(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq)
 383 {
 384         free_srq_wrid(srq);
 385         free_srq_wqe_buf(hr_dev, srq);
 386         free_srq_idx(hr_dev, srq);
 387 }
 388
 389 int hns_roce_create_srq(struct ib_srq *ib_srq,
 390                         struct ib_srq_init_attr *init_attr,
 391                         struct ib_udata *udata)
 392 {
 393         struct hns_roce_dev *hr_dev = to_hr_dev(ib_srq->device);
 394         struct hns_roce_ib_create_srq_resp resp = {};
 395         struct hns_roce_srq *srq = to_hr_srq(ib_srq);
 396         int ret;
 397
 398         mutex_init(&srq->mutex);
 399         spin_lock_init(&srq->lock);
 400
 401         ret = set_srq_param(srq, init_attr, udata);
 402         if (ret)
 403                 return ret;
 404
 405         ret = alloc_srq_buf(hr_dev, srq, udata);
 406         if (ret)
 407                 return ret;
 408
 409         ret = alloc_srqc(hr_dev, srq);
 410         if (ret)
 411                 goto err_srq_buf;
 412
 413         if (udata) {
 414                 resp.srqn = srq->srqn;
 415                 if (ib_copy_to_udata(udata, &resp,
 416                                      min(udata->outlen, sizeof(resp)))) {
 417                         ret = -EFAULT;
 418                         goto err_srqc;
 419                 }
 420         }
 421
 422         srq->db_reg = hr_dev->reg_base + SRQ_DB_REG;
 423         srq->event = hns_roce_ib_srq_event;
 424         refcount_set(&srq->refcount, 1);
 425         init_completion(&srq->free);
 426
 427         return 0;
 428
 429 err_srqc:
 430         free_srqc(hr_dev, srq);
 431 err_srq_buf:
 432         free_srq_buf(hr_dev, srq);
 433
 434         return ret;
 435 }
 436
 437 int hns_roce_destroy_srq(struct ib_srq *ibsrq, struct ib_udata *udata)
 438 {
 439         struct hns_roce_dev *hr_dev = to_hr_dev(ibsrq->device);
 440         struct hns_roce_srq *srq = to_hr_srq(ibsrq);
 441
 442         free_srqc(hr_dev, srq);
 443         free_srq_buf(hr_dev, srq);
 444         return 0;
 445 }
 446
 447 void hns_roce_init_srq_table(struct hns_roce_dev *hr_dev)
 448 {
 449         struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;
 450         struct hns_roce_ida *srq_ida = &srq_table->srq_ida;
 451
 452         xa_init(&srq_table->xa);
 453
 454         ida_init(&srq_ida->ida);
 455         srq_ida->max = hr_dev->caps.num_srqs - 1;
 456         srq_ida->min = hr_dev->caps.reserved_srqs;
 457 }