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#include <linux/mlx5/driver.h>
34#include "mlx5_core.h"
35#include <linux/mlx5/transobj.h>
36
37int mlx5_core_alloc_transport_domain(struct mlx5_core_dev *dev, u32 *tdn)
38{
39 u32 in[MLX5_ST_SZ_DW(alloc_transport_domain_in)] = {0};
40 u32 out[MLX5_ST_SZ_DW(alloc_transport_domain_out)] = {0};
41 int err;
42
43 MLX5_SET(alloc_transport_domain_in, in, opcode,
44 MLX5_CMD_OP_ALLOC_TRANSPORT_DOMAIN);
45
46 err = mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
47 if (!err)
48 *tdn = MLX5_GET(alloc_transport_domain_out, out,
49 transport_domain);
50
51 return err;
52}
53EXPORT_SYMBOL(mlx5_core_alloc_transport_domain);
54
55void mlx5_core_dealloc_transport_domain(struct mlx5_core_dev *dev, u32 tdn)
56{
57 u32 in[MLX5_ST_SZ_DW(dealloc_transport_domain_in)] = {0};
58 u32 out[MLX5_ST_SZ_DW(dealloc_transport_domain_out)] = {0};
59
60 MLX5_SET(dealloc_transport_domain_in, in, opcode,
61 MLX5_CMD_OP_DEALLOC_TRANSPORT_DOMAIN);
62 MLX5_SET(dealloc_transport_domain_in, in, transport_domain, tdn);
63 mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
64}
65EXPORT_SYMBOL(mlx5_core_dealloc_transport_domain);
66
67int mlx5_core_create_rq(struct mlx5_core_dev *dev, u32 *in, int inlen, u32 *rqn)
68{
69 u32 out[MLX5_ST_SZ_DW(create_rq_out)] = {0};
70 int err;
71
72 MLX5_SET(create_rq_in, in, opcode, MLX5_CMD_OP_CREATE_RQ);
73 err = mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
74 if (!err)
75 *rqn = MLX5_GET(create_rq_out, out, rqn);
76
77 return err;
78}
79EXPORT_SYMBOL(mlx5_core_create_rq);
80
81int mlx5_core_modify_rq(struct mlx5_core_dev *dev, u32 rqn, u32 *in, int inlen)
82{
83 u32 out[MLX5_ST_SZ_DW(modify_rq_out)];
84
85 MLX5_SET(modify_rq_in, in, rqn, rqn);
86 MLX5_SET(modify_rq_in, in, opcode, MLX5_CMD_OP_MODIFY_RQ);
87
88 memset(out, 0, sizeof(out));
89 return mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
90}
91EXPORT_SYMBOL(mlx5_core_modify_rq);
92
93void mlx5_core_destroy_rq(struct mlx5_core_dev *dev, u32 rqn)
94{
95 u32 in[MLX5_ST_SZ_DW(destroy_rq_in)] = {0};
96 u32 out[MLX5_ST_SZ_DW(destroy_rq_out)] = {0};
97
98 MLX5_SET(destroy_rq_in, in, opcode, MLX5_CMD_OP_DESTROY_RQ);
99 MLX5_SET(destroy_rq_in, in, rqn, rqn);
100 mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
101}
102EXPORT_SYMBOL(mlx5_core_destroy_rq);
103
104int mlx5_core_query_rq(struct mlx5_core_dev *dev, u32 rqn, u32 *out)
105{
106 u32 in[MLX5_ST_SZ_DW(query_rq_in)] = {0};
107 int outlen = MLX5_ST_SZ_BYTES(query_rq_out);
108
109 MLX5_SET(query_rq_in, in, opcode, MLX5_CMD_OP_QUERY_RQ);
110 MLX5_SET(query_rq_in, in, rqn, rqn);
111
112 return mlx5_cmd_exec(dev, in, sizeof(in), out, outlen);
113}
114EXPORT_SYMBOL(mlx5_core_query_rq);
115
116int mlx5_core_create_sq(struct mlx5_core_dev *dev, u32 *in, int inlen, u32 *sqn)
117{
118 u32 out[MLX5_ST_SZ_DW(create_sq_out)] = {0};
119 int err;
120
121 MLX5_SET(create_sq_in, in, opcode, MLX5_CMD_OP_CREATE_SQ);
122 err = mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
123 if (!err)
124 *sqn = MLX5_GET(create_sq_out, out, sqn);
125
126 return err;
127}
128
129int mlx5_core_modify_sq(struct mlx5_core_dev *dev, u32 sqn, u32 *in, int inlen)
130{
131 u32 out[MLX5_ST_SZ_DW(modify_sq_out)] = {0};
132
133 MLX5_SET(modify_sq_in, in, sqn, sqn);
134 MLX5_SET(modify_sq_in, in, opcode, MLX5_CMD_OP_MODIFY_SQ);
135 return mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
136}
137EXPORT_SYMBOL(mlx5_core_modify_sq);
138
139void mlx5_core_destroy_sq(struct mlx5_core_dev *dev, u32 sqn)
140{
141 u32 in[MLX5_ST_SZ_DW(destroy_sq_in)] = {0};
142 u32 out[MLX5_ST_SZ_DW(destroy_sq_out)] = {0};
143
144 MLX5_SET(destroy_sq_in, in, opcode, MLX5_CMD_OP_DESTROY_SQ);
145 MLX5_SET(destroy_sq_in, in, sqn, sqn);
146 mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
147}
148
149int mlx5_core_query_sq(struct mlx5_core_dev *dev, u32 sqn, u32 *out)
150{
151 u32 in[MLX5_ST_SZ_DW(query_sq_in)] = {0};
152 int outlen = MLX5_ST_SZ_BYTES(query_sq_out);
153
154 MLX5_SET(query_sq_in, in, opcode, MLX5_CMD_OP_QUERY_SQ);
155 MLX5_SET(query_sq_in, in, sqn, sqn);
156 return mlx5_cmd_exec(dev, in, sizeof(in), out, outlen);
157}
158EXPORT_SYMBOL(mlx5_core_query_sq);
159
160int mlx5_core_query_sq_state(struct mlx5_core_dev *dev, u32 sqn, u8 *state)
161{
162 void *out;
163 void *sqc;
164 int inlen;
165 int err;
166
167 inlen = MLX5_ST_SZ_BYTES(query_sq_out);
168 out = kvzalloc(inlen, GFP_KERNEL);
169 if (!out)
170 return -ENOMEM;
171
172 err = mlx5_core_query_sq(dev, sqn, out);
173 if (err)
174 goto out;
175
176 sqc = MLX5_ADDR_OF(query_sq_out, out, sq_context);
177 *state = MLX5_GET(sqc, sqc, state);
178
179out:
180 kvfree(out);
181 return err;
182}
183EXPORT_SYMBOL_GPL(mlx5_core_query_sq_state);
184
185int mlx5_core_create_tir(struct mlx5_core_dev *dev, u32 *in, int inlen,
186 u32 *tirn)
187{
188 u32 out[MLX5_ST_SZ_DW(create_tir_out)] = {0};
189 int err;
190
191 MLX5_SET(create_tir_in, in, opcode, MLX5_CMD_OP_CREATE_TIR);
192
193 memset(out, 0, sizeof(out));
194 err = mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
195 if (!err)
196 *tirn = MLX5_GET(create_tir_out, out, tirn);
197
198 return err;
199}
200EXPORT_SYMBOL(mlx5_core_create_tir);
201
202int mlx5_core_modify_tir(struct mlx5_core_dev *dev, u32 tirn, u32 *in,
203 int inlen)
204{
205 u32 out[MLX5_ST_SZ_DW(modify_tir_out)] = {0};
206
207 MLX5_SET(modify_tir_in, in, tirn, tirn);
208 MLX5_SET(modify_tir_in, in, opcode, MLX5_CMD_OP_MODIFY_TIR);
209 return mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
210}
211
212void mlx5_core_destroy_tir(struct mlx5_core_dev *dev, u32 tirn)
213{
214 u32 in[MLX5_ST_SZ_DW(destroy_tir_in)] = {0};
215 u32 out[MLX5_ST_SZ_DW(destroy_tir_out)] = {0};
216
217 MLX5_SET(destroy_tir_in, in, opcode, MLX5_CMD_OP_DESTROY_TIR);
218 MLX5_SET(destroy_tir_in, in, tirn, tirn);
219 mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
220}
221EXPORT_SYMBOL(mlx5_core_destroy_tir);
222
223int mlx5_core_create_tis(struct mlx5_core_dev *dev, u32 *in, int inlen,
224 u32 *tisn)
225{
226 u32 out[MLX5_ST_SZ_DW(create_tis_out)] = {0};
227 int err;
228
229 MLX5_SET(create_tis_in, in, opcode, MLX5_CMD_OP_CREATE_TIS);
230 err = mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
231 if (!err)
232 *tisn = MLX5_GET(create_tis_out, out, tisn);
233
234 return err;
235}
236EXPORT_SYMBOL(mlx5_core_create_tis);
237
238int mlx5_core_modify_tis(struct mlx5_core_dev *dev, u32 tisn, u32 *in,
239 int inlen)
240{
241 u32 out[MLX5_ST_SZ_DW(modify_tis_out)] = {0};
242
243 MLX5_SET(modify_tis_in, in, tisn, tisn);
244 MLX5_SET(modify_tis_in, in, opcode, MLX5_CMD_OP_MODIFY_TIS);
245
246 return mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
247}
248EXPORT_SYMBOL(mlx5_core_modify_tis);
249
250void mlx5_core_destroy_tis(struct mlx5_core_dev *dev, u32 tisn)
251{
252 u32 in[MLX5_ST_SZ_DW(destroy_tis_in)] = {0};
253 u32 out[MLX5_ST_SZ_DW(destroy_tis_out)] = {0};
254
255 MLX5_SET(destroy_tis_in, in, opcode, MLX5_CMD_OP_DESTROY_TIS);
256 MLX5_SET(destroy_tis_in, in, tisn, tisn);
257 mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
258}
259EXPORT_SYMBOL(mlx5_core_destroy_tis);
260
261int mlx5_core_create_rmp(struct mlx5_core_dev *dev, u32 *in, int inlen,
262 u32 *rmpn)
263{
264 u32 out[MLX5_ST_SZ_DW(create_rmp_out)] = {0};
265 int err;
266
267 MLX5_SET(create_rmp_in, in, opcode, MLX5_CMD_OP_CREATE_RMP);
268 err = mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
269 if (!err)
270 *rmpn = MLX5_GET(create_rmp_out, out, rmpn);
271
272 return err;
273}
274
275int mlx5_core_modify_rmp(struct mlx5_core_dev *dev, u32 *in, int inlen)
276{
277 u32 out[MLX5_ST_SZ_DW(modify_rmp_out)] = {0};
278
279 MLX5_SET(modify_rmp_in, in, opcode, MLX5_CMD_OP_MODIFY_RMP);
280 return mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
281}
282
283int mlx5_core_destroy_rmp(struct mlx5_core_dev *dev, u32 rmpn)
284{
285 u32 in[MLX5_ST_SZ_DW(destroy_rmp_in)] = {0};
286 u32 out[MLX5_ST_SZ_DW(destroy_rmp_out)] = {0};
287
288 MLX5_SET(destroy_rmp_in, in, opcode, MLX5_CMD_OP_DESTROY_RMP);
289 MLX5_SET(destroy_rmp_in, in, rmpn, rmpn);
290 return mlx5_cmd_exec(dev, in, sizeof(in), out,
291 sizeof(out));
292}
293
294int mlx5_core_query_rmp(struct mlx5_core_dev *dev, u32 rmpn, u32 *out)
295{
296 u32 in[MLX5_ST_SZ_DW(query_rmp_in)] = {0};
297 int outlen = MLX5_ST_SZ_BYTES(query_rmp_out);
298
299 MLX5_SET(query_rmp_in, in, opcode, MLX5_CMD_OP_QUERY_RMP);
300 MLX5_SET(query_rmp_in, in, rmpn, rmpn);
301 return mlx5_cmd_exec(dev, in, sizeof(in), out, outlen);
302}
303
304int mlx5_core_arm_rmp(struct mlx5_core_dev *dev, u32 rmpn, u16 lwm)
305{
306 void *in;
307 void *rmpc;
308 void *wq;
309 void *bitmask;
310 int err;
311
312 in = kvzalloc(MLX5_ST_SZ_BYTES(modify_rmp_in), GFP_KERNEL);
313 if (!in)
314 return -ENOMEM;
315
316 rmpc = MLX5_ADDR_OF(modify_rmp_in, in, ctx);
317 bitmask = MLX5_ADDR_OF(modify_rmp_in, in, bitmask);
318 wq = MLX5_ADDR_OF(rmpc, rmpc, wq);
319
320 MLX5_SET(modify_rmp_in, in, rmp_state, MLX5_RMPC_STATE_RDY);
321 MLX5_SET(modify_rmp_in, in, rmpn, rmpn);
322 MLX5_SET(wq, wq, lwm, lwm);
323 MLX5_SET(rmp_bitmask, bitmask, lwm, 1);
324 MLX5_SET(rmpc, rmpc, state, MLX5_RMPC_STATE_RDY);
325
326 err = mlx5_core_modify_rmp(dev, in, MLX5_ST_SZ_BYTES(modify_rmp_in));
327
328 kvfree(in);
329
330 return err;
331}
332
333int mlx5_core_create_xsrq(struct mlx5_core_dev *dev, u32 *in, int inlen,
334 u32 *xsrqn)
335{
336 u32 out[MLX5_ST_SZ_DW(create_xrc_srq_out)] = {0};
337 int err;
338
339 MLX5_SET(create_xrc_srq_in, in, opcode, MLX5_CMD_OP_CREATE_XRC_SRQ);
340 err = mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
341 if (!err)
342 *xsrqn = MLX5_GET(create_xrc_srq_out, out, xrc_srqn);
343
344 return err;
345}
346
347int mlx5_core_destroy_xsrq(struct mlx5_core_dev *dev, u32 xsrqn)
348{
349 u32 in[MLX5_ST_SZ_DW(destroy_xrc_srq_in)] = {0};
350 u32 out[MLX5_ST_SZ_DW(destroy_xrc_srq_out)] = {0};
351
352 MLX5_SET(destroy_xrc_srq_in, in, opcode, MLX5_CMD_OP_DESTROY_XRC_SRQ);
353 MLX5_SET(destroy_xrc_srq_in, in, xrc_srqn, xsrqn);
354 return mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
355}
356
357int mlx5_core_arm_xsrq(struct mlx5_core_dev *dev, u32 xsrqn, u16 lwm)
358{
359 u32 in[MLX5_ST_SZ_DW(arm_xrc_srq_in)] = {0};
360 u32 out[MLX5_ST_SZ_DW(arm_xrc_srq_out)] = {0};
361
362 MLX5_SET(arm_xrc_srq_in, in, opcode, MLX5_CMD_OP_ARM_XRC_SRQ);
363 MLX5_SET(arm_xrc_srq_in, in, xrc_srqn, xsrqn);
364 MLX5_SET(arm_xrc_srq_in, in, lwm, lwm);
365 MLX5_SET(arm_xrc_srq_in, in, op_mod,
366 MLX5_ARM_XRC_SRQ_IN_OP_MOD_XRC_SRQ);
367 return mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
368}
369
370int mlx5_core_create_rqt(struct mlx5_core_dev *dev, u32 *in, int inlen,
371 u32 *rqtn)
372{
373 u32 out[MLX5_ST_SZ_DW(create_rqt_out)] = {0};
374 int err;
375
376 MLX5_SET(create_rqt_in, in, opcode, MLX5_CMD_OP_CREATE_RQT);
377 err = mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
378 if (!err)
379 *rqtn = MLX5_GET(create_rqt_out, out, rqtn);
380
381 return err;
382}
383EXPORT_SYMBOL(mlx5_core_create_rqt);
384
385int mlx5_core_modify_rqt(struct mlx5_core_dev *dev, u32 rqtn, u32 *in,
386 int inlen)
387{
388 u32 out[MLX5_ST_SZ_DW(modify_rqt_out)] = {0};
389
390 MLX5_SET(modify_rqt_in, in, rqtn, rqtn);
391 MLX5_SET(modify_rqt_in, in, opcode, MLX5_CMD_OP_MODIFY_RQT);
392 return mlx5_cmd_exec(dev, in, inlen, out, sizeof(out));
393}
394
395void mlx5_core_destroy_rqt(struct mlx5_core_dev *dev, u32 rqtn)
396{
397 u32 in[MLX5_ST_SZ_DW(destroy_rqt_in)] = {0};
398 u32 out[MLX5_ST_SZ_DW(destroy_rqt_out)] = {0};
399
400 MLX5_SET(destroy_rqt_in, in, opcode, MLX5_CMD_OP_DESTROY_RQT);
401 MLX5_SET(destroy_rqt_in, in, rqtn, rqtn);
402 mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
403}
404EXPORT_SYMBOL(mlx5_core_destroy_rqt);
405
406static int mlx5_hairpin_create_rq(struct mlx5_core_dev *mdev,
407 struct mlx5_hairpin_params *params, u32 *rqn)
408{
409 u32 in[MLX5_ST_SZ_DW(create_rq_in)] = {0};
410 void *rqc, *wq;
411
412 rqc = MLX5_ADDR_OF(create_rq_in, in, ctx);
413 wq = MLX5_ADDR_OF(rqc, rqc, wq);
414
415 MLX5_SET(rqc, rqc, hairpin, 1);
416 MLX5_SET(rqc, rqc, state, MLX5_RQC_STATE_RST);
417 MLX5_SET(rqc, rqc, counter_set_id, params->q_counter);
418
419 MLX5_SET(wq, wq, log_hairpin_data_sz, params->log_data_size);
420 MLX5_SET(wq, wq, log_hairpin_num_packets, params->log_num_packets);
421
422 return mlx5_core_create_rq(mdev, in, MLX5_ST_SZ_BYTES(create_rq_in), rqn);
423}
424
425static int mlx5_hairpin_create_sq(struct mlx5_core_dev *mdev,
426 struct mlx5_hairpin_params *params, u32 *sqn)
427{
428 u32 in[MLX5_ST_SZ_DW(create_sq_in)] = {0};
429 void *sqc, *wq;
430
431 sqc = MLX5_ADDR_OF(create_sq_in, in, ctx);
432 wq = MLX5_ADDR_OF(sqc, sqc, wq);
433
434 MLX5_SET(sqc, sqc, hairpin, 1);
435 MLX5_SET(sqc, sqc, state, MLX5_SQC_STATE_RST);
436
437 MLX5_SET(wq, wq, log_hairpin_data_sz, params->log_data_size);
438 MLX5_SET(wq, wq, log_hairpin_num_packets, params->log_num_packets);
439
440 return mlx5_core_create_sq(mdev, in, MLX5_ST_SZ_BYTES(create_sq_in), sqn);
441}
442
443static int mlx5_hairpin_create_queues(struct mlx5_hairpin *hp,
444 struct mlx5_hairpin_params *params)
445{
446 int i, j, err;
447
448 for (i = 0; i < hp->num_channels; i++) {
449 err = mlx5_hairpin_create_rq(hp->func_mdev, params, &hp->rqn[i]);
450 if (err)
451 goto out_err_rq;
452 }
453
454 for (i = 0; i < hp->num_channels; i++) {
455 err = mlx5_hairpin_create_sq(hp->peer_mdev, params, &hp->sqn[i]);
456 if (err)
457 goto out_err_sq;
458 }
459
460 return 0;
461
462out_err_sq:
463 for (j = 0; j < i; j++)
464 mlx5_core_destroy_sq(hp->peer_mdev, hp->sqn[j]);
465 i = hp->num_channels;
466out_err_rq:
467 for (j = 0; j < i; j++)
468 mlx5_core_destroy_rq(hp->func_mdev, hp->rqn[j]);
469 return err;
470}
471
472static void mlx5_hairpin_destroy_queues(struct mlx5_hairpin *hp)
473{
474 int i;
475
476 for (i = 0; i < hp->num_channels; i++) {
477 mlx5_core_destroy_rq(hp->func_mdev, hp->rqn[i]);
478 mlx5_core_destroy_sq(hp->peer_mdev, hp->sqn[i]);
479 }
480}
481
482static int mlx5_hairpin_modify_rq(struct mlx5_core_dev *func_mdev, u32 rqn,
483 int curr_state, int next_state,
484 u16 peer_vhca, u32 peer_sq)
485{
486 u32 in[MLX5_ST_SZ_DW(modify_rq_in)] = {0};
487 void *rqc;
488
489 rqc = MLX5_ADDR_OF(modify_rq_in, in, ctx);
490
491 if (next_state == MLX5_RQC_STATE_RDY) {
492 MLX5_SET(rqc, rqc, hairpin_peer_sq, peer_sq);
493 MLX5_SET(rqc, rqc, hairpin_peer_vhca, peer_vhca);
494 }
495
496 MLX5_SET(modify_rq_in, in, rq_state, curr_state);
497 MLX5_SET(rqc, rqc, state, next_state);
498
499 return mlx5_core_modify_rq(func_mdev, rqn,
500 in, MLX5_ST_SZ_BYTES(modify_rq_in));
501}
502
503static int mlx5_hairpin_modify_sq(struct mlx5_core_dev *peer_mdev, u32 sqn,
504 int curr_state, int next_state,
505 u16 peer_vhca, u32 peer_rq)
506{
507 u32 in[MLX5_ST_SZ_DW(modify_sq_in)] = {0};
508 void *sqc;
509
510 sqc = MLX5_ADDR_OF(modify_sq_in, in, ctx);
511
512 if (next_state == MLX5_RQC_STATE_RDY) {
513 MLX5_SET(sqc, sqc, hairpin_peer_rq, peer_rq);
514 MLX5_SET(sqc, sqc, hairpin_peer_vhca, peer_vhca);
515 }
516
517 MLX5_SET(modify_sq_in, in, sq_state, curr_state);
518 MLX5_SET(sqc, sqc, state, next_state);
519
520 return mlx5_core_modify_sq(peer_mdev, sqn,
521 in, MLX5_ST_SZ_BYTES(modify_sq_in));
522}
523
524static int mlx5_hairpin_pair_queues(struct mlx5_hairpin *hp)
525{
526 int i, j, err;
527
528
529 for (i = 0; i < hp->num_channels; i++) {
530 err = mlx5_hairpin_modify_sq(hp->peer_mdev, hp->sqn[i],
531 MLX5_SQC_STATE_RST, MLX5_SQC_STATE_RDY,
532 MLX5_CAP_GEN(hp->func_mdev, vhca_id), hp->rqn[i]);
533 if (err)
534 goto err_modify_sq;
535 }
536
537
538 for (i = 0; i < hp->num_channels; i++) {
539 err = mlx5_hairpin_modify_rq(hp->func_mdev, hp->rqn[i],
540 MLX5_RQC_STATE_RST, MLX5_RQC_STATE_RDY,
541 MLX5_CAP_GEN(hp->peer_mdev, vhca_id), hp->sqn[i]);
542 if (err)
543 goto err_modify_rq;
544 }
545
546 return 0;
547
548err_modify_rq:
549 for (j = 0; j < i; j++)
550 mlx5_hairpin_modify_rq(hp->func_mdev, hp->rqn[j], MLX5_RQC_STATE_RDY,
551 MLX5_RQC_STATE_RST, 0, 0);
552 i = hp->num_channels;
553err_modify_sq:
554 for (j = 0; j < i; j++)
555 mlx5_hairpin_modify_sq(hp->peer_mdev, hp->sqn[j], MLX5_SQC_STATE_RDY,
556 MLX5_SQC_STATE_RST, 0, 0);
557 return err;
558}
559
560static void mlx5_hairpin_unpair_queues(struct mlx5_hairpin *hp)
561{
562 int i;
563
564
565 for (i = 0; i < hp->num_channels; i++)
566 mlx5_hairpin_modify_rq(hp->func_mdev, hp->rqn[i], MLX5_RQC_STATE_RDY,
567 MLX5_RQC_STATE_RST, 0, 0);
568
569
570 for (i = 0; i < hp->num_channels; i++)
571 mlx5_hairpin_modify_sq(hp->peer_mdev, hp->sqn[i], MLX5_SQC_STATE_RDY,
572 MLX5_SQC_STATE_RST, 0, 0);
573}
574
575struct mlx5_hairpin *
576mlx5_core_hairpin_create(struct mlx5_core_dev *func_mdev,
577 struct mlx5_core_dev *peer_mdev,
578 struct mlx5_hairpin_params *params)
579{
580 struct mlx5_hairpin *hp;
581 int size, err;
582
583 size = sizeof(*hp) + params->num_channels * 2 * sizeof(u32);
584 hp = kzalloc(size, GFP_KERNEL);
585 if (!hp)
586 return ERR_PTR(-ENOMEM);
587
588 hp->func_mdev = func_mdev;
589 hp->peer_mdev = peer_mdev;
590 hp->num_channels = params->num_channels;
591
592 hp->rqn = (void *)hp + sizeof(*hp);
593 hp->sqn = hp->rqn + params->num_channels;
594
595
596 err = mlx5_hairpin_create_queues(hp, params);
597 if (err)
598 goto err_create_queues;
599
600 err = mlx5_hairpin_pair_queues(hp);
601 if (err)
602 goto err_pair_queues;
603
604 return hp;
605
606err_pair_queues:
607 mlx5_hairpin_destroy_queues(hp);
608err_create_queues:
609 kfree(hp);
610 return ERR_PTR(err);
611}
612
613void mlx5_core_hairpin_destroy(struct mlx5_hairpin *hp)
614{
615 mlx5_hairpin_unpair_queues(hp);
616 mlx5_hairpin_destroy_queues(hp);
617 kfree(hp);
618}
619