1
2
3
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
12void 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
34static 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
62static 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
71static 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
80static 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
132err_mbox:
133 hns_roce_free_cmd_mailbox(hr_dev, mailbox);
134err_xa:
135 xa_erase(&srq_table->xa, srq->srqn);
136err_put:
137 hns_roce_table_put(hr_dev, &srq_table->table, srq->srqn);
138err_out:
139 ida_free(&srq_ida->ida, id);
140
141 return ret;
142}
143
144static 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
164static 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;
202err_idx_mtr:
203 hns_roce_mtr_destroy(hr_dev, &idx_que->mtr);
204
205 return ret;
206}
207
208static 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
217static 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
245static 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
251static 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
260static void free_srq_wrid(struct hns_roce_srq *srq)
261{
262 kfree(srq->wrid);
263 srq->wrid = NULL;
264}
265
266static 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
275
276
277
278
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
288static 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
316static 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
326static 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
341static 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
374err_wqe_buf:
375 free_srq_wqe_buf(hr_dev, srq);
376err_idx:
377 free_srq_idx(hr_dev, srq);
378
379 return ret;
380}
381
382static 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
389int 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
429err_srqc:
430 free_srqc(hr_dev, srq);
431err_srq_buf:
432 free_srq_buf(hr_dev, srq);
433
434 return ret;
435}
436
437int 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
447void 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}
458