xref: /openbmc/linux/drivers/infiniband/hw/mlx5/qp.c (revision 514aee66)
1e126ba97SEli Cohen /*
26cf0a15fSSaeed Mahameed  * Copyright (c) 2013-2015, Mellanox Technologies. All rights reserved.
3e126ba97SEli Cohen  *
4e126ba97SEli Cohen  * This software is available to you under a choice of one of two
5e126ba97SEli Cohen  * licenses.  You may choose to be licensed under the terms of the GNU
6e126ba97SEli Cohen  * General Public License (GPL) Version 2, available from the file
7e126ba97SEli Cohen  * COPYING in the main directory of this source tree, or the
8e126ba97SEli Cohen  * OpenIB.org BSD license below:
9e126ba97SEli Cohen  *
10e126ba97SEli Cohen  *     Redistribution and use in source and binary forms, with or
11e126ba97SEli Cohen  *     without modification, are permitted provided that the following
12e126ba97SEli Cohen  *     conditions are met:
13e126ba97SEli Cohen  *
14e126ba97SEli Cohen  *      - Redistributions of source code must retain the above
15e126ba97SEli Cohen  *        copyright notice, this list of conditions and the following
16e126ba97SEli Cohen  *        disclaimer.
17e126ba97SEli Cohen  *
18e126ba97SEli Cohen  *      - Redistributions in binary form must reproduce the above
19e126ba97SEli Cohen  *        copyright notice, this list of conditions and the following
20e126ba97SEli Cohen  *        disclaimer in the documentation and/or other materials
21e126ba97SEli Cohen  *        provided with the distribution.
22e126ba97SEli Cohen  *
23e126ba97SEli Cohen  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24e126ba97SEli Cohen  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25e126ba97SEli Cohen  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26e126ba97SEli Cohen  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27e126ba97SEli Cohen  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28e126ba97SEli Cohen  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29e126ba97SEli Cohen  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30e126ba97SEli Cohen  * SOFTWARE.
31e126ba97SEli Cohen  */
32e126ba97SEli Cohen 
33e126ba97SEli Cohen #include <linux/module.h>
34e126ba97SEli Cohen #include <rdma/ib_umem.h>
352811ba51SAchiad Shochat #include <rdma/ib_cache.h>
36cfb5e088SHaggai Abramovsky #include <rdma/ib_user_verbs.h>
37d14133ddSMark Zhang #include <rdma/rdma_counter.h>
38c2e53b2cSYishai Hadas #include <linux/mlx5/fs.h>
39e126ba97SEli Cohen #include "mlx5_ib.h"
40b96c9ddeSMark Bloch #include "ib_rep.h"
4164825827SLeon Romanovsky #include "counters.h"
42443c1cf9SYishai Hadas #include "cmd.h"
43333fbaa0SLeon Romanovsky #include "qp.h"
44029e88fdSLeon Romanovsky #include "wr.h"
45e126ba97SEli Cohen 
46e126ba97SEli Cohen enum {
47e126ba97SEli Cohen 	MLX5_IB_ACK_REQ_FREQ	= 8,
48e126ba97SEli Cohen };
49e126ba97SEli Cohen 
50e126ba97SEli Cohen enum {
51e126ba97SEli Cohen 	MLX5_IB_DEFAULT_SCHED_QUEUE	= 0x83,
52e126ba97SEli Cohen 	MLX5_IB_DEFAULT_QP0_SCHED_QUEUE	= 0x3f,
53e126ba97SEli Cohen 	MLX5_IB_LINK_TYPE_IB		= 0,
54e126ba97SEli Cohen 	MLX5_IB_LINK_TYPE_ETH		= 1
55e126ba97SEli Cohen };
56e126ba97SEli Cohen 
57eb49ab0cSAlex Vesker enum raw_qp_set_mask_map {
58eb49ab0cSAlex Vesker 	MLX5_RAW_QP_MOD_SET_RQ_Q_CTR_ID		= 1UL << 0,
597d29f349SBodong Wang 	MLX5_RAW_QP_RATE_LIMIT			= 1UL << 1,
60eb49ab0cSAlex Vesker };
61eb49ab0cSAlex Vesker 
620680efa2SAlex Vesker struct mlx5_modify_raw_qp_param {
630680efa2SAlex Vesker 	u16 operation;
64eb49ab0cSAlex Vesker 
65eb49ab0cSAlex Vesker 	u32 set_mask; /* raw_qp_set_mask_map */
6661147f39SBodong Wang 
6761147f39SBodong Wang 	struct mlx5_rate_limit rl;
6861147f39SBodong Wang 
69eb49ab0cSAlex Vesker 	u8 rq_q_ctr_id;
701fb7f897SMark Bloch 	u32 port;
710680efa2SAlex Vesker };
720680efa2SAlex Vesker 
7389ea94a7SMaor Gottlieb static void get_cqs(enum ib_qp_type qp_type,
7489ea94a7SMaor Gottlieb 		    struct ib_cq *ib_send_cq, struct ib_cq *ib_recv_cq,
7589ea94a7SMaor Gottlieb 		    struct mlx5_ib_cq **send_cq, struct mlx5_ib_cq **recv_cq);
7689ea94a7SMaor Gottlieb 
77e126ba97SEli Cohen static int is_qp0(enum ib_qp_type qp_type)
78e126ba97SEli Cohen {
79e126ba97SEli Cohen 	return qp_type == IB_QPT_SMI;
80e126ba97SEli Cohen }
81e126ba97SEli Cohen 
82e126ba97SEli Cohen static int is_sqp(enum ib_qp_type qp_type)
83e126ba97SEli Cohen {
84e126ba97SEli Cohen 	return is_qp0(qp_type) || is_qp1(qp_type);
85e126ba97SEli Cohen }
86e126ba97SEli Cohen 
87c1395a2aSHaggai Eran /**
88fbeb4075SMoni Shoua  * mlx5_ib_read_user_wqe_common() - Copy a WQE (or part of) from user WQ
89fbeb4075SMoni Shoua  * to kernel buffer
90c1395a2aSHaggai Eran  *
91fbeb4075SMoni Shoua  * @umem: User space memory where the WQ is
92fbeb4075SMoni Shoua  * @buffer: buffer to copy to
93fbeb4075SMoni Shoua  * @buflen: buffer length
94fbeb4075SMoni Shoua  * @wqe_index: index of WQE to copy from
95fbeb4075SMoni Shoua  * @wq_offset: offset to start of WQ
96fbeb4075SMoni Shoua  * @wq_wqe_cnt: number of WQEs in WQ
97fbeb4075SMoni Shoua  * @wq_wqe_shift: log2 of WQE size
98fbeb4075SMoni Shoua  * @bcnt: number of bytes to copy
99fbeb4075SMoni Shoua  * @bytes_copied: number of bytes to copy (return value)
100c1395a2aSHaggai Eran  *
101fbeb4075SMoni Shoua  * Copies from start of WQE bcnt or less bytes.
102fbeb4075SMoni Shoua  * Does not gurantee to copy the entire WQE.
103c1395a2aSHaggai Eran  *
104fbeb4075SMoni Shoua  * Return: zero on success, or an error code.
105c1395a2aSHaggai Eran  */
106da9ee9d8SMoni Shoua static int mlx5_ib_read_user_wqe_common(struct ib_umem *umem, void *buffer,
107da9ee9d8SMoni Shoua 					size_t buflen, int wqe_index,
108da9ee9d8SMoni Shoua 					int wq_offset, int wq_wqe_cnt,
109da9ee9d8SMoni Shoua 					int wq_wqe_shift, int bcnt,
110fbeb4075SMoni Shoua 					size_t *bytes_copied)
111c1395a2aSHaggai Eran {
112fbeb4075SMoni Shoua 	size_t offset = wq_offset + ((wqe_index % wq_wqe_cnt) << wq_wqe_shift);
113fbeb4075SMoni Shoua 	size_t wq_end = wq_offset + (wq_wqe_cnt << wq_wqe_shift);
114fbeb4075SMoni Shoua 	size_t copy_length;
115c1395a2aSHaggai Eran 	int ret;
116c1395a2aSHaggai Eran 
117fbeb4075SMoni Shoua 	/* don't copy more than requested, more than buffer length or
118fbeb4075SMoni Shoua 	 * beyond WQ end
119fbeb4075SMoni Shoua 	 */
120fbeb4075SMoni Shoua 	copy_length = min_t(u32, buflen, wq_end - offset);
121fbeb4075SMoni Shoua 	copy_length = min_t(u32, copy_length, bcnt);
122c1395a2aSHaggai Eran 
123fbeb4075SMoni Shoua 	ret = ib_umem_copy_from(buffer, umem, offset, copy_length);
124c1395a2aSHaggai Eran 	if (ret)
125c1395a2aSHaggai Eran 		return ret;
126c1395a2aSHaggai Eran 
127fbeb4075SMoni Shoua 	if (!ret && bytes_copied)
128fbeb4075SMoni Shoua 		*bytes_copied = copy_length;
129c1395a2aSHaggai Eran 
130fbeb4075SMoni Shoua 	return 0;
131fbeb4075SMoni Shoua }
132fbeb4075SMoni Shoua 
133da9ee9d8SMoni Shoua static int mlx5_ib_read_kernel_wqe_sq(struct mlx5_ib_qp *qp, int wqe_index,
134da9ee9d8SMoni Shoua 				      void *buffer, size_t buflen, size_t *bc)
135da9ee9d8SMoni Shoua {
136da9ee9d8SMoni Shoua 	struct mlx5_wqe_ctrl_seg *ctrl;
137da9ee9d8SMoni Shoua 	size_t bytes_copied = 0;
138da9ee9d8SMoni Shoua 	size_t wqe_length;
139da9ee9d8SMoni Shoua 	void *p;
140da9ee9d8SMoni Shoua 	int ds;
141da9ee9d8SMoni Shoua 
142da9ee9d8SMoni Shoua 	wqe_index = wqe_index & qp->sq.fbc.sz_m1;
143da9ee9d8SMoni Shoua 
144da9ee9d8SMoni Shoua 	/* read the control segment first */
145da9ee9d8SMoni Shoua 	p = mlx5_frag_buf_get_wqe(&qp->sq.fbc, wqe_index);
146da9ee9d8SMoni Shoua 	ctrl = p;
147da9ee9d8SMoni Shoua 	ds = be32_to_cpu(ctrl->qpn_ds) & MLX5_WQE_CTRL_DS_MASK;
148da9ee9d8SMoni Shoua 	wqe_length = ds * MLX5_WQE_DS_UNITS;
149da9ee9d8SMoni Shoua 
150da9ee9d8SMoni Shoua 	/* read rest of WQE if it spreads over more than one stride */
151da9ee9d8SMoni Shoua 	while (bytes_copied < wqe_length) {
152da9ee9d8SMoni Shoua 		size_t copy_length =
153da9ee9d8SMoni Shoua 			min_t(size_t, buflen - bytes_copied, MLX5_SEND_WQE_BB);
154da9ee9d8SMoni Shoua 
155da9ee9d8SMoni Shoua 		if (!copy_length)
156da9ee9d8SMoni Shoua 			break;
157da9ee9d8SMoni Shoua 
158da9ee9d8SMoni Shoua 		memcpy(buffer + bytes_copied, p, copy_length);
159da9ee9d8SMoni Shoua 		bytes_copied += copy_length;
160da9ee9d8SMoni Shoua 
161da9ee9d8SMoni Shoua 		wqe_index = (wqe_index + 1) & qp->sq.fbc.sz_m1;
162da9ee9d8SMoni Shoua 		p = mlx5_frag_buf_get_wqe(&qp->sq.fbc, wqe_index);
163da9ee9d8SMoni Shoua 	}
164da9ee9d8SMoni Shoua 	*bc = bytes_copied;
165da9ee9d8SMoni Shoua 	return 0;
166da9ee9d8SMoni Shoua }
167da9ee9d8SMoni Shoua 
168da9ee9d8SMoni Shoua static int mlx5_ib_read_user_wqe_sq(struct mlx5_ib_qp *qp, int wqe_index,
169da9ee9d8SMoni Shoua 				    void *buffer, size_t buflen, size_t *bc)
170fbeb4075SMoni Shoua {
171fbeb4075SMoni Shoua 	struct mlx5_ib_qp_base *base = &qp->trans_qp.base;
172fbeb4075SMoni Shoua 	struct ib_umem *umem = base->ubuffer.umem;
173fbeb4075SMoni Shoua 	struct mlx5_ib_wq *wq = &qp->sq;
174fbeb4075SMoni Shoua 	struct mlx5_wqe_ctrl_seg *ctrl;
175fbeb4075SMoni Shoua 	size_t bytes_copied;
176fbeb4075SMoni Shoua 	size_t bytes_copied2;
177fbeb4075SMoni Shoua 	size_t wqe_length;
178fbeb4075SMoni Shoua 	int ret;
179fbeb4075SMoni Shoua 	int ds;
180fbeb4075SMoni Shoua 
181fbeb4075SMoni Shoua 	/* at first read as much as possible */
182da9ee9d8SMoni Shoua 	ret = mlx5_ib_read_user_wqe_common(umem, buffer, buflen, wqe_index,
183da9ee9d8SMoni Shoua 					   wq->offset, wq->wqe_cnt,
184da9ee9d8SMoni Shoua 					   wq->wqe_shift, buflen,
185fbeb4075SMoni Shoua 					   &bytes_copied);
186fbeb4075SMoni Shoua 	if (ret)
187fbeb4075SMoni Shoua 		return ret;
188fbeb4075SMoni Shoua 
189fbeb4075SMoni Shoua 	/* we need at least control segment size to proceed */
190fbeb4075SMoni Shoua 	if (bytes_copied < sizeof(*ctrl))
191fbeb4075SMoni Shoua 		return -EINVAL;
192fbeb4075SMoni Shoua 
193fbeb4075SMoni Shoua 	ctrl = buffer;
194fbeb4075SMoni Shoua 	ds = be32_to_cpu(ctrl->qpn_ds) & MLX5_WQE_CTRL_DS_MASK;
195c1395a2aSHaggai Eran 	wqe_length = ds * MLX5_WQE_DS_UNITS;
196fbeb4075SMoni Shoua 
197fbeb4075SMoni Shoua 	/* if we copied enough then we are done */
198fbeb4075SMoni Shoua 	if (bytes_copied >= wqe_length) {
199fbeb4075SMoni Shoua 		*bc = bytes_copied;
200fbeb4075SMoni Shoua 		return 0;
201c1395a2aSHaggai Eran 	}
202c1395a2aSHaggai Eran 
203fbeb4075SMoni Shoua 	/* otherwise this a wrapped around wqe
204fbeb4075SMoni Shoua 	 * so read the remaining bytes starting
205fbeb4075SMoni Shoua 	 * from  wqe_index 0
206fbeb4075SMoni Shoua 	 */
207da9ee9d8SMoni Shoua 	ret = mlx5_ib_read_user_wqe_common(umem, buffer + bytes_copied,
208da9ee9d8SMoni Shoua 					   buflen - bytes_copied, 0, wq->offset,
209da9ee9d8SMoni Shoua 					   wq->wqe_cnt, wq->wqe_shift,
210fbeb4075SMoni Shoua 					   wqe_length - bytes_copied,
211fbeb4075SMoni Shoua 					   &bytes_copied2);
212c1395a2aSHaggai Eran 
213c1395a2aSHaggai Eran 	if (ret)
214c1395a2aSHaggai Eran 		return ret;
215fbeb4075SMoni Shoua 	*bc = bytes_copied + bytes_copied2;
216fbeb4075SMoni Shoua 	return 0;
217fbeb4075SMoni Shoua }
218c1395a2aSHaggai Eran 
219da9ee9d8SMoni Shoua int mlx5_ib_read_wqe_sq(struct mlx5_ib_qp *qp, int wqe_index, void *buffer,
220da9ee9d8SMoni Shoua 			size_t buflen, size_t *bc)
221da9ee9d8SMoni Shoua {
222da9ee9d8SMoni Shoua 	struct mlx5_ib_qp_base *base = &qp->trans_qp.base;
223da9ee9d8SMoni Shoua 	struct ib_umem *umem = base->ubuffer.umem;
224da9ee9d8SMoni Shoua 
225da9ee9d8SMoni Shoua 	if (buflen < sizeof(struct mlx5_wqe_ctrl_seg))
226da9ee9d8SMoni Shoua 		return -EINVAL;
227da9ee9d8SMoni Shoua 
228da9ee9d8SMoni Shoua 	if (!umem)
229da9ee9d8SMoni Shoua 		return mlx5_ib_read_kernel_wqe_sq(qp, wqe_index, buffer,
230da9ee9d8SMoni Shoua 						  buflen, bc);
231da9ee9d8SMoni Shoua 
232da9ee9d8SMoni Shoua 	return mlx5_ib_read_user_wqe_sq(qp, wqe_index, buffer, buflen, bc);
233da9ee9d8SMoni Shoua }
234da9ee9d8SMoni Shoua 
235da9ee9d8SMoni Shoua static int mlx5_ib_read_user_wqe_rq(struct mlx5_ib_qp *qp, int wqe_index,
236da9ee9d8SMoni Shoua 				    void *buffer, size_t buflen, size_t *bc)
237fbeb4075SMoni Shoua {
238fbeb4075SMoni Shoua 	struct mlx5_ib_qp_base *base = &qp->trans_qp.base;
239fbeb4075SMoni Shoua 	struct ib_umem *umem = base->ubuffer.umem;
240fbeb4075SMoni Shoua 	struct mlx5_ib_wq *wq = &qp->rq;
241fbeb4075SMoni Shoua 	size_t bytes_copied;
242fbeb4075SMoni Shoua 	int ret;
243fbeb4075SMoni Shoua 
244da9ee9d8SMoni Shoua 	ret = mlx5_ib_read_user_wqe_common(umem, buffer, buflen, wqe_index,
245da9ee9d8SMoni Shoua 					   wq->offset, wq->wqe_cnt,
246da9ee9d8SMoni Shoua 					   wq->wqe_shift, buflen,
247fbeb4075SMoni Shoua 					   &bytes_copied);
248fbeb4075SMoni Shoua 
249fbeb4075SMoni Shoua 	if (ret)
250fbeb4075SMoni Shoua 		return ret;
251fbeb4075SMoni Shoua 	*bc = bytes_copied;
252fbeb4075SMoni Shoua 	return 0;
253fbeb4075SMoni Shoua }
254fbeb4075SMoni Shoua 
255da9ee9d8SMoni Shoua int mlx5_ib_read_wqe_rq(struct mlx5_ib_qp *qp, int wqe_index, void *buffer,
256da9ee9d8SMoni Shoua 			size_t buflen, size_t *bc)
257da9ee9d8SMoni Shoua {
258da9ee9d8SMoni Shoua 	struct mlx5_ib_qp_base *base = &qp->trans_qp.base;
259da9ee9d8SMoni Shoua 	struct ib_umem *umem = base->ubuffer.umem;
260da9ee9d8SMoni Shoua 	struct mlx5_ib_wq *wq = &qp->rq;
261da9ee9d8SMoni Shoua 	size_t wqe_size = 1 << wq->wqe_shift;
262da9ee9d8SMoni Shoua 
263da9ee9d8SMoni Shoua 	if (buflen < wqe_size)
264da9ee9d8SMoni Shoua 		return -EINVAL;
265da9ee9d8SMoni Shoua 
266da9ee9d8SMoni Shoua 	if (!umem)
267da9ee9d8SMoni Shoua 		return -EOPNOTSUPP;
268da9ee9d8SMoni Shoua 
269da9ee9d8SMoni Shoua 	return mlx5_ib_read_user_wqe_rq(qp, wqe_index, buffer, buflen, bc);
270da9ee9d8SMoni Shoua }
271da9ee9d8SMoni Shoua 
272da9ee9d8SMoni Shoua static int mlx5_ib_read_user_wqe_srq(struct mlx5_ib_srq *srq, int wqe_index,
273da9ee9d8SMoni Shoua 				     void *buffer, size_t buflen, size_t *bc)
274fbeb4075SMoni Shoua {
275fbeb4075SMoni Shoua 	struct ib_umem *umem = srq->umem;
276fbeb4075SMoni Shoua 	size_t bytes_copied;
277fbeb4075SMoni Shoua 	int ret;
278fbeb4075SMoni Shoua 
279da9ee9d8SMoni Shoua 	ret = mlx5_ib_read_user_wqe_common(umem, buffer, buflen, wqe_index, 0,
280da9ee9d8SMoni Shoua 					   srq->msrq.max, srq->msrq.wqe_shift,
281da9ee9d8SMoni Shoua 					   buflen, &bytes_copied);
282fbeb4075SMoni Shoua 
283fbeb4075SMoni Shoua 	if (ret)
284fbeb4075SMoni Shoua 		return ret;
285fbeb4075SMoni Shoua 	*bc = bytes_copied;
286fbeb4075SMoni Shoua 	return 0;
287c1395a2aSHaggai Eran }
288c1395a2aSHaggai Eran 
289da9ee9d8SMoni Shoua int mlx5_ib_read_wqe_srq(struct mlx5_ib_srq *srq, int wqe_index, void *buffer,
290da9ee9d8SMoni Shoua 			 size_t buflen, size_t *bc)
291da9ee9d8SMoni Shoua {
292da9ee9d8SMoni Shoua 	struct ib_umem *umem = srq->umem;
293da9ee9d8SMoni Shoua 	size_t wqe_size = 1 << srq->msrq.wqe_shift;
294da9ee9d8SMoni Shoua 
295da9ee9d8SMoni Shoua 	if (buflen < wqe_size)
296da9ee9d8SMoni Shoua 		return -EINVAL;
297da9ee9d8SMoni Shoua 
298da9ee9d8SMoni Shoua 	if (!umem)
299da9ee9d8SMoni Shoua 		return -EOPNOTSUPP;
300da9ee9d8SMoni Shoua 
301da9ee9d8SMoni Shoua 	return mlx5_ib_read_user_wqe_srq(srq, wqe_index, buffer, buflen, bc);
302da9ee9d8SMoni Shoua }
303da9ee9d8SMoni Shoua 
304e126ba97SEli Cohen static void mlx5_ib_qp_event(struct mlx5_core_qp *qp, int type)
305e126ba97SEli Cohen {
306e126ba97SEli Cohen 	struct ib_qp *ibqp = &to_mibqp(qp)->ibqp;
307e126ba97SEli Cohen 	struct ib_event event;
308e126ba97SEli Cohen 
30919098df2Smajd@mellanox.com 	if (type == MLX5_EVENT_TYPE_PATH_MIG) {
31019098df2Smajd@mellanox.com 		/* This event is only valid for trans_qps */
31119098df2Smajd@mellanox.com 		to_mibqp(qp)->port = to_mibqp(qp)->trans_qp.alt_port;
31219098df2Smajd@mellanox.com 	}
313e126ba97SEli Cohen 
314e126ba97SEli Cohen 	if (ibqp->event_handler) {
315e126ba97SEli Cohen 		event.device     = ibqp->device;
316e126ba97SEli Cohen 		event.element.qp = ibqp;
317e126ba97SEli Cohen 		switch (type) {
318e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_PATH_MIG:
319e126ba97SEli Cohen 			event.event = IB_EVENT_PATH_MIG;
320e126ba97SEli Cohen 			break;
321e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_COMM_EST:
322e126ba97SEli Cohen 			event.event = IB_EVENT_COMM_EST;
323e126ba97SEli Cohen 			break;
324e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_SQ_DRAINED:
325e126ba97SEli Cohen 			event.event = IB_EVENT_SQ_DRAINED;
326e126ba97SEli Cohen 			break;
327e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_SRQ_LAST_WQE:
328e126ba97SEli Cohen 			event.event = IB_EVENT_QP_LAST_WQE_REACHED;
329e126ba97SEli Cohen 			break;
330e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_WQ_CATAS_ERROR:
331e126ba97SEli Cohen 			event.event = IB_EVENT_QP_FATAL;
332e126ba97SEli Cohen 			break;
333e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_PATH_MIG_FAILED:
334e126ba97SEli Cohen 			event.event = IB_EVENT_PATH_MIG_ERR;
335e126ba97SEli Cohen 			break;
336e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_WQ_INVAL_REQ_ERROR:
337e126ba97SEli Cohen 			event.event = IB_EVENT_QP_REQ_ERR;
338e126ba97SEli Cohen 			break;
339e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_WQ_ACCESS_ERROR:
340e126ba97SEli Cohen 			event.event = IB_EVENT_QP_ACCESS_ERR;
341e126ba97SEli Cohen 			break;
342e126ba97SEli Cohen 		default:
343e126ba97SEli Cohen 			pr_warn("mlx5_ib: Unexpected event type %d on QP %06x\n", type, qp->qpn);
344e126ba97SEli Cohen 			return;
345e126ba97SEli Cohen 		}
346e126ba97SEli Cohen 
347e126ba97SEli Cohen 		ibqp->event_handler(&event, ibqp->qp_context);
348e126ba97SEli Cohen 	}
349e126ba97SEli Cohen }
350e126ba97SEli Cohen 
351e126ba97SEli Cohen static int set_rq_size(struct mlx5_ib_dev *dev, struct ib_qp_cap *cap,
352e126ba97SEli Cohen 		       int has_rq, struct mlx5_ib_qp *qp, struct mlx5_ib_create_qp *ucmd)
353e126ba97SEli Cohen {
354e126ba97SEli Cohen 	int wqe_size;
355e126ba97SEli Cohen 	int wq_size;
356e126ba97SEli Cohen 
357e126ba97SEli Cohen 	/* Sanity check RQ size before proceeding */
358938fe83cSSaeed Mahameed 	if (cap->max_recv_wr > (1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz)))
359e126ba97SEli Cohen 		return -EINVAL;
360e126ba97SEli Cohen 
361e126ba97SEli Cohen 	if (!has_rq) {
362e126ba97SEli Cohen 		qp->rq.max_gs = 0;
363e126ba97SEli Cohen 		qp->rq.wqe_cnt = 0;
364e126ba97SEli Cohen 		qp->rq.wqe_shift = 0;
3650540d814SNoa Osherovich 		cap->max_recv_wr = 0;
3660540d814SNoa Osherovich 		cap->max_recv_sge = 0;
367e126ba97SEli Cohen 	} else {
368c95e6d53SLeon Romanovsky 		int wq_sig = !!(qp->flags_en & MLX5_QP_FLAG_SIGNATURE);
369c95e6d53SLeon Romanovsky 
370e126ba97SEli Cohen 		if (ucmd) {
371e126ba97SEli Cohen 			qp->rq.wqe_cnt = ucmd->rq_wqe_count;
372002bf228SLeon Romanovsky 			if (ucmd->rq_wqe_shift > BITS_PER_BYTE * sizeof(ucmd->rq_wqe_shift))
373002bf228SLeon Romanovsky 				return -EINVAL;
374e126ba97SEli Cohen 			qp->rq.wqe_shift = ucmd->rq_wqe_shift;
375c95e6d53SLeon Romanovsky 			if ((1 << qp->rq.wqe_shift) /
376c95e6d53SLeon Romanovsky 				    sizeof(struct mlx5_wqe_data_seg) <
377c95e6d53SLeon Romanovsky 			    wq_sig)
378002bf228SLeon Romanovsky 				return -EINVAL;
379c95e6d53SLeon Romanovsky 			qp->rq.max_gs =
380c95e6d53SLeon Romanovsky 				(1 << qp->rq.wqe_shift) /
381c95e6d53SLeon Romanovsky 					sizeof(struct mlx5_wqe_data_seg) -
382c95e6d53SLeon Romanovsky 				wq_sig;
383e126ba97SEli Cohen 			qp->rq.max_post = qp->rq.wqe_cnt;
384e126ba97SEli Cohen 		} else {
385c95e6d53SLeon Romanovsky 			wqe_size =
386c95e6d53SLeon Romanovsky 				wq_sig ? sizeof(struct mlx5_wqe_signature_seg) :
387c95e6d53SLeon Romanovsky 					 0;
388e126ba97SEli Cohen 			wqe_size += cap->max_recv_sge * sizeof(struct mlx5_wqe_data_seg);
389e126ba97SEli Cohen 			wqe_size = roundup_pow_of_two(wqe_size);
390e126ba97SEli Cohen 			wq_size = roundup_pow_of_two(cap->max_recv_wr) * wqe_size;
391e126ba97SEli Cohen 			wq_size = max_t(int, wq_size, MLX5_SEND_WQE_BB);
392e126ba97SEli Cohen 			qp->rq.wqe_cnt = wq_size / wqe_size;
393938fe83cSSaeed Mahameed 			if (wqe_size > MLX5_CAP_GEN(dev->mdev, max_wqe_sz_rq)) {
394e126ba97SEli Cohen 				mlx5_ib_dbg(dev, "wqe_size %d, max %d\n",
395e126ba97SEli Cohen 					    wqe_size,
396938fe83cSSaeed Mahameed 					    MLX5_CAP_GEN(dev->mdev,
397938fe83cSSaeed Mahameed 							 max_wqe_sz_rq));
398e126ba97SEli Cohen 				return -EINVAL;
399e126ba97SEli Cohen 			}
400e126ba97SEli Cohen 			qp->rq.wqe_shift = ilog2(wqe_size);
401c95e6d53SLeon Romanovsky 			qp->rq.max_gs =
402c95e6d53SLeon Romanovsky 				(1 << qp->rq.wqe_shift) /
403c95e6d53SLeon Romanovsky 					sizeof(struct mlx5_wqe_data_seg) -
404c95e6d53SLeon Romanovsky 				wq_sig;
405e126ba97SEli Cohen 			qp->rq.max_post = qp->rq.wqe_cnt;
406e126ba97SEli Cohen 		}
407e126ba97SEli Cohen 	}
408e126ba97SEli Cohen 
409e126ba97SEli Cohen 	return 0;
410e126ba97SEli Cohen }
411e126ba97SEli Cohen 
412f0313965SErez Shitrit static int sq_overhead(struct ib_qp_init_attr *attr)
413e126ba97SEli Cohen {
414618af384SAndi Shyti 	int size = 0;
415e126ba97SEli Cohen 
416f0313965SErez Shitrit 	switch (attr->qp_type) {
417e126ba97SEli Cohen 	case IB_QPT_XRC_INI:
418b125a54bSEli Cohen 		size += sizeof(struct mlx5_wqe_xrc_seg);
419df561f66SGustavo A. R. Silva 		fallthrough;
420e126ba97SEli Cohen 	case IB_QPT_RC:
421e126ba97SEli Cohen 		size += sizeof(struct mlx5_wqe_ctrl_seg) +
42275c1657eSLeon Romanovsky 			max(sizeof(struct mlx5_wqe_atomic_seg) +
42375c1657eSLeon Romanovsky 			    sizeof(struct mlx5_wqe_raddr_seg),
42475c1657eSLeon Romanovsky 			    sizeof(struct mlx5_wqe_umr_ctrl_seg) +
425064e5262SIdan Burstein 			    sizeof(struct mlx5_mkey_seg) +
426064e5262SIdan Burstein 			    MLX5_IB_SQ_UMR_INLINE_THRESHOLD /
427064e5262SIdan Burstein 			    MLX5_IB_UMR_OCTOWORD);
428e126ba97SEli Cohen 		break;
429e126ba97SEli Cohen 
430b125a54bSEli Cohen 	case IB_QPT_XRC_TGT:
431b125a54bSEli Cohen 		return 0;
432b125a54bSEli Cohen 
433e126ba97SEli Cohen 	case IB_QPT_UC:
434b125a54bSEli Cohen 		size += sizeof(struct mlx5_wqe_ctrl_seg) +
43575c1657eSLeon Romanovsky 			max(sizeof(struct mlx5_wqe_raddr_seg),
4369e65dc37SEli Cohen 			    sizeof(struct mlx5_wqe_umr_ctrl_seg) +
43775c1657eSLeon Romanovsky 			    sizeof(struct mlx5_mkey_seg));
438e126ba97SEli Cohen 		break;
439e126ba97SEli Cohen 
440e126ba97SEli Cohen 	case IB_QPT_UD:
441f0313965SErez Shitrit 		if (attr->create_flags & IB_QP_CREATE_IPOIB_UD_LSO)
442f0313965SErez Shitrit 			size += sizeof(struct mlx5_wqe_eth_pad) +
443f0313965SErez Shitrit 				sizeof(struct mlx5_wqe_eth_seg);
444df561f66SGustavo A. R. Silva 		fallthrough;
445e126ba97SEli Cohen 	case IB_QPT_SMI:
446d16e91daSHaggai Eran 	case MLX5_IB_QPT_HW_GSI:
447b125a54bSEli Cohen 		size += sizeof(struct mlx5_wqe_ctrl_seg) +
448e126ba97SEli Cohen 			sizeof(struct mlx5_wqe_datagram_seg);
449e126ba97SEli Cohen 		break;
450e126ba97SEli Cohen 
451e126ba97SEli Cohen 	case MLX5_IB_QPT_REG_UMR:
452b125a54bSEli Cohen 		size += sizeof(struct mlx5_wqe_ctrl_seg) +
453e126ba97SEli Cohen 			sizeof(struct mlx5_wqe_umr_ctrl_seg) +
454e126ba97SEli Cohen 			sizeof(struct mlx5_mkey_seg);
455e126ba97SEli Cohen 		break;
456e126ba97SEli Cohen 
457e126ba97SEli Cohen 	default:
458e126ba97SEli Cohen 		return -EINVAL;
459e126ba97SEli Cohen 	}
460e126ba97SEli Cohen 
461e126ba97SEli Cohen 	return size;
462e126ba97SEli Cohen }
463e126ba97SEli Cohen 
464e126ba97SEli Cohen static int calc_send_wqe(struct ib_qp_init_attr *attr)
465e126ba97SEli Cohen {
466e126ba97SEli Cohen 	int inl_size = 0;
467e126ba97SEli Cohen 	int size;
468e126ba97SEli Cohen 
469f0313965SErez Shitrit 	size = sq_overhead(attr);
470e126ba97SEli Cohen 	if (size < 0)
471e126ba97SEli Cohen 		return size;
472e126ba97SEli Cohen 
473e126ba97SEli Cohen 	if (attr->cap.max_inline_data) {
474e126ba97SEli Cohen 		inl_size = size + sizeof(struct mlx5_wqe_inline_seg) +
475e126ba97SEli Cohen 			attr->cap.max_inline_data;
476e126ba97SEli Cohen 	}
477e126ba97SEli Cohen 
478e126ba97SEli Cohen 	size += attr->cap.max_send_sge * sizeof(struct mlx5_wqe_data_seg);
479c0a6cbb9SIsrael Rukshin 	if (attr->create_flags & IB_QP_CREATE_INTEGRITY_EN &&
480e1e66cc2SSagi Grimberg 	    ALIGN(max_t(int, inl_size, size), MLX5_SEND_WQE_BB) < MLX5_SIG_WQE_SIZE)
481e1e66cc2SSagi Grimberg 		return MLX5_SIG_WQE_SIZE;
482e1e66cc2SSagi Grimberg 	else
483e126ba97SEli Cohen 		return ALIGN(max_t(int, inl_size, size), MLX5_SEND_WQE_BB);
484e126ba97SEli Cohen }
485e126ba97SEli Cohen 
486288c01b7SEli Cohen static int get_send_sge(struct ib_qp_init_attr *attr, int wqe_size)
487288c01b7SEli Cohen {
488288c01b7SEli Cohen 	int max_sge;
489288c01b7SEli Cohen 
490288c01b7SEli Cohen 	if (attr->qp_type == IB_QPT_RC)
491288c01b7SEli Cohen 		max_sge = (min_t(int, wqe_size, 512) -
492288c01b7SEli Cohen 			   sizeof(struct mlx5_wqe_ctrl_seg) -
493288c01b7SEli Cohen 			   sizeof(struct mlx5_wqe_raddr_seg)) /
494288c01b7SEli Cohen 			sizeof(struct mlx5_wqe_data_seg);
495288c01b7SEli Cohen 	else if (attr->qp_type == IB_QPT_XRC_INI)
496288c01b7SEli Cohen 		max_sge = (min_t(int, wqe_size, 512) -
497288c01b7SEli Cohen 			   sizeof(struct mlx5_wqe_ctrl_seg) -
498288c01b7SEli Cohen 			   sizeof(struct mlx5_wqe_xrc_seg) -
499288c01b7SEli Cohen 			   sizeof(struct mlx5_wqe_raddr_seg)) /
500288c01b7SEli Cohen 			sizeof(struct mlx5_wqe_data_seg);
501288c01b7SEli Cohen 	else
502288c01b7SEli Cohen 		max_sge = (wqe_size - sq_overhead(attr)) /
503288c01b7SEli Cohen 			sizeof(struct mlx5_wqe_data_seg);
504288c01b7SEli Cohen 
505288c01b7SEli Cohen 	return min_t(int, max_sge, wqe_size - sq_overhead(attr) /
506288c01b7SEli Cohen 		     sizeof(struct mlx5_wqe_data_seg));
507288c01b7SEli Cohen }
508288c01b7SEli Cohen 
509e126ba97SEli Cohen static int calc_sq_size(struct mlx5_ib_dev *dev, struct ib_qp_init_attr *attr,
510e126ba97SEli Cohen 			struct mlx5_ib_qp *qp)
511e126ba97SEli Cohen {
512e126ba97SEli Cohen 	int wqe_size;
513e126ba97SEli Cohen 	int wq_size;
514e126ba97SEli Cohen 
515e126ba97SEli Cohen 	if (!attr->cap.max_send_wr)
516e126ba97SEli Cohen 		return 0;
517e126ba97SEli Cohen 
518e126ba97SEli Cohen 	wqe_size = calc_send_wqe(attr);
519e126ba97SEli Cohen 	mlx5_ib_dbg(dev, "wqe_size %d\n", wqe_size);
520e126ba97SEli Cohen 	if (wqe_size < 0)
521e126ba97SEli Cohen 		return wqe_size;
522e126ba97SEli Cohen 
523938fe83cSSaeed Mahameed 	if (wqe_size > MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq)) {
524b125a54bSEli Cohen 		mlx5_ib_dbg(dev, "wqe_size(%d) > max_sq_desc_sz(%d)\n",
525938fe83cSSaeed Mahameed 			    wqe_size, MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq));
526e126ba97SEli Cohen 		return -EINVAL;
527e126ba97SEli Cohen 	}
528e126ba97SEli Cohen 
529f0313965SErez Shitrit 	qp->max_inline_data = wqe_size - sq_overhead(attr) -
530e126ba97SEli Cohen 			      sizeof(struct mlx5_wqe_inline_seg);
531e126ba97SEli Cohen 	attr->cap.max_inline_data = qp->max_inline_data;
532e126ba97SEli Cohen 
533e126ba97SEli Cohen 	wq_size = roundup_pow_of_two(attr->cap.max_send_wr * wqe_size);
534e126ba97SEli Cohen 	qp->sq.wqe_cnt = wq_size / MLX5_SEND_WQE_BB;
535938fe83cSSaeed Mahameed 	if (qp->sq.wqe_cnt > (1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz))) {
5361974ab9dSBart Van Assche 		mlx5_ib_dbg(dev, "send queue size (%d * %d / %d -> %d) exceeds limits(%d)\n",
5371974ab9dSBart Van Assche 			    attr->cap.max_send_wr, wqe_size, MLX5_SEND_WQE_BB,
538938fe83cSSaeed Mahameed 			    qp->sq.wqe_cnt,
539938fe83cSSaeed Mahameed 			    1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz));
540b125a54bSEli Cohen 		return -ENOMEM;
541b125a54bSEli Cohen 	}
542e126ba97SEli Cohen 	qp->sq.wqe_shift = ilog2(MLX5_SEND_WQE_BB);
543288c01b7SEli Cohen 	qp->sq.max_gs = get_send_sge(attr, wqe_size);
544288c01b7SEli Cohen 	if (qp->sq.max_gs < attr->cap.max_send_sge)
545288c01b7SEli Cohen 		return -ENOMEM;
546288c01b7SEli Cohen 
547288c01b7SEli Cohen 	attr->cap.max_send_sge = qp->sq.max_gs;
548b125a54bSEli Cohen 	qp->sq.max_post = wq_size / wqe_size;
549b125a54bSEli Cohen 	attr->cap.max_send_wr = qp->sq.max_post;
550e126ba97SEli Cohen 
551e126ba97SEli Cohen 	return wq_size;
552e126ba97SEli Cohen }
553e126ba97SEli Cohen 
554e126ba97SEli Cohen static int set_user_buf_size(struct mlx5_ib_dev *dev,
555e126ba97SEli Cohen 			    struct mlx5_ib_qp *qp,
55619098df2Smajd@mellanox.com 			    struct mlx5_ib_create_qp *ucmd,
5570fb2ed66Smajd@mellanox.com 			    struct mlx5_ib_qp_base *base,
5580fb2ed66Smajd@mellanox.com 			    struct ib_qp_init_attr *attr)
559e126ba97SEli Cohen {
560e126ba97SEli Cohen 	int desc_sz = 1 << qp->sq.wqe_shift;
561e126ba97SEli Cohen 
562938fe83cSSaeed Mahameed 	if (desc_sz > MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq)) {
563e126ba97SEli Cohen 		mlx5_ib_warn(dev, "desc_sz %d, max_sq_desc_sz %d\n",
564938fe83cSSaeed Mahameed 			     desc_sz, MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq));
565e126ba97SEli Cohen 		return -EINVAL;
566e126ba97SEli Cohen 	}
567e126ba97SEli Cohen 
568af8b38edSGal Pressman 	if (ucmd->sq_wqe_count && !is_power_of_2(ucmd->sq_wqe_count)) {
569af8b38edSGal Pressman 		mlx5_ib_warn(dev, "sq_wqe_count %d is not a power of two\n",
570af8b38edSGal Pressman 			     ucmd->sq_wqe_count);
571e126ba97SEli Cohen 		return -EINVAL;
572e126ba97SEli Cohen 	}
573e126ba97SEli Cohen 
574e126ba97SEli Cohen 	qp->sq.wqe_cnt = ucmd->sq_wqe_count;
575e126ba97SEli Cohen 
576938fe83cSSaeed Mahameed 	if (qp->sq.wqe_cnt > (1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz))) {
577e126ba97SEli Cohen 		mlx5_ib_warn(dev, "wqe_cnt %d, max_wqes %d\n",
578938fe83cSSaeed Mahameed 			     qp->sq.wqe_cnt,
579938fe83cSSaeed Mahameed 			     1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz));
580e126ba97SEli Cohen 		return -EINVAL;
581e126ba97SEli Cohen 	}
582e126ba97SEli Cohen 
583c2e53b2cSYishai Hadas 	if (attr->qp_type == IB_QPT_RAW_PACKET ||
5842be08c30SLeon Romanovsky 	    qp->flags & IB_QP_CREATE_SOURCE_QPN) {
5850fb2ed66Smajd@mellanox.com 		base->ubuffer.buf_size = qp->rq.wqe_cnt << qp->rq.wqe_shift;
5860fb2ed66Smajd@mellanox.com 		qp->raw_packet_qp.sq.ubuffer.buf_size = qp->sq.wqe_cnt << 6;
5870fb2ed66Smajd@mellanox.com 	} else {
58819098df2Smajd@mellanox.com 		base->ubuffer.buf_size = (qp->rq.wqe_cnt << qp->rq.wqe_shift) +
589e126ba97SEli Cohen 					 (qp->sq.wqe_cnt << 6);
5900fb2ed66Smajd@mellanox.com 	}
591e126ba97SEli Cohen 
592e126ba97SEli Cohen 	return 0;
593e126ba97SEli Cohen }
594e126ba97SEli Cohen 
595e126ba97SEli Cohen static int qp_has_rq(struct ib_qp_init_attr *attr)
596e126ba97SEli Cohen {
597e126ba97SEli Cohen 	if (attr->qp_type == IB_QPT_XRC_INI ||
598e126ba97SEli Cohen 	    attr->qp_type == IB_QPT_XRC_TGT || attr->srq ||
599e126ba97SEli Cohen 	    attr->qp_type == MLX5_IB_QPT_REG_UMR ||
600e126ba97SEli Cohen 	    !attr->cap.max_recv_wr)
601e126ba97SEli Cohen 		return 0;
602e126ba97SEli Cohen 
603e126ba97SEli Cohen 	return 1;
604e126ba97SEli Cohen }
605e126ba97SEli Cohen 
6060b80c14fSEli Cohen enum {
6070b80c14fSEli Cohen 	/* this is the first blue flame register in the array of bfregs assigned
6080b80c14fSEli Cohen 	 * to a processes. Since we do not use it for blue flame but rather
6090b80c14fSEli Cohen 	 * regular 64 bit doorbells, we do not need a lock for maintaiing
6100b80c14fSEli Cohen 	 * "odd/even" order
6110b80c14fSEli Cohen 	 */
6120b80c14fSEli Cohen 	NUM_NON_BLUE_FLAME_BFREGS = 1,
6130b80c14fSEli Cohen };
6140b80c14fSEli Cohen 
615b037c29aSEli Cohen static int max_bfregs(struct mlx5_ib_dev *dev, struct mlx5_bfreg_info *bfregi)
616b037c29aSEli Cohen {
61731a78a5aSYishai Hadas 	return get_num_static_uars(dev, bfregi) * MLX5_NON_FP_BFREGS_PER_UAR;
618b037c29aSEli Cohen }
619b037c29aSEli Cohen 
620b037c29aSEli Cohen static int num_med_bfreg(struct mlx5_ib_dev *dev,
621b037c29aSEli Cohen 			 struct mlx5_bfreg_info *bfregi)
622c1be5232SEli Cohen {
623c1be5232SEli Cohen 	int n;
624c1be5232SEli Cohen 
625b037c29aSEli Cohen 	n = max_bfregs(dev, bfregi) - bfregi->num_low_latency_bfregs -
626b037c29aSEli Cohen 	    NUM_NON_BLUE_FLAME_BFREGS;
627c1be5232SEli Cohen 
628c1be5232SEli Cohen 	return n >= 0 ? n : 0;
629c1be5232SEli Cohen }
630c1be5232SEli Cohen 
63118b0362eSYishai Hadas static int first_med_bfreg(struct mlx5_ib_dev *dev,
63218b0362eSYishai Hadas 			   struct mlx5_bfreg_info *bfregi)
63318b0362eSYishai Hadas {
63418b0362eSYishai Hadas 	return num_med_bfreg(dev, bfregi) ? 1 : -ENOMEM;
63518b0362eSYishai Hadas }
63618b0362eSYishai Hadas 
637b037c29aSEli Cohen static int first_hi_bfreg(struct mlx5_ib_dev *dev,
638b037c29aSEli Cohen 			  struct mlx5_bfreg_info *bfregi)
639c1be5232SEli Cohen {
640c1be5232SEli Cohen 	int med;
641c1be5232SEli Cohen 
642b037c29aSEli Cohen 	med = num_med_bfreg(dev, bfregi);
643b037c29aSEli Cohen 	return ++med;
644c1be5232SEli Cohen }
645c1be5232SEli Cohen 
646b037c29aSEli Cohen static int alloc_high_class_bfreg(struct mlx5_ib_dev *dev,
647b037c29aSEli Cohen 				  struct mlx5_bfreg_info *bfregi)
648e126ba97SEli Cohen {
649e126ba97SEli Cohen 	int i;
650e126ba97SEli Cohen 
651b037c29aSEli Cohen 	for (i = first_hi_bfreg(dev, bfregi); i < max_bfregs(dev, bfregi); i++) {
652b037c29aSEli Cohen 		if (!bfregi->count[i]) {
6532f5ff264SEli Cohen 			bfregi->count[i]++;
654e126ba97SEli Cohen 			return i;
655e126ba97SEli Cohen 		}
656e126ba97SEli Cohen 	}
657e126ba97SEli Cohen 
658e126ba97SEli Cohen 	return -ENOMEM;
659e126ba97SEli Cohen }
660e126ba97SEli Cohen 
661b037c29aSEli Cohen static int alloc_med_class_bfreg(struct mlx5_ib_dev *dev,
662b037c29aSEli Cohen 				 struct mlx5_bfreg_info *bfregi)
663e126ba97SEli Cohen {
66418b0362eSYishai Hadas 	int minidx = first_med_bfreg(dev, bfregi);
665e126ba97SEli Cohen 	int i;
666e126ba97SEli Cohen 
66718b0362eSYishai Hadas 	if (minidx < 0)
66818b0362eSYishai Hadas 		return minidx;
66918b0362eSYishai Hadas 
67018b0362eSYishai Hadas 	for (i = minidx; i < first_hi_bfreg(dev, bfregi); i++) {
6712f5ff264SEli Cohen 		if (bfregi->count[i] < bfregi->count[minidx])
672e126ba97SEli Cohen 			minidx = i;
6730b80c14fSEli Cohen 		if (!bfregi->count[minidx])
6740b80c14fSEli Cohen 			break;
675e126ba97SEli Cohen 	}
676e126ba97SEli Cohen 
6772f5ff264SEli Cohen 	bfregi->count[minidx]++;
678e126ba97SEli Cohen 	return minidx;
679e126ba97SEli Cohen }
680e126ba97SEli Cohen 
681b037c29aSEli Cohen static int alloc_bfreg(struct mlx5_ib_dev *dev,
682ffaf58deSLeon Romanovsky 		       struct mlx5_bfreg_info *bfregi)
683e126ba97SEli Cohen {
684ffaf58deSLeon Romanovsky 	int bfregn = -ENOMEM;
685e126ba97SEli Cohen 
6860a2fd01cSYishai Hadas 	if (bfregi->lib_uar_dyn)
6870a2fd01cSYishai Hadas 		return -EINVAL;
6880a2fd01cSYishai Hadas 
6892f5ff264SEli Cohen 	mutex_lock(&bfregi->lock);
690ffaf58deSLeon Romanovsky 	if (bfregi->ver >= 2) {
691ffaf58deSLeon Romanovsky 		bfregn = alloc_high_class_bfreg(dev, bfregi);
692ffaf58deSLeon Romanovsky 		if (bfregn < 0)
693ffaf58deSLeon Romanovsky 			bfregn = alloc_med_class_bfreg(dev, bfregi);
694ffaf58deSLeon Romanovsky 	}
695ffaf58deSLeon Romanovsky 
696ffaf58deSLeon Romanovsky 	if (bfregn < 0) {
6970b80c14fSEli Cohen 		BUILD_BUG_ON(NUM_NON_BLUE_FLAME_BFREGS != 1);
6982f5ff264SEli Cohen 		bfregn = 0;
6992f5ff264SEli Cohen 		bfregi->count[bfregn]++;
700e126ba97SEli Cohen 	}
7012f5ff264SEli Cohen 	mutex_unlock(&bfregi->lock);
702e126ba97SEli Cohen 
7032f5ff264SEli Cohen 	return bfregn;
704e126ba97SEli Cohen }
705e126ba97SEli Cohen 
7064ed131d0SYishai Hadas void mlx5_ib_free_bfreg(struct mlx5_ib_dev *dev, struct mlx5_bfreg_info *bfregi, int bfregn)
707e126ba97SEli Cohen {
7082f5ff264SEli Cohen 	mutex_lock(&bfregi->lock);
709b037c29aSEli Cohen 	bfregi->count[bfregn]--;
7102f5ff264SEli Cohen 	mutex_unlock(&bfregi->lock);
711e126ba97SEli Cohen }
712e126ba97SEli Cohen 
713e126ba97SEli Cohen static enum mlx5_qp_state to_mlx5_state(enum ib_qp_state state)
714e126ba97SEli Cohen {
715e126ba97SEli Cohen 	switch (state) {
716e126ba97SEli Cohen 	case IB_QPS_RESET:	return MLX5_QP_STATE_RST;
717e126ba97SEli Cohen 	case IB_QPS_INIT:	return MLX5_QP_STATE_INIT;
718e126ba97SEli Cohen 	case IB_QPS_RTR:	return MLX5_QP_STATE_RTR;
719e126ba97SEli Cohen 	case IB_QPS_RTS:	return MLX5_QP_STATE_RTS;
720e126ba97SEli Cohen 	case IB_QPS_SQD:	return MLX5_QP_STATE_SQD;
721e126ba97SEli Cohen 	case IB_QPS_SQE:	return MLX5_QP_STATE_SQER;
722e126ba97SEli Cohen 	case IB_QPS_ERR:	return MLX5_QP_STATE_ERR;
723e126ba97SEli Cohen 	default:		return -1;
724e126ba97SEli Cohen 	}
725e126ba97SEli Cohen }
726e126ba97SEli Cohen 
727e126ba97SEli Cohen static int to_mlx5_st(enum ib_qp_type type)
728e126ba97SEli Cohen {
729e126ba97SEli Cohen 	switch (type) {
730e126ba97SEli Cohen 	case IB_QPT_RC:			return MLX5_QP_ST_RC;
731e126ba97SEli Cohen 	case IB_QPT_UC:			return MLX5_QP_ST_UC;
732e126ba97SEli Cohen 	case IB_QPT_UD:			return MLX5_QP_ST_UD;
733e126ba97SEli Cohen 	case MLX5_IB_QPT_REG_UMR:	return MLX5_QP_ST_REG_UMR;
734e126ba97SEli Cohen 	case IB_QPT_XRC_INI:
735e126ba97SEli Cohen 	case IB_QPT_XRC_TGT:		return MLX5_QP_ST_XRC;
736e126ba97SEli Cohen 	case IB_QPT_SMI:		return MLX5_QP_ST_QP0;
737d16e91daSHaggai Eran 	case MLX5_IB_QPT_HW_GSI:	return MLX5_QP_ST_QP1;
738c32a4f29SMoni Shoua 	case MLX5_IB_QPT_DCI:		return MLX5_QP_ST_DCI;
7393ae7e66aSLeon Romanovsky 	case IB_QPT_RAW_PACKET:		return MLX5_QP_ST_RAW_ETHERTYPE;
740e126ba97SEli Cohen 	default:		return -EINVAL;
741e126ba97SEli Cohen 	}
742e126ba97SEli Cohen }
743e126ba97SEli Cohen 
74489ea94a7SMaor Gottlieb static void mlx5_ib_lock_cqs(struct mlx5_ib_cq *send_cq,
74589ea94a7SMaor Gottlieb 			     struct mlx5_ib_cq *recv_cq);
74689ea94a7SMaor Gottlieb static void mlx5_ib_unlock_cqs(struct mlx5_ib_cq *send_cq,
74789ea94a7SMaor Gottlieb 			       struct mlx5_ib_cq *recv_cq);
74889ea94a7SMaor Gottlieb 
7497c043e90SYishai Hadas int bfregn_to_uar_index(struct mlx5_ib_dev *dev,
75005f58cebSLeon Romanovsky 			struct mlx5_bfreg_info *bfregi, u32 bfregn,
7511ee47ab3SYishai Hadas 			bool dyn_bfreg)
752e126ba97SEli Cohen {
75305f58cebSLeon Romanovsky 	unsigned int bfregs_per_sys_page;
75405f58cebSLeon Romanovsky 	u32 index_of_sys_page;
75505f58cebSLeon Romanovsky 	u32 offset;
756b037c29aSEli Cohen 
7570a2fd01cSYishai Hadas 	if (bfregi->lib_uar_dyn)
7580a2fd01cSYishai Hadas 		return -EINVAL;
7590a2fd01cSYishai Hadas 
760b037c29aSEli Cohen 	bfregs_per_sys_page = get_uars_per_sys_page(dev, bfregi->lib_uar_4k) *
761b037c29aSEli Cohen 				MLX5_NON_FP_BFREGS_PER_UAR;
762b037c29aSEli Cohen 	index_of_sys_page = bfregn / bfregs_per_sys_page;
763b037c29aSEli Cohen 
76405f58cebSLeon Romanovsky 	if (dyn_bfreg) {
76505f58cebSLeon Romanovsky 		index_of_sys_page += bfregi->num_static_sys_pages;
76605f58cebSLeon Romanovsky 
7677c043e90SYishai Hadas 		if (index_of_sys_page >= bfregi->num_sys_pages)
7687c043e90SYishai Hadas 			return -EINVAL;
7697c043e90SYishai Hadas 
7701ee47ab3SYishai Hadas 		if (bfregn > bfregi->num_dyn_bfregs ||
7711ee47ab3SYishai Hadas 		    bfregi->sys_pages[index_of_sys_page] == MLX5_IB_INVALID_UAR_INDEX) {
7721ee47ab3SYishai Hadas 			mlx5_ib_dbg(dev, "Invalid dynamic uar index\n");
7731ee47ab3SYishai Hadas 			return -EINVAL;
7741ee47ab3SYishai Hadas 		}
7751ee47ab3SYishai Hadas 	}
776b037c29aSEli Cohen 
7771ee47ab3SYishai Hadas 	offset = bfregn % bfregs_per_sys_page / MLX5_NON_FP_BFREGS_PER_UAR;
778b037c29aSEli Cohen 	return bfregi->sys_pages[index_of_sys_page] + offset;
779e126ba97SEli Cohen }
780e126ba97SEli Cohen 
781fe248c3aSMaor Gottlieb static void destroy_user_rq(struct mlx5_ib_dev *dev, struct ib_pd *pd,
782bdeacabdSShamir Rabinovitch 			    struct mlx5_ib_rwq *rwq, struct ib_udata *udata)
78379b20a6cSYishai Hadas {
784bdeacabdSShamir Rabinovitch 	struct mlx5_ib_ucontext *context =
785bdeacabdSShamir Rabinovitch 		rdma_udata_to_drv_context(
786bdeacabdSShamir Rabinovitch 			udata,
787bdeacabdSShamir Rabinovitch 			struct mlx5_ib_ucontext,
788bdeacabdSShamir Rabinovitch 			ibucontext);
78979b20a6cSYishai Hadas 
790fe248c3aSMaor Gottlieb 	if (rwq->create_flags & MLX5_IB_WQ_FLAGS_DELAY_DROP)
791fe248c3aSMaor Gottlieb 		atomic_dec(&dev->delay_drop.rqs_cnt);
792fe248c3aSMaor Gottlieb 
79379b20a6cSYishai Hadas 	mlx5_ib_db_unmap_user(context, &rwq->db);
79479b20a6cSYishai Hadas 	ib_umem_release(rwq->umem);
79579b20a6cSYishai Hadas }
79679b20a6cSYishai Hadas 
79779b20a6cSYishai Hadas static int create_user_rq(struct mlx5_ib_dev *dev, struct ib_pd *pd,
798b0ea0fa5SJason Gunthorpe 			  struct ib_udata *udata, struct mlx5_ib_rwq *rwq,
79979b20a6cSYishai Hadas 			  struct mlx5_ib_create_wq *ucmd)
80079b20a6cSYishai Hadas {
80189944450SShamir Rabinovitch 	struct mlx5_ib_ucontext *ucontext = rdma_udata_to_drv_context(
80289944450SShamir Rabinovitch 		udata, struct mlx5_ib_ucontext, ibucontext);
803ad480ea5SJason Gunthorpe 	unsigned long page_size = 0;
80479b20a6cSYishai Hadas 	u32 offset = 0;
80579b20a6cSYishai Hadas 	int err;
80679b20a6cSYishai Hadas 
80779b20a6cSYishai Hadas 	if (!ucmd->buf_addr)
80879b20a6cSYishai Hadas 		return -EINVAL;
80979b20a6cSYishai Hadas 
810c320e527SMoni Shoua 	rwq->umem = ib_umem_get(&dev->ib_dev, ucmd->buf_addr, rwq->buf_size, 0);
81179b20a6cSYishai Hadas 	if (IS_ERR(rwq->umem)) {
81279b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "umem_get failed\n");
81379b20a6cSYishai Hadas 		err = PTR_ERR(rwq->umem);
81479b20a6cSYishai Hadas 		return err;
81579b20a6cSYishai Hadas 	}
81679b20a6cSYishai Hadas 
817ad480ea5SJason Gunthorpe 	page_size = mlx5_umem_find_best_quantized_pgoff(
818ad480ea5SJason Gunthorpe 		rwq->umem, wq, log_wq_pg_sz, MLX5_ADAPTER_PAGE_SHIFT,
819ad480ea5SJason Gunthorpe 		page_offset, 64, &rwq->rq_page_offset);
820ad480ea5SJason Gunthorpe 	if (!page_size) {
82179b20a6cSYishai Hadas 		mlx5_ib_warn(dev, "bad offset\n");
822ad480ea5SJason Gunthorpe 		err = -EINVAL;
82379b20a6cSYishai Hadas 		goto err_umem;
82479b20a6cSYishai Hadas 	}
82579b20a6cSYishai Hadas 
826ad480ea5SJason Gunthorpe 	rwq->rq_num_pas = ib_umem_num_dma_blocks(rwq->umem, page_size);
827ad480ea5SJason Gunthorpe 	rwq->page_shift = order_base_2(page_size);
828ad480ea5SJason Gunthorpe 	rwq->log_page_size =  rwq->page_shift - MLX5_ADAPTER_PAGE_SHIFT;
82979b20a6cSYishai Hadas 	rwq->wq_sig = !!(ucmd->flags & MLX5_WQ_FLAG_SIGNATURE);
83079b20a6cSYishai Hadas 
831f8fb3110SJason Gunthorpe 	mlx5_ib_dbg(
832f8fb3110SJason Gunthorpe 		dev,
833ad480ea5SJason Gunthorpe 		"addr 0x%llx, size %zd, npages %zu, page_size %ld, ncont %d, offset %d\n",
83479b20a6cSYishai Hadas 		(unsigned long long)ucmd->buf_addr, rwq->buf_size,
835ad480ea5SJason Gunthorpe 		ib_umem_num_pages(rwq->umem), page_size, rwq->rq_num_pas,
836f8fb3110SJason Gunthorpe 		offset);
83779b20a6cSYishai Hadas 
8380bedd3d0SLang Cheng 	err = mlx5_ib_db_map_user(ucontext, ucmd->db_addr, &rwq->db);
83979b20a6cSYishai Hadas 	if (err) {
84079b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "map failed\n");
84179b20a6cSYishai Hadas 		goto err_umem;
84279b20a6cSYishai Hadas 	}
84379b20a6cSYishai Hadas 
84479b20a6cSYishai Hadas 	return 0;
84579b20a6cSYishai Hadas 
84679b20a6cSYishai Hadas err_umem:
84779b20a6cSYishai Hadas 	ib_umem_release(rwq->umem);
84879b20a6cSYishai Hadas 	return err;
84979b20a6cSYishai Hadas }
85079b20a6cSYishai Hadas 
851b037c29aSEli Cohen static int adjust_bfregn(struct mlx5_ib_dev *dev,
852b037c29aSEli Cohen 			 struct mlx5_bfreg_info *bfregi, int bfregn)
853b037c29aSEli Cohen {
854b037c29aSEli Cohen 	return bfregn / MLX5_NON_FP_BFREGS_PER_UAR * MLX5_BFREGS_PER_UAR +
855b037c29aSEli Cohen 				bfregn % MLX5_NON_FP_BFREGS_PER_UAR;
856b037c29aSEli Cohen }
857b037c29aSEli Cohen 
85898fc1126SLeon Romanovsky static int _create_user_qp(struct mlx5_ib_dev *dev, struct ib_pd *pd,
859e126ba97SEli Cohen 			   struct mlx5_ib_qp *qp, struct ib_udata *udata,
86076883a6cSLeon Romanovsky 			   struct ib_qp_init_attr *attr, u32 **in,
86119098df2Smajd@mellanox.com 			   struct mlx5_ib_create_qp_resp *resp, int *inlen,
86276883a6cSLeon Romanovsky 			   struct mlx5_ib_qp_base *base,
86376883a6cSLeon Romanovsky 			   struct mlx5_ib_create_qp *ucmd)
864e126ba97SEli Cohen {
865e126ba97SEli Cohen 	struct mlx5_ib_ucontext *context;
86619098df2Smajd@mellanox.com 	struct mlx5_ib_ubuffer *ubuffer = &base->ubuffer;
867a59b7b05SJason Gunthorpe 	unsigned int page_offset_quantized = 0;
868a59b7b05SJason Gunthorpe 	unsigned long page_size = 0;
8691ee47ab3SYishai Hadas 	int uar_index = 0;
8702f5ff264SEli Cohen 	int bfregn;
8719e9c47d0SEli Cohen 	int ncont = 0;
87209a7d9ecSSaeed Mahameed 	__be64 *pas;
87309a7d9ecSSaeed Mahameed 	void *qpc;
874e126ba97SEli Cohen 	int err;
8755aa3771dSYishai Hadas 	u16 uid;
876ac42a5eeSYishai Hadas 	u32 uar_flags;
877e126ba97SEli Cohen 
87889944450SShamir Rabinovitch 	context = rdma_udata_to_drv_context(udata, struct mlx5_ib_ucontext,
87989944450SShamir Rabinovitch 					    ibucontext);
88076883a6cSLeon Romanovsky 	uar_flags = qp->flags_en &
88176883a6cSLeon Romanovsky 		    (MLX5_QP_FLAG_UAR_PAGE_INDEX | MLX5_QP_FLAG_BFREG_INDEX);
882ac42a5eeSYishai Hadas 	switch (uar_flags) {
883ac42a5eeSYishai Hadas 	case MLX5_QP_FLAG_UAR_PAGE_INDEX:
88476883a6cSLeon Romanovsky 		uar_index = ucmd->bfreg_index;
885ac42a5eeSYishai Hadas 		bfregn = MLX5_IB_INVALID_BFREG;
886ac42a5eeSYishai Hadas 		break;
887ac42a5eeSYishai Hadas 	case MLX5_QP_FLAG_BFREG_INDEX:
8881ee47ab3SYishai Hadas 		uar_index = bfregn_to_uar_index(dev, &context->bfregi,
88976883a6cSLeon Romanovsky 						ucmd->bfreg_index, true);
8901ee47ab3SYishai Hadas 		if (uar_index < 0)
8911ee47ab3SYishai Hadas 			return uar_index;
8921ee47ab3SYishai Hadas 		bfregn = MLX5_IB_INVALID_BFREG;
893ac42a5eeSYishai Hadas 		break;
894ac42a5eeSYishai Hadas 	case 0:
8952be08c30SLeon Romanovsky 		if (qp->flags & IB_QP_CREATE_CROSS_CHANNEL)
896ac42a5eeSYishai Hadas 			return -EINVAL;
897ffaf58deSLeon Romanovsky 		bfregn = alloc_bfreg(dev, &context->bfregi);
898ffaf58deSLeon Romanovsky 		if (bfregn < 0)
8992f5ff264SEli Cohen 			return bfregn;
900ac42a5eeSYishai Hadas 		break;
901ac42a5eeSYishai Hadas 	default:
902ac42a5eeSYishai Hadas 		return -EINVAL;
903e126ba97SEli Cohen 	}
904e126ba97SEli Cohen 
9052f5ff264SEli Cohen 	mlx5_ib_dbg(dev, "bfregn 0x%x, uar_index 0x%x\n", bfregn, uar_index);
9061ee47ab3SYishai Hadas 	if (bfregn != MLX5_IB_INVALID_BFREG)
9071ee47ab3SYishai Hadas 		uar_index = bfregn_to_uar_index(dev, &context->bfregi, bfregn,
9081ee47ab3SYishai Hadas 						false);
909e126ba97SEli Cohen 
91048fea837SHaggai Eran 	qp->rq.offset = 0;
91148fea837SHaggai Eran 	qp->sq.wqe_shift = ilog2(MLX5_SEND_WQE_BB);
91248fea837SHaggai Eran 	qp->sq.offset = qp->rq.wqe_cnt << qp->rq.wqe_shift;
91348fea837SHaggai Eran 
91476883a6cSLeon Romanovsky 	err = set_user_buf_size(dev, qp, ucmd, base, attr);
915e126ba97SEli Cohen 	if (err)
9162f5ff264SEli Cohen 		goto err_bfreg;
917e126ba97SEli Cohen 
91876883a6cSLeon Romanovsky 	if (ucmd->buf_addr && ubuffer->buf_size) {
91976883a6cSLeon Romanovsky 		ubuffer->buf_addr = ucmd->buf_addr;
920a59b7b05SJason Gunthorpe 		ubuffer->umem = ib_umem_get(&dev->ib_dev, ubuffer->buf_addr,
921a59b7b05SJason Gunthorpe 					    ubuffer->buf_size, 0);
922a59b7b05SJason Gunthorpe 		if (IS_ERR(ubuffer->umem)) {
923a59b7b05SJason Gunthorpe 			err = PTR_ERR(ubuffer->umem);
9242f5ff264SEli Cohen 			goto err_bfreg;
925a59b7b05SJason Gunthorpe 		}
926a59b7b05SJason Gunthorpe 		page_size = mlx5_umem_find_best_quantized_pgoff(
927a59b7b05SJason Gunthorpe 			ubuffer->umem, qpc, log_page_size,
928a59b7b05SJason Gunthorpe 			MLX5_ADAPTER_PAGE_SHIFT, page_offset, 64,
929a59b7b05SJason Gunthorpe 			&page_offset_quantized);
930a59b7b05SJason Gunthorpe 		if (!page_size) {
931a59b7b05SJason Gunthorpe 			err = -EINVAL;
932a59b7b05SJason Gunthorpe 			goto err_umem;
933a59b7b05SJason Gunthorpe 		}
934a59b7b05SJason Gunthorpe 		ncont = ib_umem_num_dma_blocks(ubuffer->umem, page_size);
9359e9c47d0SEli Cohen 	} else {
93619098df2Smajd@mellanox.com 		ubuffer->umem = NULL;
9379e9c47d0SEli Cohen 	}
938e126ba97SEli Cohen 
93909a7d9ecSSaeed Mahameed 	*inlen = MLX5_ST_SZ_BYTES(create_qp_in) +
94009a7d9ecSSaeed Mahameed 		 MLX5_FLD_SZ_BYTES(create_qp_in, pas[0]) * ncont;
9411b9a07eeSLeon Romanovsky 	*in = kvzalloc(*inlen, GFP_KERNEL);
942e126ba97SEli Cohen 	if (!*in) {
943e126ba97SEli Cohen 		err = -ENOMEM;
944e126ba97SEli Cohen 		goto err_umem;
945e126ba97SEli Cohen 	}
946e126ba97SEli Cohen 
94704bcc1c2SLeon Romanovsky 	uid = (attr->qp_type != IB_QPT_XRC_INI) ? to_mpd(pd)->uid : 0;
9485aa3771dSYishai Hadas 	MLX5_SET(create_qp_in, *in, uid, uid);
94909a7d9ecSSaeed Mahameed 	qpc = MLX5_ADDR_OF(create_qp_in, *in, qpc);
950a59b7b05SJason Gunthorpe 	pas = (__be64 *)MLX5_ADDR_OF(create_qp_in, *in, pas);
951a59b7b05SJason Gunthorpe 	if (ubuffer->umem) {
952a59b7b05SJason Gunthorpe 		mlx5_ib_populate_pas(ubuffer->umem, page_size, pas, 0);
953a59b7b05SJason Gunthorpe 		MLX5_SET(qpc, qpc, log_page_size,
954a59b7b05SJason Gunthorpe 			 order_base_2(page_size) - MLX5_ADAPTER_PAGE_SHIFT);
955a59b7b05SJason Gunthorpe 		MLX5_SET(qpc, qpc, page_offset, page_offset_quantized);
956a59b7b05SJason Gunthorpe 	}
95709a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, uar_page, uar_index);
9581ee47ab3SYishai Hadas 	if (bfregn != MLX5_IB_INVALID_BFREG)
959b037c29aSEli Cohen 		resp->bfreg_index = adjust_bfregn(dev, &context->bfregi, bfregn);
9601ee47ab3SYishai Hadas 	else
9611ee47ab3SYishai Hadas 		resp->bfreg_index = MLX5_IB_INVALID_BFREG;
9622f5ff264SEli Cohen 	qp->bfregn = bfregn;
963e126ba97SEli Cohen 
9640bedd3d0SLang Cheng 	err = mlx5_ib_db_map_user(context, ucmd->db_addr, &qp->db);
965e126ba97SEli Cohen 	if (err) {
966e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "map failed\n");
967e126ba97SEli Cohen 		goto err_free;
968e126ba97SEli Cohen 	}
969e126ba97SEli Cohen 
970e126ba97SEli Cohen 	return 0;
971e126ba97SEli Cohen 
972e126ba97SEli Cohen err_free:
973479163f4SAl Viro 	kvfree(*in);
974e126ba97SEli Cohen 
975e126ba97SEli Cohen err_umem:
97619098df2Smajd@mellanox.com 	ib_umem_release(ubuffer->umem);
977e126ba97SEli Cohen 
9782f5ff264SEli Cohen err_bfreg:
9791ee47ab3SYishai Hadas 	if (bfregn != MLX5_IB_INVALID_BFREG)
9804ed131d0SYishai Hadas 		mlx5_ib_free_bfreg(dev, &context->bfregi, bfregn);
981e126ba97SEli Cohen 	return err;
982e126ba97SEli Cohen }
983e126ba97SEli Cohen 
984747c519cSLeon Romanovsky static void destroy_qp(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
985747c519cSLeon Romanovsky 		       struct mlx5_ib_qp_base *base, struct ib_udata *udata)
986e126ba97SEli Cohen {
987747c519cSLeon Romanovsky 	struct mlx5_ib_ucontext *context = rdma_udata_to_drv_context(
988747c519cSLeon Romanovsky 		udata, struct mlx5_ib_ucontext, ibucontext);
989e126ba97SEli Cohen 
990747c519cSLeon Romanovsky 	if (udata) {
991747c519cSLeon Romanovsky 		/* User QP */
992e126ba97SEli Cohen 		mlx5_ib_db_unmap_user(context, &qp->db);
99319098df2Smajd@mellanox.com 		ib_umem_release(base->ubuffer.umem);
9941ee47ab3SYishai Hadas 
9951ee47ab3SYishai Hadas 		/*
9961ee47ab3SYishai Hadas 		 * Free only the BFREGs which are handled by the kernel.
9971ee47ab3SYishai Hadas 		 * BFREGs of UARs allocated dynamically are handled by user.
9981ee47ab3SYishai Hadas 		 */
9991ee47ab3SYishai Hadas 		if (qp->bfregn != MLX5_IB_INVALID_BFREG)
10004ed131d0SYishai Hadas 			mlx5_ib_free_bfreg(dev, &context->bfregi, qp->bfregn);
1001747c519cSLeon Romanovsky 		return;
1002747c519cSLeon Romanovsky 	}
1003747c519cSLeon Romanovsky 
1004747c519cSLeon Romanovsky 	/* Kernel QP */
1005747c519cSLeon Romanovsky 	kvfree(qp->sq.wqe_head);
1006747c519cSLeon Romanovsky 	kvfree(qp->sq.w_list);
1007747c519cSLeon Romanovsky 	kvfree(qp->sq.wrid);
1008747c519cSLeon Romanovsky 	kvfree(qp->sq.wr_data);
1009747c519cSLeon Romanovsky 	kvfree(qp->rq.wrid);
1010747c519cSLeon Romanovsky 	if (qp->db.db)
1011747c519cSLeon Romanovsky 		mlx5_db_free(dev->mdev, &qp->db);
1012747c519cSLeon Romanovsky 	if (qp->buf.frags)
1013747c519cSLeon Romanovsky 		mlx5_frag_buf_free(dev->mdev, &qp->buf);
1014e126ba97SEli Cohen }
1015e126ba97SEli Cohen 
101698fc1126SLeon Romanovsky static int _create_kernel_qp(struct mlx5_ib_dev *dev,
1017e126ba97SEli Cohen 			     struct ib_qp_init_attr *init_attr,
101898fc1126SLeon Romanovsky 			     struct mlx5_ib_qp *qp, u32 **in, int *inlen,
101919098df2Smajd@mellanox.com 			     struct mlx5_ib_qp_base *base)
1020e126ba97SEli Cohen {
1021e126ba97SEli Cohen 	int uar_index;
102209a7d9ecSSaeed Mahameed 	void *qpc;
1023e126ba97SEli Cohen 	int err;
1024e126ba97SEli Cohen 
1025e126ba97SEli Cohen 	if (init_attr->qp_type == MLX5_IB_QPT_REG_UMR)
10265fe9dec0SEli Cohen 		qp->bf.bfreg = &dev->fp_bfreg;
10272978975cSLeon Romanovsky 	else if (qp->flags & MLX5_IB_QP_CREATE_WC_TEST)
102811f552e2SMichael Guralnik 		qp->bf.bfreg = &dev->wc_bfreg;
10295fe9dec0SEli Cohen 	else
10305fe9dec0SEli Cohen 		qp->bf.bfreg = &dev->bfreg;
1031e126ba97SEli Cohen 
1032d8030b0dSEli Cohen 	/* We need to divide by two since each register is comprised of
1033d8030b0dSEli Cohen 	 * two buffers of identical size, namely odd and even
1034d8030b0dSEli Cohen 	 */
1035d8030b0dSEli Cohen 	qp->bf.buf_size = (1 << MLX5_CAP_GEN(dev->mdev, log_bf_reg_size)) / 2;
10365fe9dec0SEli Cohen 	uar_index = qp->bf.bfreg->index;
1037e126ba97SEli Cohen 
1038e126ba97SEli Cohen 	err = calc_sq_size(dev, init_attr, qp);
1039e126ba97SEli Cohen 	if (err < 0) {
1040e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "err %d\n", err);
10415fe9dec0SEli Cohen 		return err;
1042e126ba97SEli Cohen 	}
1043e126ba97SEli Cohen 
1044e126ba97SEli Cohen 	qp->rq.offset = 0;
1045e126ba97SEli Cohen 	qp->sq.offset = qp->rq.wqe_cnt << qp->rq.wqe_shift;
104619098df2Smajd@mellanox.com 	base->ubuffer.buf_size = err + (qp->rq.wqe_cnt << qp->rq.wqe_shift);
1047e126ba97SEli Cohen 
104834f4c955SGuy Levi 	err = mlx5_frag_buf_alloc_node(dev->mdev, base->ubuffer.buf_size,
104934f4c955SGuy Levi 				       &qp->buf, dev->mdev->priv.numa_node);
1050e126ba97SEli Cohen 	if (err) {
1051e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "err %d\n", err);
10525fe9dec0SEli Cohen 		return err;
1053e126ba97SEli Cohen 	}
1054e126ba97SEli Cohen 
105534f4c955SGuy Levi 	if (qp->rq.wqe_cnt)
105634f4c955SGuy Levi 		mlx5_init_fbc(qp->buf.frags, qp->rq.wqe_shift,
105734f4c955SGuy Levi 			      ilog2(qp->rq.wqe_cnt), &qp->rq.fbc);
105834f4c955SGuy Levi 
105934f4c955SGuy Levi 	if (qp->sq.wqe_cnt) {
106034f4c955SGuy Levi 		int sq_strides_offset = (qp->sq.offset  & (PAGE_SIZE - 1)) /
106134f4c955SGuy Levi 					MLX5_SEND_WQE_BB;
106234f4c955SGuy Levi 		mlx5_init_fbc_offset(qp->buf.frags +
106334f4c955SGuy Levi 				     (qp->sq.offset / PAGE_SIZE),
106434f4c955SGuy Levi 				     ilog2(MLX5_SEND_WQE_BB),
106534f4c955SGuy Levi 				     ilog2(qp->sq.wqe_cnt),
106634f4c955SGuy Levi 				     sq_strides_offset, &qp->sq.fbc);
106734f4c955SGuy Levi 
106834f4c955SGuy Levi 		qp->sq.cur_edge = get_sq_edge(&qp->sq, 0);
106934f4c955SGuy Levi 	}
107034f4c955SGuy Levi 
107109a7d9ecSSaeed Mahameed 	*inlen = MLX5_ST_SZ_BYTES(create_qp_in) +
107209a7d9ecSSaeed Mahameed 		 MLX5_FLD_SZ_BYTES(create_qp_in, pas[0]) * qp->buf.npages;
10731b9a07eeSLeon Romanovsky 	*in = kvzalloc(*inlen, GFP_KERNEL);
1074e126ba97SEli Cohen 	if (!*in) {
1075e126ba97SEli Cohen 		err = -ENOMEM;
1076e126ba97SEli Cohen 		goto err_buf;
1077e126ba97SEli Cohen 	}
107809a7d9ecSSaeed Mahameed 
107909a7d9ecSSaeed Mahameed 	qpc = MLX5_ADDR_OF(create_qp_in, *in, qpc);
108009a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, uar_page, uar_index);
10818256c69bSMaor Gottlieb 	MLX5_SET(qpc, qpc, ts_format, mlx5_get_qp_default_ts(dev->mdev));
108209a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, log_page_size, qp->buf.page_shift - MLX5_ADAPTER_PAGE_SHIFT);
108309a7d9ecSSaeed Mahameed 
1084e126ba97SEli Cohen 	/* Set "fast registration enabled" for all kernel QPs */
108509a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, fre, 1);
108609a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, rlky, 1);
1087e126ba97SEli Cohen 
10882978975cSLeon Romanovsky 	if (qp->flags & MLX5_IB_QP_CREATE_SQPN_QP1)
108909a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, deth_sqpn, 1);
1090b11a4f9cSHaggai Eran 
109134f4c955SGuy Levi 	mlx5_fill_page_frag_array(&qp->buf,
109234f4c955SGuy Levi 				  (__be64 *)MLX5_ADDR_OF(create_qp_in,
109334f4c955SGuy Levi 							 *in, pas));
1094e126ba97SEli Cohen 
10959603b61dSJack Morgenstein 	err = mlx5_db_alloc(dev->mdev, &qp->db);
1096e126ba97SEli Cohen 	if (err) {
1097e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "err %d\n", err);
1098e126ba97SEli Cohen 		goto err_free;
1099e126ba97SEli Cohen 	}
1100e126ba97SEli Cohen 
1101b5883008SLi Dongyang 	qp->sq.wrid = kvmalloc_array(qp->sq.wqe_cnt,
1102b5883008SLi Dongyang 				     sizeof(*qp->sq.wrid), GFP_KERNEL);
1103b5883008SLi Dongyang 	qp->sq.wr_data = kvmalloc_array(qp->sq.wqe_cnt,
1104b5883008SLi Dongyang 					sizeof(*qp->sq.wr_data), GFP_KERNEL);
1105b5883008SLi Dongyang 	qp->rq.wrid = kvmalloc_array(qp->rq.wqe_cnt,
1106b5883008SLi Dongyang 				     sizeof(*qp->rq.wrid), GFP_KERNEL);
1107b5883008SLi Dongyang 	qp->sq.w_list = kvmalloc_array(qp->sq.wqe_cnt,
1108b5883008SLi Dongyang 				       sizeof(*qp->sq.w_list), GFP_KERNEL);
1109b5883008SLi Dongyang 	qp->sq.wqe_head = kvmalloc_array(qp->sq.wqe_cnt,
1110b5883008SLi Dongyang 					 sizeof(*qp->sq.wqe_head), GFP_KERNEL);
1111e126ba97SEli Cohen 
1112e126ba97SEli Cohen 	if (!qp->sq.wrid || !qp->sq.wr_data || !qp->rq.wrid ||
1113e126ba97SEli Cohen 	    !qp->sq.w_list || !qp->sq.wqe_head) {
1114e126ba97SEli Cohen 		err = -ENOMEM;
1115e126ba97SEli Cohen 		goto err_wrid;
1116e126ba97SEli Cohen 	}
1117e126ba97SEli Cohen 
1118e126ba97SEli Cohen 	return 0;
1119e126ba97SEli Cohen 
1120e126ba97SEli Cohen err_wrid:
1121b5883008SLi Dongyang 	kvfree(qp->sq.wqe_head);
1122b5883008SLi Dongyang 	kvfree(qp->sq.w_list);
1123b5883008SLi Dongyang 	kvfree(qp->sq.wrid);
1124b5883008SLi Dongyang 	kvfree(qp->sq.wr_data);
1125b5883008SLi Dongyang 	kvfree(qp->rq.wrid);
1126f4044dacSEli Cohen 	mlx5_db_free(dev->mdev, &qp->db);
1127e126ba97SEli Cohen 
1128e126ba97SEli Cohen err_free:
1129479163f4SAl Viro 	kvfree(*in);
1130e126ba97SEli Cohen 
1131e126ba97SEli Cohen err_buf:
113234f4c955SGuy Levi 	mlx5_frag_buf_free(dev->mdev, &qp->buf);
1133e126ba97SEli Cohen 	return err;
1134e126ba97SEli Cohen }
1135e126ba97SEli Cohen 
113609a7d9ecSSaeed Mahameed static u32 get_rx_type(struct mlx5_ib_qp *qp, struct ib_qp_init_attr *attr)
1137e126ba97SEli Cohen {
11387aede1a2SLeon Romanovsky 	if (attr->srq || (qp->type == IB_QPT_XRC_TGT) ||
11397aede1a2SLeon Romanovsky 	    (qp->type == MLX5_IB_QPT_DCI) || (qp->type == IB_QPT_XRC_INI))
114009a7d9ecSSaeed Mahameed 		return MLX5_SRQ_RQ;
1141e126ba97SEli Cohen 	else if (!qp->has_rq)
114209a7d9ecSSaeed Mahameed 		return MLX5_ZERO_LEN_RQ;
11437aede1a2SLeon Romanovsky 
114409a7d9ecSSaeed Mahameed 	return MLX5_NON_ZERO_RQ;
1145e126ba97SEli Cohen }
1146e126ba97SEli Cohen 
11470fb2ed66Smajd@mellanox.com static int create_raw_packet_qp_tis(struct mlx5_ib_dev *dev,
1148c2e53b2cSYishai Hadas 				    struct mlx5_ib_qp *qp,
11491cd6dbd3SYishai Hadas 				    struct mlx5_ib_sq *sq, u32 tdn,
11501cd6dbd3SYishai Hadas 				    struct ib_pd *pd)
11510fb2ed66Smajd@mellanox.com {
1152e0b4b472SLeon Romanovsky 	u32 in[MLX5_ST_SZ_DW(create_tis_in)] = {};
11530fb2ed66Smajd@mellanox.com 	void *tisc = MLX5_ADDR_OF(create_tis_in, in, ctx);
11540fb2ed66Smajd@mellanox.com 
11551cd6dbd3SYishai Hadas 	MLX5_SET(create_tis_in, in, uid, to_mpd(pd)->uid);
11560fb2ed66Smajd@mellanox.com 	MLX5_SET(tisc, tisc, transport_domain, tdn);
11572be08c30SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_SOURCE_QPN)
1158c2e53b2cSYishai Hadas 		MLX5_SET(tisc, tisc, underlay_qpn, qp->underlay_qpn);
1159c2e53b2cSYishai Hadas 
1160e0b4b472SLeon Romanovsky 	return mlx5_core_create_tis(dev->mdev, in, &sq->tisn);
11610fb2ed66Smajd@mellanox.com }
11620fb2ed66Smajd@mellanox.com 
11630fb2ed66Smajd@mellanox.com static void destroy_raw_packet_qp_tis(struct mlx5_ib_dev *dev,
11641cd6dbd3SYishai Hadas 				      struct mlx5_ib_sq *sq, struct ib_pd *pd)
11650fb2ed66Smajd@mellanox.com {
11661cd6dbd3SYishai Hadas 	mlx5_cmd_destroy_tis(dev->mdev, sq->tisn, to_mpd(pd)->uid);
11670fb2ed66Smajd@mellanox.com }
11680fb2ed66Smajd@mellanox.com 
1169d5ed8ac3SMark Bloch static void destroy_flow_rule_vport_sq(struct mlx5_ib_sq *sq)
1170b96c9ddeSMark Bloch {
1171b96c9ddeSMark Bloch 	if (sq->flow_rule)
1172b96c9ddeSMark Bloch 		mlx5_del_flow_rules(sq->flow_rule);
1173d5ed8ac3SMark Bloch 	sq->flow_rule = NULL;
1174b96c9ddeSMark Bloch }
1175b96c9ddeSMark Bloch 
11769a1ac95aSAharon Landau static bool fr_supported(int ts_cap)
11772fe8d4b8SAharon Landau {
11789a1ac95aSAharon Landau 	return ts_cap == MLX5_TIMESTAMP_FORMAT_CAP_FREE_RUNNING ||
11799a1ac95aSAharon Landau 	       ts_cap == MLX5_TIMESTAMP_FORMAT_CAP_FREE_RUNNING_AND_REAL_TIME;
11809a1ac95aSAharon Landau }
11812fe8d4b8SAharon Landau 
11829a1ac95aSAharon Landau static int get_ts_format(struct mlx5_ib_dev *dev, struct mlx5_ib_cq *cq,
118333652951SAharon Landau 			 bool fr_sup, bool rt_sup)
11849a1ac95aSAharon Landau {
118533652951SAharon Landau 	if (cq->private_flags & MLX5_IB_CQ_PR_FLAGS_REAL_TIME_TS) {
118633652951SAharon Landau 		if (!rt_sup) {
118733652951SAharon Landau 			mlx5_ib_dbg(dev,
118833652951SAharon Landau 				    "Real time TS format is not supported\n");
11892fe8d4b8SAharon Landau 			return -EOPNOTSUPP;
11902fe8d4b8SAharon Landau 		}
119133652951SAharon Landau 		return MLX5_TIMESTAMP_FORMAT_REAL_TIME;
11922fe8d4b8SAharon Landau 	}
11939a1ac95aSAharon Landau 	if (cq->create_flags & IB_UVERBS_CQ_FLAGS_TIMESTAMP_COMPLETION) {
11949a1ac95aSAharon Landau 		if (!fr_sup) {
11959a1ac95aSAharon Landau 			mlx5_ib_dbg(dev,
11969a1ac95aSAharon Landau 				    "Free running TS format is not supported\n");
11972fe8d4b8SAharon Landau 			return -EOPNOTSUPP;
11982fe8d4b8SAharon Landau 		}
11999a1ac95aSAharon Landau 		return MLX5_TIMESTAMP_FORMAT_FREE_RUNNING;
12002fe8d4b8SAharon Landau 	}
12019a1ac95aSAharon Landau 	return fr_sup ? MLX5_TIMESTAMP_FORMAT_FREE_RUNNING :
12029a1ac95aSAharon Landau 			MLX5_TIMESTAMP_FORMAT_DEFAULT;
12039a1ac95aSAharon Landau }
12049a1ac95aSAharon Landau 
12059a1ac95aSAharon Landau static int get_rq_ts_format(struct mlx5_ib_dev *dev, struct mlx5_ib_cq *recv_cq)
12069a1ac95aSAharon Landau {
12079a1ac95aSAharon Landau 	u8 ts_cap = MLX5_CAP_GEN(dev->mdev, rq_ts_format);
12089a1ac95aSAharon Landau 
120933652951SAharon Landau 	return get_ts_format(dev, recv_cq, fr_supported(ts_cap),
121033652951SAharon Landau 			     rt_supported(ts_cap));
12112fe8d4b8SAharon Landau }
12122fe8d4b8SAharon Landau 
12132fe8d4b8SAharon Landau static int get_sq_ts_format(struct mlx5_ib_dev *dev, struct mlx5_ib_cq *send_cq)
12142fe8d4b8SAharon Landau {
12159a1ac95aSAharon Landau 	u8 ts_cap = MLX5_CAP_GEN(dev->mdev, sq_ts_format);
12162fe8d4b8SAharon Landau 
121733652951SAharon Landau 	return get_ts_format(dev, send_cq, fr_supported(ts_cap),
121833652951SAharon Landau 			     rt_supported(ts_cap));
12192fe8d4b8SAharon Landau }
12202fe8d4b8SAharon Landau 
12212fe8d4b8SAharon Landau static int get_qp_ts_format(struct mlx5_ib_dev *dev, struct mlx5_ib_cq *send_cq,
12222fe8d4b8SAharon Landau 			    struct mlx5_ib_cq *recv_cq)
12232fe8d4b8SAharon Landau {
12249a1ac95aSAharon Landau 	u8 ts_cap = MLX5_CAP_ROCE(dev->mdev, qp_ts_format);
12259a1ac95aSAharon Landau 	bool fr_sup = fr_supported(ts_cap);
122633652951SAharon Landau 	bool rt_sup = rt_supported(ts_cap);
12279a1ac95aSAharon Landau 	u8 default_ts = fr_sup ? MLX5_TIMESTAMP_FORMAT_FREE_RUNNING :
12289a1ac95aSAharon Landau 				 MLX5_TIMESTAMP_FORMAT_DEFAULT;
12299a1ac95aSAharon Landau 	int send_ts_format =
123033652951SAharon Landau 		send_cq ? get_ts_format(dev, send_cq, fr_sup, rt_sup) :
12319a1ac95aSAharon Landau 			  default_ts;
12329a1ac95aSAharon Landau 	int recv_ts_format =
123333652951SAharon Landau 		recv_cq ? get_ts_format(dev, recv_cq, fr_sup, rt_sup) :
12349a1ac95aSAharon Landau 			  default_ts;
12352fe8d4b8SAharon Landau 
12369a1ac95aSAharon Landau 	if (send_ts_format < 0 || recv_ts_format < 0)
12372fe8d4b8SAharon Landau 		return -EOPNOTSUPP;
12382fe8d4b8SAharon Landau 
123933652951SAharon Landau 	if (send_ts_format != MLX5_TIMESTAMP_FORMAT_DEFAULT &&
124033652951SAharon Landau 	    recv_ts_format != MLX5_TIMESTAMP_FORMAT_DEFAULT &&
124133652951SAharon Landau 	    send_ts_format != recv_ts_format) {
124233652951SAharon Landau 		mlx5_ib_dbg(
124333652951SAharon Landau 			dev,
124433652951SAharon Landau 			"The send ts_format does not match the receive ts_format\n");
12452fe8d4b8SAharon Landau 		return -EOPNOTSUPP;
12462fe8d4b8SAharon Landau 	}
124733652951SAharon Landau 
12489a1ac95aSAharon Landau 	return send_ts_format == default_ts ? recv_ts_format : send_ts_format;
12492fe8d4b8SAharon Landau }
12502fe8d4b8SAharon Landau 
12510fb2ed66Smajd@mellanox.com static int create_raw_packet_qp_sq(struct mlx5_ib_dev *dev,
1252b0ea0fa5SJason Gunthorpe 				   struct ib_udata *udata,
12530fb2ed66Smajd@mellanox.com 				   struct mlx5_ib_sq *sq, void *qpin,
12542fe8d4b8SAharon Landau 				   struct ib_pd *pd, struct mlx5_ib_cq *cq)
12550fb2ed66Smajd@mellanox.com {
12560fb2ed66Smajd@mellanox.com 	struct mlx5_ib_ubuffer *ubuffer = &sq->ubuffer;
12570fb2ed66Smajd@mellanox.com 	__be64 *pas;
12580fb2ed66Smajd@mellanox.com 	void *in;
12590fb2ed66Smajd@mellanox.com 	void *sqc;
12600fb2ed66Smajd@mellanox.com 	void *qpc = MLX5_ADDR_OF(create_qp_in, qpin, qpc);
12610fb2ed66Smajd@mellanox.com 	void *wq;
12620fb2ed66Smajd@mellanox.com 	int inlen;
12630fb2ed66Smajd@mellanox.com 	int err;
1264ad480ea5SJason Gunthorpe 	unsigned int page_offset_quantized;
1265ad480ea5SJason Gunthorpe 	unsigned long page_size;
12662fe8d4b8SAharon Landau 	int ts_format;
12672fe8d4b8SAharon Landau 
12682fe8d4b8SAharon Landau 	ts_format = get_sq_ts_format(dev, cq);
12692fe8d4b8SAharon Landau 	if (ts_format < 0)
12702fe8d4b8SAharon Landau 		return ts_format;
12710fb2ed66Smajd@mellanox.com 
1272ad480ea5SJason Gunthorpe 	sq->ubuffer.umem = ib_umem_get(&dev->ib_dev, ubuffer->buf_addr,
1273ad480ea5SJason Gunthorpe 				       ubuffer->buf_size, 0);
1274ad480ea5SJason Gunthorpe 	if (IS_ERR(sq->ubuffer.umem))
1275ad480ea5SJason Gunthorpe 		return PTR_ERR(sq->ubuffer.umem);
1276ad480ea5SJason Gunthorpe 	page_size = mlx5_umem_find_best_quantized_pgoff(
1277ad480ea5SJason Gunthorpe 		ubuffer->umem, wq, log_wq_pg_sz, MLX5_ADAPTER_PAGE_SHIFT,
1278ad480ea5SJason Gunthorpe 		page_offset, 64, &page_offset_quantized);
1279ad480ea5SJason Gunthorpe 	if (!page_size) {
1280ad480ea5SJason Gunthorpe 		err = -EINVAL;
1281ad480ea5SJason Gunthorpe 		goto err_umem;
1282ad480ea5SJason Gunthorpe 	}
12830fb2ed66Smajd@mellanox.com 
12847db0eea9SJason Gunthorpe 	inlen = MLX5_ST_SZ_BYTES(create_sq_in) +
1285ad480ea5SJason Gunthorpe 		sizeof(u64) *
1286ad480ea5SJason Gunthorpe 			ib_umem_num_dma_blocks(sq->ubuffer.umem, page_size);
12871b9a07eeSLeon Romanovsky 	in = kvzalloc(inlen, GFP_KERNEL);
12880fb2ed66Smajd@mellanox.com 	if (!in) {
12890fb2ed66Smajd@mellanox.com 		err = -ENOMEM;
12900fb2ed66Smajd@mellanox.com 		goto err_umem;
12910fb2ed66Smajd@mellanox.com 	}
12920fb2ed66Smajd@mellanox.com 
1293c14003f0SYishai Hadas 	MLX5_SET(create_sq_in, in, uid, to_mpd(pd)->uid);
12940fb2ed66Smajd@mellanox.com 	sqc = MLX5_ADDR_OF(create_sq_in, in, ctx);
12950fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, flush_in_error_en, 1);
1296795b609cSBodong Wang 	if (MLX5_CAP_ETH(dev->mdev, multi_pkt_send_wqe))
1297795b609cSBodong Wang 		MLX5_SET(sqc, sqc, allow_multi_pkt_send_wqe, 1);
12980fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, state, MLX5_SQC_STATE_RST);
12992fe8d4b8SAharon Landau 	MLX5_SET(sqc, sqc, ts_format, ts_format);
13000fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, user_index, MLX5_GET(qpc, qpc, user_index));
13010fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, cqn, MLX5_GET(qpc, qpc, cqn_snd));
13020fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, tis_lst_sz, 1);
13030fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, tis_num_0, sq->tisn);
130496dc3fc5SNoa Osherovich 	if (MLX5_CAP_GEN(dev->mdev, eth_net_offloads) &&
130596dc3fc5SNoa Osherovich 	    MLX5_CAP_ETH(dev->mdev, swp))
130696dc3fc5SNoa Osherovich 		MLX5_SET(sqc, sqc, allow_swp, 1);
13070fb2ed66Smajd@mellanox.com 
13080fb2ed66Smajd@mellanox.com 	wq = MLX5_ADDR_OF(sqc, sqc, wq);
13090fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, wq_type, MLX5_WQ_TYPE_CYCLIC);
13100fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, pd, MLX5_GET(qpc, qpc, pd));
13110fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, uar_page, MLX5_GET(qpc, qpc, uar_page));
13120fb2ed66Smajd@mellanox.com 	MLX5_SET64(wq, wq, dbr_addr, MLX5_GET64(qpc, qpc, dbr_addr));
13130fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, log_wq_stride, ilog2(MLX5_SEND_WQE_BB));
13140fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, log_wq_sz, MLX5_GET(qpc, qpc, log_sq_size));
1315ad480ea5SJason Gunthorpe 	MLX5_SET(wq, wq, log_wq_pg_sz,
1316ad480ea5SJason Gunthorpe 		 order_base_2(page_size) - MLX5_ADAPTER_PAGE_SHIFT);
1317ad480ea5SJason Gunthorpe 	MLX5_SET(wq, wq, page_offset, page_offset_quantized);
13180fb2ed66Smajd@mellanox.com 
13190fb2ed66Smajd@mellanox.com 	pas = (__be64 *)MLX5_ADDR_OF(wq, wq, pas);
1320ad480ea5SJason Gunthorpe 	mlx5_ib_populate_pas(sq->ubuffer.umem, page_size, pas, 0);
13210fb2ed66Smajd@mellanox.com 
1322333fbaa0SLeon Romanovsky 	err = mlx5_core_create_sq_tracked(dev, in, inlen, &sq->base.mqp);
13230fb2ed66Smajd@mellanox.com 
13240fb2ed66Smajd@mellanox.com 	kvfree(in);
13250fb2ed66Smajd@mellanox.com 
13260fb2ed66Smajd@mellanox.com 	if (err)
13270fb2ed66Smajd@mellanox.com 		goto err_umem;
13280fb2ed66Smajd@mellanox.com 
13290fb2ed66Smajd@mellanox.com 	return 0;
13300fb2ed66Smajd@mellanox.com 
13310fb2ed66Smajd@mellanox.com err_umem:
13320fb2ed66Smajd@mellanox.com 	ib_umem_release(sq->ubuffer.umem);
13330fb2ed66Smajd@mellanox.com 	sq->ubuffer.umem = NULL;
13340fb2ed66Smajd@mellanox.com 
13350fb2ed66Smajd@mellanox.com 	return err;
13360fb2ed66Smajd@mellanox.com }
13370fb2ed66Smajd@mellanox.com 
13380fb2ed66Smajd@mellanox.com static void destroy_raw_packet_qp_sq(struct mlx5_ib_dev *dev,
13390fb2ed66Smajd@mellanox.com 				     struct mlx5_ib_sq *sq)
13400fb2ed66Smajd@mellanox.com {
1341d5ed8ac3SMark Bloch 	destroy_flow_rule_vport_sq(sq);
1342333fbaa0SLeon Romanovsky 	mlx5_core_destroy_sq_tracked(dev, &sq->base.mqp);
13430fb2ed66Smajd@mellanox.com 	ib_umem_release(sq->ubuffer.umem);
13440fb2ed66Smajd@mellanox.com }
13450fb2ed66Smajd@mellanox.com 
13460fb2ed66Smajd@mellanox.com static int create_raw_packet_qp_rq(struct mlx5_ib_dev *dev,
13472c292dbbSBoris Pismenny 				   struct mlx5_ib_rq *rq, void *qpin,
13482fe8d4b8SAharon Landau 				   struct ib_pd *pd, struct mlx5_ib_cq *cq)
13490fb2ed66Smajd@mellanox.com {
1350358e42eaSMajd Dibbiny 	struct mlx5_ib_qp *mqp = rq->base.container_mibqp;
13510fb2ed66Smajd@mellanox.com 	__be64 *pas;
13520fb2ed66Smajd@mellanox.com 	void *in;
13530fb2ed66Smajd@mellanox.com 	void *rqc;
13540fb2ed66Smajd@mellanox.com 	void *wq;
13550fb2ed66Smajd@mellanox.com 	void *qpc = MLX5_ADDR_OF(create_qp_in, qpin, qpc);
13567579dcdfSJason Gunthorpe 	struct ib_umem *umem = rq->base.ubuffer.umem;
13577579dcdfSJason Gunthorpe 	unsigned int page_offset_quantized;
13587579dcdfSJason Gunthorpe 	unsigned long page_size = 0;
13592fe8d4b8SAharon Landau 	int ts_format;
13602c292dbbSBoris Pismenny 	size_t inlen;
13610fb2ed66Smajd@mellanox.com 	int err;
13622c292dbbSBoris Pismenny 
13632fe8d4b8SAharon Landau 	ts_format = get_rq_ts_format(dev, cq);
13642fe8d4b8SAharon Landau 	if (ts_format < 0)
13652fe8d4b8SAharon Landau 		return ts_format;
13662fe8d4b8SAharon Landau 
13677579dcdfSJason Gunthorpe 	page_size = mlx5_umem_find_best_quantized_pgoff(umem, wq, log_wq_pg_sz,
13687579dcdfSJason Gunthorpe 							MLX5_ADAPTER_PAGE_SHIFT,
13697579dcdfSJason Gunthorpe 							page_offset, 64,
13707579dcdfSJason Gunthorpe 							&page_offset_quantized);
13717579dcdfSJason Gunthorpe 	if (!page_size)
13722c292dbbSBoris Pismenny 		return -EINVAL;
13730fb2ed66Smajd@mellanox.com 
13747579dcdfSJason Gunthorpe 	inlen = MLX5_ST_SZ_BYTES(create_rq_in) +
13757579dcdfSJason Gunthorpe 		sizeof(u64) * ib_umem_num_dma_blocks(umem, page_size);
13761b9a07eeSLeon Romanovsky 	in = kvzalloc(inlen, GFP_KERNEL);
13770fb2ed66Smajd@mellanox.com 	if (!in)
13780fb2ed66Smajd@mellanox.com 		return -ENOMEM;
13790fb2ed66Smajd@mellanox.com 
138034d57585SYishai Hadas 	MLX5_SET(create_rq_in, in, uid, to_mpd(pd)->uid);
13810fb2ed66Smajd@mellanox.com 	rqc = MLX5_ADDR_OF(create_rq_in, in, ctx);
1382e4cc4fa7SNoa Osherovich 	if (!(rq->flags & MLX5_IB_RQ_CVLAN_STRIPPING))
13830fb2ed66Smajd@mellanox.com 		MLX5_SET(rqc, rqc, vsd, 1);
13840fb2ed66Smajd@mellanox.com 	MLX5_SET(rqc, rqc, mem_rq_type, MLX5_RQC_MEM_RQ_TYPE_MEMORY_RQ_INLINE);
13850fb2ed66Smajd@mellanox.com 	MLX5_SET(rqc, rqc, state, MLX5_RQC_STATE_RST);
13862fe8d4b8SAharon Landau 	MLX5_SET(rqc, rqc, ts_format, ts_format);
13870fb2ed66Smajd@mellanox.com 	MLX5_SET(rqc, rqc, flush_in_error_en, 1);
13880fb2ed66Smajd@mellanox.com 	MLX5_SET(rqc, rqc, user_index, MLX5_GET(qpc, qpc, user_index));
13890fb2ed66Smajd@mellanox.com 	MLX5_SET(rqc, rqc, cqn, MLX5_GET(qpc, qpc, cqn_rcv));
13900fb2ed66Smajd@mellanox.com 
13912be08c30SLeon Romanovsky 	if (mqp->flags & IB_QP_CREATE_SCATTER_FCS)
1392358e42eaSMajd Dibbiny 		MLX5_SET(rqc, rqc, scatter_fcs, 1);
1393358e42eaSMajd Dibbiny 
13940fb2ed66Smajd@mellanox.com 	wq = MLX5_ADDR_OF(rqc, rqc, wq);
13950fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, wq_type, MLX5_WQ_TYPE_CYCLIC);
1396b1383aa6SNoa Osherovich 	if (rq->flags & MLX5_IB_RQ_PCI_WRITE_END_PADDING)
1397b1383aa6SNoa Osherovich 		MLX5_SET(wq, wq, end_padding_mode, MLX5_WQ_END_PAD_MODE_ALIGN);
13987579dcdfSJason Gunthorpe 	MLX5_SET(wq, wq, page_offset, page_offset_quantized);
13990fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, pd, MLX5_GET(qpc, qpc, pd));
14000fb2ed66Smajd@mellanox.com 	MLX5_SET64(wq, wq, dbr_addr, MLX5_GET64(qpc, qpc, dbr_addr));
14010fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, log_wq_stride, MLX5_GET(qpc, qpc, log_rq_stride) + 4);
14027579dcdfSJason Gunthorpe 	MLX5_SET(wq, wq, log_wq_pg_sz,
14037579dcdfSJason Gunthorpe 		 order_base_2(page_size) - MLX5_ADAPTER_PAGE_SHIFT);
14040fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, log_wq_sz, MLX5_GET(qpc, qpc, log_rq_size));
14050fb2ed66Smajd@mellanox.com 
14060fb2ed66Smajd@mellanox.com 	pas = (__be64 *)MLX5_ADDR_OF(wq, wq, pas);
14077579dcdfSJason Gunthorpe 	mlx5_ib_populate_pas(umem, page_size, pas, 0);
14080fb2ed66Smajd@mellanox.com 
1409333fbaa0SLeon Romanovsky 	err = mlx5_core_create_rq_tracked(dev, in, inlen, &rq->base.mqp);
14100fb2ed66Smajd@mellanox.com 
14110fb2ed66Smajd@mellanox.com 	kvfree(in);
14120fb2ed66Smajd@mellanox.com 
14130fb2ed66Smajd@mellanox.com 	return err;
14140fb2ed66Smajd@mellanox.com }
14150fb2ed66Smajd@mellanox.com 
14160fb2ed66Smajd@mellanox.com static void destroy_raw_packet_qp_rq(struct mlx5_ib_dev *dev,
14170fb2ed66Smajd@mellanox.com 				     struct mlx5_ib_rq *rq)
14180fb2ed66Smajd@mellanox.com {
1419333fbaa0SLeon Romanovsky 	mlx5_core_destroy_rq_tracked(dev, &rq->base.mqp);
14200fb2ed66Smajd@mellanox.com }
14210fb2ed66Smajd@mellanox.com 
14220042f9e4SMark Bloch static void destroy_raw_packet_qp_tir(struct mlx5_ib_dev *dev,
14230042f9e4SMark Bloch 				      struct mlx5_ib_rq *rq,
1424443c1cf9SYishai Hadas 				      u32 qp_flags_en,
1425443c1cf9SYishai Hadas 				      struct ib_pd *pd)
14260042f9e4SMark Bloch {
14270042f9e4SMark Bloch 	if (qp_flags_en & (MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_UC |
14280042f9e4SMark Bloch 			   MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_MC))
14290042f9e4SMark Bloch 		mlx5_ib_disable_lb(dev, false, true);
1430443c1cf9SYishai Hadas 	mlx5_cmd_destroy_tir(dev->mdev, rq->tirn, to_mpd(pd)->uid);
14310042f9e4SMark Bloch }
14320042f9e4SMark Bloch 
14330fb2ed66Smajd@mellanox.com static int create_raw_packet_qp_tir(struct mlx5_ib_dev *dev,
1434f95ef6cbSMaor Gottlieb 				    struct mlx5_ib_rq *rq, u32 tdn,
1435e0b4b472SLeon Romanovsky 				    u32 *qp_flags_en, struct ib_pd *pd,
1436e0b4b472SLeon Romanovsky 				    u32 *out)
14370fb2ed66Smajd@mellanox.com {
1438175edba8SMark Bloch 	u8 lb_flag = 0;
14390fb2ed66Smajd@mellanox.com 	u32 *in;
14400fb2ed66Smajd@mellanox.com 	void *tirc;
14410fb2ed66Smajd@mellanox.com 	int inlen;
14420fb2ed66Smajd@mellanox.com 	int err;
14430fb2ed66Smajd@mellanox.com 
14440fb2ed66Smajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(create_tir_in);
14451b9a07eeSLeon Romanovsky 	in = kvzalloc(inlen, GFP_KERNEL);
14460fb2ed66Smajd@mellanox.com 	if (!in)
14470fb2ed66Smajd@mellanox.com 		return -ENOMEM;
14480fb2ed66Smajd@mellanox.com 
1449443c1cf9SYishai Hadas 	MLX5_SET(create_tir_in, in, uid, to_mpd(pd)->uid);
14500fb2ed66Smajd@mellanox.com 	tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
14510fb2ed66Smajd@mellanox.com 	MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT);
14520fb2ed66Smajd@mellanox.com 	MLX5_SET(tirc, tirc, inline_rqn, rq->base.mqp.qpn);
14530fb2ed66Smajd@mellanox.com 	MLX5_SET(tirc, tirc, transport_domain, tdn);
1454175edba8SMark Bloch 	if (*qp_flags_en & MLX5_QP_FLAG_TUNNEL_OFFLOADS)
1455f95ef6cbSMaor Gottlieb 		MLX5_SET(tirc, tirc, tunneled_offload_en, 1);
14560fb2ed66Smajd@mellanox.com 
1457175edba8SMark Bloch 	if (*qp_flags_en & MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_UC)
1458175edba8SMark Bloch 		lb_flag |= MLX5_TIRC_SELF_LB_BLOCK_BLOCK_UNICAST;
1459175edba8SMark Bloch 
1460175edba8SMark Bloch 	if (*qp_flags_en & MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_MC)
1461175edba8SMark Bloch 		lb_flag |= MLX5_TIRC_SELF_LB_BLOCK_BLOCK_MULTICAST;
1462175edba8SMark Bloch 
14636a4d00beSMark Bloch 	if (dev->is_rep) {
1464175edba8SMark Bloch 		lb_flag |= MLX5_TIRC_SELF_LB_BLOCK_BLOCK_UNICAST;
1465175edba8SMark Bloch 		*qp_flags_en |= MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_UC;
1466175edba8SMark Bloch 	}
1467175edba8SMark Bloch 
1468175edba8SMark Bloch 	MLX5_SET(tirc, tirc, self_lb_block, lb_flag);
1469e0b4b472SLeon Romanovsky 	MLX5_SET(create_tir_in, in, opcode, MLX5_CMD_OP_CREATE_TIR);
1470e0b4b472SLeon Romanovsky 	err = mlx5_cmd_exec_inout(dev->mdev, create_tir, in, out);
14711f1d6abbSAriel Levkovich 	rq->tirn = MLX5_GET(create_tir_out, out, tirn);
14720042f9e4SMark Bloch 	if (!err && MLX5_GET(tirc, tirc, self_lb_block)) {
14730042f9e4SMark Bloch 		err = mlx5_ib_enable_lb(dev, false, true);
14740042f9e4SMark Bloch 
14750042f9e4SMark Bloch 		if (err)
1476443c1cf9SYishai Hadas 			destroy_raw_packet_qp_tir(dev, rq, 0, pd);
14770042f9e4SMark Bloch 	}
14780fb2ed66Smajd@mellanox.com 	kvfree(in);
14790fb2ed66Smajd@mellanox.com 
14800fb2ed66Smajd@mellanox.com 	return err;
14810fb2ed66Smajd@mellanox.com }
14820fb2ed66Smajd@mellanox.com 
14830fb2ed66Smajd@mellanox.com static int create_raw_packet_qp(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
14842fe8d4b8SAharon Landau 				u32 *in, size_t inlen, struct ib_pd *pd,
14857f72052cSYishai Hadas 				struct ib_udata *udata,
14862fe8d4b8SAharon Landau 				struct mlx5_ib_create_qp_resp *resp,
14872fe8d4b8SAharon Landau 				struct ib_qp_init_attr *init_attr)
14880fb2ed66Smajd@mellanox.com {
14890fb2ed66Smajd@mellanox.com 	struct mlx5_ib_raw_packet_qp *raw_packet_qp = &qp->raw_packet_qp;
14900fb2ed66Smajd@mellanox.com 	struct mlx5_ib_sq *sq = &raw_packet_qp->sq;
14910fb2ed66Smajd@mellanox.com 	struct mlx5_ib_rq *rq = &raw_packet_qp->rq;
149289944450SShamir Rabinovitch 	struct mlx5_ib_ucontext *mucontext = rdma_udata_to_drv_context(
149389944450SShamir Rabinovitch 		udata, struct mlx5_ib_ucontext, ibucontext);
14940fb2ed66Smajd@mellanox.com 	int err;
14950fb2ed66Smajd@mellanox.com 	u32 tdn = mucontext->tdn;
14967f72052cSYishai Hadas 	u16 uid = to_mpd(pd)->uid;
14971f1d6abbSAriel Levkovich 	u32 out[MLX5_ST_SZ_DW(create_tir_out)] = {};
14980fb2ed66Smajd@mellanox.com 
14990eacc574SAharon Landau 	if (!qp->sq.wqe_cnt && !qp->rq.wqe_cnt)
15000eacc574SAharon Landau 		return -EINVAL;
15010fb2ed66Smajd@mellanox.com 	if (qp->sq.wqe_cnt) {
15021cd6dbd3SYishai Hadas 		err = create_raw_packet_qp_tis(dev, qp, sq, tdn, pd);
15030fb2ed66Smajd@mellanox.com 		if (err)
15040fb2ed66Smajd@mellanox.com 			return err;
15050fb2ed66Smajd@mellanox.com 
15062fe8d4b8SAharon Landau 		err = create_raw_packet_qp_sq(dev, udata, sq, in, pd,
15072fe8d4b8SAharon Landau 					      to_mcq(init_attr->send_cq));
15080fb2ed66Smajd@mellanox.com 		if (err)
15090fb2ed66Smajd@mellanox.com 			goto err_destroy_tis;
15100fb2ed66Smajd@mellanox.com 
15117f72052cSYishai Hadas 		if (uid) {
15127f72052cSYishai Hadas 			resp->tisn = sq->tisn;
15137f72052cSYishai Hadas 			resp->comp_mask |= MLX5_IB_CREATE_QP_RESP_MASK_TISN;
15147f72052cSYishai Hadas 			resp->sqn = sq->base.mqp.qpn;
15157f72052cSYishai Hadas 			resp->comp_mask |= MLX5_IB_CREATE_QP_RESP_MASK_SQN;
15167f72052cSYishai Hadas 		}
15177f72052cSYishai Hadas 
15180fb2ed66Smajd@mellanox.com 		sq->base.container_mibqp = qp;
15191d31e9c0SMajd Dibbiny 		sq->base.mqp.event = mlx5_ib_qp_event;
15200fb2ed66Smajd@mellanox.com 	}
15210fb2ed66Smajd@mellanox.com 
15220fb2ed66Smajd@mellanox.com 	if (qp->rq.wqe_cnt) {
1523358e42eaSMajd Dibbiny 		rq->base.container_mibqp = qp;
1524358e42eaSMajd Dibbiny 
15252be08c30SLeon Romanovsky 		if (qp->flags & IB_QP_CREATE_CVLAN_STRIPPING)
1526e4cc4fa7SNoa Osherovich 			rq->flags |= MLX5_IB_RQ_CVLAN_STRIPPING;
15272be08c30SLeon Romanovsky 		if (qp->flags & IB_QP_CREATE_PCI_WRITE_END_PADDING)
1528b1383aa6SNoa Osherovich 			rq->flags |= MLX5_IB_RQ_PCI_WRITE_END_PADDING;
15292fe8d4b8SAharon Landau 		err = create_raw_packet_qp_rq(dev, rq, in, pd,
15302fe8d4b8SAharon Landau 					      to_mcq(init_attr->recv_cq));
15310fb2ed66Smajd@mellanox.com 		if (err)
15320fb2ed66Smajd@mellanox.com 			goto err_destroy_sq;
15330fb2ed66Smajd@mellanox.com 
1534e0b4b472SLeon Romanovsky 		err = create_raw_packet_qp_tir(dev, rq, tdn, &qp->flags_en, pd,
1535e0b4b472SLeon Romanovsky 					       out);
15360fb2ed66Smajd@mellanox.com 		if (err)
15370fb2ed66Smajd@mellanox.com 			goto err_destroy_rq;
15387f72052cSYishai Hadas 
15397f72052cSYishai Hadas 		if (uid) {
15407f72052cSYishai Hadas 			resp->rqn = rq->base.mqp.qpn;
15417f72052cSYishai Hadas 			resp->comp_mask |= MLX5_IB_CREATE_QP_RESP_MASK_RQN;
15427f72052cSYishai Hadas 			resp->tirn = rq->tirn;
15437f72052cSYishai Hadas 			resp->comp_mask |= MLX5_IB_CREATE_QP_RESP_MASK_TIRN;
154454a38b66SAlex Vesker 			if (MLX5_CAP_FLOWTABLE_NIC_RX(dev->mdev, sw_owner) ||
154554a38b66SAlex Vesker 			    MLX5_CAP_FLOWTABLE_NIC_RX(dev->mdev, sw_owner_v2)) {
15461f1d6abbSAriel Levkovich 				resp->tir_icm_addr = MLX5_GET(
15471f1d6abbSAriel Levkovich 					create_tir_out, out, icm_address_31_0);
15481f1d6abbSAriel Levkovich 				resp->tir_icm_addr |=
15491f1d6abbSAriel Levkovich 					(u64)MLX5_GET(create_tir_out, out,
15501f1d6abbSAriel Levkovich 						      icm_address_39_32)
15511f1d6abbSAriel Levkovich 					<< 32;
15521f1d6abbSAriel Levkovich 				resp->tir_icm_addr |=
15531f1d6abbSAriel Levkovich 					(u64)MLX5_GET(create_tir_out, out,
15541f1d6abbSAriel Levkovich 						      icm_address_63_40)
15551f1d6abbSAriel Levkovich 					<< 40;
15561f1d6abbSAriel Levkovich 				resp->comp_mask |=
15571f1d6abbSAriel Levkovich 					MLX5_IB_CREATE_QP_RESP_MASK_TIR_ICM_ADDR;
15581f1d6abbSAriel Levkovich 			}
15597f72052cSYishai Hadas 		}
15600fb2ed66Smajd@mellanox.com 	}
15610fb2ed66Smajd@mellanox.com 
15620fb2ed66Smajd@mellanox.com 	qp->trans_qp.base.mqp.qpn = qp->sq.wqe_cnt ? sq->base.mqp.qpn :
15630fb2ed66Smajd@mellanox.com 						     rq->base.mqp.qpn;
15640fb2ed66Smajd@mellanox.com 	return 0;
15650fb2ed66Smajd@mellanox.com 
15660fb2ed66Smajd@mellanox.com err_destroy_rq:
15670fb2ed66Smajd@mellanox.com 	destroy_raw_packet_qp_rq(dev, rq);
15680fb2ed66Smajd@mellanox.com err_destroy_sq:
15690fb2ed66Smajd@mellanox.com 	if (!qp->sq.wqe_cnt)
15700fb2ed66Smajd@mellanox.com 		return err;
15710fb2ed66Smajd@mellanox.com 	destroy_raw_packet_qp_sq(dev, sq);
15720fb2ed66Smajd@mellanox.com err_destroy_tis:
15731cd6dbd3SYishai Hadas 	destroy_raw_packet_qp_tis(dev, sq, pd);
15740fb2ed66Smajd@mellanox.com 
15750fb2ed66Smajd@mellanox.com 	return err;
15760fb2ed66Smajd@mellanox.com }
15770fb2ed66Smajd@mellanox.com 
15780fb2ed66Smajd@mellanox.com static void destroy_raw_packet_qp(struct mlx5_ib_dev *dev,
15790fb2ed66Smajd@mellanox.com 				  struct mlx5_ib_qp *qp)
15800fb2ed66Smajd@mellanox.com {
15810fb2ed66Smajd@mellanox.com 	struct mlx5_ib_raw_packet_qp *raw_packet_qp = &qp->raw_packet_qp;
15820fb2ed66Smajd@mellanox.com 	struct mlx5_ib_sq *sq = &raw_packet_qp->sq;
15830fb2ed66Smajd@mellanox.com 	struct mlx5_ib_rq *rq = &raw_packet_qp->rq;
15840fb2ed66Smajd@mellanox.com 
15850fb2ed66Smajd@mellanox.com 	if (qp->rq.wqe_cnt) {
1586443c1cf9SYishai Hadas 		destroy_raw_packet_qp_tir(dev, rq, qp->flags_en, qp->ibqp.pd);
15870fb2ed66Smajd@mellanox.com 		destroy_raw_packet_qp_rq(dev, rq);
15880fb2ed66Smajd@mellanox.com 	}
15890fb2ed66Smajd@mellanox.com 
15900fb2ed66Smajd@mellanox.com 	if (qp->sq.wqe_cnt) {
15910fb2ed66Smajd@mellanox.com 		destroy_raw_packet_qp_sq(dev, sq);
15921cd6dbd3SYishai Hadas 		destroy_raw_packet_qp_tis(dev, sq, qp->ibqp.pd);
15930fb2ed66Smajd@mellanox.com 	}
15940fb2ed66Smajd@mellanox.com }
15950fb2ed66Smajd@mellanox.com 
15960fb2ed66Smajd@mellanox.com static void raw_packet_qp_copy_info(struct mlx5_ib_qp *qp,
15970fb2ed66Smajd@mellanox.com 				    struct mlx5_ib_raw_packet_qp *raw_packet_qp)
15980fb2ed66Smajd@mellanox.com {
15990fb2ed66Smajd@mellanox.com 	struct mlx5_ib_sq *sq = &raw_packet_qp->sq;
16000fb2ed66Smajd@mellanox.com 	struct mlx5_ib_rq *rq = &raw_packet_qp->rq;
16010fb2ed66Smajd@mellanox.com 
16020fb2ed66Smajd@mellanox.com 	sq->sq = &qp->sq;
16030fb2ed66Smajd@mellanox.com 	rq->rq = &qp->rq;
16040fb2ed66Smajd@mellanox.com 	sq->doorbell = &qp->db;
16050fb2ed66Smajd@mellanox.com 	rq->doorbell = &qp->db;
16060fb2ed66Smajd@mellanox.com }
16070fb2ed66Smajd@mellanox.com 
160828d61370SYishai Hadas static void destroy_rss_raw_qp_tir(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp)
160928d61370SYishai Hadas {
16100042f9e4SMark Bloch 	if (qp->flags_en & (MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_UC |
16110042f9e4SMark Bloch 			    MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_MC))
16120042f9e4SMark Bloch 		mlx5_ib_disable_lb(dev, false, true);
1613443c1cf9SYishai Hadas 	mlx5_cmd_destroy_tir(dev->mdev, qp->rss_qp.tirn,
1614443c1cf9SYishai Hadas 			     to_mpd(qp->ibqp.pd)->uid);
161528d61370SYishai Hadas }
161628d61370SYishai Hadas 
1617f78d358cSLeon Romanovsky struct mlx5_create_qp_params {
1618f78d358cSLeon Romanovsky 	struct ib_udata *udata;
1619f78d358cSLeon Romanovsky 	size_t inlen;
16206f2cf76eSLeon Romanovsky 	size_t outlen;
1621e383085cSLeon Romanovsky 	size_t ucmd_size;
1622f78d358cSLeon Romanovsky 	void *ucmd;
1623f78d358cSLeon Romanovsky 	u8 is_rss_raw : 1;
1624f78d358cSLeon Romanovsky 	struct ib_qp_init_attr *attr;
1625f78d358cSLeon Romanovsky 	u32 uidx;
162608d53976SLeon Romanovsky 	struct mlx5_ib_create_qp_resp resp;
1627f78d358cSLeon Romanovsky };
1628f78d358cSLeon Romanovsky 
1629f78d358cSLeon Romanovsky static int create_rss_raw_qp_tir(struct mlx5_ib_dev *dev, struct ib_pd *pd,
1630f78d358cSLeon Romanovsky 				 struct mlx5_ib_qp *qp,
1631f78d358cSLeon Romanovsky 				 struct mlx5_create_qp_params *params)
163228d61370SYishai Hadas {
1633f78d358cSLeon Romanovsky 	struct ib_qp_init_attr *init_attr = params->attr;
1634f78d358cSLeon Romanovsky 	struct mlx5_ib_create_qp_rss *ucmd = params->ucmd;
1635f78d358cSLeon Romanovsky 	struct ib_udata *udata = params->udata;
163689944450SShamir Rabinovitch 	struct mlx5_ib_ucontext *mucontext = rdma_udata_to_drv_context(
163789944450SShamir Rabinovitch 		udata, struct mlx5_ib_ucontext, ibucontext);
163828d61370SYishai Hadas 	int inlen;
16391f1d6abbSAriel Levkovich 	int outlen;
164028d61370SYishai Hadas 	int err;
164128d61370SYishai Hadas 	u32 *in;
16421f1d6abbSAriel Levkovich 	u32 *out;
164328d61370SYishai Hadas 	void *tirc;
164428d61370SYishai Hadas 	void *hfso;
164528d61370SYishai Hadas 	u32 selected_fields = 0;
16462d93fc85SMatan Barak 	u32 outer_l4;
164728d61370SYishai Hadas 	u32 tdn = mucontext->tdn;
1648175edba8SMark Bloch 	u8 lb_flag = 0;
164928d61370SYishai Hadas 
16505ce0592bSLeon Romanovsky 	if (ucmd->comp_mask) {
165128d61370SYishai Hadas 		mlx5_ib_dbg(dev, "invalid comp mask\n");
165228d61370SYishai Hadas 		return -EOPNOTSUPP;
165328d61370SYishai Hadas 	}
165428d61370SYishai Hadas 
16555ce0592bSLeon Romanovsky 	if (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_INNER &&
16565ce0592bSLeon Romanovsky 	    !(ucmd->flags & MLX5_QP_FLAG_TUNNEL_OFFLOADS)) {
1657309fa347SMaor Gottlieb 		mlx5_ib_dbg(dev, "Tunnel offloads must be set for inner RSS\n");
1658309fa347SMaor Gottlieb 		return -EOPNOTSUPP;
1659309fa347SMaor Gottlieb 	}
1660309fa347SMaor Gottlieb 
166137518fa4SLeon Romanovsky 	if (dev->is_rep)
1662175edba8SMark Bloch 		qp->flags_en |= MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_UC;
1663175edba8SMark Bloch 
166437518fa4SLeon Romanovsky 	if (qp->flags_en & MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_UC)
166537518fa4SLeon Romanovsky 		lb_flag |= MLX5_TIRC_SELF_LB_BLOCK_BLOCK_UNICAST;
166637518fa4SLeon Romanovsky 
166737518fa4SLeon Romanovsky 	if (qp->flags_en & MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_MC)
1668175edba8SMark Bloch 		lb_flag |= MLX5_TIRC_SELF_LB_BLOCK_BLOCK_MULTICAST;
1669175edba8SMark Bloch 
167028d61370SYishai Hadas 	inlen = MLX5_ST_SZ_BYTES(create_tir_in);
16711f1d6abbSAriel Levkovich 	outlen = MLX5_ST_SZ_BYTES(create_tir_out);
16721f1d6abbSAriel Levkovich 	in = kvzalloc(inlen + outlen, GFP_KERNEL);
167328d61370SYishai Hadas 	if (!in)
167428d61370SYishai Hadas 		return -ENOMEM;
167528d61370SYishai Hadas 
16761f1d6abbSAriel Levkovich 	out = in + MLX5_ST_SZ_DW(create_tir_in);
1677443c1cf9SYishai Hadas 	MLX5_SET(create_tir_in, in, uid, to_mpd(pd)->uid);
167828d61370SYishai Hadas 	tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
167928d61370SYishai Hadas 	MLX5_SET(tirc, tirc, disp_type,
168028d61370SYishai Hadas 		 MLX5_TIRC_DISP_TYPE_INDIRECT);
168128d61370SYishai Hadas 	MLX5_SET(tirc, tirc, indirect_table,
168228d61370SYishai Hadas 		 init_attr->rwq_ind_tbl->ind_tbl_num);
168328d61370SYishai Hadas 	MLX5_SET(tirc, tirc, transport_domain, tdn);
168428d61370SYishai Hadas 
168528d61370SYishai Hadas 	hfso = MLX5_ADDR_OF(tirc, tirc, rx_hash_field_selector_outer);
1686f95ef6cbSMaor Gottlieb 
16875ce0592bSLeon Romanovsky 	if (ucmd->flags & MLX5_QP_FLAG_TUNNEL_OFFLOADS)
1688f95ef6cbSMaor Gottlieb 		MLX5_SET(tirc, tirc, tunneled_offload_en, 1);
1689f95ef6cbSMaor Gottlieb 
1690175edba8SMark Bloch 	MLX5_SET(tirc, tirc, self_lb_block, lb_flag);
1691175edba8SMark Bloch 
16925ce0592bSLeon Romanovsky 	if (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_INNER)
1693309fa347SMaor Gottlieb 		hfso = MLX5_ADDR_OF(tirc, tirc, rx_hash_field_selector_inner);
1694309fa347SMaor Gottlieb 	else
1695309fa347SMaor Gottlieb 		hfso = MLX5_ADDR_OF(tirc, tirc, rx_hash_field_selector_outer);
1696309fa347SMaor Gottlieb 
16975ce0592bSLeon Romanovsky 	switch (ucmd->rx_hash_function) {
169828d61370SYishai Hadas 	case MLX5_RX_HASH_FUNC_TOEPLITZ:
169928d61370SYishai Hadas 	{
170028d61370SYishai Hadas 		void *rss_key = MLX5_ADDR_OF(tirc, tirc, rx_hash_toeplitz_key);
170128d61370SYishai Hadas 		size_t len = MLX5_FLD_SZ_BYTES(tirc, rx_hash_toeplitz_key);
170228d61370SYishai Hadas 
17035ce0592bSLeon Romanovsky 		if (len != ucmd->rx_key_len) {
170428d61370SYishai Hadas 			err = -EINVAL;
170528d61370SYishai Hadas 			goto err;
170628d61370SYishai Hadas 		}
170728d61370SYishai Hadas 
170828d61370SYishai Hadas 		MLX5_SET(tirc, tirc, rx_hash_fn, MLX5_RX_HASH_FN_TOEPLITZ);
17095ce0592bSLeon Romanovsky 		memcpy(rss_key, ucmd->rx_hash_key, len);
171028d61370SYishai Hadas 		break;
171128d61370SYishai Hadas 	}
171228d61370SYishai Hadas 	default:
171328d61370SYishai Hadas 		err = -EOPNOTSUPP;
171428d61370SYishai Hadas 		goto err;
171528d61370SYishai Hadas 	}
171628d61370SYishai Hadas 
17175ce0592bSLeon Romanovsky 	if (!ucmd->rx_hash_fields_mask) {
171828d61370SYishai Hadas 		/* special case when this TIR serves as steering entry without hashing */
171928d61370SYishai Hadas 		if (!init_attr->rwq_ind_tbl->log_ind_tbl_size)
172028d61370SYishai Hadas 			goto create_tir;
172128d61370SYishai Hadas 		err = -EINVAL;
172228d61370SYishai Hadas 		goto err;
172328d61370SYishai Hadas 	}
172428d61370SYishai Hadas 
17255ce0592bSLeon Romanovsky 	if (((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV4) ||
17265ce0592bSLeon Romanovsky 	     (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV4)) &&
17275ce0592bSLeon Romanovsky 	     ((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV6) ||
17285ce0592bSLeon Romanovsky 	     (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV6))) {
172928d61370SYishai Hadas 		err = -EINVAL;
173028d61370SYishai Hadas 		goto err;
173128d61370SYishai Hadas 	}
173228d61370SYishai Hadas 
173328d61370SYishai Hadas 	/* If none of IPV4 & IPV6 SRC/DST was set - this bit field is ignored */
17345ce0592bSLeon Romanovsky 	if ((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV4) ||
17355ce0592bSLeon Romanovsky 	    (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV4))
173628d61370SYishai Hadas 		MLX5_SET(rx_hash_field_select, hfso, l3_prot_type,
173728d61370SYishai Hadas 			 MLX5_L3_PROT_TYPE_IPV4);
17385ce0592bSLeon Romanovsky 	else if ((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV6) ||
17395ce0592bSLeon Romanovsky 		 (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV6))
174028d61370SYishai Hadas 		MLX5_SET(rx_hash_field_select, hfso, l3_prot_type,
174128d61370SYishai Hadas 			 MLX5_L3_PROT_TYPE_IPV6);
174228d61370SYishai Hadas 
17435ce0592bSLeon Romanovsky 	outer_l4 = ((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_TCP) ||
17445ce0592bSLeon Romanovsky 		    (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_TCP))
17455ce0592bSLeon Romanovsky 			   << 0 |
17465ce0592bSLeon Romanovsky 		   ((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_UDP) ||
17475ce0592bSLeon Romanovsky 		    (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_UDP))
17485ce0592bSLeon Romanovsky 			   << 1 |
17495ce0592bSLeon Romanovsky 		   (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_IPSEC_SPI) << 2;
17502d93fc85SMatan Barak 
17512d93fc85SMatan Barak 	/* Check that only one l4 protocol is set */
17522d93fc85SMatan Barak 	if (outer_l4 & (outer_l4 - 1)) {
175328d61370SYishai Hadas 		err = -EINVAL;
175428d61370SYishai Hadas 		goto err;
175528d61370SYishai Hadas 	}
175628d61370SYishai Hadas 
175728d61370SYishai Hadas 	/* If none of TCP & UDP SRC/DST was set - this bit field is ignored */
17585ce0592bSLeon Romanovsky 	if ((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_TCP) ||
17595ce0592bSLeon Romanovsky 	    (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_TCP))
176028d61370SYishai Hadas 		MLX5_SET(rx_hash_field_select, hfso, l4_prot_type,
176128d61370SYishai Hadas 			 MLX5_L4_PROT_TYPE_TCP);
17625ce0592bSLeon Romanovsky 	else if ((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_UDP) ||
17635ce0592bSLeon Romanovsky 		 (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_UDP))
176428d61370SYishai Hadas 		MLX5_SET(rx_hash_field_select, hfso, l4_prot_type,
176528d61370SYishai Hadas 			 MLX5_L4_PROT_TYPE_UDP);
176628d61370SYishai Hadas 
17675ce0592bSLeon Romanovsky 	if ((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV4) ||
17685ce0592bSLeon Romanovsky 	    (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV6))
176928d61370SYishai Hadas 		selected_fields |= MLX5_HASH_FIELD_SEL_SRC_IP;
177028d61370SYishai Hadas 
17715ce0592bSLeon Romanovsky 	if ((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV4) ||
17725ce0592bSLeon Romanovsky 	    (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV6))
177328d61370SYishai Hadas 		selected_fields |= MLX5_HASH_FIELD_SEL_DST_IP;
177428d61370SYishai Hadas 
17755ce0592bSLeon Romanovsky 	if ((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_TCP) ||
17765ce0592bSLeon Romanovsky 	    (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_UDP))
177728d61370SYishai Hadas 		selected_fields |= MLX5_HASH_FIELD_SEL_L4_SPORT;
177828d61370SYishai Hadas 
17795ce0592bSLeon Romanovsky 	if ((ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_TCP) ||
17805ce0592bSLeon Romanovsky 	    (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_UDP))
178128d61370SYishai Hadas 		selected_fields |= MLX5_HASH_FIELD_SEL_L4_DPORT;
178228d61370SYishai Hadas 
17835ce0592bSLeon Romanovsky 	if (ucmd->rx_hash_fields_mask & MLX5_RX_HASH_IPSEC_SPI)
17842d93fc85SMatan Barak 		selected_fields |= MLX5_HASH_FIELD_SEL_IPSEC_SPI;
17852d93fc85SMatan Barak 
178628d61370SYishai Hadas 	MLX5_SET(rx_hash_field_select, hfso, selected_fields, selected_fields);
178728d61370SYishai Hadas 
178828d61370SYishai Hadas create_tir:
1789e0b4b472SLeon Romanovsky 	MLX5_SET(create_tir_in, in, opcode, MLX5_CMD_OP_CREATE_TIR);
1790e0b4b472SLeon Romanovsky 	err = mlx5_cmd_exec_inout(dev->mdev, create_tir, in, out);
179128d61370SYishai Hadas 
17921f1d6abbSAriel Levkovich 	qp->rss_qp.tirn = MLX5_GET(create_tir_out, out, tirn);
17930042f9e4SMark Bloch 	if (!err && MLX5_GET(tirc, tirc, self_lb_block)) {
17940042f9e4SMark Bloch 		err = mlx5_ib_enable_lb(dev, false, true);
17950042f9e4SMark Bloch 
17960042f9e4SMark Bloch 		if (err)
1797443c1cf9SYishai Hadas 			mlx5_cmd_destroy_tir(dev->mdev, qp->rss_qp.tirn,
1798443c1cf9SYishai Hadas 					     to_mpd(pd)->uid);
17990042f9e4SMark Bloch 	}
18000042f9e4SMark Bloch 
180128d61370SYishai Hadas 	if (err)
180228d61370SYishai Hadas 		goto err;
180328d61370SYishai Hadas 
18047f72052cSYishai Hadas 	if (mucontext->devx_uid) {
180508d53976SLeon Romanovsky 		params->resp.comp_mask |= MLX5_IB_CREATE_QP_RESP_MASK_TIRN;
180608d53976SLeon Romanovsky 		params->resp.tirn = qp->rss_qp.tirn;
180754a38b66SAlex Vesker 		if (MLX5_CAP_FLOWTABLE_NIC_RX(dev->mdev, sw_owner) ||
180854a38b66SAlex Vesker 		    MLX5_CAP_FLOWTABLE_NIC_RX(dev->mdev, sw_owner_v2)) {
180908d53976SLeon Romanovsky 			params->resp.tir_icm_addr =
18101f1d6abbSAriel Levkovich 				MLX5_GET(create_tir_out, out, icm_address_31_0);
181108d53976SLeon Romanovsky 			params->resp.tir_icm_addr |=
181208d53976SLeon Romanovsky 				(u64)MLX5_GET(create_tir_out, out,
18131f1d6abbSAriel Levkovich 					      icm_address_39_32)
18141f1d6abbSAriel Levkovich 				<< 32;
181508d53976SLeon Romanovsky 			params->resp.tir_icm_addr |=
181608d53976SLeon Romanovsky 				(u64)MLX5_GET(create_tir_out, out,
18171f1d6abbSAriel Levkovich 					      icm_address_63_40)
18181f1d6abbSAriel Levkovich 				<< 40;
181908d53976SLeon Romanovsky 			params->resp.comp_mask |=
18201f1d6abbSAriel Levkovich 				MLX5_IB_CREATE_QP_RESP_MASK_TIR_ICM_ADDR;
18211f1d6abbSAriel Levkovich 		}
18227f72052cSYishai Hadas 	}
18237f72052cSYishai Hadas 
182428d61370SYishai Hadas 	kvfree(in);
182528d61370SYishai Hadas 	/* qpn is reserved for that QP */
182628d61370SYishai Hadas 	qp->trans_qp.base.mqp.qpn = 0;
18272be08c30SLeon Romanovsky 	qp->is_rss = true;
182828d61370SYishai Hadas 	return 0;
182928d61370SYishai Hadas 
183028d61370SYishai Hadas err:
183128d61370SYishai Hadas 	kvfree(in);
183228d61370SYishai Hadas 	return err;
183328d61370SYishai Hadas }
183428d61370SYishai Hadas 
18355d6ff1baSYonatan Cohen static void configure_requester_scat_cqe(struct mlx5_ib_dev *dev,
183681530ab0SLeon Romanovsky 					 struct mlx5_ib_qp *qp,
18375d6ff1baSYonatan Cohen 					 struct ib_qp_init_attr *init_attr,
18385d6ff1baSYonatan Cohen 					 void *qpc)
18395d6ff1baSYonatan Cohen {
18405d6ff1baSYonatan Cohen 	int scqe_sz;
18412ab367a7Szhengbin 	bool allow_scat_cqe = false;
18425d6ff1baSYonatan Cohen 
184381530ab0SLeon Romanovsky 	allow_scat_cqe = qp->flags_en & MLX5_QP_FLAG_ALLOW_SCATTER_CQE;
18446f4bc0eaSYonatan Cohen 
18456f4bc0eaSYonatan Cohen 	if (!allow_scat_cqe && init_attr->sq_sig_type != IB_SIGNAL_ALL_WR)
18465d6ff1baSYonatan Cohen 		return;
18475d6ff1baSYonatan Cohen 
18485d6ff1baSYonatan Cohen 	scqe_sz = mlx5_ib_get_cqe_size(init_attr->send_cq);
18495d6ff1baSYonatan Cohen 	if (scqe_sz == 128) {
18505d6ff1baSYonatan Cohen 		MLX5_SET(qpc, qpc, cs_req, MLX5_REQ_SCAT_DATA64_CQE);
18515d6ff1baSYonatan Cohen 		return;
18525d6ff1baSYonatan Cohen 	}
18535d6ff1baSYonatan Cohen 
18545d6ff1baSYonatan Cohen 	if (init_attr->qp_type != MLX5_IB_QPT_DCI ||
18555d6ff1baSYonatan Cohen 	    MLX5_CAP_GEN(dev->mdev, dc_req_scat_data_cqe))
18565d6ff1baSYonatan Cohen 		MLX5_SET(qpc, qpc, cs_req, MLX5_REQ_SCAT_DATA32_CQE);
18575d6ff1baSYonatan Cohen }
18585d6ff1baSYonatan Cohen 
1859a60109dcSYonatan Cohen static int atomic_size_to_mode(int size_mask)
1860a60109dcSYonatan Cohen {
1861a60109dcSYonatan Cohen 	/* driver does not support atomic_size > 256B
1862a60109dcSYonatan Cohen 	 * and does not know how to translate bigger sizes
1863a60109dcSYonatan Cohen 	 */
1864a60109dcSYonatan Cohen 	int supported_size_mask = size_mask & 0x1ff;
1865a60109dcSYonatan Cohen 	int log_max_size;
1866a60109dcSYonatan Cohen 
1867a60109dcSYonatan Cohen 	if (!supported_size_mask)
1868a60109dcSYonatan Cohen 		return -EOPNOTSUPP;
1869a60109dcSYonatan Cohen 
1870a60109dcSYonatan Cohen 	log_max_size = __fls(supported_size_mask);
1871a60109dcSYonatan Cohen 
1872a60109dcSYonatan Cohen 	if (log_max_size > 3)
1873a60109dcSYonatan Cohen 		return log_max_size;
1874a60109dcSYonatan Cohen 
1875a60109dcSYonatan Cohen 	return MLX5_ATOMIC_MODE_8B;
1876a60109dcSYonatan Cohen }
1877a60109dcSYonatan Cohen 
1878a60109dcSYonatan Cohen static int get_atomic_mode(struct mlx5_ib_dev *dev,
1879a60109dcSYonatan Cohen 			   enum ib_qp_type qp_type)
1880a60109dcSYonatan Cohen {
1881a60109dcSYonatan Cohen 	u8 atomic_operations = MLX5_CAP_ATOMIC(dev->mdev, atomic_operations);
1882a60109dcSYonatan Cohen 	u8 atomic = MLX5_CAP_GEN(dev->mdev, atomic);
1883a60109dcSYonatan Cohen 	int atomic_mode = -EOPNOTSUPP;
1884a60109dcSYonatan Cohen 	int atomic_size_mask;
1885a60109dcSYonatan Cohen 
1886a60109dcSYonatan Cohen 	if (!atomic)
1887a60109dcSYonatan Cohen 		return -EOPNOTSUPP;
1888a60109dcSYonatan Cohen 
1889a60109dcSYonatan Cohen 	if (qp_type == MLX5_IB_QPT_DCT)
1890a60109dcSYonatan Cohen 		atomic_size_mask = MLX5_CAP_ATOMIC(dev->mdev, atomic_size_dc);
1891a60109dcSYonatan Cohen 	else
1892a60109dcSYonatan Cohen 		atomic_size_mask = MLX5_CAP_ATOMIC(dev->mdev, atomic_size_qp);
1893a60109dcSYonatan Cohen 
1894a60109dcSYonatan Cohen 	if ((atomic_operations & MLX5_ATOMIC_OPS_EXTENDED_CMP_SWAP) ||
1895a60109dcSYonatan Cohen 	    (atomic_operations & MLX5_ATOMIC_OPS_EXTENDED_FETCH_ADD))
1896a60109dcSYonatan Cohen 		atomic_mode = atomic_size_to_mode(atomic_size_mask);
1897a60109dcSYonatan Cohen 
1898a60109dcSYonatan Cohen 	if (atomic_mode <= 0 &&
1899a60109dcSYonatan Cohen 	    (atomic_operations & MLX5_ATOMIC_OPS_CMP_SWAP &&
1900a60109dcSYonatan Cohen 	     atomic_operations & MLX5_ATOMIC_OPS_FETCH_ADD))
1901a60109dcSYonatan Cohen 		atomic_mode = MLX5_ATOMIC_MODE_IB_COMP;
1902a60109dcSYonatan Cohen 
1903a60109dcSYonatan Cohen 	return atomic_mode;
1904a60109dcSYonatan Cohen }
1905a60109dcSYonatan Cohen 
1906f78d358cSLeon Romanovsky static int create_xrc_tgt_qp(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
1907f78d358cSLeon Romanovsky 			     struct mlx5_create_qp_params *params)
190804bcc1c2SLeon Romanovsky {
1909e383085cSLeon Romanovsky 	struct mlx5_ib_create_qp *ucmd = params->ucmd;
1910f78d358cSLeon Romanovsky 	struct ib_qp_init_attr *attr = params->attr;
1911f78d358cSLeon Romanovsky 	u32 uidx = params->uidx;
191204bcc1c2SLeon Romanovsky 	struct mlx5_ib_resources *devr = &dev->devr;
19133e09a427SLeon Romanovsky 	u32 out[MLX5_ST_SZ_DW(create_qp_out)] = {};
191404bcc1c2SLeon Romanovsky 	int inlen = MLX5_ST_SZ_BYTES(create_qp_in);
191504bcc1c2SLeon Romanovsky 	struct mlx5_core_dev *mdev = dev->mdev;
191604bcc1c2SLeon Romanovsky 	struct mlx5_ib_qp_base *base;
191704bcc1c2SLeon Romanovsky 	unsigned long flags;
191804bcc1c2SLeon Romanovsky 	void *qpc;
191904bcc1c2SLeon Romanovsky 	u32 *in;
192004bcc1c2SLeon Romanovsky 	int err;
192104bcc1c2SLeon Romanovsky 
192204bcc1c2SLeon Romanovsky 	if (attr->sq_sig_type == IB_SIGNAL_ALL_WR)
192304bcc1c2SLeon Romanovsky 		qp->sq_signal_bits = MLX5_WQE_CTRL_CQ_UPDATE;
192404bcc1c2SLeon Romanovsky 
192504bcc1c2SLeon Romanovsky 	in = kvzalloc(inlen, GFP_KERNEL);
192604bcc1c2SLeon Romanovsky 	if (!in)
192704bcc1c2SLeon Romanovsky 		return -ENOMEM;
192804bcc1c2SLeon Romanovsky 
19296eefa839SLeon Romanovsky 	if (MLX5_CAP_GEN(mdev, ece_support) && ucmd)
1930e383085cSLeon Romanovsky 		MLX5_SET(create_qp_in, in, ece, ucmd->ece_options);
193104bcc1c2SLeon Romanovsky 	qpc = MLX5_ADDR_OF(create_qp_in, in, qpc);
193204bcc1c2SLeon Romanovsky 
193304bcc1c2SLeon Romanovsky 	MLX5_SET(qpc, qpc, st, MLX5_QP_ST_XRC);
193404bcc1c2SLeon Romanovsky 	MLX5_SET(qpc, qpc, pm_state, MLX5_QP_PM_MIGRATED);
193504bcc1c2SLeon Romanovsky 	MLX5_SET(qpc, qpc, pd, to_mpd(devr->p0)->pdn);
193604bcc1c2SLeon Romanovsky 
193704bcc1c2SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_BLOCK_MULTICAST_LOOPBACK)
193804bcc1c2SLeon Romanovsky 		MLX5_SET(qpc, qpc, block_lb_mc, 1);
193904bcc1c2SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_CROSS_CHANNEL)
194004bcc1c2SLeon Romanovsky 		MLX5_SET(qpc, qpc, cd_master, 1);
194104bcc1c2SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_MANAGED_SEND)
194204bcc1c2SLeon Romanovsky 		MLX5_SET(qpc, qpc, cd_slave_send, 1);
194304bcc1c2SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_MANAGED_RECV)
194404bcc1c2SLeon Romanovsky 		MLX5_SET(qpc, qpc, cd_slave_receive, 1);
194504bcc1c2SLeon Romanovsky 
19468256c69bSMaor Gottlieb 	MLX5_SET(qpc, qpc, ts_format, mlx5_get_qp_default_ts(dev->mdev));
194704bcc1c2SLeon Romanovsky 	MLX5_SET(qpc, qpc, rq_type, MLX5_SRQ_RQ);
194804bcc1c2SLeon Romanovsky 	MLX5_SET(qpc, qpc, no_sq, 1);
194904bcc1c2SLeon Romanovsky 	MLX5_SET(qpc, qpc, cqn_rcv, to_mcq(devr->c0)->mcq.cqn);
195004bcc1c2SLeon Romanovsky 	MLX5_SET(qpc, qpc, cqn_snd, to_mcq(devr->c0)->mcq.cqn);
195104bcc1c2SLeon Romanovsky 	MLX5_SET(qpc, qpc, srqn_rmpn_xrqn, to_msrq(devr->s0)->msrq.srqn);
195204bcc1c2SLeon Romanovsky 	MLX5_SET(qpc, qpc, xrcd, to_mxrcd(attr->xrcd)->xrcdn);
195304bcc1c2SLeon Romanovsky 	MLX5_SET64(qpc, qpc, dbr_addr, qp->db.dma);
195404bcc1c2SLeon Romanovsky 
195504bcc1c2SLeon Romanovsky 	/* 0xffffff means we ask to work with cqe version 0 */
195604bcc1c2SLeon Romanovsky 	if (MLX5_CAP_GEN(mdev, cqe_version) == MLX5_CQE_VERSION_V1)
195704bcc1c2SLeon Romanovsky 		MLX5_SET(qpc, qpc, user_index, uidx);
195804bcc1c2SLeon Romanovsky 
195904bcc1c2SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_PCI_WRITE_END_PADDING) {
196004bcc1c2SLeon Romanovsky 		MLX5_SET(qpc, qpc, end_padding_mode,
196104bcc1c2SLeon Romanovsky 			 MLX5_WQ_END_PAD_MODE_ALIGN);
196204bcc1c2SLeon Romanovsky 		/* Special case to clean flag */
196304bcc1c2SLeon Romanovsky 		qp->flags &= ~IB_QP_CREATE_PCI_WRITE_END_PADDING;
196404bcc1c2SLeon Romanovsky 	}
196504bcc1c2SLeon Romanovsky 
196604bcc1c2SLeon Romanovsky 	base = &qp->trans_qp.base;
19673e09a427SLeon Romanovsky 	err = mlx5_qpc_create_qp(dev, &base->mqp, in, inlen, out);
196804bcc1c2SLeon Romanovsky 	kvfree(in);
19696367da46SLeon Romanovsky 	if (err)
197004bcc1c2SLeon Romanovsky 		return err;
197104bcc1c2SLeon Romanovsky 
197204bcc1c2SLeon Romanovsky 	base->container_mibqp = qp;
197304bcc1c2SLeon Romanovsky 	base->mqp.event = mlx5_ib_qp_event;
197492cd667cSLeon Romanovsky 	if (MLX5_CAP_GEN(mdev, ece_support))
19753e09a427SLeon Romanovsky 		params->resp.ece_options = MLX5_GET(create_qp_out, out, ece);
197604bcc1c2SLeon Romanovsky 
197704bcc1c2SLeon Romanovsky 	spin_lock_irqsave(&dev->reset_flow_resource_lock, flags);
197804bcc1c2SLeon Romanovsky 	list_add_tail(&qp->qps_list, &dev->qp_list);
197904bcc1c2SLeon Romanovsky 	spin_unlock_irqrestore(&dev->reset_flow_resource_lock, flags);
198004bcc1c2SLeon Romanovsky 
1981968f0b6fSLeon Romanovsky 	qp->trans_qp.xrcdn = to_mxrcd(attr->xrcd)->xrcdn;
198204bcc1c2SLeon Romanovsky 	return 0;
198304bcc1c2SLeon Romanovsky }
198404bcc1c2SLeon Romanovsky 
19852013b4d5SLior Nahmanson static int create_dci(struct mlx5_ib_dev *dev, struct ib_pd *pd,
19862013b4d5SLior Nahmanson 		      struct mlx5_ib_qp *qp,
19872013b4d5SLior Nahmanson 		      struct mlx5_create_qp_params *params)
19882013b4d5SLior Nahmanson {
19892013b4d5SLior Nahmanson 	struct ib_qp_init_attr *init_attr = params->attr;
19902013b4d5SLior Nahmanson 	struct mlx5_ib_create_qp *ucmd = params->ucmd;
19912013b4d5SLior Nahmanson 	u32 out[MLX5_ST_SZ_DW(create_qp_out)] = {};
19922013b4d5SLior Nahmanson 	struct ib_udata *udata = params->udata;
19932013b4d5SLior Nahmanson 	u32 uidx = params->uidx;
19942013b4d5SLior Nahmanson 	struct mlx5_ib_resources *devr = &dev->devr;
19952013b4d5SLior Nahmanson 	int inlen = MLX5_ST_SZ_BYTES(create_qp_in);
19962013b4d5SLior Nahmanson 	struct mlx5_core_dev *mdev = dev->mdev;
19972013b4d5SLior Nahmanson 	struct mlx5_ib_cq *send_cq;
19982013b4d5SLior Nahmanson 	struct mlx5_ib_cq *recv_cq;
19992013b4d5SLior Nahmanson 	unsigned long flags;
20002013b4d5SLior Nahmanson 	struct mlx5_ib_qp_base *base;
20012013b4d5SLior Nahmanson 	int ts_format;
20022013b4d5SLior Nahmanson 	int mlx5_st;
20032013b4d5SLior Nahmanson 	void *qpc;
20042013b4d5SLior Nahmanson 	u32 *in;
20052013b4d5SLior Nahmanson 	int err;
20062013b4d5SLior Nahmanson 
20072013b4d5SLior Nahmanson 	spin_lock_init(&qp->sq.lock);
20082013b4d5SLior Nahmanson 	spin_lock_init(&qp->rq.lock);
20092013b4d5SLior Nahmanson 
20102013b4d5SLior Nahmanson 	mlx5_st = to_mlx5_st(qp->type);
20112013b4d5SLior Nahmanson 	if (mlx5_st < 0)
20122013b4d5SLior Nahmanson 		return -EINVAL;
20132013b4d5SLior Nahmanson 
20142013b4d5SLior Nahmanson 	if (init_attr->sq_sig_type == IB_SIGNAL_ALL_WR)
20152013b4d5SLior Nahmanson 		qp->sq_signal_bits = MLX5_WQE_CTRL_CQ_UPDATE;
20162013b4d5SLior Nahmanson 
20172013b4d5SLior Nahmanson 	base = &qp->trans_qp.base;
20182013b4d5SLior Nahmanson 
20192013b4d5SLior Nahmanson 	qp->has_rq = qp_has_rq(init_attr);
20202013b4d5SLior Nahmanson 	err = set_rq_size(dev, &init_attr->cap, qp->has_rq, qp, ucmd);
20212013b4d5SLior Nahmanson 	if (err) {
20222013b4d5SLior Nahmanson 		mlx5_ib_dbg(dev, "err %d\n", err);
20232013b4d5SLior Nahmanson 		return err;
20242013b4d5SLior Nahmanson 	}
20252013b4d5SLior Nahmanson 
20262013b4d5SLior Nahmanson 	if (ucmd->rq_wqe_shift != qp->rq.wqe_shift ||
20272013b4d5SLior Nahmanson 	    ucmd->rq_wqe_count != qp->rq.wqe_cnt)
20282013b4d5SLior Nahmanson 		return -EINVAL;
20292013b4d5SLior Nahmanson 
20302013b4d5SLior Nahmanson 	if (ucmd->sq_wqe_count > (1 << MLX5_CAP_GEN(mdev, log_max_qp_sz)))
20312013b4d5SLior Nahmanson 		return -EINVAL;
20322013b4d5SLior Nahmanson 
20332013b4d5SLior Nahmanson 	ts_format = get_qp_ts_format(dev, to_mcq(init_attr->send_cq),
20342013b4d5SLior Nahmanson 				     to_mcq(init_attr->recv_cq));
20352013b4d5SLior Nahmanson 
20362013b4d5SLior Nahmanson 	if (ts_format < 0)
20372013b4d5SLior Nahmanson 		return ts_format;
20382013b4d5SLior Nahmanson 
20392013b4d5SLior Nahmanson 	err = _create_user_qp(dev, pd, qp, udata, init_attr, &in, &params->resp,
20402013b4d5SLior Nahmanson 			      &inlen, base, ucmd);
20412013b4d5SLior Nahmanson 	if (err)
20422013b4d5SLior Nahmanson 		return err;
20432013b4d5SLior Nahmanson 
20442013b4d5SLior Nahmanson 	if (MLX5_CAP_GEN(mdev, ece_support))
20452013b4d5SLior Nahmanson 		MLX5_SET(create_qp_in, in, ece, ucmd->ece_options);
20462013b4d5SLior Nahmanson 	qpc = MLX5_ADDR_OF(create_qp_in, in, qpc);
20472013b4d5SLior Nahmanson 
20482013b4d5SLior Nahmanson 	MLX5_SET(qpc, qpc, st, mlx5_st);
20492013b4d5SLior Nahmanson 	MLX5_SET(qpc, qpc, pm_state, MLX5_QP_PM_MIGRATED);
20502013b4d5SLior Nahmanson 	MLX5_SET(qpc, qpc, pd, to_mpd(pd)->pdn);
20512013b4d5SLior Nahmanson 
20522013b4d5SLior Nahmanson 	if (qp->flags_en & MLX5_QP_FLAG_SIGNATURE)
20532013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, wq_signature, 1);
20542013b4d5SLior Nahmanson 
20552013b4d5SLior Nahmanson 	if (qp->flags & IB_QP_CREATE_CROSS_CHANNEL)
20562013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, cd_master, 1);
20572013b4d5SLior Nahmanson 	if (qp->flags & IB_QP_CREATE_MANAGED_SEND)
20582013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, cd_slave_send, 1);
20592013b4d5SLior Nahmanson 	if (qp->flags_en & MLX5_QP_FLAG_SCATTER_CQE)
20602013b4d5SLior Nahmanson 		configure_requester_scat_cqe(dev, qp, init_attr, qpc);
20612013b4d5SLior Nahmanson 
20622013b4d5SLior Nahmanson 	if (qp->rq.wqe_cnt) {
20632013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, log_rq_stride, qp->rq.wqe_shift - 4);
20642013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, log_rq_size, ilog2(qp->rq.wqe_cnt));
20652013b4d5SLior Nahmanson 	}
20662013b4d5SLior Nahmanson 
206711656f59SLior Nahmanson 	if (qp->flags_en & MLX5_QP_FLAG_DCI_STREAM) {
206811656f59SLior Nahmanson 		MLX5_SET(qpc, qpc, log_num_dci_stream_channels,
206911656f59SLior Nahmanson 			 ucmd->dci_streams.log_num_concurent);
207011656f59SLior Nahmanson 		MLX5_SET(qpc, qpc, log_num_dci_errored_streams,
207111656f59SLior Nahmanson 			 ucmd->dci_streams.log_num_errored);
207211656f59SLior Nahmanson 	}
207311656f59SLior Nahmanson 
20742013b4d5SLior Nahmanson 	MLX5_SET(qpc, qpc, ts_format, ts_format);
20752013b4d5SLior Nahmanson 	MLX5_SET(qpc, qpc, rq_type, get_rx_type(qp, init_attr));
20762013b4d5SLior Nahmanson 
20772013b4d5SLior Nahmanson 	MLX5_SET(qpc, qpc, log_sq_size, ilog2(qp->sq.wqe_cnt));
20782013b4d5SLior Nahmanson 
20792013b4d5SLior Nahmanson 	/* Set default resources */
20802013b4d5SLior Nahmanson 	if (init_attr->srq) {
20812013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, xrcd, devr->xrcdn0);
20822013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, srqn_rmpn_xrqn,
20832013b4d5SLior Nahmanson 			 to_msrq(init_attr->srq)->msrq.srqn);
20842013b4d5SLior Nahmanson 	} else {
20852013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, xrcd, devr->xrcdn1);
20862013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, srqn_rmpn_xrqn,
20872013b4d5SLior Nahmanson 			 to_msrq(devr->s1)->msrq.srqn);
20882013b4d5SLior Nahmanson 	}
20892013b4d5SLior Nahmanson 
20902013b4d5SLior Nahmanson 	if (init_attr->send_cq)
20912013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, cqn_snd,
20922013b4d5SLior Nahmanson 			 to_mcq(init_attr->send_cq)->mcq.cqn);
20932013b4d5SLior Nahmanson 
20942013b4d5SLior Nahmanson 	if (init_attr->recv_cq)
20952013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, cqn_rcv,
20962013b4d5SLior Nahmanson 			 to_mcq(init_attr->recv_cq)->mcq.cqn);
20972013b4d5SLior Nahmanson 
20982013b4d5SLior Nahmanson 	MLX5_SET64(qpc, qpc, dbr_addr, qp->db.dma);
20992013b4d5SLior Nahmanson 
21002013b4d5SLior Nahmanson 	/* 0xffffff means we ask to work with cqe version 0 */
21012013b4d5SLior Nahmanson 	if (MLX5_CAP_GEN(mdev, cqe_version) == MLX5_CQE_VERSION_V1)
21022013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, user_index, uidx);
21032013b4d5SLior Nahmanson 
21042013b4d5SLior Nahmanson 	if (qp->flags & IB_QP_CREATE_PCI_WRITE_END_PADDING) {
21052013b4d5SLior Nahmanson 		MLX5_SET(qpc, qpc, end_padding_mode,
21062013b4d5SLior Nahmanson 			 MLX5_WQ_END_PAD_MODE_ALIGN);
21072013b4d5SLior Nahmanson 		/* Special case to clean flag */
21082013b4d5SLior Nahmanson 		qp->flags &= ~IB_QP_CREATE_PCI_WRITE_END_PADDING;
21092013b4d5SLior Nahmanson 	}
21102013b4d5SLior Nahmanson 
21112013b4d5SLior Nahmanson 	err = mlx5_qpc_create_qp(dev, &base->mqp, in, inlen, out);
21122013b4d5SLior Nahmanson 
21132013b4d5SLior Nahmanson 	kvfree(in);
21142013b4d5SLior Nahmanson 	if (err)
21152013b4d5SLior Nahmanson 		goto err_create;
21162013b4d5SLior Nahmanson 
21172013b4d5SLior Nahmanson 	base->container_mibqp = qp;
21182013b4d5SLior Nahmanson 	base->mqp.event = mlx5_ib_qp_event;
21192013b4d5SLior Nahmanson 	if (MLX5_CAP_GEN(mdev, ece_support))
21202013b4d5SLior Nahmanson 		params->resp.ece_options = MLX5_GET(create_qp_out, out, ece);
21212013b4d5SLior Nahmanson 
21222013b4d5SLior Nahmanson 	get_cqs(qp->type, init_attr->send_cq, init_attr->recv_cq,
21232013b4d5SLior Nahmanson 		&send_cq, &recv_cq);
21242013b4d5SLior Nahmanson 	spin_lock_irqsave(&dev->reset_flow_resource_lock, flags);
21252013b4d5SLior Nahmanson 	mlx5_ib_lock_cqs(send_cq, recv_cq);
21262013b4d5SLior Nahmanson 	/* Maintain device to QPs access, needed for further handling via reset
21272013b4d5SLior Nahmanson 	 * flow
21282013b4d5SLior Nahmanson 	 */
21292013b4d5SLior Nahmanson 	list_add_tail(&qp->qps_list, &dev->qp_list);
21302013b4d5SLior Nahmanson 	/* Maintain CQ to QPs access, needed for further handling via reset flow
21312013b4d5SLior Nahmanson 	 */
21322013b4d5SLior Nahmanson 	if (send_cq)
21332013b4d5SLior Nahmanson 		list_add_tail(&qp->cq_send_list, &send_cq->list_send_qp);
21342013b4d5SLior Nahmanson 	if (recv_cq)
21352013b4d5SLior Nahmanson 		list_add_tail(&qp->cq_recv_list, &recv_cq->list_recv_qp);
21362013b4d5SLior Nahmanson 	mlx5_ib_unlock_cqs(send_cq, recv_cq);
21372013b4d5SLior Nahmanson 	spin_unlock_irqrestore(&dev->reset_flow_resource_lock, flags);
21382013b4d5SLior Nahmanson 
21392013b4d5SLior Nahmanson 	return 0;
21402013b4d5SLior Nahmanson 
21412013b4d5SLior Nahmanson err_create:
21422013b4d5SLior Nahmanson 	destroy_qp(dev, qp, base, udata);
21432013b4d5SLior Nahmanson 	return err;
21442013b4d5SLior Nahmanson }
21452013b4d5SLior Nahmanson 
214698fc1126SLeon Romanovsky static int create_user_qp(struct mlx5_ib_dev *dev, struct ib_pd *pd,
2147f78d358cSLeon Romanovsky 			  struct mlx5_ib_qp *qp,
2148f78d358cSLeon Romanovsky 			  struct mlx5_create_qp_params *params)
2149e126ba97SEli Cohen {
2150f78d358cSLeon Romanovsky 	struct ib_qp_init_attr *init_attr = params->attr;
2151f78d358cSLeon Romanovsky 	struct mlx5_ib_create_qp *ucmd = params->ucmd;
21523e09a427SLeon Romanovsky 	u32 out[MLX5_ST_SZ_DW(create_qp_out)] = {};
2153f78d358cSLeon Romanovsky 	struct ib_udata *udata = params->udata;
2154f78d358cSLeon Romanovsky 	u32 uidx = params->uidx;
2155e126ba97SEli Cohen 	struct mlx5_ib_resources *devr = &dev->devr;
215609a7d9ecSSaeed Mahameed 	int inlen = MLX5_ST_SZ_BYTES(create_qp_in);
2157938fe83cSSaeed Mahameed 	struct mlx5_core_dev *mdev = dev->mdev;
215889ea94a7SMaor Gottlieb 	struct mlx5_ib_cq *send_cq;
215989ea94a7SMaor Gottlieb 	struct mlx5_ib_cq *recv_cq;
216089ea94a7SMaor Gottlieb 	unsigned long flags;
216109a7d9ecSSaeed Mahameed 	struct mlx5_ib_qp_base *base;
21622fe8d4b8SAharon Landau 	int ts_format;
2163e7b169f3SNoa Osherovich 	int mlx5_st;
2164cfb5e088SHaggai Abramovsky 	void *qpc;
216509a7d9ecSSaeed Mahameed 	u32 *in;
216609a7d9ecSSaeed Mahameed 	int err;
2167e126ba97SEli Cohen 
2168e126ba97SEli Cohen 	spin_lock_init(&qp->sq.lock);
2169e126ba97SEli Cohen 	spin_lock_init(&qp->rq.lock);
2170e126ba97SEli Cohen 
21717aede1a2SLeon Romanovsky 	mlx5_st = to_mlx5_st(qp->type);
2172e7b169f3SNoa Osherovich 	if (mlx5_st < 0)
2173e7b169f3SNoa Osherovich 		return -EINVAL;
2174e7b169f3SNoa Osherovich 
2175e126ba97SEli Cohen 	if (init_attr->sq_sig_type == IB_SIGNAL_ALL_WR)
2176e126ba97SEli Cohen 		qp->sq_signal_bits = MLX5_WQE_CTRL_CQ_UPDATE;
2177e126ba97SEli Cohen 
21782978975cSLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_SOURCE_QPN)
21792978975cSLeon Romanovsky 		qp->underlay_qpn = init_attr->source_qpn;
21802978975cSLeon Romanovsky 
2181c2e53b2cSYishai Hadas 	base = (init_attr->qp_type == IB_QPT_RAW_PACKET ||
21822be08c30SLeon Romanovsky 		qp->flags & IB_QP_CREATE_SOURCE_QPN) ?
2183c2e53b2cSYishai Hadas 	       &qp->raw_packet_qp.rq.base :
2184c2e53b2cSYishai Hadas 	       &qp->trans_qp.base;
2185c2e53b2cSYishai Hadas 
2186e126ba97SEli Cohen 	qp->has_rq = qp_has_rq(init_attr);
21872dfac92dSLeon Romanovsky 	err = set_rq_size(dev, &init_attr->cap, qp->has_rq, qp, ucmd);
2188e126ba97SEli Cohen 	if (err) {
2189e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "err %d\n", err);
2190e126ba97SEli Cohen 		return err;
2191e126ba97SEli Cohen 	}
2192e126ba97SEli Cohen 
21932dfac92dSLeon Romanovsky 	if (ucmd->rq_wqe_shift != qp->rq.wqe_shift ||
219498fc1126SLeon Romanovsky 	    ucmd->rq_wqe_count != qp->rq.wqe_cnt)
2195e126ba97SEli Cohen 		return -EINVAL;
2196e126ba97SEli Cohen 
219798fc1126SLeon Romanovsky 	if (ucmd->sq_wqe_count > (1 << MLX5_CAP_GEN(mdev, log_max_qp_sz)))
219898fc1126SLeon Romanovsky 		return -EINVAL;
219998fc1126SLeon Romanovsky 
22002fe8d4b8SAharon Landau 	if (init_attr->qp_type != IB_QPT_RAW_PACKET) {
22012fe8d4b8SAharon Landau 		ts_format = get_qp_ts_format(dev, to_mcq(init_attr->send_cq),
22022fe8d4b8SAharon Landau 					     to_mcq(init_attr->recv_cq));
22032fe8d4b8SAharon Landau 		if (ts_format < 0)
22042fe8d4b8SAharon Landau 			return ts_format;
22052fe8d4b8SAharon Landau 	}
22062fe8d4b8SAharon Landau 
220708d53976SLeon Romanovsky 	err = _create_user_qp(dev, pd, qp, udata, init_attr, &in, &params->resp,
220808d53976SLeon Romanovsky 			      &inlen, base, ucmd);
2209e126ba97SEli Cohen 	if (err)
2210e126ba97SEli Cohen 		return err;
2211e126ba97SEli Cohen 
2212e126ba97SEli Cohen 	if (is_sqp(init_attr->qp_type))
2213e126ba97SEli Cohen 		qp->port = init_attr->port_num;
2214e126ba97SEli Cohen 
2215e383085cSLeon Romanovsky 	if (MLX5_CAP_GEN(mdev, ece_support))
2216e383085cSLeon Romanovsky 		MLX5_SET(create_qp_in, in, ece, ucmd->ece_options);
221709a7d9ecSSaeed Mahameed 	qpc = MLX5_ADDR_OF(create_qp_in, in, qpc);
221809a7d9ecSSaeed Mahameed 
2219e7b169f3SNoa Osherovich 	MLX5_SET(qpc, qpc, st, mlx5_st);
222009a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, pm_state, MLX5_QP_PM_MIGRATED);
222198fc1126SLeon Romanovsky 	MLX5_SET(qpc, qpc, pd, to_mpd(pd)->pdn);
2222e126ba97SEli Cohen 
2223c95e6d53SLeon Romanovsky 	if (qp->flags_en & MLX5_QP_FLAG_SIGNATURE)
222409a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, wq_signature, 1);
2225e126ba97SEli Cohen 
22262be08c30SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_BLOCK_MULTICAST_LOOPBACK)
222709a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, block_lb_mc, 1);
2228f360d88aSEli Cohen 
22292be08c30SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_CROSS_CHANNEL)
223009a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cd_master, 1);
22312be08c30SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_MANAGED_SEND)
223209a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cd_slave_send, 1);
22332be08c30SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_MANAGED_RECV)
223409a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cd_slave_receive, 1);
22352be08c30SLeon Romanovsky 	if (qp->flags_en & MLX5_QP_FLAG_PACKET_BASED_CREDIT_MODE)
2236569c6651SDanit Goldberg 		MLX5_SET(qpc, qpc, req_e2e_credit_mode, 1);
223790ecb37aSLeon Romanovsky 	if ((qp->flags_en & MLX5_QP_FLAG_SCATTER_CQE) &&
223890ecb37aSLeon Romanovsky 	    (init_attr->qp_type == IB_QPT_RC ||
22398bde2c50SLeon Romanovsky 	     init_attr->qp_type == IB_QPT_UC)) {
224052c81f47SColin Ian King 		int rcqe_sz = mlx5_ib_get_cqe_size(init_attr->recv_cq);
22418bde2c50SLeon Romanovsky 
22428bde2c50SLeon Romanovsky 		MLX5_SET(qpc, qpc, cs_res,
22438bde2c50SLeon Romanovsky 			 rcqe_sz == 128 ? MLX5_RES_SCAT_DATA64_CQE :
22448bde2c50SLeon Romanovsky 					  MLX5_RES_SCAT_DATA32_CQE);
22458bde2c50SLeon Romanovsky 	}
224690ecb37aSLeon Romanovsky 	if ((qp->flags_en & MLX5_QP_FLAG_SCATTER_CQE) &&
22477aede1a2SLeon Romanovsky 	    (qp->type == MLX5_IB_QPT_DCI || qp->type == IB_QPT_RC))
224881530ab0SLeon Romanovsky 		configure_requester_scat_cqe(dev, qp, init_attr, qpc);
2249e126ba97SEli Cohen 
2250e126ba97SEli Cohen 	if (qp->rq.wqe_cnt) {
225109a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, log_rq_stride, qp->rq.wqe_shift - 4);
225209a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, log_rq_size, ilog2(qp->rq.wqe_cnt));
2253e126ba97SEli Cohen 	}
2254e126ba97SEli Cohen 
22552fe8d4b8SAharon Landau 	if (init_attr->qp_type != IB_QPT_RAW_PACKET)
22562fe8d4b8SAharon Landau 		MLX5_SET(qpc, qpc, ts_format, ts_format);
22572fe8d4b8SAharon Landau 
225809a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, rq_type, get_rx_type(qp, init_attr));
2259e126ba97SEli Cohen 
22603fd3307eSArtemy Kovalyov 	if (qp->sq.wqe_cnt) {
226109a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, log_sq_size, ilog2(qp->sq.wqe_cnt));
22623fd3307eSArtemy Kovalyov 	} else {
226309a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, no_sq, 1);
22643fd3307eSArtemy Kovalyov 		if (init_attr->srq &&
22653fd3307eSArtemy Kovalyov 		    init_attr->srq->srq_type == IB_SRQT_TM)
22663fd3307eSArtemy Kovalyov 			MLX5_SET(qpc, qpc, offload_type,
22673fd3307eSArtemy Kovalyov 				 MLX5_QPC_OFFLOAD_TYPE_RNDV);
22683fd3307eSArtemy Kovalyov 	}
2269e126ba97SEli Cohen 
2270e126ba97SEli Cohen 	/* Set default resources */
2271e126ba97SEli Cohen 	switch (init_attr->qp_type) {
2272e126ba97SEli Cohen 	case IB_QPT_XRC_INI:
227309a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cqn_rcv, to_mcq(devr->c0)->mcq.cqn);
2274f4375443SLeon Romanovsky 		MLX5_SET(qpc, qpc, xrcd, devr->xrcdn1);
227509a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, srqn_rmpn_xrqn, to_msrq(devr->s0)->msrq.srqn);
2276e126ba97SEli Cohen 		break;
2277e126ba97SEli Cohen 	default:
2278e126ba97SEli Cohen 		if (init_attr->srq) {
2279f4375443SLeon Romanovsky 			MLX5_SET(qpc, qpc, xrcd, devr->xrcdn0);
228009a7d9ecSSaeed Mahameed 			MLX5_SET(qpc, qpc, srqn_rmpn_xrqn, to_msrq(init_attr->srq)->msrq.srqn);
2281e126ba97SEli Cohen 		} else {
2282f4375443SLeon Romanovsky 			MLX5_SET(qpc, qpc, xrcd, devr->xrcdn1);
228309a7d9ecSSaeed Mahameed 			MLX5_SET(qpc, qpc, srqn_rmpn_xrqn, to_msrq(devr->s1)->msrq.srqn);
2284e126ba97SEli Cohen 		}
2285e126ba97SEli Cohen 	}
2286e126ba97SEli Cohen 
2287e126ba97SEli Cohen 	if (init_attr->send_cq)
228809a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cqn_snd, to_mcq(init_attr->send_cq)->mcq.cqn);
2289e126ba97SEli Cohen 
2290e126ba97SEli Cohen 	if (init_attr->recv_cq)
229109a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cqn_rcv, to_mcq(init_attr->recv_cq)->mcq.cqn);
2292e126ba97SEli Cohen 
229309a7d9ecSSaeed Mahameed 	MLX5_SET64(qpc, qpc, dbr_addr, qp->db.dma);
2294e126ba97SEli Cohen 
2295cfb5e088SHaggai Abramovsky 	/* 0xffffff means we ask to work with cqe version 0 */
229609a7d9ecSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, cqe_version) == MLX5_CQE_VERSION_V1)
2297cfb5e088SHaggai Abramovsky 		MLX5_SET(qpc, qpc, user_index, uidx);
229809a7d9ecSSaeed Mahameed 
22992978975cSLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_PCI_WRITE_END_PADDING &&
23002978975cSLeon Romanovsky 	    init_attr->qp_type != IB_QPT_RAW_PACKET) {
2301b1383aa6SNoa Osherovich 		MLX5_SET(qpc, qpc, end_padding_mode,
2302b1383aa6SNoa Osherovich 			 MLX5_WQ_END_PAD_MODE_ALIGN);
23032978975cSLeon Romanovsky 		/* Special case to clean flag */
23042978975cSLeon Romanovsky 		qp->flags &= ~IB_QP_CREATE_PCI_WRITE_END_PADDING;
2305b1383aa6SNoa Osherovich 	}
2306b1383aa6SNoa Osherovich 
2307c2e53b2cSYishai Hadas 	if (init_attr->qp_type == IB_QPT_RAW_PACKET ||
23082be08c30SLeon Romanovsky 	    qp->flags & IB_QP_CREATE_SOURCE_QPN) {
23092dfac92dSLeon Romanovsky 		qp->raw_packet_qp.sq.ubuffer.buf_addr = ucmd->sq_buf_addr;
23100fb2ed66Smajd@mellanox.com 		raw_packet_qp_copy_info(qp, &qp->raw_packet_qp);
23117f72052cSYishai Hadas 		err = create_raw_packet_qp(dev, qp, in, inlen, pd, udata,
23122fe8d4b8SAharon Landau 					   &params->resp, init_attr);
231304bcc1c2SLeon Romanovsky 	} else
23143e09a427SLeon Romanovsky 		err = mlx5_qpc_create_qp(dev, &base->mqp, in, inlen, out);
2315e126ba97SEli Cohen 
2316479163f4SAl Viro 	kvfree(in);
231704bcc1c2SLeon Romanovsky 	if (err)
231804bcc1c2SLeon Romanovsky 		goto err_create;
2319e126ba97SEli Cohen 
232019098df2Smajd@mellanox.com 	base->container_mibqp = qp;
232119098df2Smajd@mellanox.com 	base->mqp.event = mlx5_ib_qp_event;
232292cd667cSLeon Romanovsky 	if (MLX5_CAP_GEN(mdev, ece_support))
23233e09a427SLeon Romanovsky 		params->resp.ece_options = MLX5_GET(create_qp_out, out, ece);
2324e126ba97SEli Cohen 
23257aede1a2SLeon Romanovsky 	get_cqs(qp->type, init_attr->send_cq, init_attr->recv_cq,
232689ea94a7SMaor Gottlieb 		&send_cq, &recv_cq);
232789ea94a7SMaor Gottlieb 	spin_lock_irqsave(&dev->reset_flow_resource_lock, flags);
232889ea94a7SMaor Gottlieb 	mlx5_ib_lock_cqs(send_cq, recv_cq);
232989ea94a7SMaor Gottlieb 	/* Maintain device to QPs access, needed for further handling via reset
233089ea94a7SMaor Gottlieb 	 * flow
233189ea94a7SMaor Gottlieb 	 */
233289ea94a7SMaor Gottlieb 	list_add_tail(&qp->qps_list, &dev->qp_list);
233389ea94a7SMaor Gottlieb 	/* Maintain CQ to QPs access, needed for further handling via reset flow
233489ea94a7SMaor Gottlieb 	 */
233589ea94a7SMaor Gottlieb 	if (send_cq)
233689ea94a7SMaor Gottlieb 		list_add_tail(&qp->cq_send_list, &send_cq->list_send_qp);
233789ea94a7SMaor Gottlieb 	if (recv_cq)
233889ea94a7SMaor Gottlieb 		list_add_tail(&qp->cq_recv_list, &recv_cq->list_recv_qp);
233989ea94a7SMaor Gottlieb 	mlx5_ib_unlock_cqs(send_cq, recv_cq);
234089ea94a7SMaor Gottlieb 	spin_unlock_irqrestore(&dev->reset_flow_resource_lock, flags);
234189ea94a7SMaor Gottlieb 
2342e126ba97SEli Cohen 	return 0;
2343e126ba97SEli Cohen 
2344e126ba97SEli Cohen err_create:
2345747c519cSLeon Romanovsky 	destroy_qp(dev, qp, base, udata);
2346e126ba97SEli Cohen 	return err;
2347e126ba97SEli Cohen }
2348e126ba97SEli Cohen 
234998fc1126SLeon Romanovsky static int create_kernel_qp(struct mlx5_ib_dev *dev, struct ib_pd *pd,
2350f78d358cSLeon Romanovsky 			    struct mlx5_ib_qp *qp,
2351f78d358cSLeon Romanovsky 			    struct mlx5_create_qp_params *params)
235298fc1126SLeon Romanovsky {
2353f78d358cSLeon Romanovsky 	struct ib_qp_init_attr *attr = params->attr;
2354f78d358cSLeon Romanovsky 	u32 uidx = params->uidx;
235598fc1126SLeon Romanovsky 	struct mlx5_ib_resources *devr = &dev->devr;
23563e09a427SLeon Romanovsky 	u32 out[MLX5_ST_SZ_DW(create_qp_out)] = {};
235798fc1126SLeon Romanovsky 	int inlen = MLX5_ST_SZ_BYTES(create_qp_in);
235898fc1126SLeon Romanovsky 	struct mlx5_core_dev *mdev = dev->mdev;
235998fc1126SLeon Romanovsky 	struct mlx5_ib_cq *send_cq;
236098fc1126SLeon Romanovsky 	struct mlx5_ib_cq *recv_cq;
236198fc1126SLeon Romanovsky 	unsigned long flags;
236298fc1126SLeon Romanovsky 	struct mlx5_ib_qp_base *base;
236398fc1126SLeon Romanovsky 	int mlx5_st;
236498fc1126SLeon Romanovsky 	void *qpc;
236598fc1126SLeon Romanovsky 	u32 *in;
236698fc1126SLeon Romanovsky 	int err;
236798fc1126SLeon Romanovsky 
236898fc1126SLeon Romanovsky 	spin_lock_init(&qp->sq.lock);
236998fc1126SLeon Romanovsky 	spin_lock_init(&qp->rq.lock);
237098fc1126SLeon Romanovsky 
237198fc1126SLeon Romanovsky 	mlx5_st = to_mlx5_st(qp->type);
237298fc1126SLeon Romanovsky 	if (mlx5_st < 0)
237398fc1126SLeon Romanovsky 		return -EINVAL;
237498fc1126SLeon Romanovsky 
237598fc1126SLeon Romanovsky 	if (attr->sq_sig_type == IB_SIGNAL_ALL_WR)
237698fc1126SLeon Romanovsky 		qp->sq_signal_bits = MLX5_WQE_CTRL_CQ_UPDATE;
237798fc1126SLeon Romanovsky 
237898fc1126SLeon Romanovsky 	base = &qp->trans_qp.base;
237998fc1126SLeon Romanovsky 
238098fc1126SLeon Romanovsky 	qp->has_rq = qp_has_rq(attr);
238198fc1126SLeon Romanovsky 	err = set_rq_size(dev, &attr->cap, qp->has_rq, qp, NULL);
238298fc1126SLeon Romanovsky 	if (err) {
238398fc1126SLeon Romanovsky 		mlx5_ib_dbg(dev, "err %d\n", err);
238498fc1126SLeon Romanovsky 		return err;
238598fc1126SLeon Romanovsky 	}
238698fc1126SLeon Romanovsky 
238798fc1126SLeon Romanovsky 	err = _create_kernel_qp(dev, attr, qp, &in, &inlen, base);
238898fc1126SLeon Romanovsky 	if (err)
238998fc1126SLeon Romanovsky 		return err;
239098fc1126SLeon Romanovsky 
239198fc1126SLeon Romanovsky 	if (is_sqp(attr->qp_type))
239298fc1126SLeon Romanovsky 		qp->port = attr->port_num;
239398fc1126SLeon Romanovsky 
239498fc1126SLeon Romanovsky 	qpc = MLX5_ADDR_OF(create_qp_in, in, qpc);
239598fc1126SLeon Romanovsky 
239698fc1126SLeon Romanovsky 	MLX5_SET(qpc, qpc, st, mlx5_st);
239798fc1126SLeon Romanovsky 	MLX5_SET(qpc, qpc, pm_state, MLX5_QP_PM_MIGRATED);
239898fc1126SLeon Romanovsky 
239998fc1126SLeon Romanovsky 	if (attr->qp_type != MLX5_IB_QPT_REG_UMR)
240098fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, pd, to_mpd(pd ? pd : devr->p0)->pdn);
240198fc1126SLeon Romanovsky 	else
240298fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, latency_sensitive, 1);
240398fc1126SLeon Romanovsky 
240498fc1126SLeon Romanovsky 
240598fc1126SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_BLOCK_MULTICAST_LOOPBACK)
240698fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, block_lb_mc, 1);
240798fc1126SLeon Romanovsky 
240898fc1126SLeon Romanovsky 	if (qp->rq.wqe_cnt) {
240998fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, log_rq_stride, qp->rq.wqe_shift - 4);
241098fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, log_rq_size, ilog2(qp->rq.wqe_cnt));
241198fc1126SLeon Romanovsky 	}
241298fc1126SLeon Romanovsky 
241398fc1126SLeon Romanovsky 	MLX5_SET(qpc, qpc, rq_type, get_rx_type(qp, attr));
241498fc1126SLeon Romanovsky 
241598fc1126SLeon Romanovsky 	if (qp->sq.wqe_cnt)
241698fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, log_sq_size, ilog2(qp->sq.wqe_cnt));
241798fc1126SLeon Romanovsky 	else
241898fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, no_sq, 1);
241998fc1126SLeon Romanovsky 
242098fc1126SLeon Romanovsky 	if (attr->srq) {
2421f4375443SLeon Romanovsky 		MLX5_SET(qpc, qpc, xrcd, devr->xrcdn0);
242298fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, srqn_rmpn_xrqn,
242398fc1126SLeon Romanovsky 			 to_msrq(attr->srq)->msrq.srqn);
242498fc1126SLeon Romanovsky 	} else {
2425f4375443SLeon Romanovsky 		MLX5_SET(qpc, qpc, xrcd, devr->xrcdn1);
242698fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, srqn_rmpn_xrqn,
242798fc1126SLeon Romanovsky 			 to_msrq(devr->s1)->msrq.srqn);
242898fc1126SLeon Romanovsky 	}
242998fc1126SLeon Romanovsky 
243098fc1126SLeon Romanovsky 	if (attr->send_cq)
243198fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, cqn_snd, to_mcq(attr->send_cq)->mcq.cqn);
243298fc1126SLeon Romanovsky 
243398fc1126SLeon Romanovsky 	if (attr->recv_cq)
243498fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, cqn_rcv, to_mcq(attr->recv_cq)->mcq.cqn);
243598fc1126SLeon Romanovsky 
243698fc1126SLeon Romanovsky 	MLX5_SET64(qpc, qpc, dbr_addr, qp->db.dma);
243798fc1126SLeon Romanovsky 
243898fc1126SLeon Romanovsky 	/* 0xffffff means we ask to work with cqe version 0 */
243998fc1126SLeon Romanovsky 	if (MLX5_CAP_GEN(mdev, cqe_version) == MLX5_CQE_VERSION_V1)
244098fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, user_index, uidx);
244198fc1126SLeon Romanovsky 
244298fc1126SLeon Romanovsky 	/* we use IB_QP_CREATE_IPOIB_UD_LSO to indicates ipoib qp */
244398fc1126SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_IPOIB_UD_LSO)
244498fc1126SLeon Romanovsky 		MLX5_SET(qpc, qpc, ulp_stateless_offload_mode, 1);
244598fc1126SLeon Romanovsky 
24463e09a427SLeon Romanovsky 	err = mlx5_qpc_create_qp(dev, &base->mqp, in, inlen, out);
244798fc1126SLeon Romanovsky 	kvfree(in);
244898fc1126SLeon Romanovsky 	if (err)
244998fc1126SLeon Romanovsky 		goto err_create;
245098fc1126SLeon Romanovsky 
245198fc1126SLeon Romanovsky 	base->container_mibqp = qp;
245298fc1126SLeon Romanovsky 	base->mqp.event = mlx5_ib_qp_event;
245398fc1126SLeon Romanovsky 
245498fc1126SLeon Romanovsky 	get_cqs(qp->type, attr->send_cq, attr->recv_cq,
245598fc1126SLeon Romanovsky 		&send_cq, &recv_cq);
245698fc1126SLeon Romanovsky 	spin_lock_irqsave(&dev->reset_flow_resource_lock, flags);
245798fc1126SLeon Romanovsky 	mlx5_ib_lock_cqs(send_cq, recv_cq);
245898fc1126SLeon Romanovsky 	/* Maintain device to QPs access, needed for further handling via reset
245998fc1126SLeon Romanovsky 	 * flow
246098fc1126SLeon Romanovsky 	 */
246198fc1126SLeon Romanovsky 	list_add_tail(&qp->qps_list, &dev->qp_list);
246298fc1126SLeon Romanovsky 	/* Maintain CQ to QPs access, needed for further handling via reset flow
246398fc1126SLeon Romanovsky 	 */
246498fc1126SLeon Romanovsky 	if (send_cq)
246598fc1126SLeon Romanovsky 		list_add_tail(&qp->cq_send_list, &send_cq->list_send_qp);
246698fc1126SLeon Romanovsky 	if (recv_cq)
246798fc1126SLeon Romanovsky 		list_add_tail(&qp->cq_recv_list, &recv_cq->list_recv_qp);
246898fc1126SLeon Romanovsky 	mlx5_ib_unlock_cqs(send_cq, recv_cq);
246998fc1126SLeon Romanovsky 	spin_unlock_irqrestore(&dev->reset_flow_resource_lock, flags);
247098fc1126SLeon Romanovsky 
247198fc1126SLeon Romanovsky 	return 0;
247298fc1126SLeon Romanovsky 
247398fc1126SLeon Romanovsky err_create:
2474747c519cSLeon Romanovsky 	destroy_qp(dev, qp, base, NULL);
247598fc1126SLeon Romanovsky 	return err;
247698fc1126SLeon Romanovsky }
247798fc1126SLeon Romanovsky 
2478e126ba97SEli Cohen static void mlx5_ib_lock_cqs(struct mlx5_ib_cq *send_cq, struct mlx5_ib_cq *recv_cq)
2479e126ba97SEli Cohen 	__acquires(&send_cq->lock) __acquires(&recv_cq->lock)
2480e126ba97SEli Cohen {
2481e126ba97SEli Cohen 	if (send_cq) {
2482e126ba97SEli Cohen 		if (recv_cq) {
2483e126ba97SEli Cohen 			if (send_cq->mcq.cqn < recv_cq->mcq.cqn)  {
248489ea94a7SMaor Gottlieb 				spin_lock(&send_cq->lock);
2485e126ba97SEli Cohen 				spin_lock_nested(&recv_cq->lock,
2486e126ba97SEli Cohen 						 SINGLE_DEPTH_NESTING);
2487e126ba97SEli Cohen 			} else if (send_cq->mcq.cqn == recv_cq->mcq.cqn) {
248889ea94a7SMaor Gottlieb 				spin_lock(&send_cq->lock);
2489e126ba97SEli Cohen 				__acquire(&recv_cq->lock);
2490e126ba97SEli Cohen 			} else {
249189ea94a7SMaor Gottlieb 				spin_lock(&recv_cq->lock);
2492e126ba97SEli Cohen 				spin_lock_nested(&send_cq->lock,
2493e126ba97SEli Cohen 						 SINGLE_DEPTH_NESTING);
2494e126ba97SEli Cohen 			}
2495e126ba97SEli Cohen 		} else {
249689ea94a7SMaor Gottlieb 			spin_lock(&send_cq->lock);
24976a4f139aSEli Cohen 			__acquire(&recv_cq->lock);
2498e126ba97SEli Cohen 		}
2499e126ba97SEli Cohen 	} else if (recv_cq) {
250089ea94a7SMaor Gottlieb 		spin_lock(&recv_cq->lock);
25016a4f139aSEli Cohen 		__acquire(&send_cq->lock);
25026a4f139aSEli Cohen 	} else {
25036a4f139aSEli Cohen 		__acquire(&send_cq->lock);
25046a4f139aSEli Cohen 		__acquire(&recv_cq->lock);
2505e126ba97SEli Cohen 	}
2506e126ba97SEli Cohen }
2507e126ba97SEli Cohen 
2508e126ba97SEli Cohen static void mlx5_ib_unlock_cqs(struct mlx5_ib_cq *send_cq, struct mlx5_ib_cq *recv_cq)
2509e126ba97SEli Cohen 	__releases(&send_cq->lock) __releases(&recv_cq->lock)
2510e126ba97SEli Cohen {
2511e126ba97SEli Cohen 	if (send_cq) {
2512e126ba97SEli Cohen 		if (recv_cq) {
2513e126ba97SEli Cohen 			if (send_cq->mcq.cqn < recv_cq->mcq.cqn)  {
2514e126ba97SEli Cohen 				spin_unlock(&recv_cq->lock);
251589ea94a7SMaor Gottlieb 				spin_unlock(&send_cq->lock);
2516e126ba97SEli Cohen 			} else if (send_cq->mcq.cqn == recv_cq->mcq.cqn) {
2517e126ba97SEli Cohen 				__release(&recv_cq->lock);
251889ea94a7SMaor Gottlieb 				spin_unlock(&send_cq->lock);
2519e126ba97SEli Cohen 			} else {
2520e126ba97SEli Cohen 				spin_unlock(&send_cq->lock);
252189ea94a7SMaor Gottlieb 				spin_unlock(&recv_cq->lock);
2522e126ba97SEli Cohen 			}
2523e126ba97SEli Cohen 		} else {
25246a4f139aSEli Cohen 			__release(&recv_cq->lock);
252589ea94a7SMaor Gottlieb 			spin_unlock(&send_cq->lock);
2526e126ba97SEli Cohen 		}
2527e126ba97SEli Cohen 	} else if (recv_cq) {
25286a4f139aSEli Cohen 		__release(&send_cq->lock);
252989ea94a7SMaor Gottlieb 		spin_unlock(&recv_cq->lock);
25306a4f139aSEli Cohen 	} else {
25316a4f139aSEli Cohen 		__release(&recv_cq->lock);
25326a4f139aSEli Cohen 		__release(&send_cq->lock);
2533e126ba97SEli Cohen 	}
2534e126ba97SEli Cohen }
2535e126ba97SEli Cohen 
253689ea94a7SMaor Gottlieb static void get_cqs(enum ib_qp_type qp_type,
253789ea94a7SMaor Gottlieb 		    struct ib_cq *ib_send_cq, struct ib_cq *ib_recv_cq,
2538e126ba97SEli Cohen 		    struct mlx5_ib_cq **send_cq, struct mlx5_ib_cq **recv_cq)
2539e126ba97SEli Cohen {
254089ea94a7SMaor Gottlieb 	switch (qp_type) {
2541e126ba97SEli Cohen 	case IB_QPT_XRC_TGT:
2542e126ba97SEli Cohen 		*send_cq = NULL;
2543e126ba97SEli Cohen 		*recv_cq = NULL;
2544e126ba97SEli Cohen 		break;
2545e126ba97SEli Cohen 	case MLX5_IB_QPT_REG_UMR:
2546e126ba97SEli Cohen 	case IB_QPT_XRC_INI:
254789ea94a7SMaor Gottlieb 		*send_cq = ib_send_cq ? to_mcq(ib_send_cq) : NULL;
2548e126ba97SEli Cohen 		*recv_cq = NULL;
2549e126ba97SEli Cohen 		break;
2550e126ba97SEli Cohen 
2551e126ba97SEli Cohen 	case IB_QPT_SMI:
2552d16e91daSHaggai Eran 	case MLX5_IB_QPT_HW_GSI:
2553e126ba97SEli Cohen 	case IB_QPT_RC:
2554e126ba97SEli Cohen 	case IB_QPT_UC:
2555e126ba97SEli Cohen 	case IB_QPT_UD:
25560fb2ed66Smajd@mellanox.com 	case IB_QPT_RAW_PACKET:
255789ea94a7SMaor Gottlieb 		*send_cq = ib_send_cq ? to_mcq(ib_send_cq) : NULL;
255889ea94a7SMaor Gottlieb 		*recv_cq = ib_recv_cq ? to_mcq(ib_recv_cq) : NULL;
2559e126ba97SEli Cohen 		break;
2560e126ba97SEli Cohen 	default:
2561e126ba97SEli Cohen 		*send_cq = NULL;
2562e126ba97SEli Cohen 		*recv_cq = NULL;
2563e126ba97SEli Cohen 		break;
2564e126ba97SEli Cohen 	}
2565e126ba97SEli Cohen }
2566e126ba97SEli Cohen 
2567ad5f8e96Smajd@mellanox.com static int modify_raw_packet_qp(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
256813eab21fSAviv Heller 				const struct mlx5_modify_raw_qp_param *raw_qp_param,
256913eab21fSAviv Heller 				u8 lag_tx_affinity);
2570ad5f8e96Smajd@mellanox.com 
2571bdeacabdSShamir Rabinovitch static void destroy_qp_common(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
2572bdeacabdSShamir Rabinovitch 			      struct ib_udata *udata)
2573e126ba97SEli Cohen {
2574e126ba97SEli Cohen 	struct mlx5_ib_cq *send_cq, *recv_cq;
2575c2e53b2cSYishai Hadas 	struct mlx5_ib_qp_base *base;
257689ea94a7SMaor Gottlieb 	unsigned long flags;
2577e126ba97SEli Cohen 	int err;
2578e126ba97SEli Cohen 
25796c41965dSLeon Romanovsky 	if (qp->is_rss) {
258028d61370SYishai Hadas 		destroy_rss_raw_qp_tir(dev, qp);
258128d61370SYishai Hadas 		return;
258228d61370SYishai Hadas 	}
258328d61370SYishai Hadas 
25846c41965dSLeon Romanovsky 	base = (qp->type == IB_QPT_RAW_PACKET ||
25852be08c30SLeon Romanovsky 		qp->flags & IB_QP_CREATE_SOURCE_QPN) ?
25860fb2ed66Smajd@mellanox.com 		       &qp->raw_packet_qp.rq.base :
25870fb2ed66Smajd@mellanox.com 		       &qp->trans_qp.base;
25880fb2ed66Smajd@mellanox.com 
25896aec21f6SHaggai Eran 	if (qp->state != IB_QPS_RESET) {
25906c41965dSLeon Romanovsky 		if (qp->type != IB_QPT_RAW_PACKET &&
25912be08c30SLeon Romanovsky 		    !(qp->flags & IB_QP_CREATE_SOURCE_QPN)) {
2592333fbaa0SLeon Romanovsky 			err = mlx5_core_qp_modify(dev, MLX5_CMD_OP_2RST_QP, 0,
25935f62a521SLeon Romanovsky 						  NULL, &base->mqp, NULL);
2594ad5f8e96Smajd@mellanox.com 		} else {
25950680efa2SAlex Vesker 			struct mlx5_modify_raw_qp_param raw_qp_param = {
25960680efa2SAlex Vesker 				.operation = MLX5_CMD_OP_2RST_QP
25970680efa2SAlex Vesker 			};
25980680efa2SAlex Vesker 
259913eab21fSAviv Heller 			err = modify_raw_packet_qp(dev, qp, &raw_qp_param, 0);
2600ad5f8e96Smajd@mellanox.com 		}
2601ad5f8e96Smajd@mellanox.com 		if (err)
2602427c1e7bSmajd@mellanox.com 			mlx5_ib_warn(dev, "mlx5_ib: modify QP 0x%06x to RESET failed\n",
260319098df2Smajd@mellanox.com 				     base->mqp.qpn);
26046aec21f6SHaggai Eran 	}
2605e126ba97SEli Cohen 
26066c41965dSLeon Romanovsky 	get_cqs(qp->type, qp->ibqp.send_cq, qp->ibqp.recv_cq, &send_cq,
26076c41965dSLeon Romanovsky 		&recv_cq);
260889ea94a7SMaor Gottlieb 
260989ea94a7SMaor Gottlieb 	spin_lock_irqsave(&dev->reset_flow_resource_lock, flags);
261089ea94a7SMaor Gottlieb 	mlx5_ib_lock_cqs(send_cq, recv_cq);
261189ea94a7SMaor Gottlieb 	/* del from lists under both locks above to protect reset flow paths */
261289ea94a7SMaor Gottlieb 	list_del(&qp->qps_list);
261389ea94a7SMaor Gottlieb 	if (send_cq)
261489ea94a7SMaor Gottlieb 		list_del(&qp->cq_send_list);
261589ea94a7SMaor Gottlieb 
261689ea94a7SMaor Gottlieb 	if (recv_cq)
261789ea94a7SMaor Gottlieb 		list_del(&qp->cq_recv_list);
2618e126ba97SEli Cohen 
261903c4077bSLeon Romanovsky 	if (!udata) {
262019098df2Smajd@mellanox.com 		__mlx5_ib_cq_clean(recv_cq, base->mqp.qpn,
2621e126ba97SEli Cohen 				   qp->ibqp.srq ? to_msrq(qp->ibqp.srq) : NULL);
2622e126ba97SEli Cohen 		if (send_cq != recv_cq)
262319098df2Smajd@mellanox.com 			__mlx5_ib_cq_clean(send_cq, base->mqp.qpn,
262419098df2Smajd@mellanox.com 					   NULL);
2625e126ba97SEli Cohen 	}
262689ea94a7SMaor Gottlieb 	mlx5_ib_unlock_cqs(send_cq, recv_cq);
262789ea94a7SMaor Gottlieb 	spin_unlock_irqrestore(&dev->reset_flow_resource_lock, flags);
2628e126ba97SEli Cohen 
26296c41965dSLeon Romanovsky 	if (qp->type == IB_QPT_RAW_PACKET ||
26302be08c30SLeon Romanovsky 	    qp->flags & IB_QP_CREATE_SOURCE_QPN) {
26310fb2ed66Smajd@mellanox.com 		destroy_raw_packet_qp(dev, qp);
26320fb2ed66Smajd@mellanox.com 	} else {
2633333fbaa0SLeon Romanovsky 		err = mlx5_core_destroy_qp(dev, &base->mqp);
2634e126ba97SEli Cohen 		if (err)
26350fb2ed66Smajd@mellanox.com 			mlx5_ib_warn(dev, "failed to destroy QP 0x%x\n",
26360fb2ed66Smajd@mellanox.com 				     base->mqp.qpn);
26370fb2ed66Smajd@mellanox.com 	}
2638e126ba97SEli Cohen 
2639747c519cSLeon Romanovsky 	destroy_qp(dev, qp, base, udata);
2640e126ba97SEli Cohen }
2641e126ba97SEli Cohen 
2642a645a89dSLeon Romanovsky static int create_dct(struct mlx5_ib_dev *dev, struct ib_pd *pd,
2643a645a89dSLeon Romanovsky 		      struct mlx5_ib_qp *qp,
2644f78d358cSLeon Romanovsky 		      struct mlx5_create_qp_params *params)
2645b4aaa1f0SMoni Shoua {
2646f78d358cSLeon Romanovsky 	struct ib_qp_init_attr *attr = params->attr;
2647f78d358cSLeon Romanovsky 	struct mlx5_ib_create_qp *ucmd = params->ucmd;
2648f78d358cSLeon Romanovsky 	u32 uidx = params->uidx;
2649b4aaa1f0SMoni Shoua 	void *dctc;
2650b4aaa1f0SMoni Shoua 
26517c4b1ab9SMark Zhang 	if (mlx5_lag_is_active(dev->mdev) && !MLX5_CAP_GEN(dev->mdev, lag_dct))
26527c4b1ab9SMark Zhang 		return -EOPNOTSUPP;
26537c4b1ab9SMark Zhang 
2654b4aaa1f0SMoni Shoua 	qp->dct.in = kzalloc(MLX5_ST_SZ_BYTES(create_dct_in), GFP_KERNEL);
26559c2ba4edSLeon Romanovsky 	if (!qp->dct.in)
265647c80612SLeon Romanovsky 		return -ENOMEM;
2657b4aaa1f0SMoni Shoua 
2658a01a5860SYishai Hadas 	MLX5_SET(create_dct_in, qp->dct.in, uid, to_mpd(pd)->uid);
2659b4aaa1f0SMoni Shoua 	dctc = MLX5_ADDR_OF(create_dct_in, qp->dct.in, dct_context_entry);
2660b4aaa1f0SMoni Shoua 	MLX5_SET(dctc, dctc, pd, to_mpd(pd)->pdn);
2661b4aaa1f0SMoni Shoua 	MLX5_SET(dctc, dctc, srqn_xrqn, to_msrq(attr->srq)->msrq.srqn);
2662b4aaa1f0SMoni Shoua 	MLX5_SET(dctc, dctc, cqn, to_mcq(attr->recv_cq)->mcq.cqn);
2663b4aaa1f0SMoni Shoua 	MLX5_SET64(dctc, dctc, dc_access_key, ucmd->access_key);
2664b4aaa1f0SMoni Shoua 	MLX5_SET(dctc, dctc, user_index, uidx);
2665a645a89dSLeon Romanovsky 	if (MLX5_CAP_GEN(dev->mdev, ece_support))
2666a645a89dSLeon Romanovsky 		MLX5_SET(dctc, dctc, ece, ucmd->ece_options);
2667b4aaa1f0SMoni Shoua 
266837518fa4SLeon Romanovsky 	if (qp->flags_en & MLX5_QP_FLAG_SCATTER_CQE) {
2669fd9dab7eSLeon Romanovsky 		int rcqe_sz = mlx5_ib_get_cqe_size(attr->recv_cq);
2670fd9dab7eSLeon Romanovsky 
2671fd9dab7eSLeon Romanovsky 		if (rcqe_sz == 128)
2672fd9dab7eSLeon Romanovsky 			MLX5_SET(dctc, dctc, cs_res, MLX5_RES_SCAT_DATA64_CQE);
2673fd9dab7eSLeon Romanovsky 	}
26745d6ff1baSYonatan Cohen 
2675b4aaa1f0SMoni Shoua 	qp->state = IB_QPS_RESET;
267647c80612SLeon Romanovsky 	return 0;
2677b4aaa1f0SMoni Shoua }
2678b4aaa1f0SMoni Shoua 
26797aede1a2SLeon Romanovsky static int check_qp_type(struct mlx5_ib_dev *dev, struct ib_qp_init_attr *attr,
26807aede1a2SLeon Romanovsky 			 enum ib_qp_type *type)
26816eb7edffSLeon Romanovsky {
26826eb7edffSLeon Romanovsky 	if (attr->qp_type == IB_QPT_DRIVER && !MLX5_CAP_GEN(dev->mdev, dct))
26836eb7edffSLeon Romanovsky 		goto out;
26846eb7edffSLeon Romanovsky 
26856eb7edffSLeon Romanovsky 	switch (attr->qp_type) {
26866eb7edffSLeon Romanovsky 	case IB_QPT_XRC_TGT:
26876eb7edffSLeon Romanovsky 	case IB_QPT_XRC_INI:
26886eb7edffSLeon Romanovsky 		if (!MLX5_CAP_GEN(dev->mdev, xrc))
26896eb7edffSLeon Romanovsky 			goto out;
26906eb7edffSLeon Romanovsky 		fallthrough;
26916eb7edffSLeon Romanovsky 	case IB_QPT_RC:
26926eb7edffSLeon Romanovsky 	case IB_QPT_UC:
26936eb7edffSLeon Romanovsky 	case IB_QPT_SMI:
26946eb7edffSLeon Romanovsky 	case MLX5_IB_QPT_HW_GSI:
26956eb7edffSLeon Romanovsky 	case IB_QPT_DRIVER:
26966eb7edffSLeon Romanovsky 	case IB_QPT_GSI:
269742caf9cbSMark Bloch 	case IB_QPT_RAW_PACKET:
269842caf9cbSMark Bloch 	case IB_QPT_UD:
269942caf9cbSMark Bloch 	case MLX5_IB_QPT_REG_UMR:
27007aede1a2SLeon Romanovsky 		break;
27016eb7edffSLeon Romanovsky 	default:
27026eb7edffSLeon Romanovsky 		goto out;
2703b4aaa1f0SMoni Shoua 	}
2704b4aaa1f0SMoni Shoua 
27057aede1a2SLeon Romanovsky 	*type = attr->qp_type;
2706b4aaa1f0SMoni Shoua 	return 0;
27076eb7edffSLeon Romanovsky 
27086eb7edffSLeon Romanovsky out:
27096eb7edffSLeon Romanovsky 	mlx5_ib_dbg(dev, "Unsupported QP type %d\n", attr->qp_type);
27106eb7edffSLeon Romanovsky 	return -EOPNOTSUPP;
2711b4aaa1f0SMoni Shoua }
2712b4aaa1f0SMoni Shoua 
27132242cc25SLeon Romanovsky static int check_valid_flow(struct mlx5_ib_dev *dev, struct ib_pd *pd,
27142242cc25SLeon Romanovsky 			    struct ib_qp_init_attr *attr,
27152242cc25SLeon Romanovsky 			    struct ib_udata *udata)
27162242cc25SLeon Romanovsky {
27172242cc25SLeon Romanovsky 	struct mlx5_ib_ucontext *ucontext = rdma_udata_to_drv_context(
27182242cc25SLeon Romanovsky 		udata, struct mlx5_ib_ucontext, ibucontext);
27192242cc25SLeon Romanovsky 
27202242cc25SLeon Romanovsky 	if (!udata) {
27212242cc25SLeon Romanovsky 		/* Kernel create_qp callers */
27222242cc25SLeon Romanovsky 		if (attr->rwq_ind_tbl)
27232242cc25SLeon Romanovsky 			return -EOPNOTSUPP;
27242242cc25SLeon Romanovsky 
27252242cc25SLeon Romanovsky 		switch (attr->qp_type) {
27262242cc25SLeon Romanovsky 		case IB_QPT_RAW_PACKET:
27272242cc25SLeon Romanovsky 		case IB_QPT_DRIVER:
27282242cc25SLeon Romanovsky 			return -EOPNOTSUPP;
27292242cc25SLeon Romanovsky 		default:
27302242cc25SLeon Romanovsky 			return 0;
27312242cc25SLeon Romanovsky 		}
27322242cc25SLeon Romanovsky 	}
27332242cc25SLeon Romanovsky 
27342242cc25SLeon Romanovsky 	/* Userspace create_qp callers */
27352242cc25SLeon Romanovsky 	if (attr->qp_type == IB_QPT_RAW_PACKET && !ucontext->cqe_version) {
27362242cc25SLeon Romanovsky 		mlx5_ib_dbg(dev,
27372242cc25SLeon Romanovsky 			"Raw Packet QP is only supported for CQE version > 0\n");
27382242cc25SLeon Romanovsky 		return -EINVAL;
27392242cc25SLeon Romanovsky 	}
27402242cc25SLeon Romanovsky 
27412242cc25SLeon Romanovsky 	if (attr->qp_type != IB_QPT_RAW_PACKET && attr->rwq_ind_tbl) {
27422242cc25SLeon Romanovsky 		mlx5_ib_dbg(dev,
27432242cc25SLeon Romanovsky 			    "Wrong QP type %d for the RWQ indirect table\n",
27442242cc25SLeon Romanovsky 			    attr->qp_type);
27452242cc25SLeon Romanovsky 		return -EINVAL;
27462242cc25SLeon Romanovsky 	}
27472242cc25SLeon Romanovsky 
27482242cc25SLeon Romanovsky 	/*
27492242cc25SLeon Romanovsky 	 * We don't need to see this warning, it means that kernel code
27502242cc25SLeon Romanovsky 	 * missing ib_pd. Placed here to catch developer's mistakes.
27512242cc25SLeon Romanovsky 	 */
27522242cc25SLeon Romanovsky 	WARN_ONCE(!pd && attr->qp_type != IB_QPT_XRC_TGT,
27532242cc25SLeon Romanovsky 		  "There is a missing PD pointer assignment\n");
27542242cc25SLeon Romanovsky 	return 0;
27552242cc25SLeon Romanovsky }
27562242cc25SLeon Romanovsky 
275737518fa4SLeon Romanovsky static void process_vendor_flag(struct mlx5_ib_dev *dev, int *flags, int flag,
275837518fa4SLeon Romanovsky 				bool cond, struct mlx5_ib_qp *qp)
275937518fa4SLeon Romanovsky {
276037518fa4SLeon Romanovsky 	if (!(*flags & flag))
276137518fa4SLeon Romanovsky 		return;
276237518fa4SLeon Romanovsky 
276337518fa4SLeon Romanovsky 	if (cond) {
276437518fa4SLeon Romanovsky 		qp->flags_en |= flag;
276537518fa4SLeon Romanovsky 		*flags &= ~flag;
276637518fa4SLeon Romanovsky 		return;
276737518fa4SLeon Romanovsky 	}
276837518fa4SLeon Romanovsky 
276981530ab0SLeon Romanovsky 	switch (flag) {
277081530ab0SLeon Romanovsky 	case MLX5_QP_FLAG_SCATTER_CQE:
277181530ab0SLeon Romanovsky 	case MLX5_QP_FLAG_ALLOW_SCATTER_CQE:
277237518fa4SLeon Romanovsky 		/*
277381530ab0SLeon Romanovsky 			 * We don't return error if these flags were provided,
277437518fa4SLeon Romanovsky 			 * and mlx5 doesn't have right capability.
277537518fa4SLeon Romanovsky 			 */
277681530ab0SLeon Romanovsky 		*flags &= ~(MLX5_QP_FLAG_SCATTER_CQE |
277781530ab0SLeon Romanovsky 			    MLX5_QP_FLAG_ALLOW_SCATTER_CQE);
277837518fa4SLeon Romanovsky 		return;
277981530ab0SLeon Romanovsky 	default:
278081530ab0SLeon Romanovsky 		break;
278137518fa4SLeon Romanovsky 	}
278237518fa4SLeon Romanovsky 	mlx5_ib_dbg(dev, "Vendor create QP flag 0x%X is not supported\n", flag);
278337518fa4SLeon Romanovsky }
278437518fa4SLeon Romanovsky 
278537518fa4SLeon Romanovsky static int process_vendor_flags(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
27865ce0592bSLeon Romanovsky 				void *ucmd, struct ib_qp_init_attr *attr)
27872fdddbd5SLeon Romanovsky {
278837518fa4SLeon Romanovsky 	struct mlx5_core_dev *mdev = dev->mdev;
278937518fa4SLeon Romanovsky 	bool cond;
27905ce0592bSLeon Romanovsky 	int flags;
27915ce0592bSLeon Romanovsky 
27925ce0592bSLeon Romanovsky 	if (attr->rwq_ind_tbl)
27935ce0592bSLeon Romanovsky 		flags = ((struct mlx5_ib_create_qp_rss *)ucmd)->flags;
27945ce0592bSLeon Romanovsky 	else
27955ce0592bSLeon Romanovsky 		flags = ((struct mlx5_ib_create_qp *)ucmd)->flags;
279637518fa4SLeon Romanovsky 
279737518fa4SLeon Romanovsky 	switch (flags & (MLX5_QP_FLAG_TYPE_DCT | MLX5_QP_FLAG_TYPE_DCI)) {
27982fdddbd5SLeon Romanovsky 	case MLX5_QP_FLAG_TYPE_DCI:
27997aede1a2SLeon Romanovsky 		qp->type = MLX5_IB_QPT_DCI;
28002fdddbd5SLeon Romanovsky 		break;
28012fdddbd5SLeon Romanovsky 	case MLX5_QP_FLAG_TYPE_DCT:
28027aede1a2SLeon Romanovsky 		qp->type = MLX5_IB_QPT_DCT;
280337518fa4SLeon Romanovsky 		break;
28047aede1a2SLeon Romanovsky 	default:
28057aede1a2SLeon Romanovsky 		if (qp->type != IB_QPT_DRIVER)
28067aede1a2SLeon Romanovsky 			break;
28077aede1a2SLeon Romanovsky 		/*
28087aede1a2SLeon Romanovsky 		 * It is IB_QPT_DRIVER and or no subtype or
28097aede1a2SLeon Romanovsky 		 * wrong subtype were provided.
28107aede1a2SLeon Romanovsky 		 */
281137518fa4SLeon Romanovsky 		return -EINVAL;
28127aede1a2SLeon Romanovsky 	}
281337518fa4SLeon Romanovsky 
281437518fa4SLeon Romanovsky 	process_vendor_flag(dev, &flags, MLX5_QP_FLAG_TYPE_DCI, true, qp);
281537518fa4SLeon Romanovsky 	process_vendor_flag(dev, &flags, MLX5_QP_FLAG_TYPE_DCT, true, qp);
281611656f59SLior Nahmanson 	process_vendor_flag(dev, &flags, MLX5_QP_FLAG_DCI_STREAM,
281711656f59SLior Nahmanson 			    MLX5_CAP_GEN(mdev, log_max_dci_stream_channels) &&
281811656f59SLior Nahmanson 			    MLX5_CAP_GEN(mdev, log_max_dci_errored_streams),
281911656f59SLior Nahmanson 			    qp);
282037518fa4SLeon Romanovsky 
282137518fa4SLeon Romanovsky 	process_vendor_flag(dev, &flags, MLX5_QP_FLAG_SIGNATURE, true, qp);
282237518fa4SLeon Romanovsky 	process_vendor_flag(dev, &flags, MLX5_QP_FLAG_SCATTER_CQE,
282337518fa4SLeon Romanovsky 			    MLX5_CAP_GEN(mdev, sctr_data_cqe), qp);
282481530ab0SLeon Romanovsky 	process_vendor_flag(dev, &flags, MLX5_QP_FLAG_ALLOW_SCATTER_CQE,
282581530ab0SLeon Romanovsky 			    MLX5_CAP_GEN(mdev, sctr_data_cqe), qp);
282637518fa4SLeon Romanovsky 
28277aede1a2SLeon Romanovsky 	if (qp->type == IB_QPT_RAW_PACKET) {
282837518fa4SLeon Romanovsky 		cond = MLX5_CAP_ETH(mdev, tunnel_stateless_vxlan) ||
282937518fa4SLeon Romanovsky 		       MLX5_CAP_ETH(mdev, tunnel_stateless_gre) ||
283037518fa4SLeon Romanovsky 		       MLX5_CAP_ETH(mdev, tunnel_stateless_geneve_rx);
283137518fa4SLeon Romanovsky 		process_vendor_flag(dev, &flags, MLX5_QP_FLAG_TUNNEL_OFFLOADS,
283237518fa4SLeon Romanovsky 				    cond, qp);
283337518fa4SLeon Romanovsky 		process_vendor_flag(dev, &flags,
283437518fa4SLeon Romanovsky 				    MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_UC, true,
283537518fa4SLeon Romanovsky 				    qp);
283637518fa4SLeon Romanovsky 		process_vendor_flag(dev, &flags,
283737518fa4SLeon Romanovsky 				    MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_MC, true,
283837518fa4SLeon Romanovsky 				    qp);
283937518fa4SLeon Romanovsky 	}
284037518fa4SLeon Romanovsky 
28417aede1a2SLeon Romanovsky 	if (qp->type == IB_QPT_RC)
284237518fa4SLeon Romanovsky 		process_vendor_flag(dev, &flags,
284337518fa4SLeon Romanovsky 				    MLX5_QP_FLAG_PACKET_BASED_CREDIT_MODE,
284437518fa4SLeon Romanovsky 				    MLX5_CAP_GEN(mdev, qp_packet_based), qp);
284537518fa4SLeon Romanovsky 
284676883a6cSLeon Romanovsky 	process_vendor_flag(dev, &flags, MLX5_QP_FLAG_BFREG_INDEX, true, qp);
284776883a6cSLeon Romanovsky 	process_vendor_flag(dev, &flags, MLX5_QP_FLAG_UAR_PAGE_INDEX, true, qp);
284876883a6cSLeon Romanovsky 
28495d6fffedSLeon Romanovsky 	cond = qp->flags_en & ~(MLX5_QP_FLAG_TUNNEL_OFFLOADS |
28505d6fffedSLeon Romanovsky 				MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_UC |
28515d6fffedSLeon Romanovsky 				MLX5_QP_FLAG_TIR_ALLOW_SELF_LB_MC);
28525d6fffedSLeon Romanovsky 	if (attr->rwq_ind_tbl && cond) {
28535d6fffedSLeon Romanovsky 		mlx5_ib_dbg(dev, "RSS RAW QP has unsupported flags 0x%X\n",
28545d6fffedSLeon Romanovsky 			    cond);
28555d6fffedSLeon Romanovsky 		return -EINVAL;
28565d6fffedSLeon Romanovsky 	}
28575d6fffedSLeon Romanovsky 
285837518fa4SLeon Romanovsky 	if (flags)
285937518fa4SLeon Romanovsky 		mlx5_ib_dbg(dev, "udata has unsupported flags 0x%X\n", flags);
286037518fa4SLeon Romanovsky 
286137518fa4SLeon Romanovsky 	return (flags) ? -EINVAL : 0;
28622fdddbd5SLeon Romanovsky 	}
28632fdddbd5SLeon Romanovsky 
28642978975cSLeon Romanovsky static void process_create_flag(struct mlx5_ib_dev *dev, int *flags, int flag,
28652978975cSLeon Romanovsky 				bool cond, struct mlx5_ib_qp *qp)
28662978975cSLeon Romanovsky {
28672978975cSLeon Romanovsky 	if (!(*flags & flag))
28682978975cSLeon Romanovsky 		return;
28692978975cSLeon Romanovsky 
28702978975cSLeon Romanovsky 	if (cond) {
28712978975cSLeon Romanovsky 		qp->flags |= flag;
28722978975cSLeon Romanovsky 		*flags &= ~flag;
28732978975cSLeon Romanovsky 		return;
28742978975cSLeon Romanovsky 	}
28752978975cSLeon Romanovsky 
28762978975cSLeon Romanovsky 	if (flag == MLX5_IB_QP_CREATE_WC_TEST) {
28772978975cSLeon Romanovsky 		/*
28782978975cSLeon Romanovsky 		 * Special case, if condition didn't meet, it won't be error,
28792978975cSLeon Romanovsky 		 * just different in-kernel flow.
28802978975cSLeon Romanovsky 		 */
28812978975cSLeon Romanovsky 		*flags &= ~MLX5_IB_QP_CREATE_WC_TEST;
28822978975cSLeon Romanovsky 		return;
28832978975cSLeon Romanovsky 	}
28842978975cSLeon Romanovsky 	mlx5_ib_dbg(dev, "Verbs create QP flag 0x%X is not supported\n", flag);
28852978975cSLeon Romanovsky }
28862978975cSLeon Romanovsky 
28872978975cSLeon Romanovsky static int process_create_flags(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
28882978975cSLeon Romanovsky 				struct ib_qp_init_attr *attr)
28892978975cSLeon Romanovsky {
28907aede1a2SLeon Romanovsky 	enum ib_qp_type qp_type = qp->type;
28912978975cSLeon Romanovsky 	struct mlx5_core_dev *mdev = dev->mdev;
28922978975cSLeon Romanovsky 	int create_flags = attr->create_flags;
28932978975cSLeon Romanovsky 	bool cond;
28942978975cSLeon Romanovsky 
28957aede1a2SLeon Romanovsky 	if (qp_type == MLX5_IB_QPT_DCT)
28962978975cSLeon Romanovsky 		return (create_flags) ? -EINVAL : 0;
28972978975cSLeon Romanovsky 
28982978975cSLeon Romanovsky 	if (qp_type == IB_QPT_RAW_PACKET && attr->rwq_ind_tbl)
28992978975cSLeon Romanovsky 		return (create_flags) ? -EINVAL : 0;
29002978975cSLeon Romanovsky 
2901f81b4565SLeon Romanovsky 	process_create_flag(dev, &create_flags, IB_QP_CREATE_NETIF_QP,
2902f81b4565SLeon Romanovsky 			    mlx5_get_flow_namespace(dev->mdev,
2903f81b4565SLeon Romanovsky 						    MLX5_FLOW_NAMESPACE_BYPASS),
2904f81b4565SLeon Romanovsky 			    qp);
29052978975cSLeon Romanovsky 	process_create_flag(dev, &create_flags,
29069e0dc7b9SMax Gurtovoy 			    IB_QP_CREATE_INTEGRITY_EN,
29079e0dc7b9SMax Gurtovoy 			    MLX5_CAP_GEN(mdev, sho), qp);
29089e0dc7b9SMax Gurtovoy 	process_create_flag(dev, &create_flags,
29092978975cSLeon Romanovsky 			    IB_QP_CREATE_BLOCK_MULTICAST_LOOPBACK,
29102978975cSLeon Romanovsky 			    MLX5_CAP_GEN(mdev, block_lb_mc), qp);
29112978975cSLeon Romanovsky 	process_create_flag(dev, &create_flags, IB_QP_CREATE_CROSS_CHANNEL,
29122978975cSLeon Romanovsky 			    MLX5_CAP_GEN(mdev, cd), qp);
29132978975cSLeon Romanovsky 	process_create_flag(dev, &create_flags, IB_QP_CREATE_MANAGED_SEND,
29142978975cSLeon Romanovsky 			    MLX5_CAP_GEN(mdev, cd), qp);
29152978975cSLeon Romanovsky 	process_create_flag(dev, &create_flags, IB_QP_CREATE_MANAGED_RECV,
29162978975cSLeon Romanovsky 			    MLX5_CAP_GEN(mdev, cd), qp);
29172978975cSLeon Romanovsky 
29182978975cSLeon Romanovsky 	if (qp_type == IB_QPT_UD) {
29192978975cSLeon Romanovsky 		process_create_flag(dev, &create_flags,
29202978975cSLeon Romanovsky 				    IB_QP_CREATE_IPOIB_UD_LSO,
29212978975cSLeon Romanovsky 				    MLX5_CAP_GEN(mdev, ipoib_basic_offloads),
29222978975cSLeon Romanovsky 				    qp);
29232978975cSLeon Romanovsky 		cond = MLX5_CAP_GEN(mdev, port_type) == MLX5_CAP_PORT_TYPE_IB;
29242978975cSLeon Romanovsky 		process_create_flag(dev, &create_flags, IB_QP_CREATE_SOURCE_QPN,
29252978975cSLeon Romanovsky 				    cond, qp);
29262978975cSLeon Romanovsky 	}
29272978975cSLeon Romanovsky 
29282978975cSLeon Romanovsky 	if (qp_type == IB_QPT_RAW_PACKET) {
29292978975cSLeon Romanovsky 		cond = MLX5_CAP_GEN(mdev, eth_net_offloads) &&
29302978975cSLeon Romanovsky 		       MLX5_CAP_ETH(mdev, scatter_fcs);
29312978975cSLeon Romanovsky 		process_create_flag(dev, &create_flags,
29322978975cSLeon Romanovsky 				    IB_QP_CREATE_SCATTER_FCS, cond, qp);
29332978975cSLeon Romanovsky 
29342978975cSLeon Romanovsky 		cond = MLX5_CAP_GEN(mdev, eth_net_offloads) &&
29352978975cSLeon Romanovsky 		       MLX5_CAP_ETH(mdev, vlan_cap);
29362978975cSLeon Romanovsky 		process_create_flag(dev, &create_flags,
29372978975cSLeon Romanovsky 				    IB_QP_CREATE_CVLAN_STRIPPING, cond, qp);
29382978975cSLeon Romanovsky 	}
29392978975cSLeon Romanovsky 
29402978975cSLeon Romanovsky 	process_create_flag(dev, &create_flags,
29412978975cSLeon Romanovsky 			    IB_QP_CREATE_PCI_WRITE_END_PADDING,
29422978975cSLeon Romanovsky 			    MLX5_CAP_GEN(mdev, end_pad), qp);
29432978975cSLeon Romanovsky 
29442978975cSLeon Romanovsky 	process_create_flag(dev, &create_flags, MLX5_IB_QP_CREATE_WC_TEST,
29452978975cSLeon Romanovsky 			    qp_type != MLX5_IB_QPT_REG_UMR, qp);
29462978975cSLeon Romanovsky 	process_create_flag(dev, &create_flags, MLX5_IB_QP_CREATE_SQPN_QP1,
29472978975cSLeon Romanovsky 			    true, qp);
29482978975cSLeon Romanovsky 
29491f11a761SJason Gunthorpe 	if (create_flags) {
29502978975cSLeon Romanovsky 		mlx5_ib_dbg(dev, "Create QP has unsupported flags 0x%X\n",
29512978975cSLeon Romanovsky 			    create_flags);
29521f11a761SJason Gunthorpe 		return -EOPNOTSUPP;
29531f11a761SJason Gunthorpe 	}
29541f11a761SJason Gunthorpe 	return 0;
29552978975cSLeon Romanovsky }
29562978975cSLeon Romanovsky 
29576f2cf76eSLeon Romanovsky static int process_udata_size(struct mlx5_ib_dev *dev,
29586f2cf76eSLeon Romanovsky 			      struct mlx5_create_qp_params *params)
29592fdddbd5SLeon Romanovsky {
29602fdddbd5SLeon Romanovsky 	size_t ucmd = sizeof(struct mlx5_ib_create_qp);
29616f2cf76eSLeon Romanovsky 	struct ib_udata *udata = params->udata;
29626f2cf76eSLeon Romanovsky 	size_t outlen = udata->outlen;
29635ce0592bSLeon Romanovsky 	size_t inlen = udata->inlen;
29642fdddbd5SLeon Romanovsky 
29656f2cf76eSLeon Romanovsky 	params->outlen = min(outlen, sizeof(struct mlx5_ib_create_qp_resp));
2966e383085cSLeon Romanovsky 	params->ucmd_size = ucmd;
29676f2cf76eSLeon Romanovsky 	if (!params->is_rss_raw) {
2968e383085cSLeon Romanovsky 		/* User has old rdma-core, which doesn't support ECE */
2969e383085cSLeon Romanovsky 		size_t min_inlen =
2970e383085cSLeon Romanovsky 			offsetof(struct mlx5_ib_create_qp, ece_options);
2971e383085cSLeon Romanovsky 
2972e383085cSLeon Romanovsky 		/*
2973e383085cSLeon Romanovsky 		 * We will check in check_ucmd_data() that user
2974e383085cSLeon Romanovsky 		 * cleared everything after inlen.
2975e383085cSLeon Romanovsky 		 */
2976e383085cSLeon Romanovsky 		params->inlen = (inlen < min_inlen) ? 0 : min(inlen, ucmd);
29776f2cf76eSLeon Romanovsky 		goto out;
29786f2cf76eSLeon Romanovsky 	}
29795ce0592bSLeon Romanovsky 
29806f2cf76eSLeon Romanovsky 	/* RSS RAW QP */
29815ce0592bSLeon Romanovsky 	if (inlen < offsetofend(struct mlx5_ib_create_qp_rss, flags))
29826f2cf76eSLeon Romanovsky 		return -EINVAL;
29836f2cf76eSLeon Romanovsky 
29846f2cf76eSLeon Romanovsky 	if (outlen < offsetofend(struct mlx5_ib_create_qp_resp, bfreg_index))
29856f2cf76eSLeon Romanovsky 		return -EINVAL;
29865ce0592bSLeon Romanovsky 
29875ce0592bSLeon Romanovsky 	ucmd = sizeof(struct mlx5_ib_create_qp_rss);
2988e383085cSLeon Romanovsky 	params->ucmd_size = ucmd;
29895ce0592bSLeon Romanovsky 	if (inlen > ucmd && !ib_is_udata_cleared(udata, ucmd, inlen - ucmd))
29906f2cf76eSLeon Romanovsky 		return -EINVAL;
29915ce0592bSLeon Romanovsky 
29926f2cf76eSLeon Romanovsky 	params->inlen = min(ucmd, inlen);
29936f2cf76eSLeon Romanovsky out:
29946f2cf76eSLeon Romanovsky 	if (!params->inlen)
2995e383085cSLeon Romanovsky 		mlx5_ib_dbg(dev, "udata is too small\n");
29966f2cf76eSLeon Romanovsky 
29976f2cf76eSLeon Romanovsky 	return (params->inlen) ? 0 : -EINVAL;
29982fdddbd5SLeon Romanovsky }
29992fdddbd5SLeon Romanovsky 
3000968f0b6fSLeon Romanovsky static int create_qp(struct mlx5_ib_dev *dev, struct ib_pd *pd,
3001f78d358cSLeon Romanovsky 		     struct mlx5_ib_qp *qp,
3002f78d358cSLeon Romanovsky 		     struct mlx5_create_qp_params *params)
30035d0dc3d9SLeon Romanovsky {
3004968f0b6fSLeon Romanovsky 	int err;
30055d0dc3d9SLeon Romanovsky 
3006968f0b6fSLeon Romanovsky 	if (params->is_rss_raw) {
3007968f0b6fSLeon Romanovsky 		err = create_rss_raw_qp_tir(dev, pd, qp, params);
3008968f0b6fSLeon Romanovsky 		goto out;
3009968f0b6fSLeon Romanovsky 	}
3010968f0b6fSLeon Romanovsky 
30112dc4d672SLeon Romanovsky 	switch (qp->type) {
30122dc4d672SLeon Romanovsky 	case MLX5_IB_QPT_DCT:
3013a645a89dSLeon Romanovsky 		err = create_dct(dev, pd, qp, params);
30140dc0da15SLeon Romanovsky 		rdma_restrack_no_track(&qp->ibqp.res);
30152dc4d672SLeon Romanovsky 		break;
30162013b4d5SLior Nahmanson 	case MLX5_IB_QPT_DCI:
30172013b4d5SLior Nahmanson 		err = create_dci(dev, pd, qp, params);
30182013b4d5SLior Nahmanson 		break;
30192dc4d672SLeon Romanovsky 	case IB_QPT_XRC_TGT:
3020968f0b6fSLeon Romanovsky 		err = create_xrc_tgt_qp(dev, qp, params);
30212dc4d672SLeon Romanovsky 		break;
30222dc4d672SLeon Romanovsky 	case IB_QPT_GSI:
30232dc4d672SLeon Romanovsky 		err = mlx5_ib_create_gsi(pd, qp, params->attr);
30242dc4d672SLeon Romanovsky 		break;
30250dc0da15SLeon Romanovsky 	case MLX5_IB_QPT_HW_GSI:
30260dc0da15SLeon Romanovsky 	case MLX5_IB_QPT_REG_UMR:
30270dc0da15SLeon Romanovsky 		rdma_restrack_no_track(&qp->ibqp.res);
30280dc0da15SLeon Romanovsky 		fallthrough;
30292dc4d672SLeon Romanovsky 	default:
3030968f0b6fSLeon Romanovsky 		if (params->udata)
3031968f0b6fSLeon Romanovsky 			err = create_user_qp(dev, pd, qp, params);
3032968f0b6fSLeon Romanovsky 		else
3033968f0b6fSLeon Romanovsky 			err = create_kernel_qp(dev, pd, qp, params);
30342dc4d672SLeon Romanovsky 	}
3035968f0b6fSLeon Romanovsky 
3036968f0b6fSLeon Romanovsky out:
3037968f0b6fSLeon Romanovsky 	if (err) {
3038968f0b6fSLeon Romanovsky 		mlx5_ib_err(dev, "Create QP type %d failed\n", qp->type);
3039968f0b6fSLeon Romanovsky 		return err;
3040968f0b6fSLeon Romanovsky 	}
3041968f0b6fSLeon Romanovsky 
3042968f0b6fSLeon Romanovsky 	if (is_qp0(qp->type))
3043968f0b6fSLeon Romanovsky 		qp->ibqp.qp_num = 0;
3044968f0b6fSLeon Romanovsky 	else if (is_qp1(qp->type))
3045968f0b6fSLeon Romanovsky 		qp->ibqp.qp_num = 1;
3046968f0b6fSLeon Romanovsky 	else
3047968f0b6fSLeon Romanovsky 		qp->ibqp.qp_num = qp->trans_qp.base.mqp.qpn;
3048968f0b6fSLeon Romanovsky 
3049968f0b6fSLeon Romanovsky 	mlx5_ib_dbg(dev,
30503e09a427SLeon Romanovsky 		"QP type %d, ib qpn 0x%X, mlx qpn 0x%x, rcqn 0x%x, scqn 0x%x, ece 0x%x\n",
3051968f0b6fSLeon Romanovsky 		qp->type, qp->ibqp.qp_num, qp->trans_qp.base.mqp.qpn,
3052968f0b6fSLeon Romanovsky 		params->attr->recv_cq ? to_mcq(params->attr->recv_cq)->mcq.cqn :
3053968f0b6fSLeon Romanovsky 					-1,
3054968f0b6fSLeon Romanovsky 		params->attr->send_cq ? to_mcq(params->attr->send_cq)->mcq.cqn :
30553e09a427SLeon Romanovsky 					-1,
30563e09a427SLeon Romanovsky 		params->resp.ece_options);
3057968f0b6fSLeon Romanovsky 
3058968f0b6fSLeon Romanovsky 	return 0;
30595d0dc3d9SLeon Romanovsky }
30605d0dc3d9SLeon Romanovsky 
30617aede1a2SLeon Romanovsky static int check_qp_attr(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
30627aede1a2SLeon Romanovsky 			 struct ib_qp_init_attr *attr)
30637aede1a2SLeon Romanovsky {
30647aede1a2SLeon Romanovsky 	int ret = 0;
30657aede1a2SLeon Romanovsky 
30667aede1a2SLeon Romanovsky 	switch (qp->type) {
30677aede1a2SLeon Romanovsky 	case MLX5_IB_QPT_DCT:
30687aede1a2SLeon Romanovsky 		ret = (!attr->srq || !attr->recv_cq) ? -EINVAL : 0;
30697aede1a2SLeon Romanovsky 		break;
30707aede1a2SLeon Romanovsky 	case MLX5_IB_QPT_DCI:
30717aede1a2SLeon Romanovsky 		ret = (attr->cap.max_recv_wr || attr->cap.max_recv_sge) ?
30727aede1a2SLeon Romanovsky 			      -EINVAL :
30737aede1a2SLeon Romanovsky 			      0;
30747aede1a2SLeon Romanovsky 		break;
3075266424ebSLeon Romanovsky 	case IB_QPT_RAW_PACKET:
3076266424ebSLeon Romanovsky 		ret = (attr->rwq_ind_tbl && attr->send_cq) ? -EINVAL : 0;
3077266424ebSLeon Romanovsky 		break;
30787aede1a2SLeon Romanovsky 	default:
30797aede1a2SLeon Romanovsky 		break;
30807aede1a2SLeon Romanovsky 	}
30817aede1a2SLeon Romanovsky 
30827aede1a2SLeon Romanovsky 	if (ret)
30837aede1a2SLeon Romanovsky 		mlx5_ib_dbg(dev, "QP type %d has wrong attributes\n", qp->type);
30847aede1a2SLeon Romanovsky 
30857aede1a2SLeon Romanovsky 	return ret;
30867aede1a2SLeon Romanovsky }
30877aede1a2SLeon Romanovsky 
3088f78d358cSLeon Romanovsky static int get_qp_uidx(struct mlx5_ib_qp *qp,
3089f78d358cSLeon Romanovsky 		       struct mlx5_create_qp_params *params)
309021aad80bSLeon Romanovsky {
3091f78d358cSLeon Romanovsky 	struct mlx5_ib_create_qp *ucmd = params->ucmd;
3092f78d358cSLeon Romanovsky 	struct ib_udata *udata = params->udata;
309321aad80bSLeon Romanovsky 	struct mlx5_ib_ucontext *ucontext = rdma_udata_to_drv_context(
309421aad80bSLeon Romanovsky 		udata, struct mlx5_ib_ucontext, ibucontext);
309521aad80bSLeon Romanovsky 
3096f78d358cSLeon Romanovsky 	if (params->is_rss_raw)
309721aad80bSLeon Romanovsky 		return 0;
309821aad80bSLeon Romanovsky 
3099f78d358cSLeon Romanovsky 	return get_qp_user_index(ucontext, ucmd, sizeof(*ucmd), &params->uidx);
310021aad80bSLeon Romanovsky }
310121aad80bSLeon Romanovsky 
310208d53976SLeon Romanovsky static int mlx5_ib_destroy_dct(struct mlx5_ib_qp *mqp)
310308d53976SLeon Romanovsky {
310408d53976SLeon Romanovsky 	struct mlx5_ib_dev *dev = to_mdev(mqp->ibqp.device);
310508d53976SLeon Romanovsky 
310608d53976SLeon Romanovsky 	if (mqp->state == IB_QPS_RTR) {
310708d53976SLeon Romanovsky 		int err;
310808d53976SLeon Romanovsky 
310908d53976SLeon Romanovsky 		err = mlx5_core_destroy_dct(dev, &mqp->dct.mdct);
311008d53976SLeon Romanovsky 		if (err) {
311108d53976SLeon Romanovsky 			mlx5_ib_warn(dev, "failed to destroy DCT %d\n", err);
311208d53976SLeon Romanovsky 			return err;
311308d53976SLeon Romanovsky 		}
311408d53976SLeon Romanovsky 	}
311508d53976SLeon Romanovsky 
311608d53976SLeon Romanovsky 	kfree(mqp->dct.in);
311708d53976SLeon Romanovsky 	return 0;
311808d53976SLeon Romanovsky }
311908d53976SLeon Romanovsky 
3120e383085cSLeon Romanovsky static int check_ucmd_data(struct mlx5_ib_dev *dev,
3121e383085cSLeon Romanovsky 			   struct mlx5_create_qp_params *params)
3122e383085cSLeon Romanovsky {
3123e383085cSLeon Romanovsky 	struct ib_udata *udata = params->udata;
3124e383085cSLeon Romanovsky 	size_t size, last;
3125e383085cSLeon Romanovsky 	int ret;
3126e383085cSLeon Romanovsky 
3127e383085cSLeon Romanovsky 	if (params->is_rss_raw)
3128e383085cSLeon Romanovsky 		/*
3129e383085cSLeon Romanovsky 		 * These QPs don't have "reserved" field in their
3130e383085cSLeon Romanovsky 		 * create_qp input struct, so their data is always valid.
3131e383085cSLeon Romanovsky 		 */
3132e383085cSLeon Romanovsky 		last = sizeof(struct mlx5_ib_create_qp_rss);
3133e383085cSLeon Romanovsky 	else
3134e383085cSLeon Romanovsky 		last = offsetof(struct mlx5_ib_create_qp, reserved);
3135e383085cSLeon Romanovsky 
3136e383085cSLeon Romanovsky 	if (udata->inlen <= last)
3137e383085cSLeon Romanovsky 		return 0;
3138e383085cSLeon Romanovsky 
3139e383085cSLeon Romanovsky 	/*
3140e383085cSLeon Romanovsky 	 * User provides different create_qp structures based on the
3141e383085cSLeon Romanovsky 	 * flow and we need to know if he cleared memory after our
3142e383085cSLeon Romanovsky 	 * struct create_qp ends.
3143e383085cSLeon Romanovsky 	 */
3144e383085cSLeon Romanovsky 	size = udata->inlen - last;
3145e383085cSLeon Romanovsky 	ret = ib_is_udata_cleared(params->udata, last, size);
3146e383085cSLeon Romanovsky 	if (!ret)
3147e383085cSLeon Romanovsky 		mlx5_ib_dbg(
3148e383085cSLeon Romanovsky 			dev,
31494f5747cfSTom Seewald 			"udata is not cleared, inlen = %zu, ucmd = %zu, last = %zu, size = %zu\n",
3150e383085cSLeon Romanovsky 			udata->inlen, params->ucmd_size, last, size);
3151e383085cSLeon Romanovsky 	return ret ? 0 : -EINVAL;
3152e383085cSLeon Romanovsky }
3153e383085cSLeon Romanovsky 
3154*514aee66SLeon Romanovsky int mlx5_ib_create_qp(struct ib_qp *ibqp, struct ib_qp_init_attr *attr,
3155e126ba97SEli Cohen 		      struct ib_udata *udata)
3156e126ba97SEli Cohen {
3157f78d358cSLeon Romanovsky 	struct mlx5_create_qp_params params = {};
3158*514aee66SLeon Romanovsky 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
3159*514aee66SLeon Romanovsky 	struct mlx5_ib_qp *qp = to_mqp(ibqp);
3160*514aee66SLeon Romanovsky 	struct ib_pd *pd = ibqp->pd;
31617aede1a2SLeon Romanovsky 	enum ib_qp_type type;
3162e126ba97SEli Cohen 	int err;
3163e126ba97SEli Cohen 
3164f78d358cSLeon Romanovsky 	err = check_qp_type(dev, attr, &type);
31652242cc25SLeon Romanovsky 	if (err)
3166*514aee66SLeon Romanovsky 		return err;
3167e126ba97SEli Cohen 
3168f78d358cSLeon Romanovsky 	err = check_valid_flow(dev, pd, attr, udata);
3169f78d358cSLeon Romanovsky 	if (err)
3170*514aee66SLeon Romanovsky 		return err;
3171f78d358cSLeon Romanovsky 
3172f78d358cSLeon Romanovsky 	params.udata = udata;
3173f78d358cSLeon Romanovsky 	params.uidx = MLX5_IB_DEFAULT_UIDX;
3174f78d358cSLeon Romanovsky 	params.attr = attr;
3175f78d358cSLeon Romanovsky 	params.is_rss_raw = !!attr->rwq_ind_tbl;
31769c2ba4edSLeon Romanovsky 
31775ce0592bSLeon Romanovsky 	if (udata) {
31786f2cf76eSLeon Romanovsky 		err = process_udata_size(dev, &params);
31796f2cf76eSLeon Romanovsky 		if (err)
3180*514aee66SLeon Romanovsky 			return err;
31812fdddbd5SLeon Romanovsky 
3182e383085cSLeon Romanovsky 		err = check_ucmd_data(dev, &params);
3183e383085cSLeon Romanovsky 		if (err)
3184*514aee66SLeon Romanovsky 			return err;
3185e383085cSLeon Romanovsky 
3186e383085cSLeon Romanovsky 		params.ucmd = kzalloc(params.ucmd_size, GFP_KERNEL);
3187f78d358cSLeon Romanovsky 		if (!params.ucmd)
3188*514aee66SLeon Romanovsky 			return -ENOMEM;
31895ce0592bSLeon Romanovsky 
3190f78d358cSLeon Romanovsky 		err = ib_copy_from_udata(params.ucmd, udata, params.inlen);
31912fdddbd5SLeon Romanovsky 		if (err)
31925ce0592bSLeon Romanovsky 			goto free_ucmd;
31932fdddbd5SLeon Romanovsky 	}
31942fdddbd5SLeon Romanovsky 
31957fa84b57SLeon Romanovsky 	mutex_init(&qp->mutex);
31967aede1a2SLeon Romanovsky 	qp->type = type;
319737518fa4SLeon Romanovsky 	if (udata) {
3198f78d358cSLeon Romanovsky 		err = process_vendor_flags(dev, qp, params.ucmd, attr);
3199b4aaa1f0SMoni Shoua 		if (err)
3200*514aee66SLeon Romanovsky 			goto free_ucmd;
320121aad80bSLeon Romanovsky 
3202f78d358cSLeon Romanovsky 		err = get_qp_uidx(qp, &params);
320321aad80bSLeon Romanovsky 		if (err)
3204*514aee66SLeon Romanovsky 			goto free_ucmd;
3205b4aaa1f0SMoni Shoua 	}
3206f78d358cSLeon Romanovsky 	err = process_create_flags(dev, qp, attr);
32072978975cSLeon Romanovsky 	if (err)
3208*514aee66SLeon Romanovsky 		goto free_ucmd;
3209b4aaa1f0SMoni Shoua 
3210f78d358cSLeon Romanovsky 	err = check_qp_attr(dev, qp, attr);
32117aede1a2SLeon Romanovsky 	if (err)
3212*514aee66SLeon Romanovsky 		goto free_ucmd;
32137aede1a2SLeon Romanovsky 
3214968f0b6fSLeon Romanovsky 	err = create_qp(dev, pd, qp, &params);
3215968f0b6fSLeon Romanovsky 	if (err)
3216*514aee66SLeon Romanovsky 		goto free_ucmd;
3217e126ba97SEli Cohen 
3218f78d358cSLeon Romanovsky 	kfree(params.ucmd);
321908d53976SLeon Romanovsky 	params.ucmd = NULL;
32205ce0592bSLeon Romanovsky 
322108d53976SLeon Romanovsky 	if (udata)
322208d53976SLeon Romanovsky 		/*
322308d53976SLeon Romanovsky 		 * It is safe to copy response for all user create QP flows,
322408d53976SLeon Romanovsky 		 * including MLX5_IB_QPT_DCT, which doesn't need it.
322508d53976SLeon Romanovsky 		 * In that case, resp will be filled with zeros.
322608d53976SLeon Romanovsky 		 */
322708d53976SLeon Romanovsky 		err = ib_copy_to_udata(udata, &params.resp, params.outlen);
322808d53976SLeon Romanovsky 	if (err)
322908d53976SLeon Romanovsky 		goto destroy_qp;
323008d53976SLeon Romanovsky 
3231*514aee66SLeon Romanovsky 	return 0;
32329c2ba4edSLeon Romanovsky 
323308d53976SLeon Romanovsky destroy_qp:
32342dc4d672SLeon Romanovsky 	switch (qp->type) {
32352dc4d672SLeon Romanovsky 	case MLX5_IB_QPT_DCT:
323608d53976SLeon Romanovsky 		mlx5_ib_destroy_dct(qp);
32372dc4d672SLeon Romanovsky 		break;
32382dc4d672SLeon Romanovsky 	case IB_QPT_GSI:
32392dc4d672SLeon Romanovsky 		mlx5_ib_destroy_gsi(qp);
32402dc4d672SLeon Romanovsky 		break;
32412dc4d672SLeon Romanovsky 	default:
324208d53976SLeon Romanovsky 		destroy_qp_common(dev, qp, udata);
32436c41965dSLeon Romanovsky 	}
32446c41965dSLeon Romanovsky 
32455ce0592bSLeon Romanovsky free_ucmd:
3246f78d358cSLeon Romanovsky 	kfree(params.ucmd);
3247*514aee66SLeon Romanovsky 	return err;
3248e126ba97SEli Cohen }
3249e126ba97SEli Cohen 
3250c4367a26SShamir Rabinovitch int mlx5_ib_destroy_qp(struct ib_qp *qp, struct ib_udata *udata)
3251e126ba97SEli Cohen {
3252e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(qp->device);
3253e126ba97SEli Cohen 	struct mlx5_ib_qp *mqp = to_mqp(qp);
3254e126ba97SEli Cohen 
32559ecf6ac1SMaor Gottlieb 	if (mqp->type == IB_QPT_GSI)
32560d9aef86SLeon Romanovsky 		return mlx5_ib_destroy_gsi(mqp);
3257d16e91daSHaggai Eran 
32587aede1a2SLeon Romanovsky 	if (mqp->type == MLX5_IB_QPT_DCT)
3259776a3906SMoni Shoua 		return mlx5_ib_destroy_dct(mqp);
3260776a3906SMoni Shoua 
3261bdeacabdSShamir Rabinovitch 	destroy_qp_common(dev, mqp, udata);
3262e126ba97SEli Cohen 	return 0;
3263e126ba97SEli Cohen }
3264e126ba97SEli Cohen 
3265f18e26afSLeon Romanovsky static int set_qpc_atomic_flags(struct mlx5_ib_qp *qp,
3266f18e26afSLeon Romanovsky 				const struct ib_qp_attr *attr, int attr_mask,
3267f18e26afSLeon Romanovsky 				void *qpc)
3268e126ba97SEli Cohen {
3269a60109dcSYonatan Cohen 	struct mlx5_ib_dev *dev = to_mdev(qp->ibqp.device);
3270f18e26afSLeon Romanovsky 	u8 dest_rd_atomic;
3271f18e26afSLeon Romanovsky 	u32 access_flags;
3272a60109dcSYonatan Cohen 
3273e126ba97SEli Cohen 	if (attr_mask & IB_QP_MAX_DEST_RD_ATOMIC)
3274e126ba97SEli Cohen 		dest_rd_atomic = attr->max_dest_rd_atomic;
3275e126ba97SEli Cohen 	else
327619098df2Smajd@mellanox.com 		dest_rd_atomic = qp->trans_qp.resp_depth;
3277e126ba97SEli Cohen 
3278e126ba97SEli Cohen 	if (attr_mask & IB_QP_ACCESS_FLAGS)
3279e126ba97SEli Cohen 		access_flags = attr->qp_access_flags;
3280e126ba97SEli Cohen 	else
328119098df2Smajd@mellanox.com 		access_flags = qp->trans_qp.atomic_rd_en;
3282e126ba97SEli Cohen 
3283e126ba97SEli Cohen 	if (!dest_rd_atomic)
3284e126ba97SEli Cohen 		access_flags &= IB_ACCESS_REMOTE_WRITE;
3285e126ba97SEli Cohen 
3286f18e26afSLeon Romanovsky 	MLX5_SET(qpc, qpc, rre, !!(access_flags & IB_ACCESS_REMOTE_READ));
3287f18e26afSLeon Romanovsky 
328813f8d9c1SYonatan Cohen 	if (access_flags & IB_ACCESS_REMOTE_ATOMIC) {
3289a60109dcSYonatan Cohen 		int atomic_mode;
3290e126ba97SEli Cohen 
32919ecf6ac1SMaor Gottlieb 		atomic_mode = get_atomic_mode(dev, qp->type);
3292a60109dcSYonatan Cohen 		if (atomic_mode < 0)
3293a60109dcSYonatan Cohen 			return -EOPNOTSUPP;
3294a60109dcSYonatan Cohen 
3295f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, rae, 1);
3296f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, atomic_mode, atomic_mode);
3297a60109dcSYonatan Cohen 	}
3298a60109dcSYonatan Cohen 
3299f18e26afSLeon Romanovsky 	MLX5_SET(qpc, qpc, rwe, !!(access_flags & IB_ACCESS_REMOTE_WRITE));
3300a60109dcSYonatan Cohen 	return 0;
3301e126ba97SEli Cohen }
3302e126ba97SEli Cohen 
3303e126ba97SEli Cohen enum {
3304e126ba97SEli Cohen 	MLX5_PATH_FLAG_FL	= 1 << 0,
3305e126ba97SEli Cohen 	MLX5_PATH_FLAG_FREE_AR	= 1 << 1,
3306e126ba97SEli Cohen 	MLX5_PATH_FLAG_COUNTER	= 1 << 2,
3307e126ba97SEli Cohen };
3308e126ba97SEli Cohen 
33096fe6e568SMark Zhang static int mlx5_to_ib_rate_map(u8 rate)
33106fe6e568SMark Zhang {
33116fe6e568SMark Zhang 	static const int rates[] = { IB_RATE_PORT_CURRENT, IB_RATE_56_GBPS,
33126fe6e568SMark Zhang 				     IB_RATE_25_GBPS,	   IB_RATE_100_GBPS,
33136fe6e568SMark Zhang 				     IB_RATE_200_GBPS,	   IB_RATE_50_GBPS,
33146fe6e568SMark Zhang 				     IB_RATE_400_GBPS };
33156fe6e568SMark Zhang 
33166fe6e568SMark Zhang 	if (rate < ARRAY_SIZE(rates))
33176fe6e568SMark Zhang 		return rates[rate];
33186fe6e568SMark Zhang 
33196fe6e568SMark Zhang 	return rate - MLX5_STAT_RATE_OFFSET;
33206fe6e568SMark Zhang }
33216fe6e568SMark Zhang 
3322c531024bSMark Zhang static int ib_to_mlx5_rate_map(u8 rate)
3323c531024bSMark Zhang {
3324c531024bSMark Zhang 	switch (rate) {
3325c531024bSMark Zhang 	case IB_RATE_PORT_CURRENT:
3326c531024bSMark Zhang 		return 0;
3327c531024bSMark Zhang 	case IB_RATE_56_GBPS:
3328c531024bSMark Zhang 		return 1;
3329c531024bSMark Zhang 	case IB_RATE_25_GBPS:
3330c531024bSMark Zhang 		return 2;
3331c531024bSMark Zhang 	case IB_RATE_100_GBPS:
3332c531024bSMark Zhang 		return 3;
3333c531024bSMark Zhang 	case IB_RATE_200_GBPS:
3334c531024bSMark Zhang 		return 4;
3335c531024bSMark Zhang 	case IB_RATE_50_GBPS:
3336c531024bSMark Zhang 		return 5;
3337c70f51deSPatrisious Haddad 	case IB_RATE_400_GBPS:
3338c70f51deSPatrisious Haddad 		return 6;
3339c531024bSMark Zhang 	default:
3340c531024bSMark Zhang 		return rate + MLX5_STAT_RATE_OFFSET;
33417f1d2dfaSTom Rix 	}
3342c531024bSMark Zhang 
3343c531024bSMark Zhang 	return 0;
3344c531024bSMark Zhang }
3345c531024bSMark Zhang 
3346e126ba97SEli Cohen static int ib_rate_to_mlx5(struct mlx5_ib_dev *dev, u8 rate)
3347e126ba97SEli Cohen {
3348c531024bSMark Zhang 	u32 stat_rate_support;
3349c531024bSMark Zhang 
33504f32ac2eSDanit Goldberg 	if (rate == IB_RATE_PORT_CURRENT)
3351e126ba97SEli Cohen 		return 0;
33524f32ac2eSDanit Goldberg 
3353a5a5d199SMichael Guralnik 	if (rate < IB_RATE_2_5_GBPS || rate > IB_RATE_600_GBPS)
3354e126ba97SEli Cohen 		return -EINVAL;
33554f32ac2eSDanit Goldberg 
3356c531024bSMark Zhang 	stat_rate_support = MLX5_CAP_GEN(dev->mdev, stat_rate_support);
33574f32ac2eSDanit Goldberg 	while (rate != IB_RATE_PORT_CURRENT &&
3358c531024bSMark Zhang 	       !(1 << ib_to_mlx5_rate_map(rate) & stat_rate_support))
3359e126ba97SEli Cohen 		--rate;
3360e126ba97SEli Cohen 
3361c531024bSMark Zhang 	return ib_to_mlx5_rate_map(rate);
3362e126ba97SEli Cohen }
3363e126ba97SEli Cohen 
336475850d0bSmajd@mellanox.com static int modify_raw_packet_eth_prio(struct mlx5_core_dev *dev,
33651cd6dbd3SYishai Hadas 				      struct mlx5_ib_sq *sq, u8 sl,
33661cd6dbd3SYishai Hadas 				      struct ib_pd *pd)
336775850d0bSmajd@mellanox.com {
336875850d0bSmajd@mellanox.com 	void *in;
336975850d0bSmajd@mellanox.com 	void *tisc;
337075850d0bSmajd@mellanox.com 	int inlen;
337175850d0bSmajd@mellanox.com 	int err;
337275850d0bSmajd@mellanox.com 
337375850d0bSmajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(modify_tis_in);
33741b9a07eeSLeon Romanovsky 	in = kvzalloc(inlen, GFP_KERNEL);
337575850d0bSmajd@mellanox.com 	if (!in)
337675850d0bSmajd@mellanox.com 		return -ENOMEM;
337775850d0bSmajd@mellanox.com 
337875850d0bSmajd@mellanox.com 	MLX5_SET(modify_tis_in, in, bitmask.prio, 1);
33791cd6dbd3SYishai Hadas 	MLX5_SET(modify_tis_in, in, uid, to_mpd(pd)->uid);
338075850d0bSmajd@mellanox.com 
338175850d0bSmajd@mellanox.com 	tisc = MLX5_ADDR_OF(modify_tis_in, in, ctx);
338275850d0bSmajd@mellanox.com 	MLX5_SET(tisc, tisc, prio, ((sl & 0x7) << 1));
338375850d0bSmajd@mellanox.com 
3384e0b4b472SLeon Romanovsky 	err = mlx5_core_modify_tis(dev, sq->tisn, in);
338575850d0bSmajd@mellanox.com 
338675850d0bSmajd@mellanox.com 	kvfree(in);
338775850d0bSmajd@mellanox.com 
338875850d0bSmajd@mellanox.com 	return err;
338975850d0bSmajd@mellanox.com }
339075850d0bSmajd@mellanox.com 
339113eab21fSAviv Heller static int modify_raw_packet_tx_affinity(struct mlx5_core_dev *dev,
33921cd6dbd3SYishai Hadas 					 struct mlx5_ib_sq *sq, u8 tx_affinity,
33931cd6dbd3SYishai Hadas 					 struct ib_pd *pd)
339413eab21fSAviv Heller {
339513eab21fSAviv Heller 	void *in;
339613eab21fSAviv Heller 	void *tisc;
339713eab21fSAviv Heller 	int inlen;
339813eab21fSAviv Heller 	int err;
339913eab21fSAviv Heller 
340013eab21fSAviv Heller 	inlen = MLX5_ST_SZ_BYTES(modify_tis_in);
34011b9a07eeSLeon Romanovsky 	in = kvzalloc(inlen, GFP_KERNEL);
340213eab21fSAviv Heller 	if (!in)
340313eab21fSAviv Heller 		return -ENOMEM;
340413eab21fSAviv Heller 
340513eab21fSAviv Heller 	MLX5_SET(modify_tis_in, in, bitmask.lag_tx_port_affinity, 1);
34061cd6dbd3SYishai Hadas 	MLX5_SET(modify_tis_in, in, uid, to_mpd(pd)->uid);
340713eab21fSAviv Heller 
340813eab21fSAviv Heller 	tisc = MLX5_ADDR_OF(modify_tis_in, in, ctx);
340913eab21fSAviv Heller 	MLX5_SET(tisc, tisc, lag_tx_port_affinity, tx_affinity);
341013eab21fSAviv Heller 
3411e0b4b472SLeon Romanovsky 	err = mlx5_core_modify_tis(dev, sq->tisn, in);
341213eab21fSAviv Heller 
341313eab21fSAviv Heller 	kvfree(in);
341413eab21fSAviv Heller 
341513eab21fSAviv Heller 	return err;
341613eab21fSAviv Heller }
341713eab21fSAviv Heller 
3418f18e26afSLeon Romanovsky static void mlx5_set_path_udp_sport(void *path, const struct rdma_ah_attr *ah,
34192b880b2eSMark Zhang 				    u32 lqpn, u32 rqpn)
34202b880b2eSMark Zhang 
34212b880b2eSMark Zhang {
34222b880b2eSMark Zhang 	u32 fl = ah->grh.flow_label;
34232b880b2eSMark Zhang 
34242b880b2eSMark Zhang 	if (!fl)
34252b880b2eSMark Zhang 		fl = rdma_calc_flow_label(lqpn, rqpn);
34262b880b2eSMark Zhang 
3427f18e26afSLeon Romanovsky 	MLX5_SET(ads, path, udp_sport, rdma_flow_label_to_udp_sport(fl));
34282b880b2eSMark Zhang }
34292b880b2eSMark Zhang 
343075850d0bSmajd@mellanox.com static int mlx5_set_path(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
3431f18e26afSLeon Romanovsky 			 const struct rdma_ah_attr *ah, void *path, u8 port,
3432f18e26afSLeon Romanovsky 			 int attr_mask, u32 path_flags,
3433f18e26afSLeon Romanovsky 			 const struct ib_qp_attr *attr, bool alt)
3434e126ba97SEli Cohen {
3435d8966fcdSDasaratharaman Chandramouli 	const struct ib_global_route *grh = rdma_ah_read_grh(ah);
3436e126ba97SEli Cohen 	int err;
3437ed88451eSMajd Dibbiny 	enum ib_gid_type gid_type;
3438d8966fcdSDasaratharaman Chandramouli 	u8 ah_flags = rdma_ah_get_ah_flags(ah);
3439d8966fcdSDasaratharaman Chandramouli 	u8 sl = rdma_ah_get_sl(ah);
3440e126ba97SEli Cohen 
3441e126ba97SEli Cohen 	if (attr_mask & IB_QP_PKEY_INDEX)
3442f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, pkey_index,
3443f18e26afSLeon Romanovsky 			 alt ? attr->alt_pkey_index : attr->pkey_index);
3444e126ba97SEli Cohen 
3445d8966fcdSDasaratharaman Chandramouli 	if (ah_flags & IB_AH_GRH) {
34467416790eSParav Pandit 		const struct ib_port_immutable *immutable;
34477416790eSParav Pandit 
34487416790eSParav Pandit 		immutable = ib_port_immutable_read(&dev->ib_dev, port);
34497416790eSParav Pandit 		if (grh->sgid_index >= immutable->gid_tbl_len) {
3450f4f01b54SJoe Perches 			pr_err("sgid_index (%u) too large. max is %d\n",
3451d8966fcdSDasaratharaman Chandramouli 			       grh->sgid_index,
34527416790eSParav Pandit 			       immutable->gid_tbl_len);
3453f83b4263SEli Cohen 			return -EINVAL;
3454f83b4263SEli Cohen 		}
34552811ba51SAchiad Shochat 	}
345644c58487SDasaratharaman Chandramouli 
345744c58487SDasaratharaman Chandramouli 	if (ah->type == RDMA_AH_ATTR_TYPE_ROCE) {
3458d8966fcdSDasaratharaman Chandramouli 		if (!(ah_flags & IB_AH_GRH))
34592811ba51SAchiad Shochat 			return -EINVAL;
346047ec3866SParav Pandit 
3461f18e26afSLeon Romanovsky 		ether_addr_copy(MLX5_ADDR_OF(ads, path, rmac_47_32),
3462f18e26afSLeon Romanovsky 				ah->roce.dmac);
34639ecf6ac1SMaor Gottlieb 		if ((qp->type == IB_QPT_RC ||
34649ecf6ac1SMaor Gottlieb 		     qp->type == IB_QPT_UC ||
34659ecf6ac1SMaor Gottlieb 		     qp->type == IB_QPT_XRC_INI ||
34669ecf6ac1SMaor Gottlieb 		     qp->type == IB_QPT_XRC_TGT) &&
34672b880b2eSMark Zhang 		    (grh->sgid_attr->gid_type == IB_GID_TYPE_ROCE_UDP_ENCAP) &&
34682b880b2eSMark Zhang 		    (attr_mask & IB_QP_DEST_QPN))
34692b880b2eSMark Zhang 			mlx5_set_path_udp_sport(path, ah,
34702b880b2eSMark Zhang 						qp->ibqp.qp_num,
34712b880b2eSMark Zhang 						attr->dest_qp_num);
3472f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, eth_prio, sl & 0x7);
347347ec3866SParav Pandit 		gid_type = ah->grh.sgid_attr->gid_type;
3474ed88451eSMajd Dibbiny 		if (gid_type == IB_GID_TYPE_ROCE_UDP_ENCAP)
3475f18e26afSLeon Romanovsky 			MLX5_SET(ads, path, dscp, grh->traffic_class >> 2);
34762811ba51SAchiad Shochat 	} else {
3477f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, fl, !!(path_flags & MLX5_PATH_FLAG_FL));
3478f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, free_ar,
3479f18e26afSLeon Romanovsky 			 !!(path_flags & MLX5_PATH_FLAG_FREE_AR));
3480f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, rlid, rdma_ah_get_dlid(ah));
3481f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, mlid, rdma_ah_get_path_bits(ah));
3482f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, grh, !!(ah_flags & IB_AH_GRH));
3483f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, sl, sl);
34842811ba51SAchiad Shochat 	}
34852811ba51SAchiad Shochat 
3486d8966fcdSDasaratharaman Chandramouli 	if (ah_flags & IB_AH_GRH) {
3487f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, src_addr_index, grh->sgid_index);
3488f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, hop_limit, grh->hop_limit);
3489f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, tclass, grh->traffic_class);
3490f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, flow_label, grh->flow_label);
3491f18e26afSLeon Romanovsky 		memcpy(MLX5_ADDR_OF(ads, path, rgid_rip), grh->dgid.raw,
3492f18e26afSLeon Romanovsky 		       sizeof(grh->dgid.raw));
3493e126ba97SEli Cohen 	}
3494e126ba97SEli Cohen 
3495d8966fcdSDasaratharaman Chandramouli 	err = ib_rate_to_mlx5(dev, rdma_ah_get_static_rate(ah));
3496e126ba97SEli Cohen 	if (err < 0)
3497e126ba97SEli Cohen 		return err;
3498f18e26afSLeon Romanovsky 	MLX5_SET(ads, path, stat_rate, err);
3499f18e26afSLeon Romanovsky 	MLX5_SET(ads, path, vhca_port_num, port);
3500e126ba97SEli Cohen 
3501e126ba97SEli Cohen 	if (attr_mask & IB_QP_TIMEOUT)
3502f18e26afSLeon Romanovsky 		MLX5_SET(ads, path, ack_timeout,
3503f18e26afSLeon Romanovsky 			 alt ? attr->alt_timeout : attr->timeout);
3504e126ba97SEli Cohen 
35059ecf6ac1SMaor Gottlieb 	if ((qp->type == IB_QPT_RAW_PACKET) && qp->sq.wqe_cnt)
350675850d0bSmajd@mellanox.com 		return modify_raw_packet_eth_prio(dev->mdev,
350775850d0bSmajd@mellanox.com 						  &qp->raw_packet_qp.sq,
35081cd6dbd3SYishai Hadas 						  sl & 0xf, qp->ibqp.pd);
350975850d0bSmajd@mellanox.com 
3510e126ba97SEli Cohen 	return 0;
3511e126ba97SEli Cohen }
3512e126ba97SEli Cohen 
3513e126ba97SEli Cohen static enum mlx5_qp_optpar opt_mask[MLX5_QP_NUM_STATE][MLX5_QP_NUM_STATE][MLX5_QP_ST_MAX] = {
3514e126ba97SEli Cohen 	[MLX5_QP_STATE_INIT] = {
3515e126ba97SEli Cohen 		[MLX5_QP_STATE_INIT] = {
3516e126ba97SEli Cohen 			[MLX5_QP_ST_RC] = MLX5_QP_OPTPAR_RRE		|
3517e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RAE		|
3518e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE		|
3519e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PKEY_INDEX	|
3520cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_PRI_PORT	|
3521cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_LAG_TX_AFF,
3522e126ba97SEli Cohen 			[MLX5_QP_ST_UC] = MLX5_QP_OPTPAR_RWE		|
3523e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PKEY_INDEX	|
3524cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_PRI_PORT	|
3525cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_LAG_TX_AFF,
3526e126ba97SEli Cohen 			[MLX5_QP_ST_UD] = MLX5_QP_OPTPAR_PKEY_INDEX	|
3527e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_Q_KEY		|
3528e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PRI_PORT,
35298f4426aaSJack Morgenstein 			[MLX5_QP_ST_XRC] = MLX5_QP_OPTPAR_RRE		|
35308f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_RAE		|
35318f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_RWE		|
35328f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_PKEY_INDEX	|
3533cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_PRI_PORT	|
3534cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_LAG_TX_AFF,
3535e126ba97SEli Cohen 		},
3536e126ba97SEli Cohen 		[MLX5_QP_STATE_RTR] = {
3537e126ba97SEli Cohen 			[MLX5_QP_ST_RC] = MLX5_QP_OPTPAR_ALT_ADDR_PATH  |
3538e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RRE            |
3539e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RAE            |
3540e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE            |
3541cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_PKEY_INDEX	|
3542cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_LAG_TX_AFF,
3543e126ba97SEli Cohen 			[MLX5_QP_ST_UC] = MLX5_QP_OPTPAR_ALT_ADDR_PATH  |
3544e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE            |
3545cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_PKEY_INDEX	|
3546cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_LAG_TX_AFF,
3547e126ba97SEli Cohen 			[MLX5_QP_ST_UD] = MLX5_QP_OPTPAR_PKEY_INDEX     |
3548e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_Q_KEY,
3549e126ba97SEli Cohen 			[MLX5_QP_ST_MLX] = MLX5_QP_OPTPAR_PKEY_INDEX	|
3550e126ba97SEli Cohen 					   MLX5_QP_OPTPAR_Q_KEY,
3551a4774e90SEli Cohen 			[MLX5_QP_ST_XRC] = MLX5_QP_OPTPAR_ALT_ADDR_PATH |
3552a4774e90SEli Cohen 					  MLX5_QP_OPTPAR_RRE            |
3553a4774e90SEli Cohen 					  MLX5_QP_OPTPAR_RAE            |
3554a4774e90SEli Cohen 					  MLX5_QP_OPTPAR_RWE            |
3555cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_PKEY_INDEX	|
3556cfc1a89eSMaor Gottlieb 					  MLX5_QP_OPTPAR_LAG_TX_AFF,
3557e126ba97SEli Cohen 		},
3558e126ba97SEli Cohen 	},
3559e126ba97SEli Cohen 	[MLX5_QP_STATE_RTR] = {
3560e126ba97SEli Cohen 		[MLX5_QP_STATE_RTS] = {
3561e126ba97SEli Cohen 			[MLX5_QP_ST_RC] = MLX5_QP_OPTPAR_ALT_ADDR_PATH	|
3562e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RRE		|
3563e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RAE		|
3564e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE		|
3565e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PM_STATE	|
3566e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RNR_TIMEOUT,
3567e126ba97SEli Cohen 			[MLX5_QP_ST_UC] = MLX5_QP_OPTPAR_ALT_ADDR_PATH	|
3568e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE		|
3569e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PM_STATE,
3570e126ba97SEli Cohen 			[MLX5_QP_ST_UD] = MLX5_QP_OPTPAR_Q_KEY,
35718f4426aaSJack Morgenstein 			[MLX5_QP_ST_XRC] = MLX5_QP_OPTPAR_ALT_ADDR_PATH	|
35728f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_RRE		|
35738f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_RAE		|
35748f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_RWE		|
35758f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_PM_STATE	|
35768f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_RNR_TIMEOUT,
3577e126ba97SEli Cohen 		},
3578e126ba97SEli Cohen 	},
3579e126ba97SEli Cohen 	[MLX5_QP_STATE_RTS] = {
3580e126ba97SEli Cohen 		[MLX5_QP_STATE_RTS] = {
3581e126ba97SEli Cohen 			[MLX5_QP_ST_RC] = MLX5_QP_OPTPAR_RRE		|
3582e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RAE		|
3583e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE		|
3584e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RNR_TIMEOUT	|
3585c2a3431eSEli Cohen 					  MLX5_QP_OPTPAR_PM_STATE	|
3586c2a3431eSEli Cohen 					  MLX5_QP_OPTPAR_ALT_ADDR_PATH,
3587e126ba97SEli Cohen 			[MLX5_QP_ST_UC] = MLX5_QP_OPTPAR_RWE		|
3588c2a3431eSEli Cohen 					  MLX5_QP_OPTPAR_PM_STATE	|
3589c2a3431eSEli Cohen 					  MLX5_QP_OPTPAR_ALT_ADDR_PATH,
3590e126ba97SEli Cohen 			[MLX5_QP_ST_UD] = MLX5_QP_OPTPAR_Q_KEY		|
3591e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_SRQN		|
3592e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_CQN_RCV,
35938f4426aaSJack Morgenstein 			[MLX5_QP_ST_XRC] = MLX5_QP_OPTPAR_RRE		|
35948f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_RAE		|
35958f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_RWE		|
35968f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_RNR_TIMEOUT	|
35978f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_PM_STATE	|
35988f4426aaSJack Morgenstein 					  MLX5_QP_OPTPAR_ALT_ADDR_PATH,
3599e126ba97SEli Cohen 		},
3600e126ba97SEli Cohen 	},
3601e126ba97SEli Cohen 	[MLX5_QP_STATE_SQER] = {
3602e126ba97SEli Cohen 		[MLX5_QP_STATE_RTS] = {
3603e126ba97SEli Cohen 			[MLX5_QP_ST_UD]	 = MLX5_QP_OPTPAR_Q_KEY,
3604e126ba97SEli Cohen 			[MLX5_QP_ST_MLX] = MLX5_QP_OPTPAR_Q_KEY,
360575959f56SEli Cohen 			[MLX5_QP_ST_UC]	 = MLX5_QP_OPTPAR_RWE,
3606a4774e90SEli Cohen 			[MLX5_QP_ST_RC]	 = MLX5_QP_OPTPAR_RNR_TIMEOUT	|
3607a4774e90SEli Cohen 					   MLX5_QP_OPTPAR_RWE		|
3608a4774e90SEli Cohen 					   MLX5_QP_OPTPAR_RAE		|
3609a4774e90SEli Cohen 					   MLX5_QP_OPTPAR_RRE,
36108f4426aaSJack Morgenstein 			[MLX5_QP_ST_XRC]  = MLX5_QP_OPTPAR_RNR_TIMEOUT	|
36118f4426aaSJack Morgenstein 					   MLX5_QP_OPTPAR_RWE		|
36128f4426aaSJack Morgenstein 					   MLX5_QP_OPTPAR_RAE		|
36138f4426aaSJack Morgenstein 					   MLX5_QP_OPTPAR_RRE,
3614e126ba97SEli Cohen 		},
3615e126ba97SEli Cohen 	},
3616021c1f24SSergey Gorenko 	[MLX5_QP_STATE_SQD] = {
3617021c1f24SSergey Gorenko 		[MLX5_QP_STATE_RTS] = {
3618021c1f24SSergey Gorenko 			[MLX5_QP_ST_UD] = MLX5_QP_OPTPAR_Q_KEY,
3619021c1f24SSergey Gorenko 			[MLX5_QP_ST_MLX] = MLX5_QP_OPTPAR_Q_KEY,
3620021c1f24SSergey Gorenko 			[MLX5_QP_ST_UC] = MLX5_QP_OPTPAR_RWE,
3621021c1f24SSergey Gorenko 			[MLX5_QP_ST_RC] = MLX5_QP_OPTPAR_RNR_TIMEOUT	|
3622021c1f24SSergey Gorenko 					  MLX5_QP_OPTPAR_RWE		|
3623021c1f24SSergey Gorenko 					  MLX5_QP_OPTPAR_RAE		|
3624021c1f24SSergey Gorenko 					  MLX5_QP_OPTPAR_RRE,
3625021c1f24SSergey Gorenko 		},
3626021c1f24SSergey Gorenko 	},
3627e126ba97SEli Cohen };
3628e126ba97SEli Cohen 
3629e126ba97SEli Cohen static int ib_nr_to_mlx5_nr(int ib_mask)
3630e126ba97SEli Cohen {
3631e126ba97SEli Cohen 	switch (ib_mask) {
3632e126ba97SEli Cohen 	case IB_QP_STATE:
3633e126ba97SEli Cohen 		return 0;
3634e126ba97SEli Cohen 	case IB_QP_CUR_STATE:
3635e126ba97SEli Cohen 		return 0;
3636e126ba97SEli Cohen 	case IB_QP_EN_SQD_ASYNC_NOTIFY:
3637e126ba97SEli Cohen 		return 0;
3638e126ba97SEli Cohen 	case IB_QP_ACCESS_FLAGS:
3639e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_RWE | MLX5_QP_OPTPAR_RRE |
3640e126ba97SEli Cohen 			MLX5_QP_OPTPAR_RAE;
3641e126ba97SEli Cohen 	case IB_QP_PKEY_INDEX:
3642e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_PKEY_INDEX;
3643e126ba97SEli Cohen 	case IB_QP_PORT:
3644e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_PRI_PORT;
3645e126ba97SEli Cohen 	case IB_QP_QKEY:
3646e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_Q_KEY;
3647e126ba97SEli Cohen 	case IB_QP_AV:
3648e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_PRIMARY_ADDR_PATH |
3649e126ba97SEli Cohen 			MLX5_QP_OPTPAR_PRI_PORT;
3650e126ba97SEli Cohen 	case IB_QP_PATH_MTU:
3651e126ba97SEli Cohen 		return 0;
3652e126ba97SEli Cohen 	case IB_QP_TIMEOUT:
3653e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_ACK_TIMEOUT;
3654e126ba97SEli Cohen 	case IB_QP_RETRY_CNT:
3655e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_RETRY_COUNT;
3656e126ba97SEli Cohen 	case IB_QP_RNR_RETRY:
3657e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_RNR_RETRY;
3658e126ba97SEli Cohen 	case IB_QP_RQ_PSN:
3659e126ba97SEli Cohen 		return 0;
3660e126ba97SEli Cohen 	case IB_QP_MAX_QP_RD_ATOMIC:
3661e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_SRA_MAX;
3662e126ba97SEli Cohen 	case IB_QP_ALT_PATH:
3663e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_ALT_ADDR_PATH;
3664e126ba97SEli Cohen 	case IB_QP_MIN_RNR_TIMER:
3665e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_RNR_TIMEOUT;
3666e126ba97SEli Cohen 	case IB_QP_SQ_PSN:
3667e126ba97SEli Cohen 		return 0;
3668e126ba97SEli Cohen 	case IB_QP_MAX_DEST_RD_ATOMIC:
3669e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_RRA_MAX | MLX5_QP_OPTPAR_RWE |
3670e126ba97SEli Cohen 			MLX5_QP_OPTPAR_RRE | MLX5_QP_OPTPAR_RAE;
3671e126ba97SEli Cohen 	case IB_QP_PATH_MIG_STATE:
3672e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_PM_STATE;
3673e126ba97SEli Cohen 	case IB_QP_CAP:
3674e126ba97SEli Cohen 		return 0;
3675e126ba97SEli Cohen 	case IB_QP_DEST_QPN:
3676e126ba97SEli Cohen 		return 0;
3677e126ba97SEli Cohen 	}
3678e126ba97SEli Cohen 	return 0;
3679e126ba97SEli Cohen }
3680e126ba97SEli Cohen 
3681e126ba97SEli Cohen static int ib_mask_to_mlx5_opt(int ib_mask)
3682e126ba97SEli Cohen {
3683e126ba97SEli Cohen 	int result = 0;
3684e126ba97SEli Cohen 	int i;
3685e126ba97SEli Cohen 
3686e126ba97SEli Cohen 	for (i = 0; i < 8 * sizeof(int); i++) {
3687e126ba97SEli Cohen 		if ((1 << i) & ib_mask)
3688e126ba97SEli Cohen 			result |= ib_nr_to_mlx5_nr(1 << i);
3689e126ba97SEli Cohen 	}
3690e126ba97SEli Cohen 
3691e126ba97SEli Cohen 	return result;
3692e126ba97SEli Cohen }
3693e126ba97SEli Cohen 
369434d57585SYishai Hadas static int modify_raw_packet_qp_rq(
369534d57585SYishai Hadas 	struct mlx5_ib_dev *dev, struct mlx5_ib_rq *rq, int new_state,
369634d57585SYishai Hadas 	const struct mlx5_modify_raw_qp_param *raw_qp_param, struct ib_pd *pd)
3697ad5f8e96Smajd@mellanox.com {
3698ad5f8e96Smajd@mellanox.com 	void *in;
3699ad5f8e96Smajd@mellanox.com 	void *rqc;
3700ad5f8e96Smajd@mellanox.com 	int inlen;
3701ad5f8e96Smajd@mellanox.com 	int err;
3702ad5f8e96Smajd@mellanox.com 
3703ad5f8e96Smajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(modify_rq_in);
37041b9a07eeSLeon Romanovsky 	in = kvzalloc(inlen, GFP_KERNEL);
3705ad5f8e96Smajd@mellanox.com 	if (!in)
3706ad5f8e96Smajd@mellanox.com 		return -ENOMEM;
3707ad5f8e96Smajd@mellanox.com 
3708ad5f8e96Smajd@mellanox.com 	MLX5_SET(modify_rq_in, in, rq_state, rq->state);
370934d57585SYishai Hadas 	MLX5_SET(modify_rq_in, in, uid, to_mpd(pd)->uid);
3710ad5f8e96Smajd@mellanox.com 
3711ad5f8e96Smajd@mellanox.com 	rqc = MLX5_ADDR_OF(modify_rq_in, in, ctx);
3712ad5f8e96Smajd@mellanox.com 	MLX5_SET(rqc, rqc, state, new_state);
3713ad5f8e96Smajd@mellanox.com 
3714eb49ab0cSAlex Vesker 	if (raw_qp_param->set_mask & MLX5_RAW_QP_MOD_SET_RQ_Q_CTR_ID) {
3715eb49ab0cSAlex Vesker 		if (MLX5_CAP_GEN(dev->mdev, modify_rq_counter_set_id)) {
3716eb49ab0cSAlex Vesker 			MLX5_SET64(modify_rq_in, in, modify_bitmask,
371723a6964eSMajd Dibbiny 				   MLX5_MODIFY_RQ_IN_MODIFY_BITMASK_RQ_COUNTER_SET_ID);
3718eb49ab0cSAlex Vesker 			MLX5_SET(rqc, rqc, counter_set_id, raw_qp_param->rq_q_ctr_id);
3719eb49ab0cSAlex Vesker 		} else
37205a738b5dSJason Gunthorpe 			dev_info_once(
37215a738b5dSJason Gunthorpe 				&dev->ib_dev.dev,
37225a738b5dSJason Gunthorpe 				"RAW PACKET QP counters are not supported on current FW\n");
3723eb49ab0cSAlex Vesker 	}
3724eb49ab0cSAlex Vesker 
3725e0b4b472SLeon Romanovsky 	err = mlx5_core_modify_rq(dev->mdev, rq->base.mqp.qpn, in);
3726ad5f8e96Smajd@mellanox.com 	if (err)
3727ad5f8e96Smajd@mellanox.com 		goto out;
3728ad5f8e96Smajd@mellanox.com 
3729ad5f8e96Smajd@mellanox.com 	rq->state = new_state;
3730ad5f8e96Smajd@mellanox.com 
3731ad5f8e96Smajd@mellanox.com out:
3732ad5f8e96Smajd@mellanox.com 	kvfree(in);
3733ad5f8e96Smajd@mellanox.com 	return err;
3734ad5f8e96Smajd@mellanox.com }
3735ad5f8e96Smajd@mellanox.com 
3736c14003f0SYishai Hadas static int modify_raw_packet_qp_sq(
3737c14003f0SYishai Hadas 	struct mlx5_core_dev *dev, struct mlx5_ib_sq *sq, int new_state,
3738c14003f0SYishai Hadas 	const struct mlx5_modify_raw_qp_param *raw_qp_param, struct ib_pd *pd)
3739ad5f8e96Smajd@mellanox.com {
37407d29f349SBodong Wang 	struct mlx5_ib_qp *ibqp = sq->base.container_mibqp;
374161147f39SBodong Wang 	struct mlx5_rate_limit old_rl = ibqp->rl;
374261147f39SBodong Wang 	struct mlx5_rate_limit new_rl = old_rl;
374361147f39SBodong Wang 	bool new_rate_added = false;
37447d29f349SBodong Wang 	u16 rl_index = 0;
3745ad5f8e96Smajd@mellanox.com 	void *in;
3746ad5f8e96Smajd@mellanox.com 	void *sqc;
3747ad5f8e96Smajd@mellanox.com 	int inlen;
3748ad5f8e96Smajd@mellanox.com 	int err;
3749ad5f8e96Smajd@mellanox.com 
3750ad5f8e96Smajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(modify_sq_in);
37511b9a07eeSLeon Romanovsky 	in = kvzalloc(inlen, GFP_KERNEL);
3752ad5f8e96Smajd@mellanox.com 	if (!in)
3753ad5f8e96Smajd@mellanox.com 		return -ENOMEM;
3754ad5f8e96Smajd@mellanox.com 
3755c14003f0SYishai Hadas 	MLX5_SET(modify_sq_in, in, uid, to_mpd(pd)->uid);
3756ad5f8e96Smajd@mellanox.com 	MLX5_SET(modify_sq_in, in, sq_state, sq->state);
3757ad5f8e96Smajd@mellanox.com 
3758ad5f8e96Smajd@mellanox.com 	sqc = MLX5_ADDR_OF(modify_sq_in, in, ctx);
3759ad5f8e96Smajd@mellanox.com 	MLX5_SET(sqc, sqc, state, new_state);
3760ad5f8e96Smajd@mellanox.com 
37617d29f349SBodong Wang 	if (raw_qp_param->set_mask & MLX5_RAW_QP_RATE_LIMIT) {
37627d29f349SBodong Wang 		if (new_state != MLX5_SQC_STATE_RDY)
37637d29f349SBodong Wang 			pr_warn("%s: Rate limit can only be changed when SQ is moving to RDY\n",
37647d29f349SBodong Wang 				__func__);
37657d29f349SBodong Wang 		else
376661147f39SBodong Wang 			new_rl = raw_qp_param->rl;
37677d29f349SBodong Wang 	}
3768ad5f8e96Smajd@mellanox.com 
376961147f39SBodong Wang 	if (!mlx5_rl_are_equal(&old_rl, &new_rl)) {
377061147f39SBodong Wang 		if (new_rl.rate) {
377161147f39SBodong Wang 			err = mlx5_rl_add_rate(dev, &rl_index, &new_rl);
37727d29f349SBodong Wang 			if (err) {
377361147f39SBodong Wang 				pr_err("Failed configuring rate limit(err %d): \
377461147f39SBodong Wang 				       rate %u, max_burst_sz %u, typical_pkt_sz %u\n",
377561147f39SBodong Wang 				       err, new_rl.rate, new_rl.max_burst_sz,
377661147f39SBodong Wang 				       new_rl.typical_pkt_sz);
377761147f39SBodong Wang 
37787d29f349SBodong Wang 				goto out;
37797d29f349SBodong Wang 			}
378061147f39SBodong Wang 			new_rate_added = true;
37817d29f349SBodong Wang 		}
37827d29f349SBodong Wang 
37837d29f349SBodong Wang 		MLX5_SET64(modify_sq_in, in, modify_bitmask, 1);
378461147f39SBodong Wang 		/* index 0 means no limit */
37857d29f349SBodong Wang 		MLX5_SET(sqc, sqc, packet_pacing_rate_limit_index, rl_index);
37867d29f349SBodong Wang 	}
37877d29f349SBodong Wang 
3788e0b4b472SLeon Romanovsky 	err = mlx5_core_modify_sq(dev, sq->base.mqp.qpn, in);
37897d29f349SBodong Wang 	if (err) {
37907d29f349SBodong Wang 		/* Remove new rate from table if failed */
379161147f39SBodong Wang 		if (new_rate_added)
379261147f39SBodong Wang 			mlx5_rl_remove_rate(dev, &new_rl);
37937d29f349SBodong Wang 		goto out;
37947d29f349SBodong Wang 	}
37957d29f349SBodong Wang 
37967d29f349SBodong Wang 	/* Only remove the old rate after new rate was set */
3797c8973df2SRafi Wiener 	if ((old_rl.rate && !mlx5_rl_are_equal(&old_rl, &new_rl)) ||
3798c8973df2SRafi Wiener 	    (new_state != MLX5_SQC_STATE_RDY)) {
379961147f39SBodong Wang 		mlx5_rl_remove_rate(dev, &old_rl);
3800c8973df2SRafi Wiener 		if (new_state != MLX5_SQC_STATE_RDY)
3801c8973df2SRafi Wiener 			memset(&new_rl, 0, sizeof(new_rl));
3802c8973df2SRafi Wiener 	}
38037d29f349SBodong Wang 
380461147f39SBodong Wang 	ibqp->rl = new_rl;
3805ad5f8e96Smajd@mellanox.com 	sq->state = new_state;
3806ad5f8e96Smajd@mellanox.com 
3807ad5f8e96Smajd@mellanox.com out:
3808ad5f8e96Smajd@mellanox.com 	kvfree(in);
3809ad5f8e96Smajd@mellanox.com 	return err;
3810ad5f8e96Smajd@mellanox.com }
3811ad5f8e96Smajd@mellanox.com 
3812ad5f8e96Smajd@mellanox.com static int modify_raw_packet_qp(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
381313eab21fSAviv Heller 				const struct mlx5_modify_raw_qp_param *raw_qp_param,
381413eab21fSAviv Heller 				u8 tx_affinity)
3815ad5f8e96Smajd@mellanox.com {
3816ad5f8e96Smajd@mellanox.com 	struct mlx5_ib_raw_packet_qp *raw_packet_qp = &qp->raw_packet_qp;
3817ad5f8e96Smajd@mellanox.com 	struct mlx5_ib_rq *rq = &raw_packet_qp->rq;
3818ad5f8e96Smajd@mellanox.com 	struct mlx5_ib_sq *sq = &raw_packet_qp->sq;
38197d29f349SBodong Wang 	int modify_rq = !!qp->rq.wqe_cnt;
38207d29f349SBodong Wang 	int modify_sq = !!qp->sq.wqe_cnt;
3821ad5f8e96Smajd@mellanox.com 	int rq_state;
3822ad5f8e96Smajd@mellanox.com 	int sq_state;
3823ad5f8e96Smajd@mellanox.com 	int err;
3824ad5f8e96Smajd@mellanox.com 
38250680efa2SAlex Vesker 	switch (raw_qp_param->operation) {
3826ad5f8e96Smajd@mellanox.com 	case MLX5_CMD_OP_RST2INIT_QP:
3827ad5f8e96Smajd@mellanox.com 		rq_state = MLX5_RQC_STATE_RDY;
3828c94e272bSMaor Gottlieb 		sq_state = MLX5_SQC_STATE_RST;
3829ad5f8e96Smajd@mellanox.com 		break;
3830ad5f8e96Smajd@mellanox.com 	case MLX5_CMD_OP_2ERR_QP:
3831ad5f8e96Smajd@mellanox.com 		rq_state = MLX5_RQC_STATE_ERR;
3832ad5f8e96Smajd@mellanox.com 		sq_state = MLX5_SQC_STATE_ERR;
3833ad5f8e96Smajd@mellanox.com 		break;
3834ad5f8e96Smajd@mellanox.com 	case MLX5_CMD_OP_2RST_QP:
3835ad5f8e96Smajd@mellanox.com 		rq_state = MLX5_RQC_STATE_RST;
3836ad5f8e96Smajd@mellanox.com 		sq_state = MLX5_SQC_STATE_RST;
3837ad5f8e96Smajd@mellanox.com 		break;
3838ad5f8e96Smajd@mellanox.com 	case MLX5_CMD_OP_RTR2RTS_QP:
3839ad5f8e96Smajd@mellanox.com 	case MLX5_CMD_OP_RTS2RTS_QP:
3840c94e272bSMaor Gottlieb 		if (raw_qp_param->set_mask & ~MLX5_RAW_QP_RATE_LIMIT)
3841c94e272bSMaor Gottlieb 			return -EINVAL;
3842c94e272bSMaor Gottlieb 
38437d29f349SBodong Wang 		modify_rq = 0;
3844c94e272bSMaor Gottlieb 		sq_state = MLX5_SQC_STATE_RDY;
38457d29f349SBodong Wang 		break;
38467d29f349SBodong Wang 	case MLX5_CMD_OP_INIT2INIT_QP:
38477d29f349SBodong Wang 	case MLX5_CMD_OP_INIT2RTR_QP:
3848eb49ab0cSAlex Vesker 		if (raw_qp_param->set_mask)
3849eb49ab0cSAlex Vesker 			return -EINVAL;
3850eb49ab0cSAlex Vesker 		else
3851ad5f8e96Smajd@mellanox.com 			return 0;
3852ad5f8e96Smajd@mellanox.com 	default:
3853ad5f8e96Smajd@mellanox.com 		WARN_ON(1);
3854ad5f8e96Smajd@mellanox.com 		return -EINVAL;
3855ad5f8e96Smajd@mellanox.com 	}
3856ad5f8e96Smajd@mellanox.com 
38577d29f349SBodong Wang 	if (modify_rq) {
385834d57585SYishai Hadas 		err =  modify_raw_packet_qp_rq(dev, rq, rq_state, raw_qp_param,
385934d57585SYishai Hadas 					       qp->ibqp.pd);
3860ad5f8e96Smajd@mellanox.com 		if (err)
3861ad5f8e96Smajd@mellanox.com 			return err;
3862ad5f8e96Smajd@mellanox.com 	}
3863ad5f8e96Smajd@mellanox.com 
38647d29f349SBodong Wang 	if (modify_sq) {
3865d5ed8ac3SMark Bloch 		struct mlx5_flow_handle *flow_rule;
3866d5ed8ac3SMark Bloch 
386713eab21fSAviv Heller 		if (tx_affinity) {
386813eab21fSAviv Heller 			err = modify_raw_packet_tx_affinity(dev->mdev, sq,
38691cd6dbd3SYishai Hadas 							    tx_affinity,
38701cd6dbd3SYishai Hadas 							    qp->ibqp.pd);
387113eab21fSAviv Heller 			if (err)
387213eab21fSAviv Heller 				return err;
387313eab21fSAviv Heller 		}
387413eab21fSAviv Heller 
3875d5ed8ac3SMark Bloch 		flow_rule = create_flow_rule_vport_sq(dev, sq,
3876d5ed8ac3SMark Bloch 						      raw_qp_param->port);
3877d5ed8ac3SMark Bloch 		if (IS_ERR(flow_rule))
38781db86318SColin Ian King 			return PTR_ERR(flow_rule);
3879d5ed8ac3SMark Bloch 
3880d5ed8ac3SMark Bloch 		err = modify_raw_packet_qp_sq(dev->mdev, sq, sq_state,
3881c14003f0SYishai Hadas 					      raw_qp_param, qp->ibqp.pd);
3882d5ed8ac3SMark Bloch 		if (err) {
3883d5ed8ac3SMark Bloch 			if (flow_rule)
3884d5ed8ac3SMark Bloch 				mlx5_del_flow_rules(flow_rule);
3885d5ed8ac3SMark Bloch 			return err;
3886d5ed8ac3SMark Bloch 		}
3887d5ed8ac3SMark Bloch 
3888d5ed8ac3SMark Bloch 		if (flow_rule) {
3889d5ed8ac3SMark Bloch 			destroy_flow_rule_vport_sq(sq);
3890d5ed8ac3SMark Bloch 			sq->flow_rule = flow_rule;
3891d5ed8ac3SMark Bloch 		}
3892d5ed8ac3SMark Bloch 
3893d5ed8ac3SMark Bloch 		return err;
389413eab21fSAviv Heller 	}
3895ad5f8e96Smajd@mellanox.com 
3896ad5f8e96Smajd@mellanox.com 	return 0;
3897ad5f8e96Smajd@mellanox.com }
3898ad5f8e96Smajd@mellanox.com 
38995163b274SMaor Gottlieb static unsigned int get_tx_affinity_rr(struct mlx5_ib_dev *dev,
39005163b274SMaor Gottlieb 				       struct ib_udata *udata)
3901c6a21c38SMajd Dibbiny {
390289944450SShamir Rabinovitch 	struct mlx5_ib_ucontext *ucontext = rdma_udata_to_drv_context(
390389944450SShamir Rabinovitch 		udata, struct mlx5_ib_ucontext, ibucontext);
39045163b274SMaor Gottlieb 	u8 port_num = mlx5_core_native_port_num(dev->mdev) - 1;
39055163b274SMaor Gottlieb 	atomic_t *tx_port_affinity;
3906c6a21c38SMajd Dibbiny 
39075163b274SMaor Gottlieb 	if (ucontext)
39085163b274SMaor Gottlieb 		tx_port_affinity = &ucontext->tx_port_affinity;
39095163b274SMaor Gottlieb 	else
39105163b274SMaor Gottlieb 		tx_port_affinity = &dev->port[port_num].roce.tx_port_affinity;
39115163b274SMaor Gottlieb 
39125163b274SMaor Gottlieb 	return (unsigned int)atomic_add_return(1, tx_port_affinity) %
39135163b274SMaor Gottlieb 		MLX5_MAX_PORTS + 1;
3914c6a21c38SMajd Dibbiny }
3915c6a21c38SMajd Dibbiny 
39168f3243a0SMark Zhang static bool qp_supports_affinity(struct mlx5_ib_qp *qp)
39175163b274SMaor Gottlieb {
39188f3243a0SMark Zhang 	if ((qp->type == IB_QPT_RC) || (qp->type == IB_QPT_UD) ||
39198f3243a0SMark Zhang 	    (qp->type == IB_QPT_UC) || (qp->type == IB_QPT_RAW_PACKET) ||
39208f3243a0SMark Zhang 	    (qp->type == IB_QPT_XRC_INI) || (qp->type == IB_QPT_XRC_TGT) ||
39218f3243a0SMark Zhang 	    (qp->type == MLX5_IB_QPT_DCI))
39225163b274SMaor Gottlieb 		return true;
39235163b274SMaor Gottlieb 	return false;
39245163b274SMaor Gottlieb }
39255163b274SMaor Gottlieb 
3926cfc1a89eSMaor Gottlieb static unsigned int get_tx_affinity(struct ib_qp *qp,
3927cfc1a89eSMaor Gottlieb 				    const struct ib_qp_attr *attr,
3928cfc1a89eSMaor Gottlieb 				    int attr_mask, u8 init,
39295163b274SMaor Gottlieb 				    struct ib_udata *udata)
39305163b274SMaor Gottlieb {
39315163b274SMaor Gottlieb 	struct mlx5_ib_ucontext *ucontext = rdma_udata_to_drv_context(
39325163b274SMaor Gottlieb 		udata, struct mlx5_ib_ucontext, ibucontext);
39335163b274SMaor Gottlieb 	struct mlx5_ib_dev *dev = to_mdev(qp->device);
39345163b274SMaor Gottlieb 	struct mlx5_ib_qp *mqp = to_mqp(qp);
39355163b274SMaor Gottlieb 	struct mlx5_ib_qp_base *qp_base;
39365163b274SMaor Gottlieb 	unsigned int tx_affinity;
39375163b274SMaor Gottlieb 
3938802dcc7fSMark Zhang 	if (!(mlx5_ib_lag_should_assign_affinity(dev) &&
39398f3243a0SMark Zhang 	      qp_supports_affinity(mqp)))
39405163b274SMaor Gottlieb 		return 0;
39415163b274SMaor Gottlieb 
3942cfc1a89eSMaor Gottlieb 	if (mqp->flags & MLX5_IB_QP_CREATE_SQPN_QP1)
3943cfc1a89eSMaor Gottlieb 		tx_affinity = mqp->gsi_lag_port;
3944cfc1a89eSMaor Gottlieb 	else if (init)
39455163b274SMaor Gottlieb 		tx_affinity = get_tx_affinity_rr(dev, udata);
3946cfc1a89eSMaor Gottlieb 	else if ((attr_mask & IB_QP_AV) && attr->xmit_slave)
3947cfc1a89eSMaor Gottlieb 		tx_affinity =
3948cfc1a89eSMaor Gottlieb 			mlx5_lag_get_slave_port(dev->mdev, attr->xmit_slave);
3949cfc1a89eSMaor Gottlieb 	else
3950cfc1a89eSMaor Gottlieb 		return 0;
39515163b274SMaor Gottlieb 
39525163b274SMaor Gottlieb 	qp_base = &mqp->trans_qp.base;
39535163b274SMaor Gottlieb 	if (ucontext)
39545163b274SMaor Gottlieb 		mlx5_ib_dbg(dev, "Set tx affinity 0x%x to qpn 0x%x ucontext %p\n",
39555163b274SMaor Gottlieb 			    tx_affinity, qp_base->mqp.qpn, ucontext);
39565163b274SMaor Gottlieb 	else
39575163b274SMaor Gottlieb 		mlx5_ib_dbg(dev, "Set tx affinity 0x%x to qpn 0x%x\n",
39585163b274SMaor Gottlieb 			    tx_affinity, qp_base->mqp.qpn);
39595163b274SMaor Gottlieb 	return tx_affinity;
3960c6a21c38SMajd Dibbiny }
3961c6a21c38SMajd Dibbiny 
3962d14133ddSMark Zhang static int __mlx5_ib_qp_set_counter(struct ib_qp *qp,
3963d14133ddSMark Zhang 				    struct rdma_counter *counter)
3964d14133ddSMark Zhang {
3965d14133ddSMark Zhang 	struct mlx5_ib_dev *dev = to_mdev(qp->device);
396664bae2d4SLeon Romanovsky 	u32 in[MLX5_ST_SZ_DW(rts2rts_qp_in)] = {};
3967d14133ddSMark Zhang 	struct mlx5_ib_qp *mqp = to_mqp(qp);
3968d14133ddSMark Zhang 	struct mlx5_ib_qp_base *base;
3969d14133ddSMark Zhang 	u32 set_id;
397064bae2d4SLeon Romanovsky 	u32 *qpc;
3971d14133ddSMark Zhang 
39723e1f000fSParav Pandit 	if (counter)
3973d14133ddSMark Zhang 		set_id = counter->id;
39743e1f000fSParav Pandit 	else
39753e1f000fSParav Pandit 		set_id = mlx5_ib_get_counters_id(dev, mqp->port - 1);
3976d14133ddSMark Zhang 
3977d14133ddSMark Zhang 	base = &mqp->trans_qp.base;
397864bae2d4SLeon Romanovsky 	MLX5_SET(rts2rts_qp_in, in, opcode, MLX5_CMD_OP_RTS2RTS_QP);
397964bae2d4SLeon Romanovsky 	MLX5_SET(rts2rts_qp_in, in, qpn, base->mqp.qpn);
398064bae2d4SLeon Romanovsky 	MLX5_SET(rts2rts_qp_in, in, uid, base->mqp.uid);
398164bae2d4SLeon Romanovsky 	MLX5_SET(rts2rts_qp_in, in, opt_param_mask,
398264bae2d4SLeon Romanovsky 		 MLX5_QP_OPTPAR_COUNTER_SET_ID);
398364bae2d4SLeon Romanovsky 
398464bae2d4SLeon Romanovsky 	qpc = MLX5_ADDR_OF(rts2rts_qp_in, in, qpc);
398564bae2d4SLeon Romanovsky 	MLX5_SET(qpc, qpc, counter_set_id, set_id);
398664bae2d4SLeon Romanovsky 	return mlx5_cmd_exec_in(dev->mdev, rts2rts_qp, in);
3987d14133ddSMark Zhang }
3988d14133ddSMark Zhang 
3989e126ba97SEli Cohen static int __mlx5_ib_modify_qp(struct ib_qp *ibqp,
3990e126ba97SEli Cohen 			       const struct ib_qp_attr *attr, int attr_mask,
399189944450SShamir Rabinovitch 			       enum ib_qp_state cur_state,
399289944450SShamir Rabinovitch 			       enum ib_qp_state new_state,
399389944450SShamir Rabinovitch 			       const struct mlx5_ib_modify_qp *ucmd,
399450aec2c3SLeon Romanovsky 			       struct mlx5_ib_modify_qp_resp *resp,
399589944450SShamir Rabinovitch 			       struct ib_udata *udata)
3996e126ba97SEli Cohen {
3997427c1e7bSmajd@mellanox.com 	static const u16 optab[MLX5_QP_NUM_STATE][MLX5_QP_NUM_STATE] = {
3998427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_RST] = {
3999427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
4000427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
4001427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_INIT]	= MLX5_CMD_OP_RST2INIT_QP,
4002427c1e7bSmajd@mellanox.com 		},
4003427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_INIT]  = {
4004427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
4005427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
4006427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_INIT]	= MLX5_CMD_OP_INIT2INIT_QP,
4007427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RTR]	= MLX5_CMD_OP_INIT2RTR_QP,
4008427c1e7bSmajd@mellanox.com 		},
4009427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_RTR]   = {
4010427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
4011427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
4012427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RTS]	= MLX5_CMD_OP_RTR2RTS_QP,
4013427c1e7bSmajd@mellanox.com 		},
4014427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_RTS]   = {
4015427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
4016427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
4017427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RTS]	= MLX5_CMD_OP_RTS2RTS_QP,
4018427c1e7bSmajd@mellanox.com 		},
4019427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_SQD] = {
4020427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
4021427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
4022021c1f24SSergey Gorenko 			[MLX5_QP_STATE_RTS]	= MLX5_CMD_OP_SQD_RTS_QP,
4023427c1e7bSmajd@mellanox.com 		},
4024427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_SQER] = {
4025427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
4026427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
4027427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RTS]	= MLX5_CMD_OP_SQERR2RTS_QP,
4028427c1e7bSmajd@mellanox.com 		},
4029427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_ERR] = {
4030427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
4031427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
4032427c1e7bSmajd@mellanox.com 		}
4033427c1e7bSmajd@mellanox.com 	};
4034427c1e7bSmajd@mellanox.com 
4035e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
4036e126ba97SEli Cohen 	struct mlx5_ib_qp *qp = to_mqp(ibqp);
403719098df2Smajd@mellanox.com 	struct mlx5_ib_qp_base *base = &qp->trans_qp.base;
4038e126ba97SEli Cohen 	struct mlx5_ib_cq *send_cq, *recv_cq;
4039e126ba97SEli Cohen 	struct mlx5_ib_pd *pd;
4040e126ba97SEli Cohen 	enum mlx5_qp_state mlx5_cur, mlx5_new;
4041f18e26afSLeon Romanovsky 	void *qpc, *pri_path, *alt_path;
4042cfc1a89eSMaor Gottlieb 	enum mlx5_qp_optpar optpar = 0;
4043d14133ddSMark Zhang 	u32 set_id = 0;
4044e126ba97SEli Cohen 	int mlx5_st;
4045e126ba97SEli Cohen 	int err;
4046427c1e7bSmajd@mellanox.com 	u16 op;
404713eab21fSAviv Heller 	u8 tx_affinity = 0;
4048e126ba97SEli Cohen 
40497aede1a2SLeon Romanovsky 	mlx5_st = to_mlx5_st(qp->type);
405055de9a77SLeon Romanovsky 	if (mlx5_st < 0)
405155de9a77SLeon Romanovsky 		return -EINVAL;
405255de9a77SLeon Romanovsky 
4053f18e26afSLeon Romanovsky 	qpc = kzalloc(MLX5_ST_SZ_BYTES(qpc), GFP_KERNEL);
4054f18e26afSLeon Romanovsky 	if (!qpc)
4055e126ba97SEli Cohen 		return -ENOMEM;
4056e126ba97SEli Cohen 
4057029e88fdSLeon Romanovsky 	pd = to_mpd(qp->ibqp.pd);
4058f18e26afSLeon Romanovsky 	MLX5_SET(qpc, qpc, st, mlx5_st);
4059e126ba97SEli Cohen 
4060e126ba97SEli Cohen 	if (!(attr_mask & IB_QP_PATH_MIG_STATE)) {
4061f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, pm_state, MLX5_QP_PM_MIGRATED);
4062e126ba97SEli Cohen 	} else {
4063e126ba97SEli Cohen 		switch (attr->path_mig_state) {
4064e126ba97SEli Cohen 		case IB_MIG_MIGRATED:
4065f18e26afSLeon Romanovsky 			MLX5_SET(qpc, qpc, pm_state, MLX5_QP_PM_MIGRATED);
4066e126ba97SEli Cohen 			break;
4067e126ba97SEli Cohen 		case IB_MIG_REARM:
4068f18e26afSLeon Romanovsky 			MLX5_SET(qpc, qpc, pm_state, MLX5_QP_PM_REARM);
4069e126ba97SEli Cohen 			break;
4070e126ba97SEli Cohen 		case IB_MIG_ARMED:
4071f18e26afSLeon Romanovsky 			MLX5_SET(qpc, qpc, pm_state, MLX5_QP_PM_ARMED);
4072e126ba97SEli Cohen 			break;
4073e126ba97SEli Cohen 		}
4074e126ba97SEli Cohen 	}
4075e126ba97SEli Cohen 
4076cfc1a89eSMaor Gottlieb 	tx_affinity = get_tx_affinity(ibqp, attr, attr_mask,
40775163b274SMaor Gottlieb 				      cur_state == IB_QPS_RESET &&
40785163b274SMaor Gottlieb 				      new_state == IB_QPS_INIT, udata);
4079f18e26afSLeon Romanovsky 
4080f18e26afSLeon Romanovsky 	MLX5_SET(qpc, qpc, lag_tx_port_affinity, tx_affinity);
4081f18e26afSLeon Romanovsky 	if (tx_affinity && new_state == IB_QPS_RTR &&
4082cfc1a89eSMaor Gottlieb 	    MLX5_CAP_GEN(dev->mdev, init2_lag_tx_port_affinity))
4083cfc1a89eSMaor Gottlieb 		optpar |= MLX5_QP_OPTPAR_LAG_TX_AFF;
408413eab21fSAviv Heller 
40859ecf6ac1SMaor Gottlieb 	if (is_sqp(qp->type)) {
4086f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, mtu, IB_MTU_256);
4087f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, log_msg_max, 8);
40889ecf6ac1SMaor Gottlieb 	} else if ((qp->type == IB_QPT_UD &&
40892be08c30SLeon Romanovsky 		    !(qp->flags & IB_QP_CREATE_SOURCE_QPN)) ||
40909ecf6ac1SMaor Gottlieb 		   qp->type == MLX5_IB_QPT_REG_UMR) {
4091f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, mtu, IB_MTU_4096);
4092f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, log_msg_max, 12);
4093e126ba97SEli Cohen 	} else if (attr_mask & IB_QP_PATH_MTU) {
4094e126ba97SEli Cohen 		if (attr->path_mtu < IB_MTU_256 ||
4095e126ba97SEli Cohen 		    attr->path_mtu > IB_MTU_4096) {
4096e126ba97SEli Cohen 			mlx5_ib_warn(dev, "invalid mtu %d\n", attr->path_mtu);
4097e126ba97SEli Cohen 			err = -EINVAL;
4098e126ba97SEli Cohen 			goto out;
4099e126ba97SEli Cohen 		}
4100f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, mtu, attr->path_mtu);
4101f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, log_msg_max,
4102f18e26afSLeon Romanovsky 			 MLX5_CAP_GEN(dev->mdev, log_max_msg));
4103e126ba97SEli Cohen 	}
4104e126ba97SEli Cohen 
4105e126ba97SEli Cohen 	if (attr_mask & IB_QP_DEST_QPN)
4106f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, remote_qpn, attr->dest_qp_num);
4107f18e26afSLeon Romanovsky 
4108f18e26afSLeon Romanovsky 	pri_path = MLX5_ADDR_OF(qpc, qpc, primary_address_path);
4109f18e26afSLeon Romanovsky 	alt_path = MLX5_ADDR_OF(qpc, qpc, secondary_address_path);
4110e126ba97SEli Cohen 
4111e126ba97SEli Cohen 	if (attr_mask & IB_QP_PKEY_INDEX)
4112f18e26afSLeon Romanovsky 		MLX5_SET(ads, pri_path, pkey_index, attr->pkey_index);
4113e126ba97SEli Cohen 
4114e126ba97SEli Cohen 	/* todo implement counter_index functionality */
4115e126ba97SEli Cohen 
41169ecf6ac1SMaor Gottlieb 	if (is_sqp(qp->type))
4117f18e26afSLeon Romanovsky 		MLX5_SET(ads, pri_path, vhca_port_num, qp->port);
4118e126ba97SEli Cohen 
4119e126ba97SEli Cohen 	if (attr_mask & IB_QP_PORT)
4120f18e26afSLeon Romanovsky 		MLX5_SET(ads, pri_path, vhca_port_num, attr->port_num);
4121e126ba97SEli Cohen 
4122e126ba97SEli Cohen 	if (attr_mask & IB_QP_AV) {
4123f18e26afSLeon Romanovsky 		err = mlx5_set_path(dev, qp, &attr->ah_attr, pri_path,
4124f18e26afSLeon Romanovsky 				    attr_mask & IB_QP_PORT ? attr->port_num :
4125f18e26afSLeon Romanovsky 							     qp->port,
4126f879ee8dSAchiad Shochat 				    attr_mask, 0, attr, false);
4127e126ba97SEli Cohen 		if (err)
4128e126ba97SEli Cohen 			goto out;
4129e126ba97SEli Cohen 	}
4130e126ba97SEli Cohen 
4131e126ba97SEli Cohen 	if (attr_mask & IB_QP_TIMEOUT)
4132f18e26afSLeon Romanovsky 		MLX5_SET(ads, pri_path, ack_timeout, attr->timeout);
4133e126ba97SEli Cohen 
4134e126ba97SEli Cohen 	if (attr_mask & IB_QP_ALT_PATH) {
4135f18e26afSLeon Romanovsky 		err = mlx5_set_path(dev, qp, &attr->alt_ah_attr, alt_path,
4136f879ee8dSAchiad Shochat 				    attr->alt_port_num,
4137f18e26afSLeon Romanovsky 				    attr_mask | IB_QP_PKEY_INDEX |
4138f18e26afSLeon Romanovsky 					    IB_QP_TIMEOUT,
4139f879ee8dSAchiad Shochat 				    0, attr, true);
4140e126ba97SEli Cohen 		if (err)
4141e126ba97SEli Cohen 			goto out;
4142e126ba97SEli Cohen 	}
4143e126ba97SEli Cohen 
41449ecf6ac1SMaor Gottlieb 	get_cqs(qp->type, qp->ibqp.send_cq, qp->ibqp.recv_cq,
414589ea94a7SMaor Gottlieb 		&send_cq, &recv_cq);
4146e126ba97SEli Cohen 
4147f18e26afSLeon Romanovsky 	MLX5_SET(qpc, qpc, pd, pd ? pd->pdn : to_mpd(dev->devr.p0)->pdn);
4148f18e26afSLeon Romanovsky 	if (send_cq)
4149f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, cqn_snd, send_cq->mcq.cqn);
4150f18e26afSLeon Romanovsky 	if (recv_cq)
4151f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, cqn_rcv, recv_cq->mcq.cqn);
4152f18e26afSLeon Romanovsky 
4153f18e26afSLeon Romanovsky 	MLX5_SET(qpc, qpc, log_ack_req_freq, MLX5_IB_ACK_REQ_FREQ);
4154e126ba97SEli Cohen 
4155e126ba97SEli Cohen 	if (attr_mask & IB_QP_RNR_RETRY)
4156f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, rnr_retry, attr->rnr_retry);
4157e126ba97SEli Cohen 
4158e126ba97SEli Cohen 	if (attr_mask & IB_QP_RETRY_CNT)
4159f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, retry_count, attr->retry_cnt);
4160e126ba97SEli Cohen 
4161f18e26afSLeon Romanovsky 	if (attr_mask & IB_QP_MAX_QP_RD_ATOMIC && attr->max_rd_atomic)
4162f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, log_sra_max, ilog2(attr->max_rd_atomic));
4163e126ba97SEli Cohen 
4164e126ba97SEli Cohen 	if (attr_mask & IB_QP_SQ_PSN)
4165f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, next_send_psn, attr->sq_psn);
4166e126ba97SEli Cohen 
4167f18e26afSLeon Romanovsky 	if (attr_mask & IB_QP_MAX_DEST_RD_ATOMIC && attr->max_dest_rd_atomic)
4168f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, log_rra_max,
4169f18e26afSLeon Romanovsky 			 ilog2(attr->max_dest_rd_atomic));
4170e126ba97SEli Cohen 
4171a60109dcSYonatan Cohen 	if (attr_mask & (IB_QP_ACCESS_FLAGS | IB_QP_MAX_DEST_RD_ATOMIC)) {
4172f18e26afSLeon Romanovsky 		err = set_qpc_atomic_flags(qp, attr, attr_mask, qpc);
4173a60109dcSYonatan Cohen 		if (err)
4174a60109dcSYonatan Cohen 			goto out;
4175a60109dcSYonatan Cohen 	}
4176e126ba97SEli Cohen 
4177e126ba97SEli Cohen 	if (attr_mask & IB_QP_MIN_RNR_TIMER)
4178f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, min_rnr_nak, attr->min_rnr_timer);
4179e126ba97SEli Cohen 
4180e126ba97SEli Cohen 	if (attr_mask & IB_QP_RQ_PSN)
4181f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, next_rcv_psn, attr->rq_psn);
4182e126ba97SEli Cohen 
4183e126ba97SEli Cohen 	if (attr_mask & IB_QP_QKEY)
4184f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, q_key, attr->qkey);
4185e126ba97SEli Cohen 
4186e126ba97SEli Cohen 	if (qp->rq.wqe_cnt && cur_state == IB_QPS_RESET && new_state == IB_QPS_INIT)
4187f18e26afSLeon Romanovsky 		MLX5_SET64(qpc, qpc, dbr_addr, qp->db.dma);
4188e126ba97SEli Cohen 
41890837e86aSMark Bloch 	if (cur_state == IB_QPS_RESET && new_state == IB_QPS_INIT) {
41900837e86aSMark Bloch 		u8 port_num = (attr_mask & IB_QP_PORT ? attr->port_num :
41910837e86aSMark Bloch 			       qp->port) - 1;
4192c2e53b2cSYishai Hadas 
4193c2e53b2cSYishai Hadas 		/* Underlay port should be used - index 0 function per port */
41942be08c30SLeon Romanovsky 		if (qp->flags & IB_QP_CREATE_SOURCE_QPN)
4195c2e53b2cSYishai Hadas 			port_num = 0;
4196c2e53b2cSYishai Hadas 
4197d14133ddSMark Zhang 		if (ibqp->counter)
4198d14133ddSMark Zhang 			set_id = ibqp->counter->id;
4199d14133ddSMark Zhang 		else
42003e1f000fSParav Pandit 			set_id = mlx5_ib_get_counters_id(dev, port_num);
4201f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, counter_set_id, set_id);
42020837e86aSMark Bloch 	}
42030837e86aSMark Bloch 
4204e126ba97SEli Cohen 	if (!ibqp->uobject && cur_state == IB_QPS_RESET && new_state == IB_QPS_INIT)
4205f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, rlky, 1);
4206e126ba97SEli Cohen 
42072be08c30SLeon Romanovsky 	if (qp->flags & MLX5_IB_QP_CREATE_SQPN_QP1)
4208f18e26afSLeon Romanovsky 		MLX5_SET(qpc, qpc, deth_sqpn, 1);
4209e126ba97SEli Cohen 
4210e126ba97SEli Cohen 	mlx5_cur = to_mlx5_state(cur_state);
4211e126ba97SEli Cohen 	mlx5_new = to_mlx5_state(new_state);
4212e126ba97SEli Cohen 
4213427c1e7bSmajd@mellanox.com 	if (mlx5_cur >= MLX5_QP_NUM_STATE || mlx5_new >= MLX5_QP_NUM_STATE ||
42145d414b17SDan Carpenter 	    !optab[mlx5_cur][mlx5_new]) {
42155d414b17SDan Carpenter 		err = -EINVAL;
4216427c1e7bSmajd@mellanox.com 		goto out;
42175d414b17SDan Carpenter 	}
4218427c1e7bSmajd@mellanox.com 
4219427c1e7bSmajd@mellanox.com 	op = optab[mlx5_cur][mlx5_new];
4220cfc1a89eSMaor Gottlieb 	optpar |= ib_mask_to_mlx5_opt(attr_mask);
4221e126ba97SEli Cohen 	optpar &= opt_mask[mlx5_cur][mlx5_new][mlx5_st];
4222ad5f8e96Smajd@mellanox.com 
42239ecf6ac1SMaor Gottlieb 	if (qp->type == IB_QPT_RAW_PACKET ||
42242be08c30SLeon Romanovsky 	    qp->flags & IB_QP_CREATE_SOURCE_QPN) {
42250680efa2SAlex Vesker 		struct mlx5_modify_raw_qp_param raw_qp_param = {};
42260680efa2SAlex Vesker 
42270680efa2SAlex Vesker 		raw_qp_param.operation = op;
4228eb49ab0cSAlex Vesker 		if (cur_state == IB_QPS_RESET && new_state == IB_QPS_INIT) {
4229d14133ddSMark Zhang 			raw_qp_param.rq_q_ctr_id = set_id;
4230eb49ab0cSAlex Vesker 			raw_qp_param.set_mask |= MLX5_RAW_QP_MOD_SET_RQ_Q_CTR_ID;
4231eb49ab0cSAlex Vesker 		}
42327d29f349SBodong Wang 
4233d5ed8ac3SMark Bloch 		if (attr_mask & IB_QP_PORT)
4234d5ed8ac3SMark Bloch 			raw_qp_param.port = attr->port_num;
4235d5ed8ac3SMark Bloch 
42367d29f349SBodong Wang 		if (attr_mask & IB_QP_RATE_LIMIT) {
423761147f39SBodong Wang 			raw_qp_param.rl.rate = attr->rate_limit;
423861147f39SBodong Wang 
423961147f39SBodong Wang 			if (ucmd->burst_info.max_burst_sz) {
424061147f39SBodong Wang 				if (attr->rate_limit &&
424161147f39SBodong Wang 				    MLX5_CAP_QOS(dev->mdev, packet_pacing_burst_bound)) {
424261147f39SBodong Wang 					raw_qp_param.rl.max_burst_sz =
424361147f39SBodong Wang 						ucmd->burst_info.max_burst_sz;
424461147f39SBodong Wang 				} else {
424561147f39SBodong Wang 					err = -EINVAL;
424661147f39SBodong Wang 					goto out;
424761147f39SBodong Wang 				}
424861147f39SBodong Wang 			}
424961147f39SBodong Wang 
425061147f39SBodong Wang 			if (ucmd->burst_info.typical_pkt_sz) {
425161147f39SBodong Wang 				if (attr->rate_limit &&
425261147f39SBodong Wang 				    MLX5_CAP_QOS(dev->mdev, packet_pacing_typical_size)) {
425361147f39SBodong Wang 					raw_qp_param.rl.typical_pkt_sz =
425461147f39SBodong Wang 						ucmd->burst_info.typical_pkt_sz;
425561147f39SBodong Wang 				} else {
425661147f39SBodong Wang 					err = -EINVAL;
425761147f39SBodong Wang 					goto out;
425861147f39SBodong Wang 				}
425961147f39SBodong Wang 			}
426061147f39SBodong Wang 
42617d29f349SBodong Wang 			raw_qp_param.set_mask |= MLX5_RAW_QP_RATE_LIMIT;
42627d29f349SBodong Wang 		}
42637d29f349SBodong Wang 
426413eab21fSAviv Heller 		err = modify_raw_packet_qp(dev, qp, &raw_qp_param, tx_affinity);
42650680efa2SAlex Vesker 	} else {
426650aec2c3SLeon Romanovsky 		if (udata) {
426750aec2c3SLeon Romanovsky 			/* For the kernel flows, the resp will stay zero */
426850aec2c3SLeon Romanovsky 			resp->ece_options =
426950aec2c3SLeon Romanovsky 				MLX5_CAP_GEN(dev->mdev, ece_support) ?
42705f62a521SLeon Romanovsky 					ucmd->ece_options : 0;
427150aec2c3SLeon Romanovsky 			resp->response_length = sizeof(*resp);
427250aec2c3SLeon Romanovsky 		}
42735f62a521SLeon Romanovsky 		err = mlx5_core_qp_modify(dev, op, optpar, qpc, &base->mqp,
427450aec2c3SLeon Romanovsky 					  &resp->ece_options);
42750680efa2SAlex Vesker 	}
42760680efa2SAlex Vesker 
4277e126ba97SEli Cohen 	if (err)
4278e126ba97SEli Cohen 		goto out;
4279e126ba97SEli Cohen 
4280e126ba97SEli Cohen 	qp->state = new_state;
4281e126ba97SEli Cohen 
4282e126ba97SEli Cohen 	if (attr_mask & IB_QP_ACCESS_FLAGS)
428319098df2Smajd@mellanox.com 		qp->trans_qp.atomic_rd_en = attr->qp_access_flags;
4284e126ba97SEli Cohen 	if (attr_mask & IB_QP_MAX_DEST_RD_ATOMIC)
428519098df2Smajd@mellanox.com 		qp->trans_qp.resp_depth = attr->max_dest_rd_atomic;
4286e126ba97SEli Cohen 	if (attr_mask & IB_QP_PORT)
4287e126ba97SEli Cohen 		qp->port = attr->port_num;
4288e126ba97SEli Cohen 	if (attr_mask & IB_QP_ALT_PATH)
428919098df2Smajd@mellanox.com 		qp->trans_qp.alt_port = attr->alt_port_num;
4290e126ba97SEli Cohen 
4291e126ba97SEli Cohen 	/*
4292e126ba97SEli Cohen 	 * If we moved a kernel QP to RESET, clean up all old CQ
4293e126ba97SEli Cohen 	 * entries and reinitialize the QP.
4294e126ba97SEli Cohen 	 */
429575a45982SLeon Romanovsky 	if (new_state == IB_QPS_RESET &&
42969ecf6ac1SMaor Gottlieb 	    !ibqp->uobject && qp->type != IB_QPT_XRC_TGT) {
429719098df2Smajd@mellanox.com 		mlx5_ib_cq_clean(recv_cq, base->mqp.qpn,
4298e126ba97SEli Cohen 				 ibqp->srq ? to_msrq(ibqp->srq) : NULL);
4299e126ba97SEli Cohen 		if (send_cq != recv_cq)
430019098df2Smajd@mellanox.com 			mlx5_ib_cq_clean(send_cq, base->mqp.qpn, NULL);
4301e126ba97SEli Cohen 
4302e126ba97SEli Cohen 		qp->rq.head = 0;
4303e126ba97SEli Cohen 		qp->rq.tail = 0;
4304e126ba97SEli Cohen 		qp->sq.head = 0;
4305e126ba97SEli Cohen 		qp->sq.tail = 0;
4306e126ba97SEli Cohen 		qp->sq.cur_post = 0;
430734f4c955SGuy Levi 		if (qp->sq.wqe_cnt)
430834f4c955SGuy Levi 			qp->sq.cur_edge = get_sq_edge(&qp->sq, 0);
4309950bf4f1SLeon Romanovsky 		qp->sq.last_poll = 0;
4310e126ba97SEli Cohen 		qp->db.db[MLX5_RCV_DBR] = 0;
4311e126ba97SEli Cohen 		qp->db.db[MLX5_SND_DBR] = 0;
4312e126ba97SEli Cohen 	}
4313e126ba97SEli Cohen 
4314d14133ddSMark Zhang 	if ((new_state == IB_QPS_RTS) && qp->counter_pending) {
4315d14133ddSMark Zhang 		err = __mlx5_ib_qp_set_counter(ibqp, ibqp->counter);
4316d14133ddSMark Zhang 		if (!err)
4317d14133ddSMark Zhang 			qp->counter_pending = 0;
4318d14133ddSMark Zhang 	}
4319d14133ddSMark Zhang 
4320e126ba97SEli Cohen out:
4321f18e26afSLeon Romanovsky 	kfree(qpc);
4322e126ba97SEli Cohen 	return err;
4323e126ba97SEli Cohen }
4324e126ba97SEli Cohen 
4325c32a4f29SMoni Shoua static inline bool is_valid_mask(int mask, int req, int opt)
4326c32a4f29SMoni Shoua {
4327c32a4f29SMoni Shoua 	if ((mask & req) != req)
4328c32a4f29SMoni Shoua 		return false;
4329c32a4f29SMoni Shoua 
4330c32a4f29SMoni Shoua 	if (mask & ~(req | opt))
4331c32a4f29SMoni Shoua 		return false;
4332c32a4f29SMoni Shoua 
4333c32a4f29SMoni Shoua 	return true;
4334c32a4f29SMoni Shoua }
4335c32a4f29SMoni Shoua 
4336c32a4f29SMoni Shoua /* check valid transition for driver QP types
4337c32a4f29SMoni Shoua  * for now the only QP type that this function supports is DCI
4338c32a4f29SMoni Shoua  */
4339c32a4f29SMoni Shoua static bool modify_dci_qp_is_ok(enum ib_qp_state cur_state, enum ib_qp_state new_state,
4340c32a4f29SMoni Shoua 				enum ib_qp_attr_mask attr_mask)
4341c32a4f29SMoni Shoua {
4342c32a4f29SMoni Shoua 	int req = IB_QP_STATE;
4343c32a4f29SMoni Shoua 	int opt = 0;
4344c32a4f29SMoni Shoua 
434599ed748eSMoni Shoua 	if (new_state == IB_QPS_RESET) {
434699ed748eSMoni Shoua 		return is_valid_mask(attr_mask, req, opt);
434799ed748eSMoni Shoua 	} else if (cur_state == IB_QPS_RESET && new_state == IB_QPS_INIT) {
4348c32a4f29SMoni Shoua 		req |= IB_QP_PKEY_INDEX | IB_QP_PORT;
4349c32a4f29SMoni Shoua 		return is_valid_mask(attr_mask, req, opt);
4350c32a4f29SMoni Shoua 	} else if (cur_state == IB_QPS_INIT && new_state == IB_QPS_INIT) {
4351c32a4f29SMoni Shoua 		opt = IB_QP_PKEY_INDEX | IB_QP_PORT;
4352c32a4f29SMoni Shoua 		return is_valid_mask(attr_mask, req, opt);
4353c32a4f29SMoni Shoua 	} else if (cur_state == IB_QPS_INIT && new_state == IB_QPS_RTR) {
4354c32a4f29SMoni Shoua 		req |= IB_QP_PATH_MTU;
43555ec0304cSArtemy Kovalyov 		opt = IB_QP_PKEY_INDEX | IB_QP_AV;
4356c32a4f29SMoni Shoua 		return is_valid_mask(attr_mask, req, opt);
4357c32a4f29SMoni Shoua 	} else if (cur_state == IB_QPS_RTR && new_state == IB_QPS_RTS) {
4358c32a4f29SMoni Shoua 		req |= IB_QP_TIMEOUT | IB_QP_RETRY_CNT | IB_QP_RNR_RETRY |
4359c32a4f29SMoni Shoua 		       IB_QP_MAX_QP_RD_ATOMIC | IB_QP_SQ_PSN;
4360c32a4f29SMoni Shoua 		opt = IB_QP_MIN_RNR_TIMER;
4361c32a4f29SMoni Shoua 		return is_valid_mask(attr_mask, req, opt);
4362c32a4f29SMoni Shoua 	} else if (cur_state == IB_QPS_RTS && new_state == IB_QPS_RTS) {
4363c32a4f29SMoni Shoua 		opt = IB_QP_MIN_RNR_TIMER;
4364c32a4f29SMoni Shoua 		return is_valid_mask(attr_mask, req, opt);
4365c32a4f29SMoni Shoua 	} else if (cur_state != IB_QPS_RESET && new_state == IB_QPS_ERR) {
4366c32a4f29SMoni Shoua 		return is_valid_mask(attr_mask, req, opt);
4367c32a4f29SMoni Shoua 	}
4368c32a4f29SMoni Shoua 	return false;
4369c32a4f29SMoni Shoua }
4370c32a4f29SMoni Shoua 
4371776a3906SMoni Shoua /* mlx5_ib_modify_dct: modify a DCT QP
4372776a3906SMoni Shoua  * valid transitions are:
4373776a3906SMoni Shoua  * RESET to INIT: must set access_flags, pkey_index and port
4374776a3906SMoni Shoua  * INIT  to RTR : must set min_rnr_timer, tclass, flow_label,
4375776a3906SMoni Shoua  *			   mtu, gid_index and hop_limit
4376776a3906SMoni Shoua  * Other transitions and attributes are illegal
4377776a3906SMoni Shoua  */
4378776a3906SMoni Shoua static int mlx5_ib_modify_dct(struct ib_qp *ibqp, struct ib_qp_attr *attr,
4379a645a89dSLeon Romanovsky 			      int attr_mask, struct mlx5_ib_modify_qp *ucmd,
4380a645a89dSLeon Romanovsky 			      struct ib_udata *udata)
4381776a3906SMoni Shoua {
4382776a3906SMoni Shoua 	struct mlx5_ib_qp *qp = to_mqp(ibqp);
4383776a3906SMoni Shoua 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
4384776a3906SMoni Shoua 	enum ib_qp_state cur_state, new_state;
4385776a3906SMoni Shoua 	int required = IB_QP_STATE;
4386776a3906SMoni Shoua 	void *dctc;
438771cab8efSLeon Romanovsky 	int err;
4388776a3906SMoni Shoua 
4389776a3906SMoni Shoua 	if (!(attr_mask & IB_QP_STATE))
4390776a3906SMoni Shoua 		return -EINVAL;
4391776a3906SMoni Shoua 
4392776a3906SMoni Shoua 	cur_state = qp->state;
4393776a3906SMoni Shoua 	new_state = attr->qp_state;
4394776a3906SMoni Shoua 
4395776a3906SMoni Shoua 	dctc = MLX5_ADDR_OF(create_dct_in, qp->dct.in, dct_context_entry);
4396a645a89dSLeon Romanovsky 	if (MLX5_CAP_GEN(dev->mdev, ece_support) && ucmd->ece_options)
4397a645a89dSLeon Romanovsky 		/*
4398a645a89dSLeon Romanovsky 		 * DCT doesn't initialize QP till modify command is executed,
4399a645a89dSLeon Romanovsky 		 * so we need to overwrite previously set ECE field if user
4400a645a89dSLeon Romanovsky 		 * provided any value except zero, which means not set/not
4401a645a89dSLeon Romanovsky 		 * valid.
4402a645a89dSLeon Romanovsky 		 */
4403a645a89dSLeon Romanovsky 		MLX5_SET(dctc, dctc, ece, ucmd->ece_options);
4404a645a89dSLeon Romanovsky 
4405776a3906SMoni Shoua 	if (cur_state == IB_QPS_RESET && new_state == IB_QPS_INIT) {
44063e1f000fSParav Pandit 		u16 set_id;
44073e1f000fSParav Pandit 
4408776a3906SMoni Shoua 		required |= IB_QP_ACCESS_FLAGS | IB_QP_PKEY_INDEX | IB_QP_PORT;
4409776a3906SMoni Shoua 		if (!is_valid_mask(attr_mask, required, 0))
4410776a3906SMoni Shoua 			return -EINVAL;
4411776a3906SMoni Shoua 
4412776a3906SMoni Shoua 		if (attr->port_num == 0 ||
4413776a3906SMoni Shoua 		    attr->port_num > MLX5_CAP_GEN(dev->mdev, num_ports)) {
4414776a3906SMoni Shoua 			mlx5_ib_dbg(dev, "invalid port number %d. number of ports is %d\n",
4415776a3906SMoni Shoua 				    attr->port_num, dev->num_ports);
4416776a3906SMoni Shoua 			return -EINVAL;
4417776a3906SMoni Shoua 		}
4418776a3906SMoni Shoua 		if (attr->qp_access_flags & IB_ACCESS_REMOTE_READ)
4419776a3906SMoni Shoua 			MLX5_SET(dctc, dctc, rre, 1);
4420776a3906SMoni Shoua 		if (attr->qp_access_flags & IB_ACCESS_REMOTE_WRITE)
4421776a3906SMoni Shoua 			MLX5_SET(dctc, dctc, rwe, 1);
4422776a3906SMoni Shoua 		if (attr->qp_access_flags & IB_ACCESS_REMOTE_ATOMIC) {
4423a60109dcSYonatan Cohen 			int atomic_mode;
4424a60109dcSYonatan Cohen 
4425a60109dcSYonatan Cohen 			atomic_mode = get_atomic_mode(dev, MLX5_IB_QPT_DCT);
4426a60109dcSYonatan Cohen 			if (atomic_mode < 0)
4427776a3906SMoni Shoua 				return -EOPNOTSUPP;
4428a60109dcSYonatan Cohen 
4429a60109dcSYonatan Cohen 			MLX5_SET(dctc, dctc, atomic_mode, atomic_mode);
4430776a3906SMoni Shoua 			MLX5_SET(dctc, dctc, rae, 1);
4431776a3906SMoni Shoua 		}
4432776a3906SMoni Shoua 		MLX5_SET(dctc, dctc, pkey_index, attr->pkey_index);
44337c4b1ab9SMark Zhang 		if (mlx5_lag_is_active(dev->mdev))
44347c4b1ab9SMark Zhang 			MLX5_SET(dctc, dctc, port,
44357c4b1ab9SMark Zhang 				 get_tx_affinity_rr(dev, udata));
44367c4b1ab9SMark Zhang 		else
4437776a3906SMoni Shoua 			MLX5_SET(dctc, dctc, port, attr->port_num);
44383e1f000fSParav Pandit 
44393e1f000fSParav Pandit 		set_id = mlx5_ib_get_counters_id(dev, attr->port_num - 1);
44403e1f000fSParav Pandit 		MLX5_SET(dctc, dctc, counter_set_id, set_id);
4441776a3906SMoni Shoua 	} else if (cur_state == IB_QPS_INIT && new_state == IB_QPS_RTR) {
4442776a3906SMoni Shoua 		struct mlx5_ib_modify_qp_resp resp = {};
4443a645a89dSLeon Romanovsky 		u32 out[MLX5_ST_SZ_DW(create_dct_out)] = {};
4444a645a89dSLeon Romanovsky 		u32 min_resp_len = offsetofend(typeof(resp), dctn);
4445776a3906SMoni Shoua 
4446776a3906SMoni Shoua 		if (udata->outlen < min_resp_len)
4447776a3906SMoni Shoua 			return -EINVAL;
4448a645a89dSLeon Romanovsky 		/*
4449a645a89dSLeon Romanovsky 		 * If we don't have enough space for the ECE options,
4450a645a89dSLeon Romanovsky 		 * simply indicate it with resp.response_length.
4451a645a89dSLeon Romanovsky 		 */
4452a645a89dSLeon Romanovsky 		resp.response_length = (udata->outlen < sizeof(resp)) ?
4453a645a89dSLeon Romanovsky 					       min_resp_len :
4454a645a89dSLeon Romanovsky 					       sizeof(resp);
4455a645a89dSLeon Romanovsky 
4456776a3906SMoni Shoua 		required |= IB_QP_MIN_RNR_TIMER | IB_QP_AV | IB_QP_PATH_MTU;
4457776a3906SMoni Shoua 		if (!is_valid_mask(attr_mask, required, 0))
4458776a3906SMoni Shoua 			return -EINVAL;
4459776a3906SMoni Shoua 		MLX5_SET(dctc, dctc, min_rnr_nak, attr->min_rnr_timer);
4460776a3906SMoni Shoua 		MLX5_SET(dctc, dctc, tclass, attr->ah_attr.grh.traffic_class);
4461776a3906SMoni Shoua 		MLX5_SET(dctc, dctc, flow_label, attr->ah_attr.grh.flow_label);
4462776a3906SMoni Shoua 		MLX5_SET(dctc, dctc, mtu, attr->path_mtu);
4463776a3906SMoni Shoua 		MLX5_SET(dctc, dctc, my_addr_index, attr->ah_attr.grh.sgid_index);
4464776a3906SMoni Shoua 		MLX5_SET(dctc, dctc, hop_limit, attr->ah_attr.grh.hop_limit);
4465776a3906SMoni Shoua 
4466333fbaa0SLeon Romanovsky 		err = mlx5_core_create_dct(dev, &qp->dct.mdct, qp->dct.in,
4467c5ae1954SYishai Hadas 					   MLX5_ST_SZ_BYTES(create_dct_in), out,
4468c5ae1954SYishai Hadas 					   sizeof(out));
4469776a3906SMoni Shoua 		if (err)
4470776a3906SMoni Shoua 			return err;
4471776a3906SMoni Shoua 		resp.dctn = qp->dct.mdct.mqp.qpn;
4472a645a89dSLeon Romanovsky 		if (MLX5_CAP_GEN(dev->mdev, ece_support))
4473a645a89dSLeon Romanovsky 			resp.ece_options = MLX5_GET(create_dct_out, out, ece);
4474776a3906SMoni Shoua 		err = ib_copy_to_udata(udata, &resp, resp.response_length);
4475776a3906SMoni Shoua 		if (err) {
4476333fbaa0SLeon Romanovsky 			mlx5_core_destroy_dct(dev, &qp->dct.mdct);
4477776a3906SMoni Shoua 			return err;
4478776a3906SMoni Shoua 		}
4479776a3906SMoni Shoua 	} else {
4480776a3906SMoni Shoua 		mlx5_ib_warn(dev, "Modify DCT: Invalid transition from %d to %d\n", cur_state, new_state);
4481776a3906SMoni Shoua 		return -EINVAL;
4482776a3906SMoni Shoua 	}
448371cab8efSLeon Romanovsky 
4484776a3906SMoni Shoua 	qp->state = new_state;
448571cab8efSLeon Romanovsky 	return 0;
4486776a3906SMoni Shoua }
4487776a3906SMoni Shoua 
44882614488dSMark Bloch static bool mlx5_ib_modify_qp_allowed(struct mlx5_ib_dev *dev,
44899ecf6ac1SMaor Gottlieb 				      struct mlx5_ib_qp *qp)
44902614488dSMark Bloch {
44912614488dSMark Bloch 	if (dev->profile != &raw_eth_profile)
44922614488dSMark Bloch 		return true;
44932614488dSMark Bloch 
44949ecf6ac1SMaor Gottlieb 	if (qp->type == IB_QPT_RAW_PACKET || qp->type == MLX5_IB_QPT_REG_UMR)
44952614488dSMark Bloch 		return true;
44962614488dSMark Bloch 
44972614488dSMark Bloch 	/* Internal QP used for wc testing, with NOPs in wq */
44982614488dSMark Bloch 	if (qp->flags & MLX5_IB_QP_CREATE_WC_TEST)
44992614488dSMark Bloch 		return true;
45002614488dSMark Bloch 
45012614488dSMark Bloch 	return false;
45022614488dSMark Bloch }
45032614488dSMark Bloch 
4504e126ba97SEli Cohen int mlx5_ib_modify_qp(struct ib_qp *ibqp, struct ib_qp_attr *attr,
4505e126ba97SEli Cohen 		      int attr_mask, struct ib_udata *udata)
4506e126ba97SEli Cohen {
4507e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
450850aec2c3SLeon Romanovsky 	struct mlx5_ib_modify_qp_resp resp = {};
4509e126ba97SEli Cohen 	struct mlx5_ib_qp *qp = to_mqp(ibqp);
451061147f39SBodong Wang 	struct mlx5_ib_modify_qp ucmd = {};
4511d16e91daSHaggai Eran 	enum ib_qp_type qp_type;
4512e126ba97SEli Cohen 	enum ib_qp_state cur_state, new_state;
4513e126ba97SEli Cohen 	int err = -EINVAL;
4514e126ba97SEli Cohen 
45159ecf6ac1SMaor Gottlieb 	if (!mlx5_ib_modify_qp_allowed(dev, qp))
45162614488dSMark Bloch 		return -EOPNOTSUPP;
45172614488dSMark Bloch 
451826e990baSJason Gunthorpe 	if (attr_mask & ~(IB_QP_ATTR_STANDARD_BITS | IB_QP_RATE_LIMIT))
451926e990baSJason Gunthorpe 		return -EOPNOTSUPP;
452026e990baSJason Gunthorpe 
452128d61370SYishai Hadas 	if (ibqp->rwq_ind_tbl)
452228d61370SYishai Hadas 		return -ENOSYS;
452328d61370SYishai Hadas 
452461147f39SBodong Wang 	if (udata && udata->inlen) {
45255f62a521SLeon Romanovsky 		if (udata->inlen < offsetofend(typeof(ucmd), ece_options))
452661147f39SBodong Wang 			return -EINVAL;
452761147f39SBodong Wang 
452861147f39SBodong Wang 		if (udata->inlen > sizeof(ucmd) &&
452961147f39SBodong Wang 		    !ib_is_udata_cleared(udata, sizeof(ucmd),
453061147f39SBodong Wang 					 udata->inlen - sizeof(ucmd)))
453161147f39SBodong Wang 			return -EOPNOTSUPP;
453261147f39SBodong Wang 
453361147f39SBodong Wang 		if (ib_copy_from_udata(&ucmd, udata,
453461147f39SBodong Wang 				       min(udata->inlen, sizeof(ucmd))))
453561147f39SBodong Wang 			return -EFAULT;
453661147f39SBodong Wang 
453761147f39SBodong Wang 		if (ucmd.comp_mask ||
453861147f39SBodong Wang 		    memchr_inv(&ucmd.burst_info.reserved, 0,
453961147f39SBodong Wang 			       sizeof(ucmd.burst_info.reserved)))
454061147f39SBodong Wang 			return -EOPNOTSUPP;
45415f62a521SLeon Romanovsky 
454261147f39SBodong Wang 	}
454361147f39SBodong Wang 
45449ecf6ac1SMaor Gottlieb 	if (qp->type == IB_QPT_GSI)
4545d16e91daSHaggai Eran 		return mlx5_ib_gsi_modify_qp(ibqp, attr, attr_mask);
4546d16e91daSHaggai Eran 
45479ecf6ac1SMaor Gottlieb 	qp_type = (qp->type == MLX5_IB_QPT_HW_GSI) ? IB_QPT_GSI : qp->type;
4548d16e91daSHaggai Eran 
4549a645a89dSLeon Romanovsky 	if (qp_type == MLX5_IB_QPT_DCT)
4550a645a89dSLeon Romanovsky 		return mlx5_ib_modify_dct(ibqp, attr, attr_mask, &ucmd, udata);
4551c32a4f29SMoni Shoua 
4552e126ba97SEli Cohen 	mutex_lock(&qp->mutex);
4553e126ba97SEli Cohen 
4554e126ba97SEli Cohen 	cur_state = attr_mask & IB_QP_CUR_STATE ? attr->cur_qp_state : qp->state;
4555e126ba97SEli Cohen 	new_state = attr_mask & IB_QP_STATE ? attr->qp_state : cur_state;
4556e126ba97SEli Cohen 
45572be08c30SLeon Romanovsky 	if (qp->flags & IB_QP_CREATE_SOURCE_QPN) {
4558c2e53b2cSYishai Hadas 		if (attr_mask & ~(IB_QP_STATE | IB_QP_CUR_STATE)) {
4559c2e53b2cSYishai Hadas 			mlx5_ib_dbg(dev, "invalid attr_mask 0x%x when underlay QP is used\n",
4560c2e53b2cSYishai Hadas 				    attr_mask);
4561c2e53b2cSYishai Hadas 			goto out;
4562c2e53b2cSYishai Hadas 		}
4563c2e53b2cSYishai Hadas 	} else if (qp_type != MLX5_IB_QPT_REG_UMR &&
4564c32a4f29SMoni Shoua 		   qp_type != MLX5_IB_QPT_DCI &&
4565d31131bbSKamal Heib 		   !ib_modify_qp_is_ok(cur_state, new_state, qp_type,
4566d31131bbSKamal Heib 				       attr_mask)) {
4567158abf86SHaggai Eran 		mlx5_ib_dbg(dev, "invalid QP state transition from %d to %d, qp_type %d, attr_mask 0x%x\n",
45689ecf6ac1SMaor Gottlieb 			    cur_state, new_state, qp->type, attr_mask);
4569e126ba97SEli Cohen 		goto out;
4570c32a4f29SMoni Shoua 	} else if (qp_type == MLX5_IB_QPT_DCI &&
4571c32a4f29SMoni Shoua 		   !modify_dci_qp_is_ok(cur_state, new_state, attr_mask)) {
4572c32a4f29SMoni Shoua 		mlx5_ib_dbg(dev, "invalid QP state transition from %d to %d, qp_type %d, attr_mask 0x%x\n",
4573c32a4f29SMoni Shoua 			    cur_state, new_state, qp_type, attr_mask);
4574c32a4f29SMoni Shoua 		goto out;
4575158abf86SHaggai Eran 	}
4576e126ba97SEli Cohen 
4577e126ba97SEli Cohen 	if ((attr_mask & IB_QP_PORT) &&
4578938fe83cSSaeed Mahameed 	    (attr->port_num == 0 ||
4579508562d6SDaniel Jurgens 	     attr->port_num > dev->num_ports)) {
4580158abf86SHaggai Eran 		mlx5_ib_dbg(dev, "invalid port number %d. number of ports is %d\n",
4581158abf86SHaggai Eran 			    attr->port_num, dev->num_ports);
4582e126ba97SEli Cohen 		goto out;
4583158abf86SHaggai Eran 	}
4584e126ba97SEli Cohen 
45852019d70eSParav Pandit 	if ((attr_mask & IB_QP_PKEY_INDEX) &&
45862019d70eSParav Pandit 	    attr->pkey_index >= dev->pkey_table_len) {
45872019d70eSParav Pandit 		mlx5_ib_dbg(dev, "invalid pkey index %d\n", attr->pkey_index);
4588e126ba97SEli Cohen 		goto out;
4589e126ba97SEli Cohen 	}
4590e126ba97SEli Cohen 
4591e126ba97SEli Cohen 	if (attr_mask & IB_QP_MAX_QP_RD_ATOMIC &&
4592938fe83cSSaeed Mahameed 	    attr->max_rd_atomic >
4593158abf86SHaggai Eran 	    (1 << MLX5_CAP_GEN(dev->mdev, log_max_ra_res_qp))) {
4594158abf86SHaggai Eran 		mlx5_ib_dbg(dev, "invalid max_rd_atomic value %d\n",
4595158abf86SHaggai Eran 			    attr->max_rd_atomic);
4596e126ba97SEli Cohen 		goto out;
4597158abf86SHaggai Eran 	}
4598e126ba97SEli Cohen 
4599e126ba97SEli Cohen 	if (attr_mask & IB_QP_MAX_DEST_RD_ATOMIC &&
4600938fe83cSSaeed Mahameed 	    attr->max_dest_rd_atomic >
4601158abf86SHaggai Eran 	    (1 << MLX5_CAP_GEN(dev->mdev, log_max_ra_req_qp))) {
4602158abf86SHaggai Eran 		mlx5_ib_dbg(dev, "invalid max_dest_rd_atomic value %d\n",
4603158abf86SHaggai Eran 			    attr->max_dest_rd_atomic);
4604e126ba97SEli Cohen 		goto out;
4605158abf86SHaggai Eran 	}
4606e126ba97SEli Cohen 
4607e126ba97SEli Cohen 	if (cur_state == new_state && cur_state == IB_QPS_RESET) {
4608e126ba97SEli Cohen 		err = 0;
4609e126ba97SEli Cohen 		goto out;
4610e126ba97SEli Cohen 	}
4611e126ba97SEli Cohen 
461261147f39SBodong Wang 	err = __mlx5_ib_modify_qp(ibqp, attr, attr_mask, cur_state,
461350aec2c3SLeon Romanovsky 				  new_state, &ucmd, &resp, udata);
461450aec2c3SLeon Romanovsky 
461550aec2c3SLeon Romanovsky 	/* resp.response_length is set in ECE supported flows only */
461650aec2c3SLeon Romanovsky 	if (!err && resp.response_length &&
461750aec2c3SLeon Romanovsky 	    udata->outlen >= resp.response_length)
46186512f11dSLeon Romanovsky 		/* Return -EFAULT to the user and expect him to destroy QP. */
46196512f11dSLeon Romanovsky 		err = ib_copy_to_udata(udata, &resp, resp.response_length);
4620e126ba97SEli Cohen 
4621e126ba97SEli Cohen out:
4622e126ba97SEli Cohen 	mutex_unlock(&qp->mutex);
4623e126ba97SEli Cohen 	return err;
4624e126ba97SEli Cohen }
4625e126ba97SEli Cohen 
4626e126ba97SEli Cohen static inline enum ib_qp_state to_ib_qp_state(enum mlx5_qp_state mlx5_state)
4627e126ba97SEli Cohen {
4628e126ba97SEli Cohen 	switch (mlx5_state) {
4629e126ba97SEli Cohen 	case MLX5_QP_STATE_RST:      return IB_QPS_RESET;
4630e126ba97SEli Cohen 	case MLX5_QP_STATE_INIT:     return IB_QPS_INIT;
4631e126ba97SEli Cohen 	case MLX5_QP_STATE_RTR:      return IB_QPS_RTR;
4632e126ba97SEli Cohen 	case MLX5_QP_STATE_RTS:      return IB_QPS_RTS;
4633e126ba97SEli Cohen 	case MLX5_QP_STATE_SQ_DRAINING:
4634e126ba97SEli Cohen 	case MLX5_QP_STATE_SQD:      return IB_QPS_SQD;
4635e126ba97SEli Cohen 	case MLX5_QP_STATE_SQER:     return IB_QPS_SQE;
4636e126ba97SEli Cohen 	case MLX5_QP_STATE_ERR:      return IB_QPS_ERR;
4637e126ba97SEli Cohen 	default:		     return -1;
4638e126ba97SEli Cohen 	}
4639e126ba97SEli Cohen }
4640e126ba97SEli Cohen 
4641e126ba97SEli Cohen static inline enum ib_mig_state to_ib_mig_state(int mlx5_mig_state)
4642e126ba97SEli Cohen {
4643e126ba97SEli Cohen 	switch (mlx5_mig_state) {
4644e126ba97SEli Cohen 	case MLX5_QP_PM_ARMED:		return IB_MIG_ARMED;
4645e126ba97SEli Cohen 	case MLX5_QP_PM_REARM:		return IB_MIG_REARM;
4646e126ba97SEli Cohen 	case MLX5_QP_PM_MIGRATED:	return IB_MIG_MIGRATED;
4647e126ba97SEli Cohen 	default: return -1;
4648e126ba97SEli Cohen 	}
4649e126ba97SEli Cohen }
4650e126ba97SEli Cohen 
465138349389SDasaratharaman Chandramouli static void to_rdma_ah_attr(struct mlx5_ib_dev *ibdev,
465270bd7fb8SLeon Romanovsky 			    struct rdma_ah_attr *ah_attr, void *path)
4653e126ba97SEli Cohen {
465470bd7fb8SLeon Romanovsky 	int port = MLX5_GET(ads, path, vhca_port_num);
465570bd7fb8SLeon Romanovsky 	int static_rate;
4656e126ba97SEli Cohen 
4657d8966fcdSDasaratharaman Chandramouli 	memset(ah_attr, 0, sizeof(*ah_attr));
4658e126ba97SEli Cohen 
465970bd7fb8SLeon Romanovsky 	if (!port || port > ibdev->num_ports)
4660e126ba97SEli Cohen 		return;
4661e126ba97SEli Cohen 
466270bd7fb8SLeon Romanovsky 	ah_attr->type = rdma_ah_find_type(&ibdev->ib_dev, port);
4663ae59c3f0SLeon Romanovsky 
466470bd7fb8SLeon Romanovsky 	rdma_ah_set_port_num(ah_attr, port);
466570bd7fb8SLeon Romanovsky 	rdma_ah_set_sl(ah_attr, MLX5_GET(ads, path, sl));
4666e126ba97SEli Cohen 
466770bd7fb8SLeon Romanovsky 	rdma_ah_set_dlid(ah_attr, MLX5_GET(ads, path, rlid));
466870bd7fb8SLeon Romanovsky 	rdma_ah_set_path_bits(ah_attr, MLX5_GET(ads, path, mlid));
46692d7e3ff7SAharon Landau 
467070bd7fb8SLeon Romanovsky 	static_rate = MLX5_GET(ads, path, stat_rate);
46716fe6e568SMark Zhang 	rdma_ah_set_static_rate(ah_attr, mlx5_to_ib_rate_map(static_rate));
467270bd7fb8SLeon Romanovsky 	if (MLX5_GET(ads, path, grh) ||
46732d7e3ff7SAharon Landau 	    ah_attr->type == RDMA_AH_ATTR_TYPE_ROCE) {
467470bd7fb8SLeon Romanovsky 		rdma_ah_set_grh(ah_attr, NULL, MLX5_GET(ads, path, flow_label),
467570bd7fb8SLeon Romanovsky 				MLX5_GET(ads, path, src_addr_index),
467670bd7fb8SLeon Romanovsky 				MLX5_GET(ads, path, hop_limit),
467770bd7fb8SLeon Romanovsky 				MLX5_GET(ads, path, tclass));
4678d4433557SMaor Gottlieb 		rdma_ah_set_dgid_raw(ah_attr, MLX5_ADDR_OF(ads, path, rgid_rip));
4679e126ba97SEli Cohen 	}
4680e126ba97SEli Cohen }
4681e126ba97SEli Cohen 
46826d2f89dfSmajd@mellanox.com static int query_raw_packet_qp_sq_state(struct mlx5_ib_dev *dev,
46836d2f89dfSmajd@mellanox.com 					struct mlx5_ib_sq *sq,
46846d2f89dfSmajd@mellanox.com 					u8 *sq_state)
4685e126ba97SEli Cohen {
46866d2f89dfSmajd@mellanox.com 	int err;
46876d2f89dfSmajd@mellanox.com 
468828160771SEran Ben Elisha 	err = mlx5_core_query_sq_state(dev->mdev, sq->base.mqp.qpn, sq_state);
46896d2f89dfSmajd@mellanox.com 	if (err)
46906d2f89dfSmajd@mellanox.com 		goto out;
46916d2f89dfSmajd@mellanox.com 	sq->state = *sq_state;
46926d2f89dfSmajd@mellanox.com 
46936d2f89dfSmajd@mellanox.com out:
46946d2f89dfSmajd@mellanox.com 	return err;
46956d2f89dfSmajd@mellanox.com }
46966d2f89dfSmajd@mellanox.com 
46976d2f89dfSmajd@mellanox.com static int query_raw_packet_qp_rq_state(struct mlx5_ib_dev *dev,
46986d2f89dfSmajd@mellanox.com 					struct mlx5_ib_rq *rq,
46996d2f89dfSmajd@mellanox.com 					u8 *rq_state)
47006d2f89dfSmajd@mellanox.com {
47016d2f89dfSmajd@mellanox.com 	void *out;
47026d2f89dfSmajd@mellanox.com 	void *rqc;
47036d2f89dfSmajd@mellanox.com 	int inlen;
47046d2f89dfSmajd@mellanox.com 	int err;
47056d2f89dfSmajd@mellanox.com 
47066d2f89dfSmajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(query_rq_out);
47071b9a07eeSLeon Romanovsky 	out = kvzalloc(inlen, GFP_KERNEL);
47086d2f89dfSmajd@mellanox.com 	if (!out)
47096d2f89dfSmajd@mellanox.com 		return -ENOMEM;
47106d2f89dfSmajd@mellanox.com 
47116d2f89dfSmajd@mellanox.com 	err = mlx5_core_query_rq(dev->mdev, rq->base.mqp.qpn, out);
47126d2f89dfSmajd@mellanox.com 	if (err)
47136d2f89dfSmajd@mellanox.com 		goto out;
47146d2f89dfSmajd@mellanox.com 
47156d2f89dfSmajd@mellanox.com 	rqc = MLX5_ADDR_OF(query_rq_out, out, rq_context);
47166d2f89dfSmajd@mellanox.com 	*rq_state = MLX5_GET(rqc, rqc, state);
47176d2f89dfSmajd@mellanox.com 	rq->state = *rq_state;
47186d2f89dfSmajd@mellanox.com 
47196d2f89dfSmajd@mellanox.com out:
47206d2f89dfSmajd@mellanox.com 	kvfree(out);
47216d2f89dfSmajd@mellanox.com 	return err;
47226d2f89dfSmajd@mellanox.com }
47236d2f89dfSmajd@mellanox.com 
47246d2f89dfSmajd@mellanox.com static int sqrq_state_to_qp_state(u8 sq_state, u8 rq_state,
47256d2f89dfSmajd@mellanox.com 				  struct mlx5_ib_qp *qp, u8 *qp_state)
47266d2f89dfSmajd@mellanox.com {
47276d2f89dfSmajd@mellanox.com 	static const u8 sqrq_trans[MLX5_RQ_NUM_STATE][MLX5_SQ_NUM_STATE] = {
47286d2f89dfSmajd@mellanox.com 		[MLX5_RQC_STATE_RST] = {
47296d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RST]	= IB_QPS_RESET,
47306d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RDY]	= MLX5_QP_STATE_BAD,
47316d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_ERR]	= MLX5_QP_STATE_BAD,
47326d2f89dfSmajd@mellanox.com 			[MLX5_SQ_STATE_NA]	= IB_QPS_RESET,
47336d2f89dfSmajd@mellanox.com 		},
47346d2f89dfSmajd@mellanox.com 		[MLX5_RQC_STATE_RDY] = {
4735c94e272bSMaor Gottlieb 			[MLX5_SQC_STATE_RST]	= MLX5_QP_STATE,
47366d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RDY]	= MLX5_QP_STATE,
47376d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_ERR]	= IB_QPS_SQE,
47386d2f89dfSmajd@mellanox.com 			[MLX5_SQ_STATE_NA]	= MLX5_QP_STATE,
47396d2f89dfSmajd@mellanox.com 		},
47406d2f89dfSmajd@mellanox.com 		[MLX5_RQC_STATE_ERR] = {
47416d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RST]    = MLX5_QP_STATE_BAD,
47426d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RDY]	= MLX5_QP_STATE_BAD,
47436d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_ERR]	= IB_QPS_ERR,
47446d2f89dfSmajd@mellanox.com 			[MLX5_SQ_STATE_NA]	= IB_QPS_ERR,
47456d2f89dfSmajd@mellanox.com 		},
47466d2f89dfSmajd@mellanox.com 		[MLX5_RQ_STATE_NA] = {
4747c94e272bSMaor Gottlieb 			[MLX5_SQC_STATE_RST]    = MLX5_QP_STATE,
47486d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RDY]	= MLX5_QP_STATE,
47496d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_ERR]	= MLX5_QP_STATE,
47506d2f89dfSmajd@mellanox.com 			[MLX5_SQ_STATE_NA]	= MLX5_QP_STATE_BAD,
47516d2f89dfSmajd@mellanox.com 		},
47526d2f89dfSmajd@mellanox.com 	};
47536d2f89dfSmajd@mellanox.com 
47546d2f89dfSmajd@mellanox.com 	*qp_state = sqrq_trans[rq_state][sq_state];
47556d2f89dfSmajd@mellanox.com 
47566d2f89dfSmajd@mellanox.com 	if (*qp_state == MLX5_QP_STATE_BAD) {
47576d2f89dfSmajd@mellanox.com 		WARN(1, "Buggy Raw Packet QP state, SQ 0x%x state: 0x%x, RQ 0x%x state: 0x%x",
47586d2f89dfSmajd@mellanox.com 		     qp->raw_packet_qp.sq.base.mqp.qpn, sq_state,
47596d2f89dfSmajd@mellanox.com 		     qp->raw_packet_qp.rq.base.mqp.qpn, rq_state);
47606d2f89dfSmajd@mellanox.com 		return -EINVAL;
47616d2f89dfSmajd@mellanox.com 	}
47626d2f89dfSmajd@mellanox.com 
47636d2f89dfSmajd@mellanox.com 	if (*qp_state == MLX5_QP_STATE)
47646d2f89dfSmajd@mellanox.com 		*qp_state = qp->state;
47656d2f89dfSmajd@mellanox.com 
47666d2f89dfSmajd@mellanox.com 	return 0;
47676d2f89dfSmajd@mellanox.com }
47686d2f89dfSmajd@mellanox.com 
47696d2f89dfSmajd@mellanox.com static int query_raw_packet_qp_state(struct mlx5_ib_dev *dev,
47706d2f89dfSmajd@mellanox.com 				     struct mlx5_ib_qp *qp,
47716d2f89dfSmajd@mellanox.com 				     u8 *raw_packet_qp_state)
47726d2f89dfSmajd@mellanox.com {
47736d2f89dfSmajd@mellanox.com 	struct mlx5_ib_raw_packet_qp *raw_packet_qp = &qp->raw_packet_qp;
47746d2f89dfSmajd@mellanox.com 	struct mlx5_ib_sq *sq = &raw_packet_qp->sq;
47756d2f89dfSmajd@mellanox.com 	struct mlx5_ib_rq *rq = &raw_packet_qp->rq;
47766d2f89dfSmajd@mellanox.com 	int err;
47776d2f89dfSmajd@mellanox.com 	u8 sq_state = MLX5_SQ_STATE_NA;
47786d2f89dfSmajd@mellanox.com 	u8 rq_state = MLX5_RQ_STATE_NA;
47796d2f89dfSmajd@mellanox.com 
47806d2f89dfSmajd@mellanox.com 	if (qp->sq.wqe_cnt) {
47816d2f89dfSmajd@mellanox.com 		err = query_raw_packet_qp_sq_state(dev, sq, &sq_state);
47826d2f89dfSmajd@mellanox.com 		if (err)
47836d2f89dfSmajd@mellanox.com 			return err;
47846d2f89dfSmajd@mellanox.com 	}
47856d2f89dfSmajd@mellanox.com 
47866d2f89dfSmajd@mellanox.com 	if (qp->rq.wqe_cnt) {
47876d2f89dfSmajd@mellanox.com 		err = query_raw_packet_qp_rq_state(dev, rq, &rq_state);
47886d2f89dfSmajd@mellanox.com 		if (err)
47896d2f89dfSmajd@mellanox.com 			return err;
47906d2f89dfSmajd@mellanox.com 	}
47916d2f89dfSmajd@mellanox.com 
47926d2f89dfSmajd@mellanox.com 	return sqrq_state_to_qp_state(sq_state, rq_state, qp,
47936d2f89dfSmajd@mellanox.com 				      raw_packet_qp_state);
47946d2f89dfSmajd@mellanox.com }
47956d2f89dfSmajd@mellanox.com 
47966d2f89dfSmajd@mellanox.com static int query_qp_attr(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
47976d2f89dfSmajd@mellanox.com 			 struct ib_qp_attr *qp_attr)
47986d2f89dfSmajd@mellanox.com {
479909a7d9ecSSaeed Mahameed 	int outlen = MLX5_ST_SZ_BYTES(query_qp_out);
480070bd7fb8SLeon Romanovsky 	void *qpc, *pri_path, *alt_path;
480109a7d9ecSSaeed Mahameed 	u32 *outb;
480270bd7fb8SLeon Romanovsky 	int err;
4803e126ba97SEli Cohen 
480409a7d9ecSSaeed Mahameed 	outb = kzalloc(outlen, GFP_KERNEL);
48056d2f89dfSmajd@mellanox.com 	if (!outb)
48066d2f89dfSmajd@mellanox.com 		return -ENOMEM;
48076d2f89dfSmajd@mellanox.com 
4808333fbaa0SLeon Romanovsky 	err = mlx5_core_qp_query(dev, &qp->trans_qp.base.mqp, outb, outlen);
4809e126ba97SEli Cohen 	if (err)
48106d2f89dfSmajd@mellanox.com 		goto out;
4811e126ba97SEli Cohen 
481270bd7fb8SLeon Romanovsky 	qpc = MLX5_ADDR_OF(query_qp_out, outb, qpc);
481309a7d9ecSSaeed Mahameed 
481470bd7fb8SLeon Romanovsky 	qp->state = to_ib_qp_state(MLX5_GET(qpc, qpc, state));
481570bd7fb8SLeon Romanovsky 	if (MLX5_GET(qpc, qpc, state) == MLX5_QP_STATE_SQ_DRAINING)
481670bd7fb8SLeon Romanovsky 		qp_attr->sq_draining = 1;
4817e126ba97SEli Cohen 
481870bd7fb8SLeon Romanovsky 	qp_attr->path_mtu = MLX5_GET(qpc, qpc, mtu);
481970bd7fb8SLeon Romanovsky 	qp_attr->path_mig_state = to_ib_mig_state(MLX5_GET(qpc, qpc, pm_state));
482070bd7fb8SLeon Romanovsky 	qp_attr->qkey = MLX5_GET(qpc, qpc, q_key);
482170bd7fb8SLeon Romanovsky 	qp_attr->rq_psn = MLX5_GET(qpc, qpc, next_rcv_psn);
482270bd7fb8SLeon Romanovsky 	qp_attr->sq_psn = MLX5_GET(qpc, qpc, next_send_psn);
482370bd7fb8SLeon Romanovsky 	qp_attr->dest_qp_num = MLX5_GET(qpc, qpc, remote_qpn);
482470bd7fb8SLeon Romanovsky 
482570bd7fb8SLeon Romanovsky 	if (MLX5_GET(qpc, qpc, rre))
482670bd7fb8SLeon Romanovsky 		qp_attr->qp_access_flags |= IB_ACCESS_REMOTE_READ;
482770bd7fb8SLeon Romanovsky 	if (MLX5_GET(qpc, qpc, rwe))
482870bd7fb8SLeon Romanovsky 		qp_attr->qp_access_flags |= IB_ACCESS_REMOTE_WRITE;
482970bd7fb8SLeon Romanovsky 	if (MLX5_GET(qpc, qpc, rae))
483070bd7fb8SLeon Romanovsky 		qp_attr->qp_access_flags |= IB_ACCESS_REMOTE_ATOMIC;
483170bd7fb8SLeon Romanovsky 
483270bd7fb8SLeon Romanovsky 	qp_attr->max_rd_atomic = 1 << MLX5_GET(qpc, qpc, log_sra_max);
483370bd7fb8SLeon Romanovsky 	qp_attr->max_dest_rd_atomic = 1 << MLX5_GET(qpc, qpc, log_rra_max);
483470bd7fb8SLeon Romanovsky 	qp_attr->min_rnr_timer = MLX5_GET(qpc, qpc, min_rnr_nak);
483570bd7fb8SLeon Romanovsky 	qp_attr->retry_cnt = MLX5_GET(qpc, qpc, retry_count);
483670bd7fb8SLeon Romanovsky 	qp_attr->rnr_retry = MLX5_GET(qpc, qpc, rnr_retry);
483770bd7fb8SLeon Romanovsky 
483870bd7fb8SLeon Romanovsky 	pri_path = MLX5_ADDR_OF(qpc, qpc, primary_address_path);
483970bd7fb8SLeon Romanovsky 	alt_path = MLX5_ADDR_OF(qpc, qpc, secondary_address_path);
4840e126ba97SEli Cohen 
48419ecf6ac1SMaor Gottlieb 	if (qp->type == IB_QPT_RC || qp->type == IB_QPT_UC ||
48429ecf6ac1SMaor Gottlieb 	    qp->type == IB_QPT_XRC_INI || qp->type == IB_QPT_XRC_TGT) {
484370bd7fb8SLeon Romanovsky 		to_rdma_ah_attr(dev, &qp_attr->ah_attr, pri_path);
484470bd7fb8SLeon Romanovsky 		to_rdma_ah_attr(dev, &qp_attr->alt_ah_attr, alt_path);
484570bd7fb8SLeon Romanovsky 		qp_attr->alt_pkey_index = MLX5_GET(ads, alt_path, pkey_index);
484670bd7fb8SLeon Romanovsky 		qp_attr->alt_port_num = MLX5_GET(ads, alt_path, vhca_port_num);
4847e126ba97SEli Cohen 	}
4848e126ba97SEli Cohen 
484970bd7fb8SLeon Romanovsky 	qp_attr->pkey_index = MLX5_GET(ads, pri_path, pkey_index);
485070bd7fb8SLeon Romanovsky 	qp_attr->port_num = MLX5_GET(ads, pri_path, vhca_port_num);
485170bd7fb8SLeon Romanovsky 	qp_attr->timeout = MLX5_GET(ads, pri_path, ack_timeout);
485270bd7fb8SLeon Romanovsky 	qp_attr->alt_timeout = MLX5_GET(ads, alt_path, ack_timeout);
48536d2f89dfSmajd@mellanox.com 
48546d2f89dfSmajd@mellanox.com out:
48556d2f89dfSmajd@mellanox.com 	kfree(outb);
48566d2f89dfSmajd@mellanox.com 	return err;
48576d2f89dfSmajd@mellanox.com }
48586d2f89dfSmajd@mellanox.com 
4859776a3906SMoni Shoua static int mlx5_ib_dct_query_qp(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *mqp,
4860776a3906SMoni Shoua 				struct ib_qp_attr *qp_attr, int qp_attr_mask,
4861776a3906SMoni Shoua 				struct ib_qp_init_attr *qp_init_attr)
4862776a3906SMoni Shoua {
4863776a3906SMoni Shoua 	struct mlx5_core_dct	*dct = &mqp->dct.mdct;
4864776a3906SMoni Shoua 	u32 *out;
4865776a3906SMoni Shoua 	u32 access_flags = 0;
4866776a3906SMoni Shoua 	int outlen = MLX5_ST_SZ_BYTES(query_dct_out);
4867776a3906SMoni Shoua 	void *dctc;
4868776a3906SMoni Shoua 	int err;
4869776a3906SMoni Shoua 	int supported_mask = IB_QP_STATE |
4870776a3906SMoni Shoua 			     IB_QP_ACCESS_FLAGS |
4871776a3906SMoni Shoua 			     IB_QP_PORT |
4872776a3906SMoni Shoua 			     IB_QP_MIN_RNR_TIMER |
4873776a3906SMoni Shoua 			     IB_QP_AV |
4874776a3906SMoni Shoua 			     IB_QP_PATH_MTU |
4875776a3906SMoni Shoua 			     IB_QP_PKEY_INDEX;
4876776a3906SMoni Shoua 
4877776a3906SMoni Shoua 	if (qp_attr_mask & ~supported_mask)
4878776a3906SMoni Shoua 		return -EINVAL;
4879776a3906SMoni Shoua 	if (mqp->state != IB_QPS_RTR)
4880776a3906SMoni Shoua 		return -EINVAL;
4881776a3906SMoni Shoua 
4882776a3906SMoni Shoua 	out = kzalloc(outlen, GFP_KERNEL);
4883776a3906SMoni Shoua 	if (!out)
4884776a3906SMoni Shoua 		return -ENOMEM;
4885776a3906SMoni Shoua 
4886333fbaa0SLeon Romanovsky 	err = mlx5_core_dct_query(dev, dct, out, outlen);
4887776a3906SMoni Shoua 	if (err)
4888776a3906SMoni Shoua 		goto out;
4889776a3906SMoni Shoua 
4890776a3906SMoni Shoua 	dctc = MLX5_ADDR_OF(query_dct_out, out, dct_context_entry);
4891776a3906SMoni Shoua 
4892776a3906SMoni Shoua 	if (qp_attr_mask & IB_QP_STATE)
4893776a3906SMoni Shoua 		qp_attr->qp_state = IB_QPS_RTR;
4894776a3906SMoni Shoua 
4895776a3906SMoni Shoua 	if (qp_attr_mask & IB_QP_ACCESS_FLAGS) {
4896776a3906SMoni Shoua 		if (MLX5_GET(dctc, dctc, rre))
4897776a3906SMoni Shoua 			access_flags |= IB_ACCESS_REMOTE_READ;
4898776a3906SMoni Shoua 		if (MLX5_GET(dctc, dctc, rwe))
4899776a3906SMoni Shoua 			access_flags |= IB_ACCESS_REMOTE_WRITE;
4900776a3906SMoni Shoua 		if (MLX5_GET(dctc, dctc, rae))
4901776a3906SMoni Shoua 			access_flags |= IB_ACCESS_REMOTE_ATOMIC;
4902776a3906SMoni Shoua 		qp_attr->qp_access_flags = access_flags;
4903776a3906SMoni Shoua 	}
4904776a3906SMoni Shoua 
4905776a3906SMoni Shoua 	if (qp_attr_mask & IB_QP_PORT)
4906776a3906SMoni Shoua 		qp_attr->port_num = MLX5_GET(dctc, dctc, port);
4907776a3906SMoni Shoua 	if (qp_attr_mask & IB_QP_MIN_RNR_TIMER)
4908776a3906SMoni Shoua 		qp_attr->min_rnr_timer = MLX5_GET(dctc, dctc, min_rnr_nak);
4909776a3906SMoni Shoua 	if (qp_attr_mask & IB_QP_AV) {
4910776a3906SMoni Shoua 		qp_attr->ah_attr.grh.traffic_class = MLX5_GET(dctc, dctc, tclass);
4911776a3906SMoni Shoua 		qp_attr->ah_attr.grh.flow_label = MLX5_GET(dctc, dctc, flow_label);
4912776a3906SMoni Shoua 		qp_attr->ah_attr.grh.sgid_index = MLX5_GET(dctc, dctc, my_addr_index);
4913776a3906SMoni Shoua 		qp_attr->ah_attr.grh.hop_limit = MLX5_GET(dctc, dctc, hop_limit);
4914776a3906SMoni Shoua 	}
4915776a3906SMoni Shoua 	if (qp_attr_mask & IB_QP_PATH_MTU)
4916776a3906SMoni Shoua 		qp_attr->path_mtu = MLX5_GET(dctc, dctc, mtu);
4917776a3906SMoni Shoua 	if (qp_attr_mask & IB_QP_PKEY_INDEX)
4918776a3906SMoni Shoua 		qp_attr->pkey_index = MLX5_GET(dctc, dctc, pkey_index);
4919776a3906SMoni Shoua out:
4920776a3906SMoni Shoua 	kfree(out);
4921776a3906SMoni Shoua 	return err;
4922776a3906SMoni Shoua }
4923776a3906SMoni Shoua 
49246d2f89dfSmajd@mellanox.com int mlx5_ib_query_qp(struct ib_qp *ibqp, struct ib_qp_attr *qp_attr,
49256d2f89dfSmajd@mellanox.com 		     int qp_attr_mask, struct ib_qp_init_attr *qp_init_attr)
49266d2f89dfSmajd@mellanox.com {
49276d2f89dfSmajd@mellanox.com 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
49286d2f89dfSmajd@mellanox.com 	struct mlx5_ib_qp *qp = to_mqp(ibqp);
49296d2f89dfSmajd@mellanox.com 	int err = 0;
49306d2f89dfSmajd@mellanox.com 	u8 raw_packet_qp_state;
49316d2f89dfSmajd@mellanox.com 
493228d61370SYishai Hadas 	if (ibqp->rwq_ind_tbl)
493328d61370SYishai Hadas 		return -ENOSYS;
493428d61370SYishai Hadas 
49359ecf6ac1SMaor Gottlieb 	if (qp->type == IB_QPT_GSI)
4936d16e91daSHaggai Eran 		return mlx5_ib_gsi_query_qp(ibqp, qp_attr, qp_attr_mask,
4937d16e91daSHaggai Eran 					    qp_init_attr);
4938d16e91daSHaggai Eran 
4939c2e53b2cSYishai Hadas 	/* Not all of output fields are applicable, make sure to zero them */
4940c2e53b2cSYishai Hadas 	memset(qp_init_attr, 0, sizeof(*qp_init_attr));
4941c2e53b2cSYishai Hadas 	memset(qp_attr, 0, sizeof(*qp_attr));
4942c2e53b2cSYishai Hadas 
49437aede1a2SLeon Romanovsky 	if (unlikely(qp->type == MLX5_IB_QPT_DCT))
4944776a3906SMoni Shoua 		return mlx5_ib_dct_query_qp(dev, qp, qp_attr,
4945776a3906SMoni Shoua 					    qp_attr_mask, qp_init_attr);
4946776a3906SMoni Shoua 
49476d2f89dfSmajd@mellanox.com 	mutex_lock(&qp->mutex);
49486d2f89dfSmajd@mellanox.com 
49499ecf6ac1SMaor Gottlieb 	if (qp->type == IB_QPT_RAW_PACKET ||
49502be08c30SLeon Romanovsky 	    qp->flags & IB_QP_CREATE_SOURCE_QPN) {
49516d2f89dfSmajd@mellanox.com 		err = query_raw_packet_qp_state(dev, qp, &raw_packet_qp_state);
49526d2f89dfSmajd@mellanox.com 		if (err)
49536d2f89dfSmajd@mellanox.com 			goto out;
49546d2f89dfSmajd@mellanox.com 		qp->state = raw_packet_qp_state;
49556d2f89dfSmajd@mellanox.com 		qp_attr->port_num = 1;
49566d2f89dfSmajd@mellanox.com 	} else {
49576d2f89dfSmajd@mellanox.com 		err = query_qp_attr(dev, qp, qp_attr);
49586d2f89dfSmajd@mellanox.com 		if (err)
49596d2f89dfSmajd@mellanox.com 			goto out;
49606d2f89dfSmajd@mellanox.com 	}
49616d2f89dfSmajd@mellanox.com 
49626d2f89dfSmajd@mellanox.com 	qp_attr->qp_state	     = qp->state;
4963e126ba97SEli Cohen 	qp_attr->cur_qp_state	     = qp_attr->qp_state;
4964e126ba97SEli Cohen 	qp_attr->cap.max_recv_wr     = qp->rq.wqe_cnt;
4965e126ba97SEli Cohen 	qp_attr->cap.max_recv_sge    = qp->rq.max_gs;
4966e126ba97SEli Cohen 
4967e126ba97SEli Cohen 	if (!ibqp->uobject) {
49680540d814SNoa Osherovich 		qp_attr->cap.max_send_wr  = qp->sq.max_post;
4969e126ba97SEli Cohen 		qp_attr->cap.max_send_sge = qp->sq.max_gs;
49700540d814SNoa Osherovich 		qp_init_attr->qp_context = ibqp->qp_context;
4971e126ba97SEli Cohen 	} else {
4972e126ba97SEli Cohen 		qp_attr->cap.max_send_wr  = 0;
4973e126ba97SEli Cohen 		qp_attr->cap.max_send_sge = 0;
4974e126ba97SEli Cohen 	}
4975e126ba97SEli Cohen 
49769ecf6ac1SMaor Gottlieb 	qp_init_attr->qp_type = qp->type;
49770540d814SNoa Osherovich 	qp_init_attr->recv_cq = ibqp->recv_cq;
49780540d814SNoa Osherovich 	qp_init_attr->send_cq = ibqp->send_cq;
49790540d814SNoa Osherovich 	qp_init_attr->srq = ibqp->srq;
49800540d814SNoa Osherovich 	qp_attr->cap.max_inline_data = qp->max_inline_data;
4981e126ba97SEli Cohen 
4982e126ba97SEli Cohen 	qp_init_attr->cap	     = qp_attr->cap;
4983e126ba97SEli Cohen 
4984a8f3ea61SLeon Romanovsky 	qp_init_attr->create_flags = qp->flags;
4985051f2630SLeon Romanovsky 
4986e126ba97SEli Cohen 	qp_init_attr->sq_sig_type = qp->sq_signal_bits & MLX5_WQE_CTRL_CQ_UPDATE ?
4987e126ba97SEli Cohen 		IB_SIGNAL_ALL_WR : IB_SIGNAL_REQ_WR;
4988e126ba97SEli Cohen 
4989e126ba97SEli Cohen out:
4990e126ba97SEli Cohen 	mutex_unlock(&qp->mutex);
4991e126ba97SEli Cohen 	return err;
4992e126ba97SEli Cohen }
4993e126ba97SEli Cohen 
499428ad5f65SLeon Romanovsky int mlx5_ib_alloc_xrcd(struct ib_xrcd *ibxrcd, struct ib_udata *udata)
4995e126ba97SEli Cohen {
499628ad5f65SLeon Romanovsky 	struct mlx5_ib_dev *dev = to_mdev(ibxrcd->device);
499728ad5f65SLeon Romanovsky 	struct mlx5_ib_xrcd *xrcd = to_mxrcd(ibxrcd);
4998e126ba97SEli Cohen 
4999938fe83cSSaeed Mahameed 	if (!MLX5_CAP_GEN(dev->mdev, xrc))
500028ad5f65SLeon Romanovsky 		return -EOPNOTSUPP;
5001e126ba97SEli Cohen 
500228ad5f65SLeon Romanovsky 	return mlx5_cmd_xrcd_alloc(dev->mdev, &xrcd->xrcdn, 0);
5003e126ba97SEli Cohen }
5004e126ba97SEli Cohen 
5005d0c45c85SLeon Romanovsky int mlx5_ib_dealloc_xrcd(struct ib_xrcd *xrcd, struct ib_udata *udata)
5006e126ba97SEli Cohen {
5007e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(xrcd->device);
5008e126ba97SEli Cohen 	u32 xrcdn = to_mxrcd(xrcd)->xrcdn;
5009e126ba97SEli Cohen 
5010d0c45c85SLeon Romanovsky 	return mlx5_cmd_xrcd_dealloc(dev->mdev, xrcdn, 0);
5011e126ba97SEli Cohen }
501279b20a6cSYishai Hadas 
5013350d0e4cSYishai Hadas static void mlx5_ib_wq_event(struct mlx5_core_qp *core_qp, int type)
5014350d0e4cSYishai Hadas {
5015350d0e4cSYishai Hadas 	struct mlx5_ib_rwq *rwq = to_mibrwq(core_qp);
5016350d0e4cSYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(rwq->ibwq.device);
5017350d0e4cSYishai Hadas 	struct ib_event event;
5018350d0e4cSYishai Hadas 
5019350d0e4cSYishai Hadas 	if (rwq->ibwq.event_handler) {
5020350d0e4cSYishai Hadas 		event.device     = rwq->ibwq.device;
5021350d0e4cSYishai Hadas 		event.element.wq = &rwq->ibwq;
5022350d0e4cSYishai Hadas 		switch (type) {
5023350d0e4cSYishai Hadas 		case MLX5_EVENT_TYPE_WQ_CATAS_ERROR:
5024350d0e4cSYishai Hadas 			event.event = IB_EVENT_WQ_FATAL;
5025350d0e4cSYishai Hadas 			break;
5026350d0e4cSYishai Hadas 		default:
5027350d0e4cSYishai Hadas 			mlx5_ib_warn(dev, "Unexpected event type %d on WQ %06x\n", type, core_qp->qpn);
5028350d0e4cSYishai Hadas 			return;
5029350d0e4cSYishai Hadas 		}
5030350d0e4cSYishai Hadas 
5031350d0e4cSYishai Hadas 		rwq->ibwq.event_handler(&event, rwq->ibwq.wq_context);
5032350d0e4cSYishai Hadas 	}
5033350d0e4cSYishai Hadas }
5034350d0e4cSYishai Hadas 
503503404e8aSMaor Gottlieb static int set_delay_drop(struct mlx5_ib_dev *dev)
503603404e8aSMaor Gottlieb {
503703404e8aSMaor Gottlieb 	int err = 0;
503803404e8aSMaor Gottlieb 
503903404e8aSMaor Gottlieb 	mutex_lock(&dev->delay_drop.lock);
504003404e8aSMaor Gottlieb 	if (dev->delay_drop.activate)
504103404e8aSMaor Gottlieb 		goto out;
504203404e8aSMaor Gottlieb 
5043333fbaa0SLeon Romanovsky 	err = mlx5_core_set_delay_drop(dev, dev->delay_drop.timeout);
504403404e8aSMaor Gottlieb 	if (err)
504503404e8aSMaor Gottlieb 		goto out;
504603404e8aSMaor Gottlieb 
504703404e8aSMaor Gottlieb 	dev->delay_drop.activate = true;
504803404e8aSMaor Gottlieb out:
504903404e8aSMaor Gottlieb 	mutex_unlock(&dev->delay_drop.lock);
5050fe248c3aSMaor Gottlieb 
5051fe248c3aSMaor Gottlieb 	if (!err)
5052fe248c3aSMaor Gottlieb 		atomic_inc(&dev->delay_drop.rqs_cnt);
505303404e8aSMaor Gottlieb 	return err;
505403404e8aSMaor Gottlieb }
505503404e8aSMaor Gottlieb 
505679b20a6cSYishai Hadas static int  create_rq(struct mlx5_ib_rwq *rwq, struct ib_pd *pd,
505779b20a6cSYishai Hadas 		      struct ib_wq_init_attr *init_attr)
505879b20a6cSYishai Hadas {
505979b20a6cSYishai Hadas 	struct mlx5_ib_dev *dev;
50604be6da1eSNoa Osherovich 	int has_net_offloads;
506179b20a6cSYishai Hadas 	__be64 *rq_pas0;
50628256c69bSMaor Gottlieb 	int ts_format;
506379b20a6cSYishai Hadas 	void *in;
506479b20a6cSYishai Hadas 	void *rqc;
506579b20a6cSYishai Hadas 	void *wq;
506679b20a6cSYishai Hadas 	int inlen;
506779b20a6cSYishai Hadas 	int err;
506879b20a6cSYishai Hadas 
506979b20a6cSYishai Hadas 	dev = to_mdev(pd->device);
507079b20a6cSYishai Hadas 
50718256c69bSMaor Gottlieb 	ts_format = get_rq_ts_format(dev, to_mcq(init_attr->cq));
50728256c69bSMaor Gottlieb 	if (ts_format < 0)
50738256c69bSMaor Gottlieb 		return ts_format;
50748256c69bSMaor Gottlieb 
507579b20a6cSYishai Hadas 	inlen = MLX5_ST_SZ_BYTES(create_rq_in) + sizeof(u64) * rwq->rq_num_pas;
50761b9a07eeSLeon Romanovsky 	in = kvzalloc(inlen, GFP_KERNEL);
507779b20a6cSYishai Hadas 	if (!in)
507879b20a6cSYishai Hadas 		return -ENOMEM;
507979b20a6cSYishai Hadas 
508034d57585SYishai Hadas 	MLX5_SET(create_rq_in, in, uid, to_mpd(pd)->uid);
508179b20a6cSYishai Hadas 	rqc = MLX5_ADDR_OF(create_rq_in, in, ctx);
508279b20a6cSYishai Hadas 	MLX5_SET(rqc,  rqc, mem_rq_type,
508379b20a6cSYishai Hadas 		 MLX5_RQC_MEM_RQ_TYPE_MEMORY_RQ_INLINE);
50848256c69bSMaor Gottlieb 	MLX5_SET(rqc, rqc, ts_format, ts_format);
508579b20a6cSYishai Hadas 	MLX5_SET(rqc, rqc, user_index, rwq->user_index);
508679b20a6cSYishai Hadas 	MLX5_SET(rqc,  rqc, cqn, to_mcq(init_attr->cq)->mcq.cqn);
508779b20a6cSYishai Hadas 	MLX5_SET(rqc,  rqc, state, MLX5_RQC_STATE_RST);
508879b20a6cSYishai Hadas 	MLX5_SET(rqc,  rqc, flush_in_error_en, 1);
508979b20a6cSYishai Hadas 	wq = MLX5_ADDR_OF(rqc, rqc, wq);
5090ccc87087SNoa Osherovich 	MLX5_SET(wq, wq, wq_type,
5091ccc87087SNoa Osherovich 		 rwq->create_flags & MLX5_IB_WQ_FLAGS_STRIDING_RQ ?
5092ccc87087SNoa Osherovich 		 MLX5_WQ_TYPE_CYCLIC_STRIDING_RQ : MLX5_WQ_TYPE_CYCLIC);
5093b1383aa6SNoa Osherovich 	if (init_attr->create_flags & IB_WQ_FLAGS_PCI_WRITE_END_PADDING) {
5094b1383aa6SNoa Osherovich 		if (!MLX5_CAP_GEN(dev->mdev, end_pad)) {
5095b1383aa6SNoa Osherovich 			mlx5_ib_dbg(dev, "Scatter end padding is not supported\n");
5096b1383aa6SNoa Osherovich 			err = -EOPNOTSUPP;
5097b1383aa6SNoa Osherovich 			goto out;
5098b1383aa6SNoa Osherovich 		} else {
509979b20a6cSYishai Hadas 			MLX5_SET(wq, wq, end_padding_mode, MLX5_WQ_END_PAD_MODE_ALIGN);
5100b1383aa6SNoa Osherovich 		}
5101b1383aa6SNoa Osherovich 	}
510279b20a6cSYishai Hadas 	MLX5_SET(wq, wq, log_wq_stride, rwq->log_rq_stride);
5103ccc87087SNoa Osherovich 	if (rwq->create_flags & MLX5_IB_WQ_FLAGS_STRIDING_RQ) {
5104c16339b6SMark Zhang 		/*
5105c16339b6SMark Zhang 		 * In Firmware number of strides in each WQE is:
5106c16339b6SMark Zhang 		 *   "512 * 2^single_wqe_log_num_of_strides"
5107c16339b6SMark Zhang 		 * Values 3 to 8 are accepted as 10 to 15, 9 to 18 are
5108c16339b6SMark Zhang 		 * accepted as 0 to 9
5109c16339b6SMark Zhang 		 */
5110c16339b6SMark Zhang 		static const u8 fw_map[] = { 10, 11, 12, 13, 14, 15, 0, 1,
5111c16339b6SMark Zhang 					     2,  3,  4,  5,  6,  7,  8, 9 };
5112ccc87087SNoa Osherovich 		MLX5_SET(wq, wq, two_byte_shift_en, rwq->two_byte_shift_en);
5113ccc87087SNoa Osherovich 		MLX5_SET(wq, wq, log_wqe_stride_size,
5114ccc87087SNoa Osherovich 			 rwq->single_stride_log_num_of_bytes -
5115ccc87087SNoa Osherovich 			 MLX5_MIN_SINGLE_STRIDE_LOG_NUM_BYTES);
5116c16339b6SMark Zhang 		MLX5_SET(wq, wq, log_wqe_num_of_strides,
5117c16339b6SMark Zhang 			 fw_map[rwq->log_num_strides -
5118c16339b6SMark Zhang 				MLX5_EXT_MIN_SINGLE_WQE_LOG_NUM_STRIDES]);
5119ccc87087SNoa Osherovich 	}
512079b20a6cSYishai Hadas 	MLX5_SET(wq, wq, log_wq_sz, rwq->log_rq_size);
512179b20a6cSYishai Hadas 	MLX5_SET(wq, wq, pd, to_mpd(pd)->pdn);
512279b20a6cSYishai Hadas 	MLX5_SET(wq, wq, page_offset, rwq->rq_page_offset);
512379b20a6cSYishai Hadas 	MLX5_SET(wq, wq, log_wq_pg_sz, rwq->log_page_size);
512479b20a6cSYishai Hadas 	MLX5_SET(wq, wq, wq_signature, rwq->wq_sig);
512579b20a6cSYishai Hadas 	MLX5_SET64(wq, wq, dbr_addr, rwq->db.dma);
51264be6da1eSNoa Osherovich 	has_net_offloads = MLX5_CAP_GEN(dev->mdev, eth_net_offloads);
5127b1f74a84SNoa Osherovich 	if (init_attr->create_flags & IB_WQ_FLAGS_CVLAN_STRIPPING) {
51284be6da1eSNoa Osherovich 		if (!(has_net_offloads && MLX5_CAP_ETH(dev->mdev, vlan_cap))) {
5129b1f74a84SNoa Osherovich 			mlx5_ib_dbg(dev, "VLAN offloads are not supported\n");
5130b1f74a84SNoa Osherovich 			err = -EOPNOTSUPP;
5131b1f74a84SNoa Osherovich 			goto out;
5132b1f74a84SNoa Osherovich 		}
5133b1f74a84SNoa Osherovich 	} else {
5134b1f74a84SNoa Osherovich 		MLX5_SET(rqc, rqc, vsd, 1);
5135b1f74a84SNoa Osherovich 	}
51364be6da1eSNoa Osherovich 	if (init_attr->create_flags & IB_WQ_FLAGS_SCATTER_FCS) {
51374be6da1eSNoa Osherovich 		if (!(has_net_offloads && MLX5_CAP_ETH(dev->mdev, scatter_fcs))) {
51384be6da1eSNoa Osherovich 			mlx5_ib_dbg(dev, "Scatter FCS is not supported\n");
51394be6da1eSNoa Osherovich 			err = -EOPNOTSUPP;
51404be6da1eSNoa Osherovich 			goto out;
51414be6da1eSNoa Osherovich 		}
51424be6da1eSNoa Osherovich 		MLX5_SET(rqc, rqc, scatter_fcs, 1);
51434be6da1eSNoa Osherovich 	}
514403404e8aSMaor Gottlieb 	if (init_attr->create_flags & IB_WQ_FLAGS_DELAY_DROP) {
514503404e8aSMaor Gottlieb 		if (!(dev->ib_dev.attrs.raw_packet_caps &
514603404e8aSMaor Gottlieb 		      IB_RAW_PACKET_CAP_DELAY_DROP)) {
514703404e8aSMaor Gottlieb 			mlx5_ib_dbg(dev, "Delay drop is not supported\n");
514803404e8aSMaor Gottlieb 			err = -EOPNOTSUPP;
514903404e8aSMaor Gottlieb 			goto out;
515003404e8aSMaor Gottlieb 		}
515103404e8aSMaor Gottlieb 		MLX5_SET(rqc, rqc, delay_drop_en, 1);
515203404e8aSMaor Gottlieb 	}
515379b20a6cSYishai Hadas 	rq_pas0 = (__be64 *)MLX5_ADDR_OF(wq, wq, pas);
5154aab8d396SJason Gunthorpe 	mlx5_ib_populate_pas(rwq->umem, 1UL << rwq->page_shift, rq_pas0, 0);
5155333fbaa0SLeon Romanovsky 	err = mlx5_core_create_rq_tracked(dev, in, inlen, &rwq->core_qp);
515603404e8aSMaor Gottlieb 	if (!err && init_attr->create_flags & IB_WQ_FLAGS_DELAY_DROP) {
515703404e8aSMaor Gottlieb 		err = set_delay_drop(dev);
515803404e8aSMaor Gottlieb 		if (err) {
515903404e8aSMaor Gottlieb 			mlx5_ib_warn(dev, "Failed to enable delay drop err=%d\n",
516003404e8aSMaor Gottlieb 				     err);
5161333fbaa0SLeon Romanovsky 			mlx5_core_destroy_rq_tracked(dev, &rwq->core_qp);
516203404e8aSMaor Gottlieb 		} else {
516303404e8aSMaor Gottlieb 			rwq->create_flags |= MLX5_IB_WQ_FLAGS_DELAY_DROP;
516403404e8aSMaor Gottlieb 		}
516503404e8aSMaor Gottlieb 	}
5166b1f74a84SNoa Osherovich out:
516779b20a6cSYishai Hadas 	kvfree(in);
516879b20a6cSYishai Hadas 	return err;
516979b20a6cSYishai Hadas }
517079b20a6cSYishai Hadas 
517179b20a6cSYishai Hadas static int set_user_rq_size(struct mlx5_ib_dev *dev,
517279b20a6cSYishai Hadas 			    struct ib_wq_init_attr *wq_init_attr,
517379b20a6cSYishai Hadas 			    struct mlx5_ib_create_wq *ucmd,
517479b20a6cSYishai Hadas 			    struct mlx5_ib_rwq *rwq)
517579b20a6cSYishai Hadas {
517679b20a6cSYishai Hadas 	/* Sanity check RQ size before proceeding */
517779b20a6cSYishai Hadas 	if (wq_init_attr->max_wr > (1 << MLX5_CAP_GEN(dev->mdev, log_max_wq_sz)))
517879b20a6cSYishai Hadas 		return -EINVAL;
517979b20a6cSYishai Hadas 
518079b20a6cSYishai Hadas 	if (!ucmd->rq_wqe_count)
518179b20a6cSYishai Hadas 		return -EINVAL;
518279b20a6cSYishai Hadas 
518379b20a6cSYishai Hadas 	rwq->wqe_count = ucmd->rq_wqe_count;
518479b20a6cSYishai Hadas 	rwq->wqe_shift = ucmd->rq_wqe_shift;
51850dfe4522SLeon Romanovsky 	if (check_shl_overflow(rwq->wqe_count, rwq->wqe_shift, &rwq->buf_size))
51860dfe4522SLeon Romanovsky 		return -EINVAL;
51870dfe4522SLeon Romanovsky 
518879b20a6cSYishai Hadas 	rwq->log_rq_stride = rwq->wqe_shift;
518979b20a6cSYishai Hadas 	rwq->log_rq_size = ilog2(rwq->wqe_count);
519079b20a6cSYishai Hadas 	return 0;
519179b20a6cSYishai Hadas }
519279b20a6cSYishai Hadas 
5193c16339b6SMark Zhang static bool log_of_strides_valid(struct mlx5_ib_dev *dev, u32 log_num_strides)
5194c16339b6SMark Zhang {
5195c16339b6SMark Zhang 	if ((log_num_strides > MLX5_MAX_SINGLE_WQE_LOG_NUM_STRIDES) ||
5196c16339b6SMark Zhang 	    (log_num_strides < MLX5_EXT_MIN_SINGLE_WQE_LOG_NUM_STRIDES))
5197c16339b6SMark Zhang 		return false;
5198c16339b6SMark Zhang 
5199c16339b6SMark Zhang 	if (!MLX5_CAP_GEN(dev->mdev, ext_stride_num_range) &&
5200c16339b6SMark Zhang 	    (log_num_strides < MLX5_MIN_SINGLE_WQE_LOG_NUM_STRIDES))
5201c16339b6SMark Zhang 		return false;
5202c16339b6SMark Zhang 
5203c16339b6SMark Zhang 	return true;
5204c16339b6SMark Zhang }
5205c16339b6SMark Zhang 
520679b20a6cSYishai Hadas static int prepare_user_rq(struct ib_pd *pd,
520779b20a6cSYishai Hadas 			   struct ib_wq_init_attr *init_attr,
520879b20a6cSYishai Hadas 			   struct ib_udata *udata,
520979b20a6cSYishai Hadas 			   struct mlx5_ib_rwq *rwq)
521079b20a6cSYishai Hadas {
521179b20a6cSYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(pd->device);
521279b20a6cSYishai Hadas 	struct mlx5_ib_create_wq ucmd = {};
521379b20a6cSYishai Hadas 	int err;
521479b20a6cSYishai Hadas 	size_t required_cmd_sz;
521579b20a6cSYishai Hadas 
521670c1430fSLeon Romanovsky 	required_cmd_sz = offsetofend(struct mlx5_ib_create_wq,
521770c1430fSLeon Romanovsky 				      single_stride_log_num_of_bytes);
521879b20a6cSYishai Hadas 	if (udata->inlen < required_cmd_sz) {
521979b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "invalid inlen\n");
522079b20a6cSYishai Hadas 		return -EINVAL;
522179b20a6cSYishai Hadas 	}
522279b20a6cSYishai Hadas 
522379b20a6cSYishai Hadas 	if (udata->inlen > sizeof(ucmd) &&
522479b20a6cSYishai Hadas 	    !ib_is_udata_cleared(udata, sizeof(ucmd),
522579b20a6cSYishai Hadas 				 udata->inlen - sizeof(ucmd))) {
522679b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "inlen is not supported\n");
522779b20a6cSYishai Hadas 		return -EOPNOTSUPP;
522879b20a6cSYishai Hadas 	}
522979b20a6cSYishai Hadas 
523079b20a6cSYishai Hadas 	if (ib_copy_from_udata(&ucmd, udata, min(sizeof(ucmd), udata->inlen))) {
523179b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "copy failed\n");
523279b20a6cSYishai Hadas 		return -EFAULT;
523379b20a6cSYishai Hadas 	}
523479b20a6cSYishai Hadas 
5235ccc87087SNoa Osherovich 	if (ucmd.comp_mask & (~MLX5_IB_CREATE_WQ_STRIDING_RQ)) {
523679b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "invalid comp mask\n");
523779b20a6cSYishai Hadas 		return -EOPNOTSUPP;
5238ccc87087SNoa Osherovich 	} else if (ucmd.comp_mask & MLX5_IB_CREATE_WQ_STRIDING_RQ) {
5239ccc87087SNoa Osherovich 		if (!MLX5_CAP_GEN(dev->mdev, striding_rq)) {
5240ccc87087SNoa Osherovich 			mlx5_ib_dbg(dev, "Striding RQ is not supported\n");
524179b20a6cSYishai Hadas 			return -EOPNOTSUPP;
524279b20a6cSYishai Hadas 		}
5243ccc87087SNoa Osherovich 		if ((ucmd.single_stride_log_num_of_bytes <
5244ccc87087SNoa Osherovich 		    MLX5_MIN_SINGLE_STRIDE_LOG_NUM_BYTES) ||
5245ccc87087SNoa Osherovich 		    (ucmd.single_stride_log_num_of_bytes >
5246ccc87087SNoa Osherovich 		     MLX5_MAX_SINGLE_STRIDE_LOG_NUM_BYTES)) {
5247ccc87087SNoa Osherovich 			mlx5_ib_dbg(dev, "Invalid log stride size (%u. Range is %u - %u)\n",
5248ccc87087SNoa Osherovich 				    ucmd.single_stride_log_num_of_bytes,
5249ccc87087SNoa Osherovich 				    MLX5_MIN_SINGLE_STRIDE_LOG_NUM_BYTES,
5250ccc87087SNoa Osherovich 				    MLX5_MAX_SINGLE_STRIDE_LOG_NUM_BYTES);
5251ccc87087SNoa Osherovich 			return -EINVAL;
5252ccc87087SNoa Osherovich 		}
5253c16339b6SMark Zhang 		if (!log_of_strides_valid(dev,
5254c16339b6SMark Zhang 					  ucmd.single_wqe_log_num_of_strides)) {
5255c16339b6SMark Zhang 			mlx5_ib_dbg(
5256c16339b6SMark Zhang 				dev,
5257c16339b6SMark Zhang 				"Invalid log num strides (%u. Range is %u - %u)\n",
5258ccc87087SNoa Osherovich 				ucmd.single_wqe_log_num_of_strides,
5259c16339b6SMark Zhang 				MLX5_CAP_GEN(dev->mdev, ext_stride_num_range) ?
5260c16339b6SMark Zhang 					MLX5_EXT_MIN_SINGLE_WQE_LOG_NUM_STRIDES :
5261ccc87087SNoa Osherovich 					MLX5_MIN_SINGLE_WQE_LOG_NUM_STRIDES,
5262ccc87087SNoa Osherovich 				MLX5_MAX_SINGLE_WQE_LOG_NUM_STRIDES);
5263ccc87087SNoa Osherovich 			return -EINVAL;
5264ccc87087SNoa Osherovich 		}
5265ccc87087SNoa Osherovich 		rwq->single_stride_log_num_of_bytes =
5266ccc87087SNoa Osherovich 			ucmd.single_stride_log_num_of_bytes;
5267ccc87087SNoa Osherovich 		rwq->log_num_strides = ucmd.single_wqe_log_num_of_strides;
5268ccc87087SNoa Osherovich 		rwq->two_byte_shift_en = !!ucmd.two_byte_shift_en;
5269ccc87087SNoa Osherovich 		rwq->create_flags |= MLX5_IB_WQ_FLAGS_STRIDING_RQ;
5270ccc87087SNoa Osherovich 	}
527179b20a6cSYishai Hadas 
527279b20a6cSYishai Hadas 	err = set_user_rq_size(dev, init_attr, &ucmd, rwq);
527379b20a6cSYishai Hadas 	if (err) {
527479b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "err %d\n", err);
527579b20a6cSYishai Hadas 		return err;
527679b20a6cSYishai Hadas 	}
527779b20a6cSYishai Hadas 
5278b0ea0fa5SJason Gunthorpe 	err = create_user_rq(dev, pd, udata, rwq, &ucmd);
527979b20a6cSYishai Hadas 	if (err) {
528079b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "err %d\n", err);
528179b20a6cSYishai Hadas 		return err;
528279b20a6cSYishai Hadas 	}
528379b20a6cSYishai Hadas 
528479b20a6cSYishai Hadas 	rwq->user_index = ucmd.user_index;
528579b20a6cSYishai Hadas 	return 0;
528679b20a6cSYishai Hadas }
528779b20a6cSYishai Hadas 
528879b20a6cSYishai Hadas struct ib_wq *mlx5_ib_create_wq(struct ib_pd *pd,
528979b20a6cSYishai Hadas 				struct ib_wq_init_attr *init_attr,
529079b20a6cSYishai Hadas 				struct ib_udata *udata)
529179b20a6cSYishai Hadas {
529279b20a6cSYishai Hadas 	struct mlx5_ib_dev *dev;
529379b20a6cSYishai Hadas 	struct mlx5_ib_rwq *rwq;
529479b20a6cSYishai Hadas 	struct mlx5_ib_create_wq_resp resp = {};
529579b20a6cSYishai Hadas 	size_t min_resp_len;
529679b20a6cSYishai Hadas 	int err;
529779b20a6cSYishai Hadas 
529879b20a6cSYishai Hadas 	if (!udata)
529979b20a6cSYishai Hadas 		return ERR_PTR(-ENOSYS);
530079b20a6cSYishai Hadas 
530170c1430fSLeon Romanovsky 	min_resp_len = offsetofend(struct mlx5_ib_create_wq_resp, reserved);
530279b20a6cSYishai Hadas 	if (udata->outlen && udata->outlen < min_resp_len)
530379b20a6cSYishai Hadas 		return ERR_PTR(-EINVAL);
530479b20a6cSYishai Hadas 
5305ba80013fSMaor Gottlieb 	if (!capable(CAP_SYS_RAWIO) &&
5306ba80013fSMaor Gottlieb 	    init_attr->create_flags & IB_WQ_FLAGS_DELAY_DROP)
5307ba80013fSMaor Gottlieb 		return ERR_PTR(-EPERM);
5308ba80013fSMaor Gottlieb 
530979b20a6cSYishai Hadas 	dev = to_mdev(pd->device);
531079b20a6cSYishai Hadas 	switch (init_attr->wq_type) {
531179b20a6cSYishai Hadas 	case IB_WQT_RQ:
531279b20a6cSYishai Hadas 		rwq = kzalloc(sizeof(*rwq), GFP_KERNEL);
531379b20a6cSYishai Hadas 		if (!rwq)
531479b20a6cSYishai Hadas 			return ERR_PTR(-ENOMEM);
531579b20a6cSYishai Hadas 		err = prepare_user_rq(pd, init_attr, udata, rwq);
531679b20a6cSYishai Hadas 		if (err)
531779b20a6cSYishai Hadas 			goto err;
531879b20a6cSYishai Hadas 		err = create_rq(rwq, pd, init_attr);
531979b20a6cSYishai Hadas 		if (err)
532079b20a6cSYishai Hadas 			goto err_user_rq;
532179b20a6cSYishai Hadas 		break;
532279b20a6cSYishai Hadas 	default:
532379b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "unsupported wq type %d\n",
532479b20a6cSYishai Hadas 			    init_attr->wq_type);
532579b20a6cSYishai Hadas 		return ERR_PTR(-EINVAL);
532679b20a6cSYishai Hadas 	}
532779b20a6cSYishai Hadas 
5328350d0e4cSYishai Hadas 	rwq->ibwq.wq_num = rwq->core_qp.qpn;
532979b20a6cSYishai Hadas 	rwq->ibwq.state = IB_WQS_RESET;
533079b20a6cSYishai Hadas 	if (udata->outlen) {
533170c1430fSLeon Romanovsky 		resp.response_length = offsetofend(
533270c1430fSLeon Romanovsky 			struct mlx5_ib_create_wq_resp, response_length);
533379b20a6cSYishai Hadas 		err = ib_copy_to_udata(udata, &resp, resp.response_length);
533479b20a6cSYishai Hadas 		if (err)
533579b20a6cSYishai Hadas 			goto err_copy;
533679b20a6cSYishai Hadas 	}
533779b20a6cSYishai Hadas 
5338350d0e4cSYishai Hadas 	rwq->core_qp.event = mlx5_ib_wq_event;
5339350d0e4cSYishai Hadas 	rwq->ibwq.event_handler = init_attr->event_handler;
534079b20a6cSYishai Hadas 	return &rwq->ibwq;
534179b20a6cSYishai Hadas 
534279b20a6cSYishai Hadas err_copy:
5343333fbaa0SLeon Romanovsky 	mlx5_core_destroy_rq_tracked(dev, &rwq->core_qp);
534479b20a6cSYishai Hadas err_user_rq:
5345bdeacabdSShamir Rabinovitch 	destroy_user_rq(dev, pd, rwq, udata);
534679b20a6cSYishai Hadas err:
534779b20a6cSYishai Hadas 	kfree(rwq);
534879b20a6cSYishai Hadas 	return ERR_PTR(err);
534979b20a6cSYishai Hadas }
535079b20a6cSYishai Hadas 
5351add53535SLeon Romanovsky int mlx5_ib_destroy_wq(struct ib_wq *wq, struct ib_udata *udata)
535279b20a6cSYishai Hadas {
535379b20a6cSYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(wq->device);
535479b20a6cSYishai Hadas 	struct mlx5_ib_rwq *rwq = to_mrwq(wq);
5355add53535SLeon Romanovsky 	int ret;
535679b20a6cSYishai Hadas 
5357add53535SLeon Romanovsky 	ret = mlx5_core_destroy_rq_tracked(dev, &rwq->core_qp);
5358add53535SLeon Romanovsky 	if (ret)
5359add53535SLeon Romanovsky 		return ret;
5360bdeacabdSShamir Rabinovitch 	destroy_user_rq(dev, wq->pd, rwq, udata);
536179b20a6cSYishai Hadas 	kfree(rwq);
5362add53535SLeon Romanovsky 	return 0;
536379b20a6cSYishai Hadas }
536479b20a6cSYishai Hadas 
5365c0a6b5ecSLeon Romanovsky int mlx5_ib_create_rwq_ind_table(struct ib_rwq_ind_table *ib_rwq_ind_table,
5366c5f90929SYishai Hadas 				 struct ib_rwq_ind_table_init_attr *init_attr,
5367c5f90929SYishai Hadas 				 struct ib_udata *udata)
5368c5f90929SYishai Hadas {
5369c0a6b5ecSLeon Romanovsky 	struct mlx5_ib_rwq_ind_table *rwq_ind_tbl =
5370c0a6b5ecSLeon Romanovsky 		to_mrwq_ind_table(ib_rwq_ind_table);
5371c0a6b5ecSLeon Romanovsky 	struct mlx5_ib_dev *dev = to_mdev(ib_rwq_ind_table->device);
5372c5f90929SYishai Hadas 	int sz = 1 << init_attr->log_ind_tbl_size;
5373c5f90929SYishai Hadas 	struct mlx5_ib_create_rwq_ind_tbl_resp resp = {};
5374c5f90929SYishai Hadas 	size_t min_resp_len;
5375c5f90929SYishai Hadas 	int inlen;
5376c5f90929SYishai Hadas 	int err;
5377c5f90929SYishai Hadas 	int i;
5378c5f90929SYishai Hadas 	u32 *in;
5379c5f90929SYishai Hadas 	void *rqtc;
5380c5f90929SYishai Hadas 
5381c5f90929SYishai Hadas 	if (udata->inlen > 0 &&
5382c5f90929SYishai Hadas 	    !ib_is_udata_cleared(udata, 0,
5383c5f90929SYishai Hadas 				 udata->inlen))
5384c0a6b5ecSLeon Romanovsky 		return -EOPNOTSUPP;
5385c5f90929SYishai Hadas 
5386efd7f400SMaor Gottlieb 	if (init_attr->log_ind_tbl_size >
5387efd7f400SMaor Gottlieb 	    MLX5_CAP_GEN(dev->mdev, log_max_rqt_size)) {
5388efd7f400SMaor Gottlieb 		mlx5_ib_dbg(dev, "log_ind_tbl_size = %d is bigger than supported = %d\n",
5389efd7f400SMaor Gottlieb 			    init_attr->log_ind_tbl_size,
5390efd7f400SMaor Gottlieb 			    MLX5_CAP_GEN(dev->mdev, log_max_rqt_size));
5391c0a6b5ecSLeon Romanovsky 		return -EINVAL;
5392efd7f400SMaor Gottlieb 	}
5393efd7f400SMaor Gottlieb 
539470c1430fSLeon Romanovsky 	min_resp_len =
539570c1430fSLeon Romanovsky 		offsetofend(struct mlx5_ib_create_rwq_ind_tbl_resp, reserved);
5396c5f90929SYishai Hadas 	if (udata->outlen && udata->outlen < min_resp_len)
5397c0a6b5ecSLeon Romanovsky 		return -EINVAL;
5398c5f90929SYishai Hadas 
5399c5f90929SYishai Hadas 	inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz;
54001b9a07eeSLeon Romanovsky 	in = kvzalloc(inlen, GFP_KERNEL);
5401c0a6b5ecSLeon Romanovsky 	if (!in)
5402c0a6b5ecSLeon Romanovsky 		return -ENOMEM;
5403c5f90929SYishai Hadas 
5404c5f90929SYishai Hadas 	rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context);
5405c5f90929SYishai Hadas 
5406c5f90929SYishai Hadas 	MLX5_SET(rqtc, rqtc, rqt_actual_size, sz);
5407c5f90929SYishai Hadas 	MLX5_SET(rqtc, rqtc, rqt_max_size, sz);
5408c5f90929SYishai Hadas 
5409c5f90929SYishai Hadas 	for (i = 0; i < sz; i++)
5410c5f90929SYishai Hadas 		MLX5_SET(rqtc, rqtc, rq_num[i], init_attr->ind_tbl[i]->wq_num);
5411c5f90929SYishai Hadas 
54125deba86eSYishai Hadas 	rwq_ind_tbl->uid = to_mpd(init_attr->ind_tbl[0]->pd)->uid;
54135deba86eSYishai Hadas 	MLX5_SET(create_rqt_in, in, uid, rwq_ind_tbl->uid);
54145deba86eSYishai Hadas 
5415c5f90929SYishai Hadas 	err = mlx5_core_create_rqt(dev->mdev, in, inlen, &rwq_ind_tbl->rqtn);
5416c5f90929SYishai Hadas 	kvfree(in);
5417c5f90929SYishai Hadas 	if (err)
5418c0a6b5ecSLeon Romanovsky 		return err;
5419c5f90929SYishai Hadas 
5420c5f90929SYishai Hadas 	rwq_ind_tbl->ib_rwq_ind_tbl.ind_tbl_num = rwq_ind_tbl->rqtn;
5421c5f90929SYishai Hadas 	if (udata->outlen) {
542270c1430fSLeon Romanovsky 		resp.response_length =
542370c1430fSLeon Romanovsky 			offsetofend(struct mlx5_ib_create_rwq_ind_tbl_resp,
542470c1430fSLeon Romanovsky 				    response_length);
5425c5f90929SYishai Hadas 		err = ib_copy_to_udata(udata, &resp, resp.response_length);
5426c5f90929SYishai Hadas 		if (err)
5427c5f90929SYishai Hadas 			goto err_copy;
5428c5f90929SYishai Hadas 	}
5429c5f90929SYishai Hadas 
5430c0a6b5ecSLeon Romanovsky 	return 0;
5431c5f90929SYishai Hadas 
5432c5f90929SYishai Hadas err_copy:
54335deba86eSYishai Hadas 	mlx5_cmd_destroy_rqt(dev->mdev, rwq_ind_tbl->rqtn, rwq_ind_tbl->uid);
5434c0a6b5ecSLeon Romanovsky 	return err;
5435c5f90929SYishai Hadas }
5436c5f90929SYishai Hadas 
5437c5f90929SYishai Hadas int mlx5_ib_destroy_rwq_ind_table(struct ib_rwq_ind_table *ib_rwq_ind_tbl)
5438c5f90929SYishai Hadas {
5439c5f90929SYishai Hadas 	struct mlx5_ib_rwq_ind_table *rwq_ind_tbl = to_mrwq_ind_table(ib_rwq_ind_tbl);
5440c5f90929SYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(ib_rwq_ind_tbl->device);
5441c5f90929SYishai Hadas 
5442c0a6b5ecSLeon Romanovsky 	return mlx5_cmd_destroy_rqt(dev->mdev, rwq_ind_tbl->rqtn, rwq_ind_tbl->uid);
5443c5f90929SYishai Hadas }
5444c5f90929SYishai Hadas 
544579b20a6cSYishai Hadas int mlx5_ib_modify_wq(struct ib_wq *wq, struct ib_wq_attr *wq_attr,
544679b20a6cSYishai Hadas 		      u32 wq_attr_mask, struct ib_udata *udata)
544779b20a6cSYishai Hadas {
544879b20a6cSYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(wq->device);
544979b20a6cSYishai Hadas 	struct mlx5_ib_rwq *rwq = to_mrwq(wq);
545079b20a6cSYishai Hadas 	struct mlx5_ib_modify_wq ucmd = {};
545179b20a6cSYishai Hadas 	size_t required_cmd_sz;
545279b20a6cSYishai Hadas 	int curr_wq_state;
545379b20a6cSYishai Hadas 	int wq_state;
545479b20a6cSYishai Hadas 	int inlen;
545579b20a6cSYishai Hadas 	int err;
545679b20a6cSYishai Hadas 	void *rqc;
545779b20a6cSYishai Hadas 	void *in;
545879b20a6cSYishai Hadas 
545970c1430fSLeon Romanovsky 	required_cmd_sz = offsetofend(struct mlx5_ib_modify_wq, reserved);
546079b20a6cSYishai Hadas 	if (udata->inlen < required_cmd_sz)
546179b20a6cSYishai Hadas 		return -EINVAL;
546279b20a6cSYishai Hadas 
546379b20a6cSYishai Hadas 	if (udata->inlen > sizeof(ucmd) &&
546479b20a6cSYishai Hadas 	    !ib_is_udata_cleared(udata, sizeof(ucmd),
546579b20a6cSYishai Hadas 				 udata->inlen - sizeof(ucmd)))
546679b20a6cSYishai Hadas 		return -EOPNOTSUPP;
546779b20a6cSYishai Hadas 
546879b20a6cSYishai Hadas 	if (ib_copy_from_udata(&ucmd, udata, min(sizeof(ucmd), udata->inlen)))
546979b20a6cSYishai Hadas 		return -EFAULT;
547079b20a6cSYishai Hadas 
547179b20a6cSYishai Hadas 	if (ucmd.comp_mask || ucmd.reserved)
547279b20a6cSYishai Hadas 		return -EOPNOTSUPP;
547379b20a6cSYishai Hadas 
547479b20a6cSYishai Hadas 	inlen = MLX5_ST_SZ_BYTES(modify_rq_in);
54751b9a07eeSLeon Romanovsky 	in = kvzalloc(inlen, GFP_KERNEL);
547679b20a6cSYishai Hadas 	if (!in)
547779b20a6cSYishai Hadas 		return -ENOMEM;
547879b20a6cSYishai Hadas 
547979b20a6cSYishai Hadas 	rqc = MLX5_ADDR_OF(modify_rq_in, in, ctx);
548079b20a6cSYishai Hadas 
5481f9744288SLeon Romanovsky 	curr_wq_state = wq_attr->curr_wq_state;
5482f9744288SLeon Romanovsky 	wq_state = wq_attr->wq_state;
548379b20a6cSYishai Hadas 	if (curr_wq_state == IB_WQS_ERR)
548479b20a6cSYishai Hadas 		curr_wq_state = MLX5_RQC_STATE_ERR;
548579b20a6cSYishai Hadas 	if (wq_state == IB_WQS_ERR)
548679b20a6cSYishai Hadas 		wq_state = MLX5_RQC_STATE_ERR;
548779b20a6cSYishai Hadas 	MLX5_SET(modify_rq_in, in, rq_state, curr_wq_state);
548834d57585SYishai Hadas 	MLX5_SET(modify_rq_in, in, uid, to_mpd(wq->pd)->uid);
548979b20a6cSYishai Hadas 	MLX5_SET(rqc, rqc, state, wq_state);
549079b20a6cSYishai Hadas 
5491b1f74a84SNoa Osherovich 	if (wq_attr_mask & IB_WQ_FLAGS) {
5492b1f74a84SNoa Osherovich 		if (wq_attr->flags_mask & IB_WQ_FLAGS_CVLAN_STRIPPING) {
5493b1f74a84SNoa Osherovich 			if (!(MLX5_CAP_GEN(dev->mdev, eth_net_offloads) &&
5494b1f74a84SNoa Osherovich 			      MLX5_CAP_ETH(dev->mdev, vlan_cap))) {
5495b1f74a84SNoa Osherovich 				mlx5_ib_dbg(dev, "VLAN offloads are not "
5496b1f74a84SNoa Osherovich 					    "supported\n");
5497b1f74a84SNoa Osherovich 				err = -EOPNOTSUPP;
5498b1f74a84SNoa Osherovich 				goto out;
5499b1f74a84SNoa Osherovich 			}
5500b1f74a84SNoa Osherovich 			MLX5_SET64(modify_rq_in, in, modify_bitmask,
5501b1f74a84SNoa Osherovich 				   MLX5_MODIFY_RQ_IN_MODIFY_BITMASK_VSD);
5502b1f74a84SNoa Osherovich 			MLX5_SET(rqc, rqc, vsd,
5503b1f74a84SNoa Osherovich 				 (wq_attr->flags & IB_WQ_FLAGS_CVLAN_STRIPPING) ? 0 : 1);
5504b1f74a84SNoa Osherovich 		}
5505b1383aa6SNoa Osherovich 
5506b1383aa6SNoa Osherovich 		if (wq_attr->flags_mask & IB_WQ_FLAGS_PCI_WRITE_END_PADDING) {
5507b1383aa6SNoa Osherovich 			mlx5_ib_dbg(dev, "Modifying scatter end padding is not supported\n");
5508b1383aa6SNoa Osherovich 			err = -EOPNOTSUPP;
5509b1383aa6SNoa Osherovich 			goto out;
5510b1383aa6SNoa Osherovich 		}
5511b1f74a84SNoa Osherovich 	}
5512b1f74a84SNoa Osherovich 
551323a6964eSMajd Dibbiny 	if (curr_wq_state == IB_WQS_RESET && wq_state == IB_WQS_RDY) {
55143e1f000fSParav Pandit 		u16 set_id;
55153e1f000fSParav Pandit 
55163e1f000fSParav Pandit 		set_id = mlx5_ib_get_counters_id(dev, 0);
551723a6964eSMajd Dibbiny 		if (MLX5_CAP_GEN(dev->mdev, modify_rq_counter_set_id)) {
551823a6964eSMajd Dibbiny 			MLX5_SET64(modify_rq_in, in, modify_bitmask,
551923a6964eSMajd Dibbiny 				   MLX5_MODIFY_RQ_IN_MODIFY_BITMASK_RQ_COUNTER_SET_ID);
55203e1f000fSParav Pandit 			MLX5_SET(rqc, rqc, counter_set_id, set_id);
552123a6964eSMajd Dibbiny 		} else
55225a738b5dSJason Gunthorpe 			dev_info_once(
55235a738b5dSJason Gunthorpe 				&dev->ib_dev.dev,
55245a738b5dSJason Gunthorpe 				"Receive WQ counters are not supported on current FW\n");
552523a6964eSMajd Dibbiny 	}
552623a6964eSMajd Dibbiny 
5527e0b4b472SLeon Romanovsky 	err = mlx5_core_modify_rq(dev->mdev, rwq->core_qp.qpn, in);
552879b20a6cSYishai Hadas 	if (!err)
552979b20a6cSYishai Hadas 		rwq->ibwq.state = (wq_state == MLX5_RQC_STATE_ERR) ? IB_WQS_ERR : wq_state;
553079b20a6cSYishai Hadas 
5531b1f74a84SNoa Osherovich out:
5532b1f74a84SNoa Osherovich 	kvfree(in);
553379b20a6cSYishai Hadas 	return err;
553479b20a6cSYishai Hadas }
5535d0e84c0aSYishai Hadas 
5536d0e84c0aSYishai Hadas struct mlx5_ib_drain_cqe {
5537d0e84c0aSYishai Hadas 	struct ib_cqe cqe;
5538d0e84c0aSYishai Hadas 	struct completion done;
5539d0e84c0aSYishai Hadas };
5540d0e84c0aSYishai Hadas 
5541d0e84c0aSYishai Hadas static void mlx5_ib_drain_qp_done(struct ib_cq *cq, struct ib_wc *wc)
5542d0e84c0aSYishai Hadas {
5543d0e84c0aSYishai Hadas 	struct mlx5_ib_drain_cqe *cqe = container_of(wc->wr_cqe,
5544d0e84c0aSYishai Hadas 						     struct mlx5_ib_drain_cqe,
5545d0e84c0aSYishai Hadas 						     cqe);
5546d0e84c0aSYishai Hadas 
5547d0e84c0aSYishai Hadas 	complete(&cqe->done);
5548d0e84c0aSYishai Hadas }
5549d0e84c0aSYishai Hadas 
5550d0e84c0aSYishai Hadas /* This function returns only once the drained WR was completed */
5551d0e84c0aSYishai Hadas static void handle_drain_completion(struct ib_cq *cq,
5552d0e84c0aSYishai Hadas 				    struct mlx5_ib_drain_cqe *sdrain,
5553d0e84c0aSYishai Hadas 				    struct mlx5_ib_dev *dev)
5554d0e84c0aSYishai Hadas {
5555d0e84c0aSYishai Hadas 	struct mlx5_core_dev *mdev = dev->mdev;
5556d0e84c0aSYishai Hadas 
5557d0e84c0aSYishai Hadas 	if (cq->poll_ctx == IB_POLL_DIRECT) {
5558d0e84c0aSYishai Hadas 		while (wait_for_completion_timeout(&sdrain->done, HZ / 10) <= 0)
5559d0e84c0aSYishai Hadas 			ib_process_cq_direct(cq, -1);
5560d0e84c0aSYishai Hadas 		return;
5561d0e84c0aSYishai Hadas 	}
5562d0e84c0aSYishai Hadas 
5563d0e84c0aSYishai Hadas 	if (mdev->state == MLX5_DEVICE_STATE_INTERNAL_ERROR) {
5564d0e84c0aSYishai Hadas 		struct mlx5_ib_cq *mcq = to_mcq(cq);
5565d0e84c0aSYishai Hadas 		bool triggered = false;
5566d0e84c0aSYishai Hadas 		unsigned long flags;
5567d0e84c0aSYishai Hadas 
5568d0e84c0aSYishai Hadas 		spin_lock_irqsave(&dev->reset_flow_resource_lock, flags);
5569d0e84c0aSYishai Hadas 		/* Make sure that the CQ handler won't run if wasn't run yet */
5570d0e84c0aSYishai Hadas 		if (!mcq->mcq.reset_notify_added)
5571d0e84c0aSYishai Hadas 			mcq->mcq.reset_notify_added = 1;
5572d0e84c0aSYishai Hadas 		else
5573d0e84c0aSYishai Hadas 			triggered = true;
5574d0e84c0aSYishai Hadas 		spin_unlock_irqrestore(&dev->reset_flow_resource_lock, flags);
5575d0e84c0aSYishai Hadas 
5576d0e84c0aSYishai Hadas 		if (triggered) {
5577d0e84c0aSYishai Hadas 			/* Wait for any scheduled/running task to be ended */
5578d0e84c0aSYishai Hadas 			switch (cq->poll_ctx) {
5579d0e84c0aSYishai Hadas 			case IB_POLL_SOFTIRQ:
5580d0e84c0aSYishai Hadas 				irq_poll_disable(&cq->iop);
5581d0e84c0aSYishai Hadas 				irq_poll_enable(&cq->iop);
5582d0e84c0aSYishai Hadas 				break;
5583d0e84c0aSYishai Hadas 			case IB_POLL_WORKQUEUE:
5584d0e84c0aSYishai Hadas 				cancel_work_sync(&cq->work);
5585d0e84c0aSYishai Hadas 				break;
5586d0e84c0aSYishai Hadas 			default:
5587d0e84c0aSYishai Hadas 				WARN_ON_ONCE(1);
5588d0e84c0aSYishai Hadas 			}
5589d0e84c0aSYishai Hadas 		}
5590d0e84c0aSYishai Hadas 
5591d0e84c0aSYishai Hadas 		/* Run the CQ handler - this makes sure that the drain WR will
5592d0e84c0aSYishai Hadas 		 * be processed if wasn't processed yet.
5593d0e84c0aSYishai Hadas 		 */
55944e0e2ea1SYishai Hadas 		mcq->mcq.comp(&mcq->mcq, NULL);
5595d0e84c0aSYishai Hadas 	}
5596d0e84c0aSYishai Hadas 
5597d0e84c0aSYishai Hadas 	wait_for_completion(&sdrain->done);
5598d0e84c0aSYishai Hadas }
5599d0e84c0aSYishai Hadas 
5600d0e84c0aSYishai Hadas void mlx5_ib_drain_sq(struct ib_qp *qp)
5601d0e84c0aSYishai Hadas {
5602d0e84c0aSYishai Hadas 	struct ib_cq *cq = qp->send_cq;
5603d0e84c0aSYishai Hadas 	struct ib_qp_attr attr = { .qp_state = IB_QPS_ERR };
5604d0e84c0aSYishai Hadas 	struct mlx5_ib_drain_cqe sdrain;
5605d34ac5cdSBart Van Assche 	const struct ib_send_wr *bad_swr;
5606d0e84c0aSYishai Hadas 	struct ib_rdma_wr swr = {
5607d0e84c0aSYishai Hadas 		.wr = {
5608d0e84c0aSYishai Hadas 			.next = NULL,
5609d0e84c0aSYishai Hadas 			{ .wr_cqe	= &sdrain.cqe, },
5610d0e84c0aSYishai Hadas 			.opcode	= IB_WR_RDMA_WRITE,
5611d0e84c0aSYishai Hadas 		},
5612d0e84c0aSYishai Hadas 	};
5613d0e84c0aSYishai Hadas 	int ret;
5614d0e84c0aSYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(qp->device);
5615d0e84c0aSYishai Hadas 	struct mlx5_core_dev *mdev = dev->mdev;
5616d0e84c0aSYishai Hadas 
5617d0e84c0aSYishai Hadas 	ret = ib_modify_qp(qp, &attr, IB_QP_STATE);
5618d0e84c0aSYishai Hadas 	if (ret && mdev->state != MLX5_DEVICE_STATE_INTERNAL_ERROR) {
5619d0e84c0aSYishai Hadas 		WARN_ONCE(ret, "failed to drain send queue: %d\n", ret);
5620d0e84c0aSYishai Hadas 		return;
5621d0e84c0aSYishai Hadas 	}
5622d0e84c0aSYishai Hadas 
5623d0e84c0aSYishai Hadas 	sdrain.cqe.done = mlx5_ib_drain_qp_done;
5624d0e84c0aSYishai Hadas 	init_completion(&sdrain.done);
5625d0e84c0aSYishai Hadas 
5626029e88fdSLeon Romanovsky 	ret = mlx5_ib_post_send_drain(qp, &swr.wr, &bad_swr);
5627d0e84c0aSYishai Hadas 	if (ret) {
5628d0e84c0aSYishai Hadas 		WARN_ONCE(ret, "failed to drain send queue: %d\n", ret);
5629d0e84c0aSYishai Hadas 		return;
5630d0e84c0aSYishai Hadas 	}
5631d0e84c0aSYishai Hadas 
5632d0e84c0aSYishai Hadas 	handle_drain_completion(cq, &sdrain, dev);
5633d0e84c0aSYishai Hadas }
5634d0e84c0aSYishai Hadas 
5635d0e84c0aSYishai Hadas void mlx5_ib_drain_rq(struct ib_qp *qp)
5636d0e84c0aSYishai Hadas {
5637d0e84c0aSYishai Hadas 	struct ib_cq *cq = qp->recv_cq;
5638d0e84c0aSYishai Hadas 	struct ib_qp_attr attr = { .qp_state = IB_QPS_ERR };
5639d0e84c0aSYishai Hadas 	struct mlx5_ib_drain_cqe rdrain;
5640d34ac5cdSBart Van Assche 	struct ib_recv_wr rwr = {};
5641d34ac5cdSBart Van Assche 	const struct ib_recv_wr *bad_rwr;
5642d0e84c0aSYishai Hadas 	int ret;
5643d0e84c0aSYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(qp->device);
5644d0e84c0aSYishai Hadas 	struct mlx5_core_dev *mdev = dev->mdev;
5645d0e84c0aSYishai Hadas 
5646d0e84c0aSYishai Hadas 	ret = ib_modify_qp(qp, &attr, IB_QP_STATE);
5647d0e84c0aSYishai Hadas 	if (ret && mdev->state != MLX5_DEVICE_STATE_INTERNAL_ERROR) {
5648d0e84c0aSYishai Hadas 		WARN_ONCE(ret, "failed to drain recv queue: %d\n", ret);
5649d0e84c0aSYishai Hadas 		return;
5650d0e84c0aSYishai Hadas 	}
5651d0e84c0aSYishai Hadas 
5652d0e84c0aSYishai Hadas 	rwr.wr_cqe = &rdrain.cqe;
5653d0e84c0aSYishai Hadas 	rdrain.cqe.done = mlx5_ib_drain_qp_done;
5654d0e84c0aSYishai Hadas 	init_completion(&rdrain.done);
5655d0e84c0aSYishai Hadas 
5656029e88fdSLeon Romanovsky 	ret = mlx5_ib_post_recv_drain(qp, &rwr, &bad_rwr);
5657d0e84c0aSYishai Hadas 	if (ret) {
5658d0e84c0aSYishai Hadas 		WARN_ONCE(ret, "failed to drain recv queue: %d\n", ret);
5659d0e84c0aSYishai Hadas 		return;
5660d0e84c0aSYishai Hadas 	}
5661d0e84c0aSYishai Hadas 
5662d0e84c0aSYishai Hadas 	handle_drain_completion(cq, &rdrain, dev);
5663d0e84c0aSYishai Hadas }
5664d14133ddSMark Zhang 
566530cd9fc5SLee Jones /*
5666d14133ddSMark Zhang  * Bind a qp to a counter. If @counter is NULL then bind the qp to
5667d14133ddSMark Zhang  * the default counter
5668d14133ddSMark Zhang  */
5669d14133ddSMark Zhang int mlx5_ib_qp_set_counter(struct ib_qp *qp, struct rdma_counter *counter)
5670d14133ddSMark Zhang {
567110189e8eSMark Zhang 	struct mlx5_ib_dev *dev = to_mdev(qp->device);
5672d14133ddSMark Zhang 	struct mlx5_ib_qp *mqp = to_mqp(qp);
5673d14133ddSMark Zhang 	int err = 0;
5674d14133ddSMark Zhang 
5675d14133ddSMark Zhang 	mutex_lock(&mqp->mutex);
5676d14133ddSMark Zhang 	if (mqp->state == IB_QPS_RESET) {
5677d14133ddSMark Zhang 		qp->counter = counter;
5678d14133ddSMark Zhang 		goto out;
5679d14133ddSMark Zhang 	}
5680d14133ddSMark Zhang 
568110189e8eSMark Zhang 	if (!MLX5_CAP_GEN(dev->mdev, rts2rts_qp_counters_set_id)) {
568210189e8eSMark Zhang 		err = -EOPNOTSUPP;
568310189e8eSMark Zhang 		goto out;
568410189e8eSMark Zhang 	}
568510189e8eSMark Zhang 
5686d14133ddSMark Zhang 	if (mqp->state == IB_QPS_RTS) {
5687d14133ddSMark Zhang 		err = __mlx5_ib_qp_set_counter(qp, counter);
5688d14133ddSMark Zhang 		if (!err)
5689d14133ddSMark Zhang 			qp->counter = counter;
5690d14133ddSMark Zhang 
5691d14133ddSMark Zhang 		goto out;
5692d14133ddSMark Zhang 	}
5693d14133ddSMark Zhang 
5694d14133ddSMark Zhang 	mqp->counter_pending = 1;
5695d14133ddSMark Zhang 	qp->counter = counter;
5696d14133ddSMark Zhang 
5697d14133ddSMark Zhang out:
5698d14133ddSMark Zhang 	mutex_unlock(&mqp->mutex);
5699d14133ddSMark Zhang 	return err;
5700d14133ddSMark Zhang }
5701