1/*
2 * Copyright (c) 2018 Chelsio, Inc. 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 <rdma/rdma_cm.h>
34
35#include "iw_cxgb4.h"
36#include <rdma/restrack.h>
37#include <uapi/rdma/rdma_netlink.h>
38
39static int fill_sq(struct sk_buff *msg, struct t4_wq *wq)
40{
41 /* WQ+SQ */
42 if (rdma_nl_put_driver_u32(msg, name: "sqid", value: wq->sq.qid))
43 goto err;
44 if (rdma_nl_put_driver_u32(msg, name: "flushed", value: wq->flushed))
45 goto err;
46 if (rdma_nl_put_driver_u32(msg, name: "memsize", value: wq->sq.memsize))
47 goto err;
48 if (rdma_nl_put_driver_u32(msg, name: "cidx", value: wq->sq.cidx))
49 goto err;
50 if (rdma_nl_put_driver_u32(msg, name: "pidx", value: wq->sq.pidx))
51 goto err;
52 if (rdma_nl_put_driver_u32(msg, name: "wq_pidx", value: wq->sq.wq_pidx))
53 goto err;
54 if (rdma_nl_put_driver_u32(msg, name: "flush_cidx", value: wq->sq.flush_cidx))
55 goto err;
56 if (rdma_nl_put_driver_u32(msg, name: "in_use", value: wq->sq.in_use))
57 goto err;
58 if (rdma_nl_put_driver_u32(msg, name: "size", value: wq->sq.size))
59 goto err;
60 if (rdma_nl_put_driver_u32_hex(msg, name: "flags", value: wq->sq.flags))
61 goto err;
62 return 0;
63err:
64 return -EMSGSIZE;
65}
66
67static int fill_rq(struct sk_buff *msg, struct t4_wq *wq)
68{
69 /* RQ */
70 if (rdma_nl_put_driver_u32(msg, name: "rqid", value: wq->rq.qid))
71 goto err;
72 if (rdma_nl_put_driver_u32(msg, name: "memsize", value: wq->rq.memsize))
73 goto err;
74 if (rdma_nl_put_driver_u32(msg, name: "cidx", value: wq->rq.cidx))
75 goto err;
76 if (rdma_nl_put_driver_u32(msg, name: "pidx", value: wq->rq.pidx))
77 goto err;
78 if (rdma_nl_put_driver_u32(msg, name: "wq_pidx", value: wq->rq.wq_pidx))
79 goto err;
80 if (rdma_nl_put_driver_u32(msg, name: "msn", value: wq->rq.msn))
81 goto err;
82 if (rdma_nl_put_driver_u32_hex(msg, name: "rqt_hwaddr", value: wq->rq.rqt_hwaddr))
83 goto err;
84 if (rdma_nl_put_driver_u32(msg, name: "rqt_size", value: wq->rq.rqt_size))
85 goto err;
86 if (rdma_nl_put_driver_u32(msg, name: "in_use", value: wq->rq.in_use))
87 goto err;
88 if (rdma_nl_put_driver_u32(msg, name: "size", value: wq->rq.size))
89 goto err;
90 return 0;
91err:
92 return -EMSGSIZE;
93}
94
95static int fill_swsqe(struct sk_buff *msg, struct t4_sq *sq, u16 idx,
96 struct t4_swsqe *sqe)
97{
98 if (rdma_nl_put_driver_u32(msg, name: "idx", value: idx))
99 goto err;
100 if (rdma_nl_put_driver_u32(msg, name: "opcode", value: sqe->opcode))
101 goto err;
102 if (rdma_nl_put_driver_u32(msg, name: "complete", value: sqe->complete))
103 goto err;
104 if (sqe->complete &&
105 rdma_nl_put_driver_u32(msg, name: "cqe_status", CQE_STATUS(&sqe->cqe)))
106 goto err;
107 if (rdma_nl_put_driver_u32(msg, name: "signaled", value: sqe->signaled))
108 goto err;
109 if (rdma_nl_put_driver_u32(msg, name: "flushed", value: sqe->flushed))
110 goto err;
111 return 0;
112err:
113 return -EMSGSIZE;
114}
115
116/*
117 * Dump the first and last pending sqes.
118 */
119static int fill_swsqes(struct sk_buff *msg, struct t4_sq *sq,
120 u16 first_idx, struct t4_swsqe *first_sqe,
121 u16 last_idx, struct t4_swsqe *last_sqe)
122{
123 if (!first_sqe)
124 goto out;
125 if (fill_swsqe(msg, sq, idx: first_idx, sqe: first_sqe))
126 goto err;
127 if (!last_sqe)
128 goto out;
129 if (fill_swsqe(msg, sq, idx: last_idx, sqe: last_sqe))
130 goto err;
131out:
132 return 0;
133err:
134 return -EMSGSIZE;
135}
136
137int c4iw_fill_res_qp_entry(struct sk_buff *msg, struct ib_qp *ibqp)
138{
139 struct t4_swsqe *fsp = NULL, *lsp = NULL;
140 struct c4iw_qp *qhp = to_c4iw_qp(ibqp);
141 u16 first_sq_idx = 0, last_sq_idx = 0;
142 struct t4_swsqe first_sqe, last_sqe;
143 struct nlattr *table_attr;
144 struct t4_wq wq;
145
146 /* User qp state is not available, so don't dump user qps */
147 if (qhp->ucontext)
148 return 0;
149
150 table_attr = nla_nest_start_noflag(skb: msg, attrtype: RDMA_NLDEV_ATTR_DRIVER);
151 if (!table_attr)
152 goto err;
153
154 /* Get a consistent snapshot */
155 spin_lock_irq(lock: &qhp->lock);
156 wq = qhp->wq;
157
158 /* If there are any pending sqes, copy the first and last */
159 if (wq.sq.cidx != wq.sq.pidx) {
160 first_sq_idx = wq.sq.cidx;
161 first_sqe = qhp->wq.sq.sw_sq[first_sq_idx];
162 fsp = &first_sqe;
163 last_sq_idx = wq.sq.pidx;
164 if (last_sq_idx-- == 0)
165 last_sq_idx = wq.sq.size - 1;
166 if (last_sq_idx != first_sq_idx) {
167 last_sqe = qhp->wq.sq.sw_sq[last_sq_idx];
168 lsp = &last_sqe;
169 }
170 }
171 spin_unlock_irq(lock: &qhp->lock);
172
173 if (fill_sq(msg, wq: &wq))
174 goto err_cancel_table;
175
176 if (fill_swsqes(msg, sq: &wq.sq, first_idx: first_sq_idx, first_sqe: fsp, last_idx: last_sq_idx, last_sqe: lsp))
177 goto err_cancel_table;
178
179 if (fill_rq(msg, wq: &wq))
180 goto err_cancel_table;
181
182 nla_nest_end(skb: msg, start: table_attr);
183 return 0;
184
185err_cancel_table:
186 nla_nest_cancel(skb: msg, start: table_attr);
187err:
188 return -EMSGSIZE;
189}
190
191union union_ep {
192 struct c4iw_listen_ep lep;
193 struct c4iw_ep ep;
194};
195
196int c4iw_fill_res_cm_id_entry(struct sk_buff *msg,
197 struct rdma_cm_id *cm_id)
198{
199 struct nlattr *table_attr;
200 struct c4iw_ep_common *epcp;
201 struct c4iw_listen_ep *listen_ep = NULL;
202 struct c4iw_ep *ep = NULL;
203 struct iw_cm_id *iw_cm_id;
204 union union_ep *uep;
205
206 iw_cm_id = rdma_iw_cm_id(cm_id);
207 if (!iw_cm_id)
208 return 0;
209 epcp = (struct c4iw_ep_common *)iw_cm_id->provider_data;
210 if (!epcp)
211 return 0;
212 uep = kzalloc(sizeof(*uep), GFP_KERNEL);
213 if (!uep)
214 return 0;
215
216 table_attr = nla_nest_start_noflag(skb: msg, attrtype: RDMA_NLDEV_ATTR_DRIVER);
217 if (!table_attr)
218 goto err_free_uep;
219
220 /* Get a consistent snapshot */
221 mutex_lock(&epcp->mutex);
222 if (epcp->state == LISTEN) {
223 uep->lep = *(struct c4iw_listen_ep *)epcp;
224 mutex_unlock(lock: &epcp->mutex);
225 listen_ep = &uep->lep;
226 epcp = &listen_ep->com;
227 } else {
228 uep->ep = *(struct c4iw_ep *)epcp;
229 mutex_unlock(lock: &epcp->mutex);
230 ep = &uep->ep;
231 epcp = &ep->com;
232 }
233
234 if (rdma_nl_put_driver_u32(msg, name: "state", value: epcp->state))
235 goto err_cancel_table;
236 if (rdma_nl_put_driver_u64_hex(msg, name: "flags", value: epcp->flags))
237 goto err_cancel_table;
238 if (rdma_nl_put_driver_u64_hex(msg, name: "history", value: epcp->history))
239 goto err_cancel_table;
240
241 if (listen_ep) {
242 if (rdma_nl_put_driver_u32(msg, name: "stid", value: listen_ep->stid))
243 goto err_cancel_table;
244 if (rdma_nl_put_driver_u32(msg, name: "backlog", value: listen_ep->backlog))
245 goto err_cancel_table;
246 } else {
247 if (rdma_nl_put_driver_u32(msg, name: "hwtid", value: ep->hwtid))
248 goto err_cancel_table;
249 if (rdma_nl_put_driver_u32(msg, name: "ord", value: ep->ord))
250 goto err_cancel_table;
251 if (rdma_nl_put_driver_u32(msg, name: "ird", value: ep->ird))
252 goto err_cancel_table;
253 if (rdma_nl_put_driver_u32(msg, name: "emss", value: ep->emss))
254 goto err_cancel_table;
255
256 if (!ep->parent_ep && rdma_nl_put_driver_u32(msg, name: "atid",
257 value: ep->atid))
258 goto err_cancel_table;
259 }
260 nla_nest_end(skb: msg, start: table_attr);
261 kfree(objp: uep);
262 return 0;
263
264err_cancel_table:
265 nla_nest_cancel(skb: msg, start: table_attr);
266err_free_uep:
267 kfree(objp: uep);
268 return -EMSGSIZE;
269}
270
271static int fill_cq(struct sk_buff *msg, struct t4_cq *cq)
272{
273 if (rdma_nl_put_driver_u32(msg, name: "cqid", value: cq->cqid))
274 goto err;
275 if (rdma_nl_put_driver_u32(msg, name: "memsize", value: cq->memsize))
276 goto err;
277 if (rdma_nl_put_driver_u32(msg, name: "size", value: cq->size))
278 goto err;
279 if (rdma_nl_put_driver_u32(msg, name: "cidx", value: cq->cidx))
280 goto err;
281 if (rdma_nl_put_driver_u32(msg, name: "cidx_inc", value: cq->cidx_inc))
282 goto err;
283 if (rdma_nl_put_driver_u32(msg, name: "sw_cidx", value: cq->sw_cidx))
284 goto err;
285 if (rdma_nl_put_driver_u32(msg, name: "sw_pidx", value: cq->sw_pidx))
286 goto err;
287 if (rdma_nl_put_driver_u32(msg, name: "sw_in_use", value: cq->sw_in_use))
288 goto err;
289 if (rdma_nl_put_driver_u32(msg, name: "vector", value: cq->vector))
290 goto err;
291 if (rdma_nl_put_driver_u32(msg, name: "gen", value: cq->gen))
292 goto err;
293 if (rdma_nl_put_driver_u32(msg, name: "error", value: cq->error))
294 goto err;
295 if (rdma_nl_put_driver_u64_hex(msg, name: "bits_type_ts",
296 be64_to_cpu(cq->bits_type_ts)))
297 goto err;
298 if (rdma_nl_put_driver_u64_hex(msg, name: "flags", value: cq->flags))
299 goto err;
300
301 return 0;
302
303err:
304 return -EMSGSIZE;
305}
306
307static int fill_cqe(struct sk_buff *msg, struct t4_cqe *cqe, u16 idx,
308 const char *qstr)
309{
310 if (rdma_nl_put_driver_u32(msg, name: qstr, value: idx))
311 goto err;
312 if (rdma_nl_put_driver_u32_hex(msg, name: "header",
313 be32_to_cpu(cqe->header)))
314 goto err;
315 if (rdma_nl_put_driver_u32(msg, name: "len", be32_to_cpu(cqe->len)))
316 goto err;
317 if (rdma_nl_put_driver_u32_hex(msg, name: "wrid_hi",
318 be32_to_cpu(cqe->u.gen.wrid_hi)))
319 goto err;
320 if (rdma_nl_put_driver_u32_hex(msg, name: "wrid_low",
321 be32_to_cpu(cqe->u.gen.wrid_low)))
322 goto err;
323 if (rdma_nl_put_driver_u64_hex(msg, name: "bits_type_ts",
324 be64_to_cpu(cqe->bits_type_ts)))
325 goto err;
326
327 return 0;
328
329err:
330 return -EMSGSIZE;
331}
332
333static int fill_hwcqes(struct sk_buff *msg, struct t4_cq *cq,
334 struct t4_cqe *cqes)
335{
336 u16 idx;
337
338 idx = (cq->cidx > 0) ? cq->cidx - 1 : cq->size - 1;
339 if (fill_cqe(msg, cqe: cqes, idx, qstr: "hwcq_idx"))
340 goto err;
341 idx = cq->cidx;
342 if (fill_cqe(msg, cqe: cqes + 1, idx, qstr: "hwcq_idx"))
343 goto err;
344
345 return 0;
346err:
347 return -EMSGSIZE;
348}
349
350static int fill_swcqes(struct sk_buff *msg, struct t4_cq *cq,
351 struct t4_cqe *cqes)
352{
353 u16 idx;
354
355 if (!cq->sw_in_use)
356 return 0;
357
358 idx = cq->sw_cidx;
359 if (fill_cqe(msg, cqe: cqes, idx, qstr: "swcq_idx"))
360 goto err;
361 if (cq->sw_in_use == 1)
362 goto out;
363 idx = (cq->sw_pidx > 0) ? cq->sw_pidx - 1 : cq->size - 1;
364 if (fill_cqe(msg, cqe: cqes + 1, idx, qstr: "swcq_idx"))
365 goto err;
366out:
367 return 0;
368err:
369 return -EMSGSIZE;
370}
371
372int c4iw_fill_res_cq_entry(struct sk_buff *msg, struct ib_cq *ibcq)
373{
374 struct c4iw_cq *chp = to_c4iw_cq(ibcq);
375 struct nlattr *table_attr;
376 struct t4_cqe hwcqes[2];
377 struct t4_cqe swcqes[2];
378 struct t4_cq cq;
379 u16 idx;
380
381 /* User cq state is not available, so don't dump user cqs */
382 if (ibcq->uobject)
383 return 0;
384
385 table_attr = nla_nest_start_noflag(skb: msg, attrtype: RDMA_NLDEV_ATTR_DRIVER);
386 if (!table_attr)
387 goto err;
388
389 /* Get a consistent snapshot */
390 spin_lock_irq(lock: &chp->lock);
391
392 /* t4_cq struct */
393 cq = chp->cq;
394
395 /* get 2 hw cqes: cidx-1, and cidx */
396 idx = (cq.cidx > 0) ? cq.cidx - 1 : cq.size - 1;
397 hwcqes[0] = chp->cq.queue[idx];
398
399 idx = cq.cidx;
400 hwcqes[1] = chp->cq.queue[idx];
401
402 /* get first and last sw cqes */
403 if (cq.sw_in_use) {
404 swcqes[0] = chp->cq.sw_queue[cq.sw_cidx];
405 if (cq.sw_in_use > 1) {
406 idx = (cq.sw_pidx > 0) ? cq.sw_pidx - 1 : cq.size - 1;
407 swcqes[1] = chp->cq.sw_queue[idx];
408 }
409 }
410
411 spin_unlock_irq(lock: &chp->lock);
412
413 if (fill_cq(msg, cq: &cq))
414 goto err_cancel_table;
415
416 if (fill_swcqes(msg, cq: &cq, cqes: swcqes))
417 goto err_cancel_table;
418
419 if (fill_hwcqes(msg, cq: &cq, cqes: hwcqes))
420 goto err_cancel_table;
421
422 nla_nest_end(skb: msg, start: table_attr);
423 return 0;
424
425err_cancel_table:
426 nla_nest_cancel(skb: msg, start: table_attr);
427err:
428 return -EMSGSIZE;
429}
430
431int c4iw_fill_res_mr_entry(struct sk_buff *msg, struct ib_mr *ibmr)
432{
433 struct c4iw_mr *mhp = to_c4iw_mr(ibmr);
434 struct c4iw_dev *dev = mhp->rhp;
435 u32 stag = mhp->attr.stag;
436 struct nlattr *table_attr;
437 struct fw_ri_tpte tpte;
438 int ret;
439
440 if (!stag)
441 return 0;
442
443 table_attr = nla_nest_start_noflag(skb: msg, attrtype: RDMA_NLDEV_ATTR_DRIVER);
444 if (!table_attr)
445 goto err;
446
447 ret = cxgb4_read_tpte(dev->rdev.lldi.ports[0], stag, (__be32 *)&tpte);
448 if (ret) {
449 dev_err(&dev->rdev.lldi.pdev->dev,
450 "%s cxgb4_read_tpte err %d\n", __func__, ret);
451 return 0;
452 }
453
454 if (rdma_nl_put_driver_u32_hex(msg, name: "idx", value: stag >> 8))
455 goto err_cancel_table;
456 if (rdma_nl_put_driver_u32(msg, name: "valid",
457 FW_RI_TPTE_VALID_G(ntohl(tpte.valid_to_pdid))))
458 goto err_cancel_table;
459 if (rdma_nl_put_driver_u32_hex(msg, name: "key", value: stag & 0xff))
460 goto err_cancel_table;
461 if (rdma_nl_put_driver_u32(msg, name: "state",
462 FW_RI_TPTE_STAGSTATE_G(ntohl(tpte.valid_to_pdid))))
463 goto err_cancel_table;
464 if (rdma_nl_put_driver_u32(msg, name: "pdid",
465 FW_RI_TPTE_PDID_G(ntohl(tpte.valid_to_pdid))))
466 goto err_cancel_table;
467 if (rdma_nl_put_driver_u32_hex(msg, name: "perm",
468 FW_RI_TPTE_PERM_G(ntohl(tpte.locread_to_qpid))))
469 goto err_cancel_table;
470 if (rdma_nl_put_driver_u32(msg, name: "ps",
471 FW_RI_TPTE_PS_G(ntohl(tpte.locread_to_qpid))))
472 goto err_cancel_table;
473 if (rdma_nl_put_driver_u64(msg, name: "len",
474 value: ((u64)ntohl(tpte.len_hi) << 32) | ntohl(tpte.len_lo)))
475 goto err_cancel_table;
476 if (rdma_nl_put_driver_u32_hex(msg, name: "pbl_addr",
477 FW_RI_TPTE_PBLADDR_G(ntohl(tpte.nosnoop_pbladdr))))
478 goto err_cancel_table;
479
480 nla_nest_end(skb: msg, start: table_attr);
481 return 0;
482
483err_cancel_table:
484 nla_nest_cancel(skb: msg, start: table_attr);
485err:
486 return -EMSGSIZE;
487}
488

source code of linux/drivers/infiniband/hw/cxgb4/restrack.c