xref: /openbmc/linux/drivers/infiniband/hw/mlx5/qp.c (revision 1974ab9d)
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>
37e126ba97SEli Cohen #include "mlx5_ib.h"
38e126ba97SEli Cohen 
39e126ba97SEli Cohen /* not supported currently */
40e126ba97SEli Cohen static int wq_signature;
41e126ba97SEli Cohen 
42e126ba97SEli Cohen enum {
43e126ba97SEli Cohen 	MLX5_IB_ACK_REQ_FREQ	= 8,
44e126ba97SEli Cohen };
45e126ba97SEli Cohen 
46e126ba97SEli Cohen enum {
47e126ba97SEli Cohen 	MLX5_IB_DEFAULT_SCHED_QUEUE	= 0x83,
48e126ba97SEli Cohen 	MLX5_IB_DEFAULT_QP0_SCHED_QUEUE	= 0x3f,
49e126ba97SEli Cohen 	MLX5_IB_LINK_TYPE_IB		= 0,
50e126ba97SEli Cohen 	MLX5_IB_LINK_TYPE_ETH		= 1
51e126ba97SEli Cohen };
52e126ba97SEli Cohen 
53e126ba97SEli Cohen enum {
54e126ba97SEli Cohen 	MLX5_IB_SQ_STRIDE	= 6,
55e126ba97SEli Cohen 	MLX5_IB_CACHE_LINE_SIZE	= 64,
56e126ba97SEli Cohen };
57e126ba97SEli Cohen 
58e126ba97SEli Cohen static const u32 mlx5_ib_opcode[] = {
59e126ba97SEli Cohen 	[IB_WR_SEND]				= MLX5_OPCODE_SEND,
60f0313965SErez Shitrit 	[IB_WR_LSO]				= MLX5_OPCODE_LSO,
61e126ba97SEli Cohen 	[IB_WR_SEND_WITH_IMM]			= MLX5_OPCODE_SEND_IMM,
62e126ba97SEli Cohen 	[IB_WR_RDMA_WRITE]			= MLX5_OPCODE_RDMA_WRITE,
63e126ba97SEli Cohen 	[IB_WR_RDMA_WRITE_WITH_IMM]		= MLX5_OPCODE_RDMA_WRITE_IMM,
64e126ba97SEli Cohen 	[IB_WR_RDMA_READ]			= MLX5_OPCODE_RDMA_READ,
65e126ba97SEli Cohen 	[IB_WR_ATOMIC_CMP_AND_SWP]		= MLX5_OPCODE_ATOMIC_CS,
66e126ba97SEli Cohen 	[IB_WR_ATOMIC_FETCH_AND_ADD]		= MLX5_OPCODE_ATOMIC_FA,
67e126ba97SEli Cohen 	[IB_WR_SEND_WITH_INV]			= MLX5_OPCODE_SEND_INVAL,
68e126ba97SEli Cohen 	[IB_WR_LOCAL_INV]			= MLX5_OPCODE_UMR,
698a187ee5SSagi Grimberg 	[IB_WR_REG_MR]				= MLX5_OPCODE_UMR,
70e126ba97SEli Cohen 	[IB_WR_MASKED_ATOMIC_CMP_AND_SWP]	= MLX5_OPCODE_ATOMIC_MASKED_CS,
71e126ba97SEli Cohen 	[IB_WR_MASKED_ATOMIC_FETCH_AND_ADD]	= MLX5_OPCODE_ATOMIC_MASKED_FA,
72e126ba97SEli Cohen 	[MLX5_IB_WR_UMR]			= MLX5_OPCODE_UMR,
73e126ba97SEli Cohen };
74e126ba97SEli Cohen 
75f0313965SErez Shitrit struct mlx5_wqe_eth_pad {
76f0313965SErez Shitrit 	u8 rsvd0[16];
77f0313965SErez Shitrit };
78e126ba97SEli Cohen 
79eb49ab0cSAlex Vesker enum raw_qp_set_mask_map {
80eb49ab0cSAlex Vesker 	MLX5_RAW_QP_MOD_SET_RQ_Q_CTR_ID		= 1UL << 0,
817d29f349SBodong Wang 	MLX5_RAW_QP_RATE_LIMIT			= 1UL << 1,
82eb49ab0cSAlex Vesker };
83eb49ab0cSAlex Vesker 
840680efa2SAlex Vesker struct mlx5_modify_raw_qp_param {
850680efa2SAlex Vesker 	u16 operation;
86eb49ab0cSAlex Vesker 
87eb49ab0cSAlex Vesker 	u32 set_mask; /* raw_qp_set_mask_map */
887d29f349SBodong Wang 	u32 rate_limit;
89eb49ab0cSAlex Vesker 	u8 rq_q_ctr_id;
900680efa2SAlex Vesker };
910680efa2SAlex Vesker 
9289ea94a7SMaor Gottlieb static void get_cqs(enum ib_qp_type qp_type,
9389ea94a7SMaor Gottlieb 		    struct ib_cq *ib_send_cq, struct ib_cq *ib_recv_cq,
9489ea94a7SMaor Gottlieb 		    struct mlx5_ib_cq **send_cq, struct mlx5_ib_cq **recv_cq);
9589ea94a7SMaor Gottlieb 
96e126ba97SEli Cohen static int is_qp0(enum ib_qp_type qp_type)
97e126ba97SEli Cohen {
98e126ba97SEli Cohen 	return qp_type == IB_QPT_SMI;
99e126ba97SEli Cohen }
100e126ba97SEli Cohen 
101e126ba97SEli Cohen static int is_sqp(enum ib_qp_type qp_type)
102e126ba97SEli Cohen {
103e126ba97SEli Cohen 	return is_qp0(qp_type) || is_qp1(qp_type);
104e126ba97SEli Cohen }
105e126ba97SEli Cohen 
106e126ba97SEli Cohen static void *get_wqe(struct mlx5_ib_qp *qp, int offset)
107e126ba97SEli Cohen {
108e126ba97SEli Cohen 	return mlx5_buf_offset(&qp->buf, offset);
109e126ba97SEli Cohen }
110e126ba97SEli Cohen 
111e126ba97SEli Cohen static void *get_recv_wqe(struct mlx5_ib_qp *qp, int n)
112e126ba97SEli Cohen {
113e126ba97SEli Cohen 	return get_wqe(qp, qp->rq.offset + (n << qp->rq.wqe_shift));
114e126ba97SEli Cohen }
115e126ba97SEli Cohen 
116e126ba97SEli Cohen void *mlx5_get_send_wqe(struct mlx5_ib_qp *qp, int n)
117e126ba97SEli Cohen {
118e126ba97SEli Cohen 	return get_wqe(qp, qp->sq.offset + (n << MLX5_IB_SQ_STRIDE));
119e126ba97SEli Cohen }
120e126ba97SEli Cohen 
121c1395a2aSHaggai Eran /**
122c1395a2aSHaggai Eran  * mlx5_ib_read_user_wqe() - Copy a user-space WQE to kernel space.
123c1395a2aSHaggai Eran  *
124c1395a2aSHaggai Eran  * @qp: QP to copy from.
125c1395a2aSHaggai Eran  * @send: copy from the send queue when non-zero, use the receive queue
126c1395a2aSHaggai Eran  *	  otherwise.
127c1395a2aSHaggai Eran  * @wqe_index:  index to start copying from. For send work queues, the
128c1395a2aSHaggai Eran  *		wqe_index is in units of MLX5_SEND_WQE_BB.
129c1395a2aSHaggai Eran  *		For receive work queue, it is the number of work queue
130c1395a2aSHaggai Eran  *		element in the queue.
131c1395a2aSHaggai Eran  * @buffer: destination buffer.
132c1395a2aSHaggai Eran  * @length: maximum number of bytes to copy.
133c1395a2aSHaggai Eran  *
134c1395a2aSHaggai Eran  * Copies at least a single WQE, but may copy more data.
135c1395a2aSHaggai Eran  *
136c1395a2aSHaggai Eran  * Return: the number of bytes copied, or an error code.
137c1395a2aSHaggai Eran  */
138c1395a2aSHaggai Eran int mlx5_ib_read_user_wqe(struct mlx5_ib_qp *qp, int send, int wqe_index,
13919098df2Smajd@mellanox.com 			  void *buffer, u32 length,
14019098df2Smajd@mellanox.com 			  struct mlx5_ib_qp_base *base)
141c1395a2aSHaggai Eran {
142c1395a2aSHaggai Eran 	struct ib_device *ibdev = qp->ibqp.device;
143c1395a2aSHaggai Eran 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
144c1395a2aSHaggai Eran 	struct mlx5_ib_wq *wq = send ? &qp->sq : &qp->rq;
145c1395a2aSHaggai Eran 	size_t offset;
146c1395a2aSHaggai Eran 	size_t wq_end;
14719098df2Smajd@mellanox.com 	struct ib_umem *umem = base->ubuffer.umem;
148c1395a2aSHaggai Eran 	u32 first_copy_length;
149c1395a2aSHaggai Eran 	int wqe_length;
150c1395a2aSHaggai Eran 	int ret;
151c1395a2aSHaggai Eran 
152c1395a2aSHaggai Eran 	if (wq->wqe_cnt == 0) {
153c1395a2aSHaggai Eran 		mlx5_ib_dbg(dev, "mlx5_ib_read_user_wqe for a QP with wqe_cnt == 0. qp_type: 0x%x\n",
154c1395a2aSHaggai Eran 			    qp->ibqp.qp_type);
155c1395a2aSHaggai Eran 		return -EINVAL;
156c1395a2aSHaggai Eran 	}
157c1395a2aSHaggai Eran 
158c1395a2aSHaggai Eran 	offset = wq->offset + ((wqe_index % wq->wqe_cnt) << wq->wqe_shift);
159c1395a2aSHaggai Eran 	wq_end = wq->offset + (wq->wqe_cnt << wq->wqe_shift);
160c1395a2aSHaggai Eran 
161c1395a2aSHaggai Eran 	if (send && length < sizeof(struct mlx5_wqe_ctrl_seg))
162c1395a2aSHaggai Eran 		return -EINVAL;
163c1395a2aSHaggai Eran 
164c1395a2aSHaggai Eran 	if (offset > umem->length ||
165c1395a2aSHaggai Eran 	    (send && offset + sizeof(struct mlx5_wqe_ctrl_seg) > umem->length))
166c1395a2aSHaggai Eran 		return -EINVAL;
167c1395a2aSHaggai Eran 
168c1395a2aSHaggai Eran 	first_copy_length = min_t(u32, offset + length, wq_end) - offset;
169c1395a2aSHaggai Eran 	ret = ib_umem_copy_from(buffer, umem, offset, first_copy_length);
170c1395a2aSHaggai Eran 	if (ret)
171c1395a2aSHaggai Eran 		return ret;
172c1395a2aSHaggai Eran 
173c1395a2aSHaggai Eran 	if (send) {
174c1395a2aSHaggai Eran 		struct mlx5_wqe_ctrl_seg *ctrl = buffer;
175c1395a2aSHaggai Eran 		int ds = be32_to_cpu(ctrl->qpn_ds) & MLX5_WQE_CTRL_DS_MASK;
176c1395a2aSHaggai Eran 
177c1395a2aSHaggai Eran 		wqe_length = ds * MLX5_WQE_DS_UNITS;
178c1395a2aSHaggai Eran 	} else {
179c1395a2aSHaggai Eran 		wqe_length = 1 << wq->wqe_shift;
180c1395a2aSHaggai Eran 	}
181c1395a2aSHaggai Eran 
182c1395a2aSHaggai Eran 	if (wqe_length <= first_copy_length)
183c1395a2aSHaggai Eran 		return first_copy_length;
184c1395a2aSHaggai Eran 
185c1395a2aSHaggai Eran 	ret = ib_umem_copy_from(buffer + first_copy_length, umem, wq->offset,
186c1395a2aSHaggai Eran 				wqe_length - first_copy_length);
187c1395a2aSHaggai Eran 	if (ret)
188c1395a2aSHaggai Eran 		return ret;
189c1395a2aSHaggai Eran 
190c1395a2aSHaggai Eran 	return wqe_length;
191c1395a2aSHaggai Eran }
192c1395a2aSHaggai Eran 
193e126ba97SEli Cohen static void mlx5_ib_qp_event(struct mlx5_core_qp *qp, int type)
194e126ba97SEli Cohen {
195e126ba97SEli Cohen 	struct ib_qp *ibqp = &to_mibqp(qp)->ibqp;
196e126ba97SEli Cohen 	struct ib_event event;
197e126ba97SEli Cohen 
19819098df2Smajd@mellanox.com 	if (type == MLX5_EVENT_TYPE_PATH_MIG) {
19919098df2Smajd@mellanox.com 		/* This event is only valid for trans_qps */
20019098df2Smajd@mellanox.com 		to_mibqp(qp)->port = to_mibqp(qp)->trans_qp.alt_port;
20119098df2Smajd@mellanox.com 	}
202e126ba97SEli Cohen 
203e126ba97SEli Cohen 	if (ibqp->event_handler) {
204e126ba97SEli Cohen 		event.device     = ibqp->device;
205e126ba97SEli Cohen 		event.element.qp = ibqp;
206e126ba97SEli Cohen 		switch (type) {
207e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_PATH_MIG:
208e126ba97SEli Cohen 			event.event = IB_EVENT_PATH_MIG;
209e126ba97SEli Cohen 			break;
210e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_COMM_EST:
211e126ba97SEli Cohen 			event.event = IB_EVENT_COMM_EST;
212e126ba97SEli Cohen 			break;
213e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_SQ_DRAINED:
214e126ba97SEli Cohen 			event.event = IB_EVENT_SQ_DRAINED;
215e126ba97SEli Cohen 			break;
216e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_SRQ_LAST_WQE:
217e126ba97SEli Cohen 			event.event = IB_EVENT_QP_LAST_WQE_REACHED;
218e126ba97SEli Cohen 			break;
219e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_WQ_CATAS_ERROR:
220e126ba97SEli Cohen 			event.event = IB_EVENT_QP_FATAL;
221e126ba97SEli Cohen 			break;
222e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_PATH_MIG_FAILED:
223e126ba97SEli Cohen 			event.event = IB_EVENT_PATH_MIG_ERR;
224e126ba97SEli Cohen 			break;
225e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_WQ_INVAL_REQ_ERROR:
226e126ba97SEli Cohen 			event.event = IB_EVENT_QP_REQ_ERR;
227e126ba97SEli Cohen 			break;
228e126ba97SEli Cohen 		case MLX5_EVENT_TYPE_WQ_ACCESS_ERROR:
229e126ba97SEli Cohen 			event.event = IB_EVENT_QP_ACCESS_ERR;
230e126ba97SEli Cohen 			break;
231e126ba97SEli Cohen 		default:
232e126ba97SEli Cohen 			pr_warn("mlx5_ib: Unexpected event type %d on QP %06x\n", type, qp->qpn);
233e126ba97SEli Cohen 			return;
234e126ba97SEli Cohen 		}
235e126ba97SEli Cohen 
236e126ba97SEli Cohen 		ibqp->event_handler(&event, ibqp->qp_context);
237e126ba97SEli Cohen 	}
238e126ba97SEli Cohen }
239e126ba97SEli Cohen 
240e126ba97SEli Cohen static int set_rq_size(struct mlx5_ib_dev *dev, struct ib_qp_cap *cap,
241e126ba97SEli Cohen 		       int has_rq, struct mlx5_ib_qp *qp, struct mlx5_ib_create_qp *ucmd)
242e126ba97SEli Cohen {
243e126ba97SEli Cohen 	int wqe_size;
244e126ba97SEli Cohen 	int wq_size;
245e126ba97SEli Cohen 
246e126ba97SEli Cohen 	/* Sanity check RQ size before proceeding */
247938fe83cSSaeed Mahameed 	if (cap->max_recv_wr > (1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz)))
248e126ba97SEli Cohen 		return -EINVAL;
249e126ba97SEli Cohen 
250e126ba97SEli Cohen 	if (!has_rq) {
251e126ba97SEli Cohen 		qp->rq.max_gs = 0;
252e126ba97SEli Cohen 		qp->rq.wqe_cnt = 0;
253e126ba97SEli Cohen 		qp->rq.wqe_shift = 0;
2540540d814SNoa Osherovich 		cap->max_recv_wr = 0;
2550540d814SNoa Osherovich 		cap->max_recv_sge = 0;
256e126ba97SEli Cohen 	} else {
257e126ba97SEli Cohen 		if (ucmd) {
258e126ba97SEli Cohen 			qp->rq.wqe_cnt = ucmd->rq_wqe_count;
259e126ba97SEli Cohen 			qp->rq.wqe_shift = ucmd->rq_wqe_shift;
260e126ba97SEli Cohen 			qp->rq.max_gs = (1 << qp->rq.wqe_shift) / sizeof(struct mlx5_wqe_data_seg) - qp->wq_sig;
261e126ba97SEli Cohen 			qp->rq.max_post = qp->rq.wqe_cnt;
262e126ba97SEli Cohen 		} else {
263e126ba97SEli Cohen 			wqe_size = qp->wq_sig ? sizeof(struct mlx5_wqe_signature_seg) : 0;
264e126ba97SEli Cohen 			wqe_size += cap->max_recv_sge * sizeof(struct mlx5_wqe_data_seg);
265e126ba97SEli Cohen 			wqe_size = roundup_pow_of_two(wqe_size);
266e126ba97SEli Cohen 			wq_size = roundup_pow_of_two(cap->max_recv_wr) * wqe_size;
267e126ba97SEli Cohen 			wq_size = max_t(int, wq_size, MLX5_SEND_WQE_BB);
268e126ba97SEli Cohen 			qp->rq.wqe_cnt = wq_size / wqe_size;
269938fe83cSSaeed Mahameed 			if (wqe_size > MLX5_CAP_GEN(dev->mdev, max_wqe_sz_rq)) {
270e126ba97SEli Cohen 				mlx5_ib_dbg(dev, "wqe_size %d, max %d\n",
271e126ba97SEli Cohen 					    wqe_size,
272938fe83cSSaeed Mahameed 					    MLX5_CAP_GEN(dev->mdev,
273938fe83cSSaeed Mahameed 							 max_wqe_sz_rq));
274e126ba97SEli Cohen 				return -EINVAL;
275e126ba97SEli Cohen 			}
276e126ba97SEli Cohen 			qp->rq.wqe_shift = ilog2(wqe_size);
277e126ba97SEli Cohen 			qp->rq.max_gs = (1 << qp->rq.wqe_shift) / sizeof(struct mlx5_wqe_data_seg) - qp->wq_sig;
278e126ba97SEli Cohen 			qp->rq.max_post = qp->rq.wqe_cnt;
279e126ba97SEli Cohen 		}
280e126ba97SEli Cohen 	}
281e126ba97SEli Cohen 
282e126ba97SEli Cohen 	return 0;
283e126ba97SEli Cohen }
284e126ba97SEli Cohen 
285f0313965SErez Shitrit static int sq_overhead(struct ib_qp_init_attr *attr)
286e126ba97SEli Cohen {
287618af384SAndi Shyti 	int size = 0;
288e126ba97SEli Cohen 
289f0313965SErez Shitrit 	switch (attr->qp_type) {
290e126ba97SEli Cohen 	case IB_QPT_XRC_INI:
291b125a54bSEli Cohen 		size += sizeof(struct mlx5_wqe_xrc_seg);
292e126ba97SEli Cohen 		/* fall through */
293e126ba97SEli Cohen 	case IB_QPT_RC:
294e126ba97SEli Cohen 		size += sizeof(struct mlx5_wqe_ctrl_seg) +
29575c1657eSLeon Romanovsky 			max(sizeof(struct mlx5_wqe_atomic_seg) +
29675c1657eSLeon Romanovsky 			    sizeof(struct mlx5_wqe_raddr_seg),
29775c1657eSLeon Romanovsky 			    sizeof(struct mlx5_wqe_umr_ctrl_seg) +
29875c1657eSLeon Romanovsky 			    sizeof(struct mlx5_mkey_seg));
299e126ba97SEli Cohen 		break;
300e126ba97SEli Cohen 
301b125a54bSEli Cohen 	case IB_QPT_XRC_TGT:
302b125a54bSEli Cohen 		return 0;
303b125a54bSEli Cohen 
304e126ba97SEli Cohen 	case IB_QPT_UC:
305b125a54bSEli Cohen 		size += sizeof(struct mlx5_wqe_ctrl_seg) +
30675c1657eSLeon Romanovsky 			max(sizeof(struct mlx5_wqe_raddr_seg),
3079e65dc37SEli Cohen 			    sizeof(struct mlx5_wqe_umr_ctrl_seg) +
30875c1657eSLeon Romanovsky 			    sizeof(struct mlx5_mkey_seg));
309e126ba97SEli Cohen 		break;
310e126ba97SEli Cohen 
311e126ba97SEli Cohen 	case IB_QPT_UD:
312f0313965SErez Shitrit 		if (attr->create_flags & IB_QP_CREATE_IPOIB_UD_LSO)
313f0313965SErez Shitrit 			size += sizeof(struct mlx5_wqe_eth_pad) +
314f0313965SErez Shitrit 				sizeof(struct mlx5_wqe_eth_seg);
315f0313965SErez Shitrit 		/* fall through */
316e126ba97SEli Cohen 	case IB_QPT_SMI:
317d16e91daSHaggai Eran 	case MLX5_IB_QPT_HW_GSI:
318b125a54bSEli Cohen 		size += sizeof(struct mlx5_wqe_ctrl_seg) +
319e126ba97SEli Cohen 			sizeof(struct mlx5_wqe_datagram_seg);
320e126ba97SEli Cohen 		break;
321e126ba97SEli Cohen 
322e126ba97SEli Cohen 	case MLX5_IB_QPT_REG_UMR:
323b125a54bSEli Cohen 		size += sizeof(struct mlx5_wqe_ctrl_seg) +
324e126ba97SEli Cohen 			sizeof(struct mlx5_wqe_umr_ctrl_seg) +
325e126ba97SEli Cohen 			sizeof(struct mlx5_mkey_seg);
326e126ba97SEli Cohen 		break;
327e126ba97SEli Cohen 
328e126ba97SEli Cohen 	default:
329e126ba97SEli Cohen 		return -EINVAL;
330e126ba97SEli Cohen 	}
331e126ba97SEli Cohen 
332e126ba97SEli Cohen 	return size;
333e126ba97SEli Cohen }
334e126ba97SEli Cohen 
335e126ba97SEli Cohen static int calc_send_wqe(struct ib_qp_init_attr *attr)
336e126ba97SEli Cohen {
337e126ba97SEli Cohen 	int inl_size = 0;
338e126ba97SEli Cohen 	int size;
339e126ba97SEli Cohen 
340f0313965SErez Shitrit 	size = sq_overhead(attr);
341e126ba97SEli Cohen 	if (size < 0)
342e126ba97SEli Cohen 		return size;
343e126ba97SEli Cohen 
344e126ba97SEli Cohen 	if (attr->cap.max_inline_data) {
345e126ba97SEli Cohen 		inl_size = size + sizeof(struct mlx5_wqe_inline_seg) +
346e126ba97SEli Cohen 			attr->cap.max_inline_data;
347e126ba97SEli Cohen 	}
348e126ba97SEli Cohen 
349e126ba97SEli Cohen 	size += attr->cap.max_send_sge * sizeof(struct mlx5_wqe_data_seg);
350e1e66cc2SSagi Grimberg 	if (attr->create_flags & IB_QP_CREATE_SIGNATURE_EN &&
351e1e66cc2SSagi Grimberg 	    ALIGN(max_t(int, inl_size, size), MLX5_SEND_WQE_BB) < MLX5_SIG_WQE_SIZE)
352e1e66cc2SSagi Grimberg 			return MLX5_SIG_WQE_SIZE;
353e1e66cc2SSagi Grimberg 	else
354e126ba97SEli Cohen 		return ALIGN(max_t(int, inl_size, size), MLX5_SEND_WQE_BB);
355e126ba97SEli Cohen }
356e126ba97SEli Cohen 
357288c01b7SEli Cohen static int get_send_sge(struct ib_qp_init_attr *attr, int wqe_size)
358288c01b7SEli Cohen {
359288c01b7SEli Cohen 	int max_sge;
360288c01b7SEli Cohen 
361288c01b7SEli Cohen 	if (attr->qp_type == IB_QPT_RC)
362288c01b7SEli Cohen 		max_sge = (min_t(int, wqe_size, 512) -
363288c01b7SEli Cohen 			   sizeof(struct mlx5_wqe_ctrl_seg) -
364288c01b7SEli Cohen 			   sizeof(struct mlx5_wqe_raddr_seg)) /
365288c01b7SEli Cohen 			sizeof(struct mlx5_wqe_data_seg);
366288c01b7SEli Cohen 	else if (attr->qp_type == IB_QPT_XRC_INI)
367288c01b7SEli Cohen 		max_sge = (min_t(int, wqe_size, 512) -
368288c01b7SEli Cohen 			   sizeof(struct mlx5_wqe_ctrl_seg) -
369288c01b7SEli Cohen 			   sizeof(struct mlx5_wqe_xrc_seg) -
370288c01b7SEli Cohen 			   sizeof(struct mlx5_wqe_raddr_seg)) /
371288c01b7SEli Cohen 			sizeof(struct mlx5_wqe_data_seg);
372288c01b7SEli Cohen 	else
373288c01b7SEli Cohen 		max_sge = (wqe_size - sq_overhead(attr)) /
374288c01b7SEli Cohen 			sizeof(struct mlx5_wqe_data_seg);
375288c01b7SEli Cohen 
376288c01b7SEli Cohen 	return min_t(int, max_sge, wqe_size - sq_overhead(attr) /
377288c01b7SEli Cohen 		     sizeof(struct mlx5_wqe_data_seg));
378288c01b7SEli Cohen }
379288c01b7SEli Cohen 
380e126ba97SEli Cohen static int calc_sq_size(struct mlx5_ib_dev *dev, struct ib_qp_init_attr *attr,
381e126ba97SEli Cohen 			struct mlx5_ib_qp *qp)
382e126ba97SEli Cohen {
383e126ba97SEli Cohen 	int wqe_size;
384e126ba97SEli Cohen 	int wq_size;
385e126ba97SEli Cohen 
386e126ba97SEli Cohen 	if (!attr->cap.max_send_wr)
387e126ba97SEli Cohen 		return 0;
388e126ba97SEli Cohen 
389e126ba97SEli Cohen 	wqe_size = calc_send_wqe(attr);
390e126ba97SEli Cohen 	mlx5_ib_dbg(dev, "wqe_size %d\n", wqe_size);
391e126ba97SEli Cohen 	if (wqe_size < 0)
392e126ba97SEli Cohen 		return wqe_size;
393e126ba97SEli Cohen 
394938fe83cSSaeed Mahameed 	if (wqe_size > MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq)) {
395b125a54bSEli Cohen 		mlx5_ib_dbg(dev, "wqe_size(%d) > max_sq_desc_sz(%d)\n",
396938fe83cSSaeed Mahameed 			    wqe_size, MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq));
397e126ba97SEli Cohen 		return -EINVAL;
398e126ba97SEli Cohen 	}
399e126ba97SEli Cohen 
400f0313965SErez Shitrit 	qp->max_inline_data = wqe_size - sq_overhead(attr) -
401e126ba97SEli Cohen 			      sizeof(struct mlx5_wqe_inline_seg);
402e126ba97SEli Cohen 	attr->cap.max_inline_data = qp->max_inline_data;
403e126ba97SEli Cohen 
404e1e66cc2SSagi Grimberg 	if (attr->create_flags & IB_QP_CREATE_SIGNATURE_EN)
405e1e66cc2SSagi Grimberg 		qp->signature_en = true;
406e1e66cc2SSagi Grimberg 
407e126ba97SEli Cohen 	wq_size = roundup_pow_of_two(attr->cap.max_send_wr * wqe_size);
408e126ba97SEli Cohen 	qp->sq.wqe_cnt = wq_size / MLX5_SEND_WQE_BB;
409938fe83cSSaeed Mahameed 	if (qp->sq.wqe_cnt > (1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz))) {
4101974ab9dSBart Van Assche 		mlx5_ib_dbg(dev, "send queue size (%d * %d / %d -> %d) exceeds limits(%d)\n",
4111974ab9dSBart Van Assche 			    attr->cap.max_send_wr, wqe_size, MLX5_SEND_WQE_BB,
412938fe83cSSaeed Mahameed 			    qp->sq.wqe_cnt,
413938fe83cSSaeed Mahameed 			    1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz));
414b125a54bSEli Cohen 		return -ENOMEM;
415b125a54bSEli Cohen 	}
416e126ba97SEli Cohen 	qp->sq.wqe_shift = ilog2(MLX5_SEND_WQE_BB);
417288c01b7SEli Cohen 	qp->sq.max_gs = get_send_sge(attr, wqe_size);
418288c01b7SEli Cohen 	if (qp->sq.max_gs < attr->cap.max_send_sge)
419288c01b7SEli Cohen 		return -ENOMEM;
420288c01b7SEli Cohen 
421288c01b7SEli Cohen 	attr->cap.max_send_sge = qp->sq.max_gs;
422b125a54bSEli Cohen 	qp->sq.max_post = wq_size / wqe_size;
423b125a54bSEli Cohen 	attr->cap.max_send_wr = qp->sq.max_post;
424e126ba97SEli Cohen 
425e126ba97SEli Cohen 	return wq_size;
426e126ba97SEli Cohen }
427e126ba97SEli Cohen 
428e126ba97SEli Cohen static int set_user_buf_size(struct mlx5_ib_dev *dev,
429e126ba97SEli Cohen 			    struct mlx5_ib_qp *qp,
43019098df2Smajd@mellanox.com 			    struct mlx5_ib_create_qp *ucmd,
4310fb2ed66Smajd@mellanox.com 			    struct mlx5_ib_qp_base *base,
4320fb2ed66Smajd@mellanox.com 			    struct ib_qp_init_attr *attr)
433e126ba97SEli Cohen {
434e126ba97SEli Cohen 	int desc_sz = 1 << qp->sq.wqe_shift;
435e126ba97SEli Cohen 
436938fe83cSSaeed Mahameed 	if (desc_sz > MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq)) {
437e126ba97SEli Cohen 		mlx5_ib_warn(dev, "desc_sz %d, max_sq_desc_sz %d\n",
438938fe83cSSaeed Mahameed 			     desc_sz, MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq));
439e126ba97SEli Cohen 		return -EINVAL;
440e126ba97SEli Cohen 	}
441e126ba97SEli Cohen 
442e126ba97SEli Cohen 	if (ucmd->sq_wqe_count && ((1 << ilog2(ucmd->sq_wqe_count)) != ucmd->sq_wqe_count)) {
443e126ba97SEli Cohen 		mlx5_ib_warn(dev, "sq_wqe_count %d, sq_wqe_count %d\n",
444e126ba97SEli Cohen 			     ucmd->sq_wqe_count, ucmd->sq_wqe_count);
445e126ba97SEli Cohen 		return -EINVAL;
446e126ba97SEli Cohen 	}
447e126ba97SEli Cohen 
448e126ba97SEli Cohen 	qp->sq.wqe_cnt = ucmd->sq_wqe_count;
449e126ba97SEli Cohen 
450938fe83cSSaeed Mahameed 	if (qp->sq.wqe_cnt > (1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz))) {
451e126ba97SEli Cohen 		mlx5_ib_warn(dev, "wqe_cnt %d, max_wqes %d\n",
452938fe83cSSaeed Mahameed 			     qp->sq.wqe_cnt,
453938fe83cSSaeed Mahameed 			     1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz));
454e126ba97SEli Cohen 		return -EINVAL;
455e126ba97SEli Cohen 	}
456e126ba97SEli Cohen 
4570fb2ed66Smajd@mellanox.com 	if (attr->qp_type == IB_QPT_RAW_PACKET) {
4580fb2ed66Smajd@mellanox.com 		base->ubuffer.buf_size = qp->rq.wqe_cnt << qp->rq.wqe_shift;
4590fb2ed66Smajd@mellanox.com 		qp->raw_packet_qp.sq.ubuffer.buf_size = qp->sq.wqe_cnt << 6;
4600fb2ed66Smajd@mellanox.com 	} else {
46119098df2Smajd@mellanox.com 		base->ubuffer.buf_size = (qp->rq.wqe_cnt << qp->rq.wqe_shift) +
462e126ba97SEli Cohen 					 (qp->sq.wqe_cnt << 6);
4630fb2ed66Smajd@mellanox.com 	}
464e126ba97SEli Cohen 
465e126ba97SEli Cohen 	return 0;
466e126ba97SEli Cohen }
467e126ba97SEli Cohen 
468e126ba97SEli Cohen static int qp_has_rq(struct ib_qp_init_attr *attr)
469e126ba97SEli Cohen {
470e126ba97SEli Cohen 	if (attr->qp_type == IB_QPT_XRC_INI ||
471e126ba97SEli Cohen 	    attr->qp_type == IB_QPT_XRC_TGT || attr->srq ||
472e126ba97SEli Cohen 	    attr->qp_type == MLX5_IB_QPT_REG_UMR ||
473e126ba97SEli Cohen 	    !attr->cap.max_recv_wr)
474e126ba97SEli Cohen 		return 0;
475e126ba97SEli Cohen 
476e126ba97SEli Cohen 	return 1;
477e126ba97SEli Cohen }
478e126ba97SEli Cohen 
479c1be5232SEli Cohen static int first_med_uuar(void)
480c1be5232SEli Cohen {
481c1be5232SEli Cohen 	return 1;
482c1be5232SEli Cohen }
483c1be5232SEli Cohen 
484c1be5232SEli Cohen static int next_uuar(int n)
485c1be5232SEli Cohen {
486c1be5232SEli Cohen 	n++;
487c1be5232SEli Cohen 
488c1be5232SEli Cohen 	while (((n % 4) & 2))
489c1be5232SEli Cohen 		n++;
490c1be5232SEli Cohen 
491c1be5232SEli Cohen 	return n;
492c1be5232SEli Cohen }
493c1be5232SEli Cohen 
494c1be5232SEli Cohen static int num_med_uuar(struct mlx5_uuar_info *uuari)
495c1be5232SEli Cohen {
496c1be5232SEli Cohen 	int n;
497c1be5232SEli Cohen 
498c1be5232SEli Cohen 	n = uuari->num_uars * MLX5_NON_FP_BF_REGS_PER_PAGE -
499c1be5232SEli Cohen 		uuari->num_low_latency_uuars - 1;
500c1be5232SEli Cohen 
501c1be5232SEli Cohen 	return n >= 0 ? n : 0;
502c1be5232SEli Cohen }
503c1be5232SEli Cohen 
504c1be5232SEli Cohen static int max_uuari(struct mlx5_uuar_info *uuari)
505c1be5232SEli Cohen {
506c1be5232SEli Cohen 	return uuari->num_uars * 4;
507c1be5232SEli Cohen }
508c1be5232SEli Cohen 
509c1be5232SEli Cohen static int first_hi_uuar(struct mlx5_uuar_info *uuari)
510c1be5232SEli Cohen {
511c1be5232SEli Cohen 	int med;
512c1be5232SEli Cohen 	int i;
513c1be5232SEli Cohen 	int t;
514c1be5232SEli Cohen 
515c1be5232SEli Cohen 	med = num_med_uuar(uuari);
516c1be5232SEli Cohen 	for (t = 0, i = first_med_uuar();; i = next_uuar(i)) {
517c1be5232SEli Cohen 		t++;
518c1be5232SEli Cohen 		if (t == med)
519c1be5232SEli Cohen 			return next_uuar(i);
520c1be5232SEli Cohen 	}
521c1be5232SEli Cohen 
522c1be5232SEli Cohen 	return 0;
523c1be5232SEli Cohen }
524c1be5232SEli Cohen 
525e126ba97SEli Cohen static int alloc_high_class_uuar(struct mlx5_uuar_info *uuari)
526e126ba97SEli Cohen {
527e126ba97SEli Cohen 	int i;
528e126ba97SEli Cohen 
529c1be5232SEli Cohen 	for (i = first_hi_uuar(uuari); i < max_uuari(uuari); i = next_uuar(i)) {
530e126ba97SEli Cohen 		if (!test_bit(i, uuari->bitmap)) {
531e126ba97SEli Cohen 			set_bit(i, uuari->bitmap);
532e126ba97SEli Cohen 			uuari->count[i]++;
533e126ba97SEli Cohen 			return i;
534e126ba97SEli Cohen 		}
535e126ba97SEli Cohen 	}
536e126ba97SEli Cohen 
537e126ba97SEli Cohen 	return -ENOMEM;
538e126ba97SEli Cohen }
539e126ba97SEli Cohen 
540e126ba97SEli Cohen static int alloc_med_class_uuar(struct mlx5_uuar_info *uuari)
541e126ba97SEli Cohen {
542c1be5232SEli Cohen 	int minidx = first_med_uuar();
543e126ba97SEli Cohen 	int i;
544e126ba97SEli Cohen 
545c1be5232SEli Cohen 	for (i = first_med_uuar(); i < first_hi_uuar(uuari); i = next_uuar(i)) {
546e126ba97SEli Cohen 		if (uuari->count[i] < uuari->count[minidx])
547e126ba97SEli Cohen 			minidx = i;
548e126ba97SEli Cohen 	}
549e126ba97SEli Cohen 
550e126ba97SEli Cohen 	uuari->count[minidx]++;
551e126ba97SEli Cohen 	return minidx;
552e126ba97SEli Cohen }
553e126ba97SEli Cohen 
554e126ba97SEli Cohen static int alloc_uuar(struct mlx5_uuar_info *uuari,
555e126ba97SEli Cohen 		      enum mlx5_ib_latency_class lat)
556e126ba97SEli Cohen {
557e126ba97SEli Cohen 	int uuarn = -EINVAL;
558e126ba97SEli Cohen 
559e126ba97SEli Cohen 	mutex_lock(&uuari->lock);
560e126ba97SEli Cohen 	switch (lat) {
561e126ba97SEli Cohen 	case MLX5_IB_LATENCY_CLASS_LOW:
562e126ba97SEli Cohen 		uuarn = 0;
563e126ba97SEli Cohen 		uuari->count[uuarn]++;
564e126ba97SEli Cohen 		break;
565e126ba97SEli Cohen 
566e126ba97SEli Cohen 	case MLX5_IB_LATENCY_CLASS_MEDIUM:
56778c0f98cSEli Cohen 		if (uuari->ver < 2)
56878c0f98cSEli Cohen 			uuarn = -ENOMEM;
56978c0f98cSEli Cohen 		else
570e126ba97SEli Cohen 			uuarn = alloc_med_class_uuar(uuari);
571e126ba97SEli Cohen 		break;
572e126ba97SEli Cohen 
573e126ba97SEli Cohen 	case MLX5_IB_LATENCY_CLASS_HIGH:
57478c0f98cSEli Cohen 		if (uuari->ver < 2)
57578c0f98cSEli Cohen 			uuarn = -ENOMEM;
57678c0f98cSEli Cohen 		else
577e126ba97SEli Cohen 			uuarn = alloc_high_class_uuar(uuari);
578e126ba97SEli Cohen 		break;
579e126ba97SEli Cohen 
580e126ba97SEli Cohen 	case MLX5_IB_LATENCY_CLASS_FAST_PATH:
581e126ba97SEli Cohen 		uuarn = 2;
582e126ba97SEli Cohen 		break;
583e126ba97SEli Cohen 	}
584e126ba97SEli Cohen 	mutex_unlock(&uuari->lock);
585e126ba97SEli Cohen 
586e126ba97SEli Cohen 	return uuarn;
587e126ba97SEli Cohen }
588e126ba97SEli Cohen 
589e126ba97SEli Cohen static void free_med_class_uuar(struct mlx5_uuar_info *uuari, int uuarn)
590e126ba97SEli Cohen {
591e126ba97SEli Cohen 	clear_bit(uuarn, uuari->bitmap);
592e126ba97SEli Cohen 	--uuari->count[uuarn];
593e126ba97SEli Cohen }
594e126ba97SEli Cohen 
595e126ba97SEli Cohen static void free_high_class_uuar(struct mlx5_uuar_info *uuari, int uuarn)
596e126ba97SEli Cohen {
597e126ba97SEli Cohen 	clear_bit(uuarn, uuari->bitmap);
598e126ba97SEli Cohen 	--uuari->count[uuarn];
599e126ba97SEli Cohen }
600e126ba97SEli Cohen 
601e126ba97SEli Cohen static void free_uuar(struct mlx5_uuar_info *uuari, int uuarn)
602e126ba97SEli Cohen {
603e126ba97SEli Cohen 	int nuuars = uuari->num_uars * MLX5_BF_REGS_PER_PAGE;
604e126ba97SEli Cohen 	int high_uuar = nuuars - uuari->num_low_latency_uuars;
605e126ba97SEli Cohen 
606e126ba97SEli Cohen 	mutex_lock(&uuari->lock);
607e126ba97SEli Cohen 	if (uuarn == 0) {
608e126ba97SEli Cohen 		--uuari->count[uuarn];
609e126ba97SEli Cohen 		goto out;
610e126ba97SEli Cohen 	}
611e126ba97SEli Cohen 
612e126ba97SEli Cohen 	if (uuarn < high_uuar) {
613e126ba97SEli Cohen 		free_med_class_uuar(uuari, uuarn);
614e126ba97SEli Cohen 		goto out;
615e126ba97SEli Cohen 	}
616e126ba97SEli Cohen 
617e126ba97SEli Cohen 	free_high_class_uuar(uuari, uuarn);
618e126ba97SEli Cohen 
619e126ba97SEli Cohen out:
620e126ba97SEli Cohen 	mutex_unlock(&uuari->lock);
621e126ba97SEli Cohen }
622e126ba97SEli Cohen 
623e126ba97SEli Cohen static enum mlx5_qp_state to_mlx5_state(enum ib_qp_state state)
624e126ba97SEli Cohen {
625e126ba97SEli Cohen 	switch (state) {
626e126ba97SEli Cohen 	case IB_QPS_RESET:	return MLX5_QP_STATE_RST;
627e126ba97SEli Cohen 	case IB_QPS_INIT:	return MLX5_QP_STATE_INIT;
628e126ba97SEli Cohen 	case IB_QPS_RTR:	return MLX5_QP_STATE_RTR;
629e126ba97SEli Cohen 	case IB_QPS_RTS:	return MLX5_QP_STATE_RTS;
630e126ba97SEli Cohen 	case IB_QPS_SQD:	return MLX5_QP_STATE_SQD;
631e126ba97SEli Cohen 	case IB_QPS_SQE:	return MLX5_QP_STATE_SQER;
632e126ba97SEli Cohen 	case IB_QPS_ERR:	return MLX5_QP_STATE_ERR;
633e126ba97SEli Cohen 	default:		return -1;
634e126ba97SEli Cohen 	}
635e126ba97SEli Cohen }
636e126ba97SEli Cohen 
637e126ba97SEli Cohen static int to_mlx5_st(enum ib_qp_type type)
638e126ba97SEli Cohen {
639e126ba97SEli Cohen 	switch (type) {
640e126ba97SEli Cohen 	case IB_QPT_RC:			return MLX5_QP_ST_RC;
641e126ba97SEli Cohen 	case IB_QPT_UC:			return MLX5_QP_ST_UC;
642e126ba97SEli Cohen 	case IB_QPT_UD:			return MLX5_QP_ST_UD;
643e126ba97SEli Cohen 	case MLX5_IB_QPT_REG_UMR:	return MLX5_QP_ST_REG_UMR;
644e126ba97SEli Cohen 	case IB_QPT_XRC_INI:
645e126ba97SEli Cohen 	case IB_QPT_XRC_TGT:		return MLX5_QP_ST_XRC;
646e126ba97SEli Cohen 	case IB_QPT_SMI:		return MLX5_QP_ST_QP0;
647d16e91daSHaggai Eran 	case MLX5_IB_QPT_HW_GSI:	return MLX5_QP_ST_QP1;
648e126ba97SEli Cohen 	case IB_QPT_RAW_IPV6:		return MLX5_QP_ST_RAW_IPV6;
649e126ba97SEli Cohen 	case IB_QPT_RAW_PACKET:
6500fb2ed66Smajd@mellanox.com 	case IB_QPT_RAW_ETHERTYPE:	return MLX5_QP_ST_RAW_ETHERTYPE;
651e126ba97SEli Cohen 	case IB_QPT_MAX:
652e126ba97SEli Cohen 	default:		return -EINVAL;
653e126ba97SEli Cohen 	}
654e126ba97SEli Cohen }
655e126ba97SEli Cohen 
65689ea94a7SMaor Gottlieb static void mlx5_ib_lock_cqs(struct mlx5_ib_cq *send_cq,
65789ea94a7SMaor Gottlieb 			     struct mlx5_ib_cq *recv_cq);
65889ea94a7SMaor Gottlieb static void mlx5_ib_unlock_cqs(struct mlx5_ib_cq *send_cq,
65989ea94a7SMaor Gottlieb 			       struct mlx5_ib_cq *recv_cq);
66089ea94a7SMaor Gottlieb 
661e126ba97SEli Cohen static int uuarn_to_uar_index(struct mlx5_uuar_info *uuari, int uuarn)
662e126ba97SEli Cohen {
663e126ba97SEli Cohen 	return uuari->uars[uuarn / MLX5_BF_REGS_PER_PAGE].index;
664e126ba97SEli Cohen }
665e126ba97SEli Cohen 
66619098df2Smajd@mellanox.com static int mlx5_ib_umem_get(struct mlx5_ib_dev *dev,
66719098df2Smajd@mellanox.com 			    struct ib_pd *pd,
66819098df2Smajd@mellanox.com 			    unsigned long addr, size_t size,
66919098df2Smajd@mellanox.com 			    struct ib_umem **umem,
67019098df2Smajd@mellanox.com 			    int *npages, int *page_shift, int *ncont,
67119098df2Smajd@mellanox.com 			    u32 *offset)
67219098df2Smajd@mellanox.com {
67319098df2Smajd@mellanox.com 	int err;
67419098df2Smajd@mellanox.com 
67519098df2Smajd@mellanox.com 	*umem = ib_umem_get(pd->uobject->context, addr, size, 0, 0);
67619098df2Smajd@mellanox.com 	if (IS_ERR(*umem)) {
67719098df2Smajd@mellanox.com 		mlx5_ib_dbg(dev, "umem_get failed\n");
67819098df2Smajd@mellanox.com 		return PTR_ERR(*umem);
67919098df2Smajd@mellanox.com 	}
68019098df2Smajd@mellanox.com 
681762f899aSMajd Dibbiny 	mlx5_ib_cont_pages(*umem, addr, 0, npages, page_shift, ncont, NULL);
68219098df2Smajd@mellanox.com 
68319098df2Smajd@mellanox.com 	err = mlx5_ib_get_buf_offset(addr, *page_shift, offset);
68419098df2Smajd@mellanox.com 	if (err) {
68519098df2Smajd@mellanox.com 		mlx5_ib_warn(dev, "bad offset\n");
68619098df2Smajd@mellanox.com 		goto err_umem;
68719098df2Smajd@mellanox.com 	}
68819098df2Smajd@mellanox.com 
68919098df2Smajd@mellanox.com 	mlx5_ib_dbg(dev, "addr 0x%lx, size %zu, npages %d, page_shift %d, ncont %d, offset %d\n",
69019098df2Smajd@mellanox.com 		    addr, size, *npages, *page_shift, *ncont, *offset);
69119098df2Smajd@mellanox.com 
69219098df2Smajd@mellanox.com 	return 0;
69319098df2Smajd@mellanox.com 
69419098df2Smajd@mellanox.com err_umem:
69519098df2Smajd@mellanox.com 	ib_umem_release(*umem);
69619098df2Smajd@mellanox.com 	*umem = NULL;
69719098df2Smajd@mellanox.com 
69819098df2Smajd@mellanox.com 	return err;
69919098df2Smajd@mellanox.com }
70019098df2Smajd@mellanox.com 
70179b20a6cSYishai Hadas static void destroy_user_rq(struct ib_pd *pd, struct mlx5_ib_rwq *rwq)
70279b20a6cSYishai Hadas {
70379b20a6cSYishai Hadas 	struct mlx5_ib_ucontext *context;
70479b20a6cSYishai Hadas 
70579b20a6cSYishai Hadas 	context = to_mucontext(pd->uobject->context);
70679b20a6cSYishai Hadas 	mlx5_ib_db_unmap_user(context, &rwq->db);
70779b20a6cSYishai Hadas 	if (rwq->umem)
70879b20a6cSYishai Hadas 		ib_umem_release(rwq->umem);
70979b20a6cSYishai Hadas }
71079b20a6cSYishai Hadas 
71179b20a6cSYishai Hadas static int create_user_rq(struct mlx5_ib_dev *dev, struct ib_pd *pd,
71279b20a6cSYishai Hadas 			  struct mlx5_ib_rwq *rwq,
71379b20a6cSYishai Hadas 			  struct mlx5_ib_create_wq *ucmd)
71479b20a6cSYishai Hadas {
71579b20a6cSYishai Hadas 	struct mlx5_ib_ucontext *context;
71679b20a6cSYishai Hadas 	int page_shift = 0;
71779b20a6cSYishai Hadas 	int npages;
71879b20a6cSYishai Hadas 	u32 offset = 0;
71979b20a6cSYishai Hadas 	int ncont = 0;
72079b20a6cSYishai Hadas 	int err;
72179b20a6cSYishai Hadas 
72279b20a6cSYishai Hadas 	if (!ucmd->buf_addr)
72379b20a6cSYishai Hadas 		return -EINVAL;
72479b20a6cSYishai Hadas 
72579b20a6cSYishai Hadas 	context = to_mucontext(pd->uobject->context);
72679b20a6cSYishai Hadas 	rwq->umem = ib_umem_get(pd->uobject->context, ucmd->buf_addr,
72779b20a6cSYishai Hadas 			       rwq->buf_size, 0, 0);
72879b20a6cSYishai Hadas 	if (IS_ERR(rwq->umem)) {
72979b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "umem_get failed\n");
73079b20a6cSYishai Hadas 		err = PTR_ERR(rwq->umem);
73179b20a6cSYishai Hadas 		return err;
73279b20a6cSYishai Hadas 	}
73379b20a6cSYishai Hadas 
734762f899aSMajd Dibbiny 	mlx5_ib_cont_pages(rwq->umem, ucmd->buf_addr, 0, &npages, &page_shift,
73579b20a6cSYishai Hadas 			   &ncont, NULL);
73679b20a6cSYishai Hadas 	err = mlx5_ib_get_buf_offset(ucmd->buf_addr, page_shift,
73779b20a6cSYishai Hadas 				     &rwq->rq_page_offset);
73879b20a6cSYishai Hadas 	if (err) {
73979b20a6cSYishai Hadas 		mlx5_ib_warn(dev, "bad offset\n");
74079b20a6cSYishai Hadas 		goto err_umem;
74179b20a6cSYishai Hadas 	}
74279b20a6cSYishai Hadas 
74379b20a6cSYishai Hadas 	rwq->rq_num_pas = ncont;
74479b20a6cSYishai Hadas 	rwq->page_shift = page_shift;
74579b20a6cSYishai Hadas 	rwq->log_page_size =  page_shift - MLX5_ADAPTER_PAGE_SHIFT;
74679b20a6cSYishai Hadas 	rwq->wq_sig = !!(ucmd->flags & MLX5_WQ_FLAG_SIGNATURE);
74779b20a6cSYishai Hadas 
74879b20a6cSYishai Hadas 	mlx5_ib_dbg(dev, "addr 0x%llx, size %zd, npages %d, page_shift %d, ncont %d, offset %d\n",
74979b20a6cSYishai Hadas 		    (unsigned long long)ucmd->buf_addr, rwq->buf_size,
75079b20a6cSYishai Hadas 		    npages, page_shift, ncont, offset);
75179b20a6cSYishai Hadas 
75279b20a6cSYishai Hadas 	err = mlx5_ib_db_map_user(context, ucmd->db_addr, &rwq->db);
75379b20a6cSYishai Hadas 	if (err) {
75479b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "map failed\n");
75579b20a6cSYishai Hadas 		goto err_umem;
75679b20a6cSYishai Hadas 	}
75779b20a6cSYishai Hadas 
75879b20a6cSYishai Hadas 	rwq->create_type = MLX5_WQ_USER;
75979b20a6cSYishai Hadas 	return 0;
76079b20a6cSYishai Hadas 
76179b20a6cSYishai Hadas err_umem:
76279b20a6cSYishai Hadas 	ib_umem_release(rwq->umem);
76379b20a6cSYishai Hadas 	return err;
76479b20a6cSYishai Hadas }
76579b20a6cSYishai Hadas 
766e126ba97SEli Cohen static int create_user_qp(struct mlx5_ib_dev *dev, struct ib_pd *pd,
767e126ba97SEli Cohen 			  struct mlx5_ib_qp *qp, struct ib_udata *udata,
7680fb2ed66Smajd@mellanox.com 			  struct ib_qp_init_attr *attr,
76909a7d9ecSSaeed Mahameed 			  u32 **in,
77019098df2Smajd@mellanox.com 			  struct mlx5_ib_create_qp_resp *resp, int *inlen,
77119098df2Smajd@mellanox.com 			  struct mlx5_ib_qp_base *base)
772e126ba97SEli Cohen {
773e126ba97SEli Cohen 	struct mlx5_ib_ucontext *context;
774e126ba97SEli Cohen 	struct mlx5_ib_create_qp ucmd;
77519098df2Smajd@mellanox.com 	struct mlx5_ib_ubuffer *ubuffer = &base->ubuffer;
7769e9c47d0SEli Cohen 	int page_shift = 0;
777e126ba97SEli Cohen 	int uar_index;
778e126ba97SEli Cohen 	int npages;
7799e9c47d0SEli Cohen 	u32 offset = 0;
780e126ba97SEli Cohen 	int uuarn;
7819e9c47d0SEli Cohen 	int ncont = 0;
78209a7d9ecSSaeed Mahameed 	__be64 *pas;
78309a7d9ecSSaeed Mahameed 	void *qpc;
784e126ba97SEli Cohen 	int err;
785e126ba97SEli Cohen 
786e126ba97SEli Cohen 	err = ib_copy_from_udata(&ucmd, udata, sizeof(ucmd));
787e126ba97SEli Cohen 	if (err) {
788e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "copy failed\n");
789e126ba97SEli Cohen 		return err;
790e126ba97SEli Cohen 	}
791e126ba97SEli Cohen 
792e126ba97SEli Cohen 	context = to_mucontext(pd->uobject->context);
793e126ba97SEli Cohen 	/*
794e126ba97SEli Cohen 	 * TBD: should come from the verbs when we have the API
795e126ba97SEli Cohen 	 */
796051f2630SLeon Romanovsky 	if (qp->flags & MLX5_IB_QP_CROSS_CHANNEL)
797051f2630SLeon Romanovsky 		/* In CROSS_CHANNEL CQ and QP must use the same UAR */
798051f2630SLeon Romanovsky 		uuarn = MLX5_CROSS_CHANNEL_UUAR;
799051f2630SLeon Romanovsky 	else {
800e126ba97SEli Cohen 		uuarn = alloc_uuar(&context->uuari, MLX5_IB_LATENCY_CLASS_HIGH);
801e126ba97SEli Cohen 		if (uuarn < 0) {
802e126ba97SEli Cohen 			mlx5_ib_dbg(dev, "failed to allocate low latency UUAR\n");
803c1be5232SEli Cohen 			mlx5_ib_dbg(dev, "reverting to medium latency\n");
804c1be5232SEli Cohen 			uuarn = alloc_uuar(&context->uuari, MLX5_IB_LATENCY_CLASS_MEDIUM);
805c1be5232SEli Cohen 			if (uuarn < 0) {
806c1be5232SEli Cohen 				mlx5_ib_dbg(dev, "failed to allocate medium latency UUAR\n");
807e126ba97SEli Cohen 				mlx5_ib_dbg(dev, "reverting to high latency\n");
808e126ba97SEli Cohen 				uuarn = alloc_uuar(&context->uuari, MLX5_IB_LATENCY_CLASS_LOW);
809e126ba97SEli Cohen 				if (uuarn < 0) {
810c1be5232SEli Cohen 					mlx5_ib_warn(dev, "uuar allocation failed\n");
811e126ba97SEli Cohen 					return uuarn;
812e126ba97SEli Cohen 				}
813e126ba97SEli Cohen 			}
814c1be5232SEli Cohen 		}
815051f2630SLeon Romanovsky 	}
816e126ba97SEli Cohen 
817e126ba97SEli Cohen 	uar_index = uuarn_to_uar_index(&context->uuari, uuarn);
818e126ba97SEli Cohen 	mlx5_ib_dbg(dev, "uuarn 0x%x, uar_index 0x%x\n", uuarn, uar_index);
819e126ba97SEli Cohen 
82048fea837SHaggai Eran 	qp->rq.offset = 0;
82148fea837SHaggai Eran 	qp->sq.wqe_shift = ilog2(MLX5_SEND_WQE_BB);
82248fea837SHaggai Eran 	qp->sq.offset = qp->rq.wqe_cnt << qp->rq.wqe_shift;
82348fea837SHaggai Eran 
8240fb2ed66Smajd@mellanox.com 	err = set_user_buf_size(dev, qp, &ucmd, base, attr);
825e126ba97SEli Cohen 	if (err)
826e126ba97SEli Cohen 		goto err_uuar;
827e126ba97SEli Cohen 
82819098df2Smajd@mellanox.com 	if (ucmd.buf_addr && ubuffer->buf_size) {
82919098df2Smajd@mellanox.com 		ubuffer->buf_addr = ucmd.buf_addr;
83019098df2Smajd@mellanox.com 		err = mlx5_ib_umem_get(dev, pd, ubuffer->buf_addr,
83119098df2Smajd@mellanox.com 				       ubuffer->buf_size,
83219098df2Smajd@mellanox.com 				       &ubuffer->umem, &npages, &page_shift,
83319098df2Smajd@mellanox.com 				       &ncont, &offset);
83419098df2Smajd@mellanox.com 		if (err)
835e126ba97SEli Cohen 			goto err_uuar;
8369e9c47d0SEli Cohen 	} else {
83719098df2Smajd@mellanox.com 		ubuffer->umem = NULL;
8389e9c47d0SEli Cohen 	}
839e126ba97SEli Cohen 
84009a7d9ecSSaeed Mahameed 	*inlen = MLX5_ST_SZ_BYTES(create_qp_in) +
84109a7d9ecSSaeed Mahameed 		 MLX5_FLD_SZ_BYTES(create_qp_in, pas[0]) * ncont;
842e126ba97SEli Cohen 	*in = mlx5_vzalloc(*inlen);
843e126ba97SEli Cohen 	if (!*in) {
844e126ba97SEli Cohen 		err = -ENOMEM;
845e126ba97SEli Cohen 		goto err_umem;
846e126ba97SEli Cohen 	}
847e126ba97SEli Cohen 
84809a7d9ecSSaeed Mahameed 	pas = (__be64 *)MLX5_ADDR_OF(create_qp_in, *in, pas);
84909a7d9ecSSaeed Mahameed 	if (ubuffer->umem)
85009a7d9ecSSaeed Mahameed 		mlx5_ib_populate_pas(dev, ubuffer->umem, page_shift, pas, 0);
85109a7d9ecSSaeed Mahameed 
85209a7d9ecSSaeed Mahameed 	qpc = MLX5_ADDR_OF(create_qp_in, *in, qpc);
85309a7d9ecSSaeed Mahameed 
85409a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, log_page_size, page_shift - MLX5_ADAPTER_PAGE_SHIFT);
85509a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, page_offset, offset);
85609a7d9ecSSaeed Mahameed 
85709a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, uar_page, uar_index);
858e126ba97SEli Cohen 	resp->uuar_index = uuarn;
859e126ba97SEli Cohen 	qp->uuarn = uuarn;
860e126ba97SEli Cohen 
861e126ba97SEli Cohen 	err = mlx5_ib_db_map_user(context, ucmd.db_addr, &qp->db);
862e126ba97SEli Cohen 	if (err) {
863e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "map failed\n");
864e126ba97SEli Cohen 		goto err_free;
865e126ba97SEli Cohen 	}
866e126ba97SEli Cohen 
867e126ba97SEli Cohen 	err = ib_copy_to_udata(udata, resp, sizeof(*resp));
868e126ba97SEli Cohen 	if (err) {
869e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "copy failed\n");
870e126ba97SEli Cohen 		goto err_unmap;
871e126ba97SEli Cohen 	}
872e126ba97SEli Cohen 	qp->create_type = MLX5_QP_USER;
873e126ba97SEli Cohen 
874e126ba97SEli Cohen 	return 0;
875e126ba97SEli Cohen 
876e126ba97SEli Cohen err_unmap:
877e126ba97SEli Cohen 	mlx5_ib_db_unmap_user(context, &qp->db);
878e126ba97SEli Cohen 
879e126ba97SEli Cohen err_free:
880479163f4SAl Viro 	kvfree(*in);
881e126ba97SEli Cohen 
882e126ba97SEli Cohen err_umem:
88319098df2Smajd@mellanox.com 	if (ubuffer->umem)
88419098df2Smajd@mellanox.com 		ib_umem_release(ubuffer->umem);
885e126ba97SEli Cohen 
886e126ba97SEli Cohen err_uuar:
887e126ba97SEli Cohen 	free_uuar(&context->uuari, uuarn);
888e126ba97SEli Cohen 	return err;
889e126ba97SEli Cohen }
890e126ba97SEli Cohen 
89119098df2Smajd@mellanox.com static void destroy_qp_user(struct ib_pd *pd, struct mlx5_ib_qp *qp,
89219098df2Smajd@mellanox.com 			    struct mlx5_ib_qp_base *base)
893e126ba97SEli Cohen {
894e126ba97SEli Cohen 	struct mlx5_ib_ucontext *context;
895e126ba97SEli Cohen 
896e126ba97SEli Cohen 	context = to_mucontext(pd->uobject->context);
897e126ba97SEli Cohen 	mlx5_ib_db_unmap_user(context, &qp->db);
89819098df2Smajd@mellanox.com 	if (base->ubuffer.umem)
89919098df2Smajd@mellanox.com 		ib_umem_release(base->ubuffer.umem);
900e126ba97SEli Cohen 	free_uuar(&context->uuari, qp->uuarn);
901e126ba97SEli Cohen }
902e126ba97SEli Cohen 
903e126ba97SEli Cohen static int create_kernel_qp(struct mlx5_ib_dev *dev,
904e126ba97SEli Cohen 			    struct ib_qp_init_attr *init_attr,
905e126ba97SEli Cohen 			    struct mlx5_ib_qp *qp,
90609a7d9ecSSaeed Mahameed 			    u32 **in, int *inlen,
90719098df2Smajd@mellanox.com 			    struct mlx5_ib_qp_base *base)
908e126ba97SEli Cohen {
909e126ba97SEli Cohen 	enum mlx5_ib_latency_class lc = MLX5_IB_LATENCY_CLASS_LOW;
910e126ba97SEli Cohen 	struct mlx5_uuar_info *uuari;
911e126ba97SEli Cohen 	int uar_index;
91209a7d9ecSSaeed Mahameed 	void *qpc;
913e126ba97SEli Cohen 	int uuarn;
914e126ba97SEli Cohen 	int err;
915e126ba97SEli Cohen 
9169603b61dSJack Morgenstein 	uuari = &dev->mdev->priv.uuari;
917f0313965SErez Shitrit 	if (init_attr->create_flags & ~(IB_QP_CREATE_SIGNATURE_EN |
918f0313965SErez Shitrit 					IB_QP_CREATE_BLOCK_MULTICAST_LOOPBACK |
919b11a4f9cSHaggai Eran 					IB_QP_CREATE_IPOIB_UD_LSO |
920b11a4f9cSHaggai Eran 					mlx5_ib_create_qp_sqpn_qp1()))
9211a4c3a3dSEli Cohen 		return -EINVAL;
922e126ba97SEli Cohen 
923e126ba97SEli Cohen 	if (init_attr->qp_type == MLX5_IB_QPT_REG_UMR)
924e126ba97SEli Cohen 		lc = MLX5_IB_LATENCY_CLASS_FAST_PATH;
925e126ba97SEli Cohen 
926e126ba97SEli Cohen 	uuarn = alloc_uuar(uuari, lc);
927e126ba97SEli Cohen 	if (uuarn < 0) {
928e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "\n");
929e126ba97SEli Cohen 		return -ENOMEM;
930e126ba97SEli Cohen 	}
931e126ba97SEli Cohen 
932e126ba97SEli Cohen 	qp->bf = &uuari->bfs[uuarn];
933e126ba97SEli Cohen 	uar_index = qp->bf->uar->index;
934e126ba97SEli Cohen 
935e126ba97SEli Cohen 	err = calc_sq_size(dev, init_attr, qp);
936e126ba97SEli Cohen 	if (err < 0) {
937e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "err %d\n", err);
938e126ba97SEli Cohen 		goto err_uuar;
939e126ba97SEli Cohen 	}
940e126ba97SEli Cohen 
941e126ba97SEli Cohen 	qp->rq.offset = 0;
942e126ba97SEli Cohen 	qp->sq.offset = qp->rq.wqe_cnt << qp->rq.wqe_shift;
94319098df2Smajd@mellanox.com 	base->ubuffer.buf_size = err + (qp->rq.wqe_cnt << qp->rq.wqe_shift);
944e126ba97SEli Cohen 
94519098df2Smajd@mellanox.com 	err = mlx5_buf_alloc(dev->mdev, base->ubuffer.buf_size, &qp->buf);
946e126ba97SEli Cohen 	if (err) {
947e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "err %d\n", err);
948e126ba97SEli Cohen 		goto err_uuar;
949e126ba97SEli Cohen 	}
950e126ba97SEli Cohen 
951e126ba97SEli Cohen 	qp->sq.qend = mlx5_get_send_wqe(qp, qp->sq.wqe_cnt);
95209a7d9ecSSaeed Mahameed 	*inlen = MLX5_ST_SZ_BYTES(create_qp_in) +
95309a7d9ecSSaeed Mahameed 		 MLX5_FLD_SZ_BYTES(create_qp_in, pas[0]) * qp->buf.npages;
954e126ba97SEli Cohen 	*in = mlx5_vzalloc(*inlen);
955e126ba97SEli Cohen 	if (!*in) {
956e126ba97SEli Cohen 		err = -ENOMEM;
957e126ba97SEli Cohen 		goto err_buf;
958e126ba97SEli Cohen 	}
95909a7d9ecSSaeed Mahameed 
96009a7d9ecSSaeed Mahameed 	qpc = MLX5_ADDR_OF(create_qp_in, *in, qpc);
96109a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, uar_page, uar_index);
96209a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, log_page_size, qp->buf.page_shift - MLX5_ADAPTER_PAGE_SHIFT);
96309a7d9ecSSaeed Mahameed 
964e126ba97SEli Cohen 	/* Set "fast registration enabled" for all kernel QPs */
96509a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, fre, 1);
96609a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, rlky, 1);
967e126ba97SEli Cohen 
968b11a4f9cSHaggai Eran 	if (init_attr->create_flags & mlx5_ib_create_qp_sqpn_qp1()) {
96909a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, deth_sqpn, 1);
970b11a4f9cSHaggai Eran 		qp->flags |= MLX5_IB_QP_SQPN_QP1;
971b11a4f9cSHaggai Eran 	}
972b11a4f9cSHaggai Eran 
97309a7d9ecSSaeed Mahameed 	mlx5_fill_page_array(&qp->buf,
97409a7d9ecSSaeed Mahameed 			     (__be64 *)MLX5_ADDR_OF(create_qp_in, *in, pas));
975e126ba97SEli Cohen 
9769603b61dSJack Morgenstein 	err = mlx5_db_alloc(dev->mdev, &qp->db);
977e126ba97SEli Cohen 	if (err) {
978e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "err %d\n", err);
979e126ba97SEli Cohen 		goto err_free;
980e126ba97SEli Cohen 	}
981e126ba97SEli Cohen 
982e126ba97SEli Cohen 	qp->sq.wrid = kmalloc(qp->sq.wqe_cnt * sizeof(*qp->sq.wrid), GFP_KERNEL);
983e126ba97SEli Cohen 	qp->sq.wr_data = kmalloc(qp->sq.wqe_cnt * sizeof(*qp->sq.wr_data), GFP_KERNEL);
984e126ba97SEli Cohen 	qp->rq.wrid = kmalloc(qp->rq.wqe_cnt * sizeof(*qp->rq.wrid), GFP_KERNEL);
985e126ba97SEli Cohen 	qp->sq.w_list = kmalloc(qp->sq.wqe_cnt * sizeof(*qp->sq.w_list), GFP_KERNEL);
986e126ba97SEli Cohen 	qp->sq.wqe_head = kmalloc(qp->sq.wqe_cnt * sizeof(*qp->sq.wqe_head), GFP_KERNEL);
987e126ba97SEli Cohen 
988e126ba97SEli Cohen 	if (!qp->sq.wrid || !qp->sq.wr_data || !qp->rq.wrid ||
989e126ba97SEli Cohen 	    !qp->sq.w_list || !qp->sq.wqe_head) {
990e126ba97SEli Cohen 		err = -ENOMEM;
991e126ba97SEli Cohen 		goto err_wrid;
992e126ba97SEli Cohen 	}
993e126ba97SEli Cohen 	qp->create_type = MLX5_QP_KERNEL;
994e126ba97SEli Cohen 
995e126ba97SEli Cohen 	return 0;
996e126ba97SEli Cohen 
997e126ba97SEli Cohen err_wrid:
9989603b61dSJack Morgenstein 	mlx5_db_free(dev->mdev, &qp->db);
999e126ba97SEli Cohen 	kfree(qp->sq.wqe_head);
1000e126ba97SEli Cohen 	kfree(qp->sq.w_list);
1001e126ba97SEli Cohen 	kfree(qp->sq.wrid);
1002e126ba97SEli Cohen 	kfree(qp->sq.wr_data);
1003e126ba97SEli Cohen 	kfree(qp->rq.wrid);
1004e126ba97SEli Cohen 
1005e126ba97SEli Cohen err_free:
1006479163f4SAl Viro 	kvfree(*in);
1007e126ba97SEli Cohen 
1008e126ba97SEli Cohen err_buf:
10099603b61dSJack Morgenstein 	mlx5_buf_free(dev->mdev, &qp->buf);
1010e126ba97SEli Cohen 
1011e126ba97SEli Cohen err_uuar:
10129603b61dSJack Morgenstein 	free_uuar(&dev->mdev->priv.uuari, uuarn);
1013e126ba97SEli Cohen 	return err;
1014e126ba97SEli Cohen }
1015e126ba97SEli Cohen 
1016e126ba97SEli Cohen static void destroy_qp_kernel(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp)
1017e126ba97SEli Cohen {
10189603b61dSJack Morgenstein 	mlx5_db_free(dev->mdev, &qp->db);
1019e126ba97SEli Cohen 	kfree(qp->sq.wqe_head);
1020e126ba97SEli Cohen 	kfree(qp->sq.w_list);
1021e126ba97SEli Cohen 	kfree(qp->sq.wrid);
1022e126ba97SEli Cohen 	kfree(qp->sq.wr_data);
1023e126ba97SEli Cohen 	kfree(qp->rq.wrid);
10249603b61dSJack Morgenstein 	mlx5_buf_free(dev->mdev, &qp->buf);
10259603b61dSJack Morgenstein 	free_uuar(&dev->mdev->priv.uuari, qp->bf->uuarn);
1026e126ba97SEli Cohen }
1027e126ba97SEli Cohen 
102809a7d9ecSSaeed Mahameed static u32 get_rx_type(struct mlx5_ib_qp *qp, struct ib_qp_init_attr *attr)
1029e126ba97SEli Cohen {
1030e126ba97SEli Cohen 	if (attr->srq || (attr->qp_type == IB_QPT_XRC_TGT) ||
1031e126ba97SEli Cohen 	    (attr->qp_type == IB_QPT_XRC_INI))
103209a7d9ecSSaeed Mahameed 		return MLX5_SRQ_RQ;
1033e126ba97SEli Cohen 	else if (!qp->has_rq)
103409a7d9ecSSaeed Mahameed 		return MLX5_ZERO_LEN_RQ;
1035e126ba97SEli Cohen 	else
103609a7d9ecSSaeed Mahameed 		return MLX5_NON_ZERO_RQ;
1037e126ba97SEli Cohen }
1038e126ba97SEli Cohen 
1039e126ba97SEli Cohen static int is_connected(enum ib_qp_type qp_type)
1040e126ba97SEli Cohen {
1041e126ba97SEli Cohen 	if (qp_type == IB_QPT_RC || qp_type == IB_QPT_UC)
1042e126ba97SEli Cohen 		return 1;
1043e126ba97SEli Cohen 
1044e126ba97SEli Cohen 	return 0;
1045e126ba97SEli Cohen }
1046e126ba97SEli Cohen 
10470fb2ed66Smajd@mellanox.com static int create_raw_packet_qp_tis(struct mlx5_ib_dev *dev,
10480fb2ed66Smajd@mellanox.com 				    struct mlx5_ib_sq *sq, u32 tdn)
10490fb2ed66Smajd@mellanox.com {
1050c4f287c4SSaeed Mahameed 	u32 in[MLX5_ST_SZ_DW(create_tis_in)] = {0};
10510fb2ed66Smajd@mellanox.com 	void *tisc = MLX5_ADDR_OF(create_tis_in, in, ctx);
10520fb2ed66Smajd@mellanox.com 
10530fb2ed66Smajd@mellanox.com 	MLX5_SET(tisc, tisc, transport_domain, tdn);
10540fb2ed66Smajd@mellanox.com 	return mlx5_core_create_tis(dev->mdev, in, sizeof(in), &sq->tisn);
10550fb2ed66Smajd@mellanox.com }
10560fb2ed66Smajd@mellanox.com 
10570fb2ed66Smajd@mellanox.com static void destroy_raw_packet_qp_tis(struct mlx5_ib_dev *dev,
10580fb2ed66Smajd@mellanox.com 				      struct mlx5_ib_sq *sq)
10590fb2ed66Smajd@mellanox.com {
10600fb2ed66Smajd@mellanox.com 	mlx5_core_destroy_tis(dev->mdev, sq->tisn);
10610fb2ed66Smajd@mellanox.com }
10620fb2ed66Smajd@mellanox.com 
10630fb2ed66Smajd@mellanox.com static int create_raw_packet_qp_sq(struct mlx5_ib_dev *dev,
10640fb2ed66Smajd@mellanox.com 				   struct mlx5_ib_sq *sq, void *qpin,
10650fb2ed66Smajd@mellanox.com 				   struct ib_pd *pd)
10660fb2ed66Smajd@mellanox.com {
10670fb2ed66Smajd@mellanox.com 	struct mlx5_ib_ubuffer *ubuffer = &sq->ubuffer;
10680fb2ed66Smajd@mellanox.com 	__be64 *pas;
10690fb2ed66Smajd@mellanox.com 	void *in;
10700fb2ed66Smajd@mellanox.com 	void *sqc;
10710fb2ed66Smajd@mellanox.com 	void *qpc = MLX5_ADDR_OF(create_qp_in, qpin, qpc);
10720fb2ed66Smajd@mellanox.com 	void *wq;
10730fb2ed66Smajd@mellanox.com 	int inlen;
10740fb2ed66Smajd@mellanox.com 	int err;
10750fb2ed66Smajd@mellanox.com 	int page_shift = 0;
10760fb2ed66Smajd@mellanox.com 	int npages;
10770fb2ed66Smajd@mellanox.com 	int ncont = 0;
10780fb2ed66Smajd@mellanox.com 	u32 offset = 0;
10790fb2ed66Smajd@mellanox.com 
10800fb2ed66Smajd@mellanox.com 	err = mlx5_ib_umem_get(dev, pd, ubuffer->buf_addr, ubuffer->buf_size,
10810fb2ed66Smajd@mellanox.com 			       &sq->ubuffer.umem, &npages, &page_shift,
10820fb2ed66Smajd@mellanox.com 			       &ncont, &offset);
10830fb2ed66Smajd@mellanox.com 	if (err)
10840fb2ed66Smajd@mellanox.com 		return err;
10850fb2ed66Smajd@mellanox.com 
10860fb2ed66Smajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(create_sq_in) + sizeof(u64) * ncont;
10870fb2ed66Smajd@mellanox.com 	in = mlx5_vzalloc(inlen);
10880fb2ed66Smajd@mellanox.com 	if (!in) {
10890fb2ed66Smajd@mellanox.com 		err = -ENOMEM;
10900fb2ed66Smajd@mellanox.com 		goto err_umem;
10910fb2ed66Smajd@mellanox.com 	}
10920fb2ed66Smajd@mellanox.com 
10930fb2ed66Smajd@mellanox.com 	sqc = MLX5_ADDR_OF(create_sq_in, in, ctx);
10940fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, flush_in_error_en, 1);
10950fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, state, MLX5_SQC_STATE_RST);
10960fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, user_index, MLX5_GET(qpc, qpc, user_index));
10970fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, cqn, MLX5_GET(qpc, qpc, cqn_snd));
10980fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, tis_lst_sz, 1);
10990fb2ed66Smajd@mellanox.com 	MLX5_SET(sqc, sqc, tis_num_0, sq->tisn);
11000fb2ed66Smajd@mellanox.com 
11010fb2ed66Smajd@mellanox.com 	wq = MLX5_ADDR_OF(sqc, sqc, wq);
11020fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, wq_type, MLX5_WQ_TYPE_CYCLIC);
11030fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, pd, MLX5_GET(qpc, qpc, pd));
11040fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, uar_page, MLX5_GET(qpc, qpc, uar_page));
11050fb2ed66Smajd@mellanox.com 	MLX5_SET64(wq, wq, dbr_addr, MLX5_GET64(qpc, qpc, dbr_addr));
11060fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, log_wq_stride, ilog2(MLX5_SEND_WQE_BB));
11070fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, log_wq_sz, MLX5_GET(qpc, qpc, log_sq_size));
11080fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, log_wq_pg_sz,  page_shift - MLX5_ADAPTER_PAGE_SHIFT);
11090fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, page_offset, offset);
11100fb2ed66Smajd@mellanox.com 
11110fb2ed66Smajd@mellanox.com 	pas = (__be64 *)MLX5_ADDR_OF(wq, wq, pas);
11120fb2ed66Smajd@mellanox.com 	mlx5_ib_populate_pas(dev, sq->ubuffer.umem, page_shift, pas, 0);
11130fb2ed66Smajd@mellanox.com 
11140fb2ed66Smajd@mellanox.com 	err = mlx5_core_create_sq_tracked(dev->mdev, in, inlen, &sq->base.mqp);
11150fb2ed66Smajd@mellanox.com 
11160fb2ed66Smajd@mellanox.com 	kvfree(in);
11170fb2ed66Smajd@mellanox.com 
11180fb2ed66Smajd@mellanox.com 	if (err)
11190fb2ed66Smajd@mellanox.com 		goto err_umem;
11200fb2ed66Smajd@mellanox.com 
11210fb2ed66Smajd@mellanox.com 	return 0;
11220fb2ed66Smajd@mellanox.com 
11230fb2ed66Smajd@mellanox.com err_umem:
11240fb2ed66Smajd@mellanox.com 	ib_umem_release(sq->ubuffer.umem);
11250fb2ed66Smajd@mellanox.com 	sq->ubuffer.umem = NULL;
11260fb2ed66Smajd@mellanox.com 
11270fb2ed66Smajd@mellanox.com 	return err;
11280fb2ed66Smajd@mellanox.com }
11290fb2ed66Smajd@mellanox.com 
11300fb2ed66Smajd@mellanox.com static void destroy_raw_packet_qp_sq(struct mlx5_ib_dev *dev,
11310fb2ed66Smajd@mellanox.com 				     struct mlx5_ib_sq *sq)
11320fb2ed66Smajd@mellanox.com {
11330fb2ed66Smajd@mellanox.com 	mlx5_core_destroy_sq_tracked(dev->mdev, &sq->base.mqp);
11340fb2ed66Smajd@mellanox.com 	ib_umem_release(sq->ubuffer.umem);
11350fb2ed66Smajd@mellanox.com }
11360fb2ed66Smajd@mellanox.com 
11370fb2ed66Smajd@mellanox.com static int get_rq_pas_size(void *qpc)
11380fb2ed66Smajd@mellanox.com {
11390fb2ed66Smajd@mellanox.com 	u32 log_page_size = MLX5_GET(qpc, qpc, log_page_size) + 12;
11400fb2ed66Smajd@mellanox.com 	u32 log_rq_stride = MLX5_GET(qpc, qpc, log_rq_stride);
11410fb2ed66Smajd@mellanox.com 	u32 log_rq_size   = MLX5_GET(qpc, qpc, log_rq_size);
11420fb2ed66Smajd@mellanox.com 	u32 page_offset   = MLX5_GET(qpc, qpc, page_offset);
11430fb2ed66Smajd@mellanox.com 	u32 po_quanta	  = 1 << (log_page_size - 6);
11440fb2ed66Smajd@mellanox.com 	u32 rq_sz	  = 1 << (log_rq_size + 4 + log_rq_stride);
11450fb2ed66Smajd@mellanox.com 	u32 page_size	  = 1 << log_page_size;
11460fb2ed66Smajd@mellanox.com 	u32 rq_sz_po      = rq_sz + (page_offset * po_quanta);
11470fb2ed66Smajd@mellanox.com 	u32 rq_num_pas	  = (rq_sz_po + page_size - 1) / page_size;
11480fb2ed66Smajd@mellanox.com 
11490fb2ed66Smajd@mellanox.com 	return rq_num_pas * sizeof(u64);
11500fb2ed66Smajd@mellanox.com }
11510fb2ed66Smajd@mellanox.com 
11520fb2ed66Smajd@mellanox.com static int create_raw_packet_qp_rq(struct mlx5_ib_dev *dev,
11530fb2ed66Smajd@mellanox.com 				   struct mlx5_ib_rq *rq, void *qpin)
11540fb2ed66Smajd@mellanox.com {
1155358e42eaSMajd Dibbiny 	struct mlx5_ib_qp *mqp = rq->base.container_mibqp;
11560fb2ed66Smajd@mellanox.com 	__be64 *pas;
11570fb2ed66Smajd@mellanox.com 	__be64 *qp_pas;
11580fb2ed66Smajd@mellanox.com 	void *in;
11590fb2ed66Smajd@mellanox.com 	void *rqc;
11600fb2ed66Smajd@mellanox.com 	void *wq;
11610fb2ed66Smajd@mellanox.com 	void *qpc = MLX5_ADDR_OF(create_qp_in, qpin, qpc);
11620fb2ed66Smajd@mellanox.com 	int inlen;
11630fb2ed66Smajd@mellanox.com 	int err;
11640fb2ed66Smajd@mellanox.com 	u32 rq_pas_size = get_rq_pas_size(qpc);
11650fb2ed66Smajd@mellanox.com 
11660fb2ed66Smajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(create_rq_in) + rq_pas_size;
11670fb2ed66Smajd@mellanox.com 	in = mlx5_vzalloc(inlen);
11680fb2ed66Smajd@mellanox.com 	if (!in)
11690fb2ed66Smajd@mellanox.com 		return -ENOMEM;
11700fb2ed66Smajd@mellanox.com 
11710fb2ed66Smajd@mellanox.com 	rqc = MLX5_ADDR_OF(create_rq_in, in, ctx);
11720fb2ed66Smajd@mellanox.com 	MLX5_SET(rqc, rqc, vsd, 1);
11730fb2ed66Smajd@mellanox.com 	MLX5_SET(rqc, rqc, mem_rq_type, MLX5_RQC_MEM_RQ_TYPE_MEMORY_RQ_INLINE);
11740fb2ed66Smajd@mellanox.com 	MLX5_SET(rqc, rqc, state, MLX5_RQC_STATE_RST);
11750fb2ed66Smajd@mellanox.com 	MLX5_SET(rqc, rqc, flush_in_error_en, 1);
11760fb2ed66Smajd@mellanox.com 	MLX5_SET(rqc, rqc, user_index, MLX5_GET(qpc, qpc, user_index));
11770fb2ed66Smajd@mellanox.com 	MLX5_SET(rqc, rqc, cqn, MLX5_GET(qpc, qpc, cqn_rcv));
11780fb2ed66Smajd@mellanox.com 
1179358e42eaSMajd Dibbiny 	if (mqp->flags & MLX5_IB_QP_CAP_SCATTER_FCS)
1180358e42eaSMajd Dibbiny 		MLX5_SET(rqc, rqc, scatter_fcs, 1);
1181358e42eaSMajd Dibbiny 
11820fb2ed66Smajd@mellanox.com 	wq = MLX5_ADDR_OF(rqc, rqc, wq);
11830fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, wq_type, MLX5_WQ_TYPE_CYCLIC);
11840fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, end_padding_mode,
118501581fb8SMaor Gottlieb 		 MLX5_GET(qpc, qpc, end_padding_mode));
11860fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, page_offset, MLX5_GET(qpc, qpc, page_offset));
11870fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, pd, MLX5_GET(qpc, qpc, pd));
11880fb2ed66Smajd@mellanox.com 	MLX5_SET64(wq, wq, dbr_addr, MLX5_GET64(qpc, qpc, dbr_addr));
11890fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, log_wq_stride, MLX5_GET(qpc, qpc, log_rq_stride) + 4);
11900fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, log_wq_pg_sz, MLX5_GET(qpc, qpc, log_page_size));
11910fb2ed66Smajd@mellanox.com 	MLX5_SET(wq, wq, log_wq_sz, MLX5_GET(qpc, qpc, log_rq_size));
11920fb2ed66Smajd@mellanox.com 
11930fb2ed66Smajd@mellanox.com 	pas = (__be64 *)MLX5_ADDR_OF(wq, wq, pas);
11940fb2ed66Smajd@mellanox.com 	qp_pas = (__be64 *)MLX5_ADDR_OF(create_qp_in, qpin, pas);
11950fb2ed66Smajd@mellanox.com 	memcpy(pas, qp_pas, rq_pas_size);
11960fb2ed66Smajd@mellanox.com 
11970fb2ed66Smajd@mellanox.com 	err = mlx5_core_create_rq_tracked(dev->mdev, in, inlen, &rq->base.mqp);
11980fb2ed66Smajd@mellanox.com 
11990fb2ed66Smajd@mellanox.com 	kvfree(in);
12000fb2ed66Smajd@mellanox.com 
12010fb2ed66Smajd@mellanox.com 	return err;
12020fb2ed66Smajd@mellanox.com }
12030fb2ed66Smajd@mellanox.com 
12040fb2ed66Smajd@mellanox.com static void destroy_raw_packet_qp_rq(struct mlx5_ib_dev *dev,
12050fb2ed66Smajd@mellanox.com 				     struct mlx5_ib_rq *rq)
12060fb2ed66Smajd@mellanox.com {
12070fb2ed66Smajd@mellanox.com 	mlx5_core_destroy_rq_tracked(dev->mdev, &rq->base.mqp);
12080fb2ed66Smajd@mellanox.com }
12090fb2ed66Smajd@mellanox.com 
12100fb2ed66Smajd@mellanox.com static int create_raw_packet_qp_tir(struct mlx5_ib_dev *dev,
12110fb2ed66Smajd@mellanox.com 				    struct mlx5_ib_rq *rq, u32 tdn)
12120fb2ed66Smajd@mellanox.com {
12130fb2ed66Smajd@mellanox.com 	u32 *in;
12140fb2ed66Smajd@mellanox.com 	void *tirc;
12150fb2ed66Smajd@mellanox.com 	int inlen;
12160fb2ed66Smajd@mellanox.com 	int err;
12170fb2ed66Smajd@mellanox.com 
12180fb2ed66Smajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(create_tir_in);
12190fb2ed66Smajd@mellanox.com 	in = mlx5_vzalloc(inlen);
12200fb2ed66Smajd@mellanox.com 	if (!in)
12210fb2ed66Smajd@mellanox.com 		return -ENOMEM;
12220fb2ed66Smajd@mellanox.com 
12230fb2ed66Smajd@mellanox.com 	tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
12240fb2ed66Smajd@mellanox.com 	MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT);
12250fb2ed66Smajd@mellanox.com 	MLX5_SET(tirc, tirc, inline_rqn, rq->base.mqp.qpn);
12260fb2ed66Smajd@mellanox.com 	MLX5_SET(tirc, tirc, transport_domain, tdn);
12270fb2ed66Smajd@mellanox.com 
12280fb2ed66Smajd@mellanox.com 	err = mlx5_core_create_tir(dev->mdev, in, inlen, &rq->tirn);
12290fb2ed66Smajd@mellanox.com 
12300fb2ed66Smajd@mellanox.com 	kvfree(in);
12310fb2ed66Smajd@mellanox.com 
12320fb2ed66Smajd@mellanox.com 	return err;
12330fb2ed66Smajd@mellanox.com }
12340fb2ed66Smajd@mellanox.com 
12350fb2ed66Smajd@mellanox.com static void destroy_raw_packet_qp_tir(struct mlx5_ib_dev *dev,
12360fb2ed66Smajd@mellanox.com 				      struct mlx5_ib_rq *rq)
12370fb2ed66Smajd@mellanox.com {
12380fb2ed66Smajd@mellanox.com 	mlx5_core_destroy_tir(dev->mdev, rq->tirn);
12390fb2ed66Smajd@mellanox.com }
12400fb2ed66Smajd@mellanox.com 
12410fb2ed66Smajd@mellanox.com static int create_raw_packet_qp(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
124209a7d9ecSSaeed Mahameed 				u32 *in,
12430fb2ed66Smajd@mellanox.com 				struct ib_pd *pd)
12440fb2ed66Smajd@mellanox.com {
12450fb2ed66Smajd@mellanox.com 	struct mlx5_ib_raw_packet_qp *raw_packet_qp = &qp->raw_packet_qp;
12460fb2ed66Smajd@mellanox.com 	struct mlx5_ib_sq *sq = &raw_packet_qp->sq;
12470fb2ed66Smajd@mellanox.com 	struct mlx5_ib_rq *rq = &raw_packet_qp->rq;
12480fb2ed66Smajd@mellanox.com 	struct ib_uobject *uobj = pd->uobject;
12490fb2ed66Smajd@mellanox.com 	struct ib_ucontext *ucontext = uobj->context;
12500fb2ed66Smajd@mellanox.com 	struct mlx5_ib_ucontext *mucontext = to_mucontext(ucontext);
12510fb2ed66Smajd@mellanox.com 	int err;
12520fb2ed66Smajd@mellanox.com 	u32 tdn = mucontext->tdn;
12530fb2ed66Smajd@mellanox.com 
12540fb2ed66Smajd@mellanox.com 	if (qp->sq.wqe_cnt) {
12550fb2ed66Smajd@mellanox.com 		err = create_raw_packet_qp_tis(dev, sq, tdn);
12560fb2ed66Smajd@mellanox.com 		if (err)
12570fb2ed66Smajd@mellanox.com 			return err;
12580fb2ed66Smajd@mellanox.com 
12590fb2ed66Smajd@mellanox.com 		err = create_raw_packet_qp_sq(dev, sq, in, pd);
12600fb2ed66Smajd@mellanox.com 		if (err)
12610fb2ed66Smajd@mellanox.com 			goto err_destroy_tis;
12620fb2ed66Smajd@mellanox.com 
12630fb2ed66Smajd@mellanox.com 		sq->base.container_mibqp = qp;
12640fb2ed66Smajd@mellanox.com 	}
12650fb2ed66Smajd@mellanox.com 
12660fb2ed66Smajd@mellanox.com 	if (qp->rq.wqe_cnt) {
1267358e42eaSMajd Dibbiny 		rq->base.container_mibqp = qp;
1268358e42eaSMajd Dibbiny 
12690fb2ed66Smajd@mellanox.com 		err = create_raw_packet_qp_rq(dev, rq, in);
12700fb2ed66Smajd@mellanox.com 		if (err)
12710fb2ed66Smajd@mellanox.com 			goto err_destroy_sq;
12720fb2ed66Smajd@mellanox.com 
12730fb2ed66Smajd@mellanox.com 
12740fb2ed66Smajd@mellanox.com 		err = create_raw_packet_qp_tir(dev, rq, tdn);
12750fb2ed66Smajd@mellanox.com 		if (err)
12760fb2ed66Smajd@mellanox.com 			goto err_destroy_rq;
12770fb2ed66Smajd@mellanox.com 	}
12780fb2ed66Smajd@mellanox.com 
12790fb2ed66Smajd@mellanox.com 	qp->trans_qp.base.mqp.qpn = qp->sq.wqe_cnt ? sq->base.mqp.qpn :
12800fb2ed66Smajd@mellanox.com 						     rq->base.mqp.qpn;
12810fb2ed66Smajd@mellanox.com 
12820fb2ed66Smajd@mellanox.com 	return 0;
12830fb2ed66Smajd@mellanox.com 
12840fb2ed66Smajd@mellanox.com err_destroy_rq:
12850fb2ed66Smajd@mellanox.com 	destroy_raw_packet_qp_rq(dev, rq);
12860fb2ed66Smajd@mellanox.com err_destroy_sq:
12870fb2ed66Smajd@mellanox.com 	if (!qp->sq.wqe_cnt)
12880fb2ed66Smajd@mellanox.com 		return err;
12890fb2ed66Smajd@mellanox.com 	destroy_raw_packet_qp_sq(dev, sq);
12900fb2ed66Smajd@mellanox.com err_destroy_tis:
12910fb2ed66Smajd@mellanox.com 	destroy_raw_packet_qp_tis(dev, sq);
12920fb2ed66Smajd@mellanox.com 
12930fb2ed66Smajd@mellanox.com 	return err;
12940fb2ed66Smajd@mellanox.com }
12950fb2ed66Smajd@mellanox.com 
12960fb2ed66Smajd@mellanox.com static void destroy_raw_packet_qp(struct mlx5_ib_dev *dev,
12970fb2ed66Smajd@mellanox.com 				  struct mlx5_ib_qp *qp)
12980fb2ed66Smajd@mellanox.com {
12990fb2ed66Smajd@mellanox.com 	struct mlx5_ib_raw_packet_qp *raw_packet_qp = &qp->raw_packet_qp;
13000fb2ed66Smajd@mellanox.com 	struct mlx5_ib_sq *sq = &raw_packet_qp->sq;
13010fb2ed66Smajd@mellanox.com 	struct mlx5_ib_rq *rq = &raw_packet_qp->rq;
13020fb2ed66Smajd@mellanox.com 
13030fb2ed66Smajd@mellanox.com 	if (qp->rq.wqe_cnt) {
13040fb2ed66Smajd@mellanox.com 		destroy_raw_packet_qp_tir(dev, rq);
13050fb2ed66Smajd@mellanox.com 		destroy_raw_packet_qp_rq(dev, rq);
13060fb2ed66Smajd@mellanox.com 	}
13070fb2ed66Smajd@mellanox.com 
13080fb2ed66Smajd@mellanox.com 	if (qp->sq.wqe_cnt) {
13090fb2ed66Smajd@mellanox.com 		destroy_raw_packet_qp_sq(dev, sq);
13100fb2ed66Smajd@mellanox.com 		destroy_raw_packet_qp_tis(dev, sq);
13110fb2ed66Smajd@mellanox.com 	}
13120fb2ed66Smajd@mellanox.com }
13130fb2ed66Smajd@mellanox.com 
13140fb2ed66Smajd@mellanox.com static void raw_packet_qp_copy_info(struct mlx5_ib_qp *qp,
13150fb2ed66Smajd@mellanox.com 				    struct mlx5_ib_raw_packet_qp *raw_packet_qp)
13160fb2ed66Smajd@mellanox.com {
13170fb2ed66Smajd@mellanox.com 	struct mlx5_ib_sq *sq = &raw_packet_qp->sq;
13180fb2ed66Smajd@mellanox.com 	struct mlx5_ib_rq *rq = &raw_packet_qp->rq;
13190fb2ed66Smajd@mellanox.com 
13200fb2ed66Smajd@mellanox.com 	sq->sq = &qp->sq;
13210fb2ed66Smajd@mellanox.com 	rq->rq = &qp->rq;
13220fb2ed66Smajd@mellanox.com 	sq->doorbell = &qp->db;
13230fb2ed66Smajd@mellanox.com 	rq->doorbell = &qp->db;
13240fb2ed66Smajd@mellanox.com }
13250fb2ed66Smajd@mellanox.com 
132628d61370SYishai Hadas static void destroy_rss_raw_qp_tir(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp)
132728d61370SYishai Hadas {
132828d61370SYishai Hadas 	mlx5_core_destroy_tir(dev->mdev, qp->rss_qp.tirn);
132928d61370SYishai Hadas }
133028d61370SYishai Hadas 
133128d61370SYishai Hadas static int create_rss_raw_qp_tir(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
133228d61370SYishai Hadas 				 struct ib_pd *pd,
133328d61370SYishai Hadas 				 struct ib_qp_init_attr *init_attr,
133428d61370SYishai Hadas 				 struct ib_udata *udata)
133528d61370SYishai Hadas {
133628d61370SYishai Hadas 	struct ib_uobject *uobj = pd->uobject;
133728d61370SYishai Hadas 	struct ib_ucontext *ucontext = uobj->context;
133828d61370SYishai Hadas 	struct mlx5_ib_ucontext *mucontext = to_mucontext(ucontext);
133928d61370SYishai Hadas 	struct mlx5_ib_create_qp_resp resp = {};
134028d61370SYishai Hadas 	int inlen;
134128d61370SYishai Hadas 	int err;
134228d61370SYishai Hadas 	u32 *in;
134328d61370SYishai Hadas 	void *tirc;
134428d61370SYishai Hadas 	void *hfso;
134528d61370SYishai Hadas 	u32 selected_fields = 0;
134628d61370SYishai Hadas 	size_t min_resp_len;
134728d61370SYishai Hadas 	u32 tdn = mucontext->tdn;
134828d61370SYishai Hadas 	struct mlx5_ib_create_qp_rss ucmd = {};
134928d61370SYishai Hadas 	size_t required_cmd_sz;
135028d61370SYishai Hadas 
135128d61370SYishai Hadas 	if (init_attr->qp_type != IB_QPT_RAW_PACKET)
135228d61370SYishai Hadas 		return -EOPNOTSUPP;
135328d61370SYishai Hadas 
135428d61370SYishai Hadas 	if (init_attr->create_flags || init_attr->send_cq)
135528d61370SYishai Hadas 		return -EINVAL;
135628d61370SYishai Hadas 
135728d61370SYishai Hadas 	min_resp_len = offsetof(typeof(resp), uuar_index) + sizeof(resp.uuar_index);
135828d61370SYishai Hadas 	if (udata->outlen < min_resp_len)
135928d61370SYishai Hadas 		return -EINVAL;
136028d61370SYishai Hadas 
136128d61370SYishai Hadas 	required_cmd_sz = offsetof(typeof(ucmd), reserved1) + sizeof(ucmd.reserved1);
136228d61370SYishai Hadas 	if (udata->inlen < required_cmd_sz) {
136328d61370SYishai Hadas 		mlx5_ib_dbg(dev, "invalid inlen\n");
136428d61370SYishai Hadas 		return -EINVAL;
136528d61370SYishai Hadas 	}
136628d61370SYishai Hadas 
136728d61370SYishai Hadas 	if (udata->inlen > sizeof(ucmd) &&
136828d61370SYishai Hadas 	    !ib_is_udata_cleared(udata, sizeof(ucmd),
136928d61370SYishai Hadas 				 udata->inlen - sizeof(ucmd))) {
137028d61370SYishai Hadas 		mlx5_ib_dbg(dev, "inlen is not supported\n");
137128d61370SYishai Hadas 		return -EOPNOTSUPP;
137228d61370SYishai Hadas 	}
137328d61370SYishai Hadas 
137428d61370SYishai Hadas 	if (ib_copy_from_udata(&ucmd, udata, min(sizeof(ucmd), udata->inlen))) {
137528d61370SYishai Hadas 		mlx5_ib_dbg(dev, "copy failed\n");
137628d61370SYishai Hadas 		return -EFAULT;
137728d61370SYishai Hadas 	}
137828d61370SYishai Hadas 
137928d61370SYishai Hadas 	if (ucmd.comp_mask) {
138028d61370SYishai Hadas 		mlx5_ib_dbg(dev, "invalid comp mask\n");
138128d61370SYishai Hadas 		return -EOPNOTSUPP;
138228d61370SYishai Hadas 	}
138328d61370SYishai Hadas 
138428d61370SYishai Hadas 	if (memchr_inv(ucmd.reserved, 0, sizeof(ucmd.reserved)) || ucmd.reserved1) {
138528d61370SYishai Hadas 		mlx5_ib_dbg(dev, "invalid reserved\n");
138628d61370SYishai Hadas 		return -EOPNOTSUPP;
138728d61370SYishai Hadas 	}
138828d61370SYishai Hadas 
138928d61370SYishai Hadas 	err = ib_copy_to_udata(udata, &resp, min_resp_len);
139028d61370SYishai Hadas 	if (err) {
139128d61370SYishai Hadas 		mlx5_ib_dbg(dev, "copy failed\n");
139228d61370SYishai Hadas 		return -EINVAL;
139328d61370SYishai Hadas 	}
139428d61370SYishai Hadas 
139528d61370SYishai Hadas 	inlen = MLX5_ST_SZ_BYTES(create_tir_in);
139628d61370SYishai Hadas 	in = mlx5_vzalloc(inlen);
139728d61370SYishai Hadas 	if (!in)
139828d61370SYishai Hadas 		return -ENOMEM;
139928d61370SYishai Hadas 
140028d61370SYishai Hadas 	tirc = MLX5_ADDR_OF(create_tir_in, in, ctx);
140128d61370SYishai Hadas 	MLX5_SET(tirc, tirc, disp_type,
140228d61370SYishai Hadas 		 MLX5_TIRC_DISP_TYPE_INDIRECT);
140328d61370SYishai Hadas 	MLX5_SET(tirc, tirc, indirect_table,
140428d61370SYishai Hadas 		 init_attr->rwq_ind_tbl->ind_tbl_num);
140528d61370SYishai Hadas 	MLX5_SET(tirc, tirc, transport_domain, tdn);
140628d61370SYishai Hadas 
140728d61370SYishai Hadas 	hfso = MLX5_ADDR_OF(tirc, tirc, rx_hash_field_selector_outer);
140828d61370SYishai Hadas 	switch (ucmd.rx_hash_function) {
140928d61370SYishai Hadas 	case MLX5_RX_HASH_FUNC_TOEPLITZ:
141028d61370SYishai Hadas 	{
141128d61370SYishai Hadas 		void *rss_key = MLX5_ADDR_OF(tirc, tirc, rx_hash_toeplitz_key);
141228d61370SYishai Hadas 		size_t len = MLX5_FLD_SZ_BYTES(tirc, rx_hash_toeplitz_key);
141328d61370SYishai Hadas 
141428d61370SYishai Hadas 		if (len != ucmd.rx_key_len) {
141528d61370SYishai Hadas 			err = -EINVAL;
141628d61370SYishai Hadas 			goto err;
141728d61370SYishai Hadas 		}
141828d61370SYishai Hadas 
141928d61370SYishai Hadas 		MLX5_SET(tirc, tirc, rx_hash_fn, MLX5_RX_HASH_FN_TOEPLITZ);
142028d61370SYishai Hadas 		MLX5_SET(tirc, tirc, rx_hash_symmetric, 1);
142128d61370SYishai Hadas 		memcpy(rss_key, ucmd.rx_hash_key, len);
142228d61370SYishai Hadas 		break;
142328d61370SYishai Hadas 	}
142428d61370SYishai Hadas 	default:
142528d61370SYishai Hadas 		err = -EOPNOTSUPP;
142628d61370SYishai Hadas 		goto err;
142728d61370SYishai Hadas 	}
142828d61370SYishai Hadas 
142928d61370SYishai Hadas 	if (!ucmd.rx_hash_fields_mask) {
143028d61370SYishai Hadas 		/* special case when this TIR serves as steering entry without hashing */
143128d61370SYishai Hadas 		if (!init_attr->rwq_ind_tbl->log_ind_tbl_size)
143228d61370SYishai Hadas 			goto create_tir;
143328d61370SYishai Hadas 		err = -EINVAL;
143428d61370SYishai Hadas 		goto err;
143528d61370SYishai Hadas 	}
143628d61370SYishai Hadas 
143728d61370SYishai Hadas 	if (((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV4) ||
143828d61370SYishai Hadas 	     (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV4)) &&
143928d61370SYishai Hadas 	     ((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV6) ||
144028d61370SYishai Hadas 	     (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV6))) {
144128d61370SYishai Hadas 		err = -EINVAL;
144228d61370SYishai Hadas 		goto err;
144328d61370SYishai Hadas 	}
144428d61370SYishai Hadas 
144528d61370SYishai Hadas 	/* If none of IPV4 & IPV6 SRC/DST was set - this bit field is ignored */
144628d61370SYishai Hadas 	if ((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV4) ||
144728d61370SYishai Hadas 	    (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV4))
144828d61370SYishai Hadas 		MLX5_SET(rx_hash_field_select, hfso, l3_prot_type,
144928d61370SYishai Hadas 			 MLX5_L3_PROT_TYPE_IPV4);
145028d61370SYishai Hadas 	else if ((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV6) ||
145128d61370SYishai Hadas 		 (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV6))
145228d61370SYishai Hadas 		MLX5_SET(rx_hash_field_select, hfso, l3_prot_type,
145328d61370SYishai Hadas 			 MLX5_L3_PROT_TYPE_IPV6);
145428d61370SYishai Hadas 
145528d61370SYishai Hadas 	if (((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_TCP) ||
145628d61370SYishai Hadas 	     (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_TCP)) &&
145728d61370SYishai Hadas 	     ((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_UDP) ||
145828d61370SYishai Hadas 	     (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_UDP))) {
145928d61370SYishai Hadas 		err = -EINVAL;
146028d61370SYishai Hadas 		goto err;
146128d61370SYishai Hadas 	}
146228d61370SYishai Hadas 
146328d61370SYishai Hadas 	/* If none of TCP & UDP SRC/DST was set - this bit field is ignored */
146428d61370SYishai Hadas 	if ((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_TCP) ||
146528d61370SYishai Hadas 	    (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_TCP))
146628d61370SYishai Hadas 		MLX5_SET(rx_hash_field_select, hfso, l4_prot_type,
146728d61370SYishai Hadas 			 MLX5_L4_PROT_TYPE_TCP);
146828d61370SYishai Hadas 	else if ((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_UDP) ||
146928d61370SYishai Hadas 		 (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_UDP))
147028d61370SYishai Hadas 		MLX5_SET(rx_hash_field_select, hfso, l4_prot_type,
147128d61370SYishai Hadas 			 MLX5_L4_PROT_TYPE_UDP);
147228d61370SYishai Hadas 
147328d61370SYishai Hadas 	if ((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV4) ||
147428d61370SYishai Hadas 	    (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_IPV6))
147528d61370SYishai Hadas 		selected_fields |= MLX5_HASH_FIELD_SEL_SRC_IP;
147628d61370SYishai Hadas 
147728d61370SYishai Hadas 	if ((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV4) ||
147828d61370SYishai Hadas 	    (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_IPV6))
147928d61370SYishai Hadas 		selected_fields |= MLX5_HASH_FIELD_SEL_DST_IP;
148028d61370SYishai Hadas 
148128d61370SYishai Hadas 	if ((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_TCP) ||
148228d61370SYishai Hadas 	    (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_SRC_PORT_UDP))
148328d61370SYishai Hadas 		selected_fields |= MLX5_HASH_FIELD_SEL_L4_SPORT;
148428d61370SYishai Hadas 
148528d61370SYishai Hadas 	if ((ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_TCP) ||
148628d61370SYishai Hadas 	    (ucmd.rx_hash_fields_mask & MLX5_RX_HASH_DST_PORT_UDP))
148728d61370SYishai Hadas 		selected_fields |= MLX5_HASH_FIELD_SEL_L4_DPORT;
148828d61370SYishai Hadas 
148928d61370SYishai Hadas 	MLX5_SET(rx_hash_field_select, hfso, selected_fields, selected_fields);
149028d61370SYishai Hadas 
149128d61370SYishai Hadas create_tir:
149228d61370SYishai Hadas 	err = mlx5_core_create_tir(dev->mdev, in, inlen, &qp->rss_qp.tirn);
149328d61370SYishai Hadas 
149428d61370SYishai Hadas 	if (err)
149528d61370SYishai Hadas 		goto err;
149628d61370SYishai Hadas 
149728d61370SYishai Hadas 	kvfree(in);
149828d61370SYishai Hadas 	/* qpn is reserved for that QP */
149928d61370SYishai Hadas 	qp->trans_qp.base.mqp.qpn = 0;
1500d9f88e5aSYishai Hadas 	qp->flags |= MLX5_IB_QP_RSS;
150128d61370SYishai Hadas 	return 0;
150228d61370SYishai Hadas 
150328d61370SYishai Hadas err:
150428d61370SYishai Hadas 	kvfree(in);
150528d61370SYishai Hadas 	return err;
150628d61370SYishai Hadas }
150728d61370SYishai Hadas 
1508e126ba97SEli Cohen static int create_qp_common(struct mlx5_ib_dev *dev, struct ib_pd *pd,
1509e126ba97SEli Cohen 			    struct ib_qp_init_attr *init_attr,
1510e126ba97SEli Cohen 			    struct ib_udata *udata, struct mlx5_ib_qp *qp)
1511e126ba97SEli Cohen {
1512e126ba97SEli Cohen 	struct mlx5_ib_resources *devr = &dev->devr;
151309a7d9ecSSaeed Mahameed 	int inlen = MLX5_ST_SZ_BYTES(create_qp_in);
1514938fe83cSSaeed Mahameed 	struct mlx5_core_dev *mdev = dev->mdev;
1515e126ba97SEli Cohen 	struct mlx5_ib_create_qp_resp resp;
151689ea94a7SMaor Gottlieb 	struct mlx5_ib_cq *send_cq;
151789ea94a7SMaor Gottlieb 	struct mlx5_ib_cq *recv_cq;
151889ea94a7SMaor Gottlieb 	unsigned long flags;
1519cfb5e088SHaggai Abramovsky 	u32 uidx = MLX5_IB_DEFAULT_UIDX;
152009a7d9ecSSaeed Mahameed 	struct mlx5_ib_create_qp ucmd;
152109a7d9ecSSaeed Mahameed 	struct mlx5_ib_qp_base *base;
1522cfb5e088SHaggai Abramovsky 	void *qpc;
152309a7d9ecSSaeed Mahameed 	u32 *in;
152409a7d9ecSSaeed Mahameed 	int err;
1525e126ba97SEli Cohen 
15260fb2ed66Smajd@mellanox.com 	base = init_attr->qp_type == IB_QPT_RAW_PACKET ?
15270fb2ed66Smajd@mellanox.com 	       &qp->raw_packet_qp.rq.base :
15280fb2ed66Smajd@mellanox.com 	       &qp->trans_qp.base;
15290fb2ed66Smajd@mellanox.com 
15300fb2ed66Smajd@mellanox.com 	if (init_attr->qp_type != IB_QPT_RAW_PACKET)
15316aec21f6SHaggai Eran 		mlx5_ib_odp_create_qp(qp);
15326aec21f6SHaggai Eran 
1533e126ba97SEli Cohen 	mutex_init(&qp->mutex);
1534e126ba97SEli Cohen 	spin_lock_init(&qp->sq.lock);
1535e126ba97SEli Cohen 	spin_lock_init(&qp->rq.lock);
1536e126ba97SEli Cohen 
153728d61370SYishai Hadas 	if (init_attr->rwq_ind_tbl) {
153828d61370SYishai Hadas 		if (!udata)
153928d61370SYishai Hadas 			return -ENOSYS;
154028d61370SYishai Hadas 
154128d61370SYishai Hadas 		err = create_rss_raw_qp_tir(dev, qp, pd, init_attr, udata);
154228d61370SYishai Hadas 		return err;
154328d61370SYishai Hadas 	}
154428d61370SYishai Hadas 
1545f360d88aSEli Cohen 	if (init_attr->create_flags & IB_QP_CREATE_BLOCK_MULTICAST_LOOPBACK) {
1546938fe83cSSaeed Mahameed 		if (!MLX5_CAP_GEN(mdev, block_lb_mc)) {
1547f360d88aSEli Cohen 			mlx5_ib_dbg(dev, "block multicast loopback isn't supported\n");
1548f360d88aSEli Cohen 			return -EINVAL;
1549f360d88aSEli Cohen 		} else {
1550f360d88aSEli Cohen 			qp->flags |= MLX5_IB_QP_BLOCK_MULTICAST_LOOPBACK;
1551f360d88aSEli Cohen 		}
1552f360d88aSEli Cohen 	}
1553f360d88aSEli Cohen 
1554051f2630SLeon Romanovsky 	if (init_attr->create_flags &
1555051f2630SLeon Romanovsky 			(IB_QP_CREATE_CROSS_CHANNEL |
1556051f2630SLeon Romanovsky 			 IB_QP_CREATE_MANAGED_SEND |
1557051f2630SLeon Romanovsky 			 IB_QP_CREATE_MANAGED_RECV)) {
1558051f2630SLeon Romanovsky 		if (!MLX5_CAP_GEN(mdev, cd)) {
1559051f2630SLeon Romanovsky 			mlx5_ib_dbg(dev, "cross-channel isn't supported\n");
1560051f2630SLeon Romanovsky 			return -EINVAL;
1561051f2630SLeon Romanovsky 		}
1562051f2630SLeon Romanovsky 		if (init_attr->create_flags & IB_QP_CREATE_CROSS_CHANNEL)
1563051f2630SLeon Romanovsky 			qp->flags |= MLX5_IB_QP_CROSS_CHANNEL;
1564051f2630SLeon Romanovsky 		if (init_attr->create_flags & IB_QP_CREATE_MANAGED_SEND)
1565051f2630SLeon Romanovsky 			qp->flags |= MLX5_IB_QP_MANAGED_SEND;
1566051f2630SLeon Romanovsky 		if (init_attr->create_flags & IB_QP_CREATE_MANAGED_RECV)
1567051f2630SLeon Romanovsky 			qp->flags |= MLX5_IB_QP_MANAGED_RECV;
1568051f2630SLeon Romanovsky 	}
1569f0313965SErez Shitrit 
1570f0313965SErez Shitrit 	if (init_attr->qp_type == IB_QPT_UD &&
1571f0313965SErez Shitrit 	    (init_attr->create_flags & IB_QP_CREATE_IPOIB_UD_LSO))
1572f0313965SErez Shitrit 		if (!MLX5_CAP_GEN(mdev, ipoib_basic_offloads)) {
1573f0313965SErez Shitrit 			mlx5_ib_dbg(dev, "ipoib UD lso qp isn't supported\n");
1574f0313965SErez Shitrit 			return -EOPNOTSUPP;
1575f0313965SErez Shitrit 		}
1576f0313965SErez Shitrit 
1577358e42eaSMajd Dibbiny 	if (init_attr->create_flags & IB_QP_CREATE_SCATTER_FCS) {
1578358e42eaSMajd Dibbiny 		if (init_attr->qp_type != IB_QPT_RAW_PACKET) {
1579358e42eaSMajd Dibbiny 			mlx5_ib_dbg(dev, "Scatter FCS is supported only for Raw Packet QPs");
1580358e42eaSMajd Dibbiny 			return -EOPNOTSUPP;
1581358e42eaSMajd Dibbiny 		}
1582358e42eaSMajd Dibbiny 		if (!MLX5_CAP_GEN(dev->mdev, eth_net_offloads) ||
1583358e42eaSMajd Dibbiny 		    !MLX5_CAP_ETH(dev->mdev, scatter_fcs)) {
1584358e42eaSMajd Dibbiny 			mlx5_ib_dbg(dev, "Scatter FCS isn't supported\n");
1585358e42eaSMajd Dibbiny 			return -EOPNOTSUPP;
1586358e42eaSMajd Dibbiny 		}
1587358e42eaSMajd Dibbiny 		qp->flags |= MLX5_IB_QP_CAP_SCATTER_FCS;
1588358e42eaSMajd Dibbiny 	}
1589358e42eaSMajd Dibbiny 
1590e126ba97SEli Cohen 	if (init_attr->sq_sig_type == IB_SIGNAL_ALL_WR)
1591e126ba97SEli Cohen 		qp->sq_signal_bits = MLX5_WQE_CTRL_CQ_UPDATE;
1592e126ba97SEli Cohen 
1593e126ba97SEli Cohen 	if (pd && pd->uobject) {
1594e126ba97SEli Cohen 		if (ib_copy_from_udata(&ucmd, udata, sizeof(ucmd))) {
1595e126ba97SEli Cohen 			mlx5_ib_dbg(dev, "copy failed\n");
1596e126ba97SEli Cohen 			return -EFAULT;
1597e126ba97SEli Cohen 		}
1598e126ba97SEli Cohen 
1599cfb5e088SHaggai Abramovsky 		err = get_qp_user_index(to_mucontext(pd->uobject->context),
1600cfb5e088SHaggai Abramovsky 					&ucmd, udata->inlen, &uidx);
1601cfb5e088SHaggai Abramovsky 		if (err)
1602cfb5e088SHaggai Abramovsky 			return err;
1603cfb5e088SHaggai Abramovsky 
1604e126ba97SEli Cohen 		qp->wq_sig = !!(ucmd.flags & MLX5_QP_FLAG_SIGNATURE);
1605e126ba97SEli Cohen 		qp->scat_cqe = !!(ucmd.flags & MLX5_QP_FLAG_SCATTER_CQE);
1606e126ba97SEli Cohen 	} else {
1607e126ba97SEli Cohen 		qp->wq_sig = !!wq_signature;
1608e126ba97SEli Cohen 	}
1609e126ba97SEli Cohen 
1610e126ba97SEli Cohen 	qp->has_rq = qp_has_rq(init_attr);
1611e126ba97SEli Cohen 	err = set_rq_size(dev, &init_attr->cap, qp->has_rq,
1612e126ba97SEli Cohen 			  qp, (pd && pd->uobject) ? &ucmd : NULL);
1613e126ba97SEli Cohen 	if (err) {
1614e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "err %d\n", err);
1615e126ba97SEli Cohen 		return err;
1616e126ba97SEli Cohen 	}
1617e126ba97SEli Cohen 
1618e126ba97SEli Cohen 	if (pd) {
1619e126ba97SEli Cohen 		if (pd->uobject) {
1620938fe83cSSaeed Mahameed 			__u32 max_wqes =
1621938fe83cSSaeed Mahameed 				1 << MLX5_CAP_GEN(mdev, log_max_qp_sz);
1622e126ba97SEli Cohen 			mlx5_ib_dbg(dev, "requested sq_wqe_count (%d)\n", ucmd.sq_wqe_count);
1623e126ba97SEli Cohen 			if (ucmd.rq_wqe_shift != qp->rq.wqe_shift ||
1624e126ba97SEli Cohen 			    ucmd.rq_wqe_count != qp->rq.wqe_cnt) {
1625e126ba97SEli Cohen 				mlx5_ib_dbg(dev, "invalid rq params\n");
1626e126ba97SEli Cohen 				return -EINVAL;
1627e126ba97SEli Cohen 			}
1628938fe83cSSaeed Mahameed 			if (ucmd.sq_wqe_count > max_wqes) {
1629e126ba97SEli Cohen 				mlx5_ib_dbg(dev, "requested sq_wqe_count (%d) > max allowed (%d)\n",
1630938fe83cSSaeed Mahameed 					    ucmd.sq_wqe_count, max_wqes);
1631e126ba97SEli Cohen 				return -EINVAL;
1632e126ba97SEli Cohen 			}
1633b11a4f9cSHaggai Eran 			if (init_attr->create_flags &
1634b11a4f9cSHaggai Eran 			    mlx5_ib_create_qp_sqpn_qp1()) {
1635b11a4f9cSHaggai Eran 				mlx5_ib_dbg(dev, "user-space is not allowed to create UD QPs spoofing as QP1\n");
1636b11a4f9cSHaggai Eran 				return -EINVAL;
1637b11a4f9cSHaggai Eran 			}
16380fb2ed66Smajd@mellanox.com 			err = create_user_qp(dev, pd, qp, udata, init_attr, &in,
16390fb2ed66Smajd@mellanox.com 					     &resp, &inlen, base);
1640e126ba97SEli Cohen 			if (err)
1641e126ba97SEli Cohen 				mlx5_ib_dbg(dev, "err %d\n", err);
1642e126ba97SEli Cohen 		} else {
164319098df2Smajd@mellanox.com 			err = create_kernel_qp(dev, init_attr, qp, &in, &inlen,
164419098df2Smajd@mellanox.com 					       base);
1645e126ba97SEli Cohen 			if (err)
1646e126ba97SEli Cohen 				mlx5_ib_dbg(dev, "err %d\n", err);
1647e126ba97SEli Cohen 		}
1648e126ba97SEli Cohen 
1649e126ba97SEli Cohen 		if (err)
1650e126ba97SEli Cohen 			return err;
1651e126ba97SEli Cohen 	} else {
165209a7d9ecSSaeed Mahameed 		in = mlx5_vzalloc(inlen);
1653e126ba97SEli Cohen 		if (!in)
1654e126ba97SEli Cohen 			return -ENOMEM;
1655e126ba97SEli Cohen 
1656e126ba97SEli Cohen 		qp->create_type = MLX5_QP_EMPTY;
1657e126ba97SEli Cohen 	}
1658e126ba97SEli Cohen 
1659e126ba97SEli Cohen 	if (is_sqp(init_attr->qp_type))
1660e126ba97SEli Cohen 		qp->port = init_attr->port_num;
1661e126ba97SEli Cohen 
166209a7d9ecSSaeed Mahameed 	qpc = MLX5_ADDR_OF(create_qp_in, in, qpc);
166309a7d9ecSSaeed Mahameed 
166409a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, st, to_mlx5_st(init_attr->qp_type));
166509a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, pm_state, MLX5_QP_PM_MIGRATED);
1666e126ba97SEli Cohen 
1667e126ba97SEli Cohen 	if (init_attr->qp_type != MLX5_IB_QPT_REG_UMR)
166809a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, pd, to_mpd(pd ? pd : devr->p0)->pdn);
1669e126ba97SEli Cohen 	else
167009a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, latency_sensitive, 1);
167109a7d9ecSSaeed Mahameed 
1672e126ba97SEli Cohen 
1673e126ba97SEli Cohen 	if (qp->wq_sig)
167409a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, wq_signature, 1);
1675e126ba97SEli Cohen 
1676f360d88aSEli Cohen 	if (qp->flags & MLX5_IB_QP_BLOCK_MULTICAST_LOOPBACK)
167709a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, block_lb_mc, 1);
1678f360d88aSEli Cohen 
1679051f2630SLeon Romanovsky 	if (qp->flags & MLX5_IB_QP_CROSS_CHANNEL)
168009a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cd_master, 1);
1681051f2630SLeon Romanovsky 	if (qp->flags & MLX5_IB_QP_MANAGED_SEND)
168209a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cd_slave_send, 1);
1683051f2630SLeon Romanovsky 	if (qp->flags & MLX5_IB_QP_MANAGED_RECV)
168409a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cd_slave_receive, 1);
1685051f2630SLeon Romanovsky 
1686e126ba97SEli Cohen 	if (qp->scat_cqe && is_connected(init_attr->qp_type)) {
1687e126ba97SEli Cohen 		int rcqe_sz;
1688e126ba97SEli Cohen 		int scqe_sz;
1689e126ba97SEli Cohen 
1690e126ba97SEli Cohen 		rcqe_sz = mlx5_ib_get_cqe_size(dev, init_attr->recv_cq);
1691e126ba97SEli Cohen 		scqe_sz = mlx5_ib_get_cqe_size(dev, init_attr->send_cq);
1692e126ba97SEli Cohen 
1693e126ba97SEli Cohen 		if (rcqe_sz == 128)
169409a7d9ecSSaeed Mahameed 			MLX5_SET(qpc, qpc, cs_res, MLX5_RES_SCAT_DATA64_CQE);
1695e126ba97SEli Cohen 		else
169609a7d9ecSSaeed Mahameed 			MLX5_SET(qpc, qpc, cs_res, MLX5_RES_SCAT_DATA32_CQE);
1697e126ba97SEli Cohen 
1698e126ba97SEli Cohen 		if (init_attr->sq_sig_type == IB_SIGNAL_ALL_WR) {
1699e126ba97SEli Cohen 			if (scqe_sz == 128)
170009a7d9ecSSaeed Mahameed 				MLX5_SET(qpc, qpc, cs_req, MLX5_REQ_SCAT_DATA64_CQE);
1701e126ba97SEli Cohen 			else
170209a7d9ecSSaeed Mahameed 				MLX5_SET(qpc, qpc, cs_req, MLX5_REQ_SCAT_DATA32_CQE);
1703e126ba97SEli Cohen 		}
1704e126ba97SEli Cohen 	}
1705e126ba97SEli Cohen 
1706e126ba97SEli Cohen 	if (qp->rq.wqe_cnt) {
170709a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, log_rq_stride, qp->rq.wqe_shift - 4);
170809a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, log_rq_size, ilog2(qp->rq.wqe_cnt));
1709e126ba97SEli Cohen 	}
1710e126ba97SEli Cohen 
171109a7d9ecSSaeed Mahameed 	MLX5_SET(qpc, qpc, rq_type, get_rx_type(qp, init_attr));
1712e126ba97SEli Cohen 
1713e126ba97SEli Cohen 	if (qp->sq.wqe_cnt)
171409a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, log_sq_size, ilog2(qp->sq.wqe_cnt));
1715e126ba97SEli Cohen 	else
171609a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, no_sq, 1);
1717e126ba97SEli Cohen 
1718e126ba97SEli Cohen 	/* Set default resources */
1719e126ba97SEli Cohen 	switch (init_attr->qp_type) {
1720e126ba97SEli Cohen 	case IB_QPT_XRC_TGT:
172109a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cqn_rcv, to_mcq(devr->c0)->mcq.cqn);
172209a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cqn_snd, to_mcq(devr->c0)->mcq.cqn);
172309a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, srqn_rmpn_xrqn, to_msrq(devr->s0)->msrq.srqn);
172409a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, xrcd, to_mxrcd(init_attr->xrcd)->xrcdn);
1725e126ba97SEli Cohen 		break;
1726e126ba97SEli Cohen 	case IB_QPT_XRC_INI:
172709a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cqn_rcv, to_mcq(devr->c0)->mcq.cqn);
172809a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, xrcd, to_mxrcd(devr->x1)->xrcdn);
172909a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, srqn_rmpn_xrqn, to_msrq(devr->s0)->msrq.srqn);
1730e126ba97SEli Cohen 		break;
1731e126ba97SEli Cohen 	default:
1732e126ba97SEli Cohen 		if (init_attr->srq) {
173309a7d9ecSSaeed Mahameed 			MLX5_SET(qpc, qpc, xrcd, to_mxrcd(devr->x0)->xrcdn);
173409a7d9ecSSaeed Mahameed 			MLX5_SET(qpc, qpc, srqn_rmpn_xrqn, to_msrq(init_attr->srq)->msrq.srqn);
1735e126ba97SEli Cohen 		} else {
173609a7d9ecSSaeed Mahameed 			MLX5_SET(qpc, qpc, xrcd, to_mxrcd(devr->x1)->xrcdn);
173709a7d9ecSSaeed Mahameed 			MLX5_SET(qpc, qpc, srqn_rmpn_xrqn, to_msrq(devr->s1)->msrq.srqn);
1738e126ba97SEli Cohen 		}
1739e126ba97SEli Cohen 	}
1740e126ba97SEli Cohen 
1741e126ba97SEli Cohen 	if (init_attr->send_cq)
174209a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cqn_snd, to_mcq(init_attr->send_cq)->mcq.cqn);
1743e126ba97SEli Cohen 
1744e126ba97SEli Cohen 	if (init_attr->recv_cq)
174509a7d9ecSSaeed Mahameed 		MLX5_SET(qpc, qpc, cqn_rcv, to_mcq(init_attr->recv_cq)->mcq.cqn);
1746e126ba97SEli Cohen 
174709a7d9ecSSaeed Mahameed 	MLX5_SET64(qpc, qpc, dbr_addr, qp->db.dma);
1748e126ba97SEli Cohen 
1749cfb5e088SHaggai Abramovsky 	/* 0xffffff means we ask to work with cqe version 0 */
175009a7d9ecSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, cqe_version) == MLX5_CQE_VERSION_V1)
1751cfb5e088SHaggai Abramovsky 		MLX5_SET(qpc, qpc, user_index, uidx);
175209a7d9ecSSaeed Mahameed 
1753f0313965SErez Shitrit 	/* we use IB_QP_CREATE_IPOIB_UD_LSO to indicates ipoib qp */
1754f0313965SErez Shitrit 	if (init_attr->qp_type == IB_QPT_UD &&
1755f0313965SErez Shitrit 	    (init_attr->create_flags & IB_QP_CREATE_IPOIB_UD_LSO)) {
1756f0313965SErez Shitrit 		MLX5_SET(qpc, qpc, ulp_stateless_offload_mode, 1);
1757f0313965SErez Shitrit 		qp->flags |= MLX5_IB_QP_LSO;
1758f0313965SErez Shitrit 	}
1759cfb5e088SHaggai Abramovsky 
17600fb2ed66Smajd@mellanox.com 	if (init_attr->qp_type == IB_QPT_RAW_PACKET) {
17610fb2ed66Smajd@mellanox.com 		qp->raw_packet_qp.sq.ubuffer.buf_addr = ucmd.sq_buf_addr;
17620fb2ed66Smajd@mellanox.com 		raw_packet_qp_copy_info(qp, &qp->raw_packet_qp);
17630fb2ed66Smajd@mellanox.com 		err = create_raw_packet_qp(dev, qp, in, pd);
17640fb2ed66Smajd@mellanox.com 	} else {
176519098df2Smajd@mellanox.com 		err = mlx5_core_create_qp(dev->mdev, &base->mqp, in, inlen);
17660fb2ed66Smajd@mellanox.com 	}
17670fb2ed66Smajd@mellanox.com 
1768e126ba97SEli Cohen 	if (err) {
1769e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "create qp failed\n");
1770e126ba97SEli Cohen 		goto err_create;
1771e126ba97SEli Cohen 	}
1772e126ba97SEli Cohen 
1773479163f4SAl Viro 	kvfree(in);
1774e126ba97SEli Cohen 
177519098df2Smajd@mellanox.com 	base->container_mibqp = qp;
177619098df2Smajd@mellanox.com 	base->mqp.event = mlx5_ib_qp_event;
1777e126ba97SEli Cohen 
177889ea94a7SMaor Gottlieb 	get_cqs(init_attr->qp_type, init_attr->send_cq, init_attr->recv_cq,
177989ea94a7SMaor Gottlieb 		&send_cq, &recv_cq);
178089ea94a7SMaor Gottlieb 	spin_lock_irqsave(&dev->reset_flow_resource_lock, flags);
178189ea94a7SMaor Gottlieb 	mlx5_ib_lock_cqs(send_cq, recv_cq);
178289ea94a7SMaor Gottlieb 	/* Maintain device to QPs access, needed for further handling via reset
178389ea94a7SMaor Gottlieb 	 * flow
178489ea94a7SMaor Gottlieb 	 */
178589ea94a7SMaor Gottlieb 	list_add_tail(&qp->qps_list, &dev->qp_list);
178689ea94a7SMaor Gottlieb 	/* Maintain CQ to QPs access, needed for further handling via reset flow
178789ea94a7SMaor Gottlieb 	 */
178889ea94a7SMaor Gottlieb 	if (send_cq)
178989ea94a7SMaor Gottlieb 		list_add_tail(&qp->cq_send_list, &send_cq->list_send_qp);
179089ea94a7SMaor Gottlieb 	if (recv_cq)
179189ea94a7SMaor Gottlieb 		list_add_tail(&qp->cq_recv_list, &recv_cq->list_recv_qp);
179289ea94a7SMaor Gottlieb 	mlx5_ib_unlock_cqs(send_cq, recv_cq);
179389ea94a7SMaor Gottlieb 	spin_unlock_irqrestore(&dev->reset_flow_resource_lock, flags);
179489ea94a7SMaor Gottlieb 
1795e126ba97SEli Cohen 	return 0;
1796e126ba97SEli Cohen 
1797e126ba97SEli Cohen err_create:
1798e126ba97SEli Cohen 	if (qp->create_type == MLX5_QP_USER)
179919098df2Smajd@mellanox.com 		destroy_qp_user(pd, qp, base);
1800e126ba97SEli Cohen 	else if (qp->create_type == MLX5_QP_KERNEL)
1801e126ba97SEli Cohen 		destroy_qp_kernel(dev, qp);
1802e126ba97SEli Cohen 
1803479163f4SAl Viro 	kvfree(in);
1804e126ba97SEli Cohen 	return err;
1805e126ba97SEli Cohen }
1806e126ba97SEli Cohen 
1807e126ba97SEli Cohen static void mlx5_ib_lock_cqs(struct mlx5_ib_cq *send_cq, struct mlx5_ib_cq *recv_cq)
1808e126ba97SEli Cohen 	__acquires(&send_cq->lock) __acquires(&recv_cq->lock)
1809e126ba97SEli Cohen {
1810e126ba97SEli Cohen 	if (send_cq) {
1811e126ba97SEli Cohen 		if (recv_cq) {
1812e126ba97SEli Cohen 			if (send_cq->mcq.cqn < recv_cq->mcq.cqn)  {
181389ea94a7SMaor Gottlieb 				spin_lock(&send_cq->lock);
1814e126ba97SEli Cohen 				spin_lock_nested(&recv_cq->lock,
1815e126ba97SEli Cohen 						 SINGLE_DEPTH_NESTING);
1816e126ba97SEli Cohen 			} else if (send_cq->mcq.cqn == recv_cq->mcq.cqn) {
181789ea94a7SMaor Gottlieb 				spin_lock(&send_cq->lock);
1818e126ba97SEli Cohen 				__acquire(&recv_cq->lock);
1819e126ba97SEli Cohen 			} else {
182089ea94a7SMaor Gottlieb 				spin_lock(&recv_cq->lock);
1821e126ba97SEli Cohen 				spin_lock_nested(&send_cq->lock,
1822e126ba97SEli Cohen 						 SINGLE_DEPTH_NESTING);
1823e126ba97SEli Cohen 			}
1824e126ba97SEli Cohen 		} else {
182589ea94a7SMaor Gottlieb 			spin_lock(&send_cq->lock);
18266a4f139aSEli Cohen 			__acquire(&recv_cq->lock);
1827e126ba97SEli Cohen 		}
1828e126ba97SEli Cohen 	} else if (recv_cq) {
182989ea94a7SMaor Gottlieb 		spin_lock(&recv_cq->lock);
18306a4f139aSEli Cohen 		__acquire(&send_cq->lock);
18316a4f139aSEli Cohen 	} else {
18326a4f139aSEli Cohen 		__acquire(&send_cq->lock);
18336a4f139aSEli Cohen 		__acquire(&recv_cq->lock);
1834e126ba97SEli Cohen 	}
1835e126ba97SEli Cohen }
1836e126ba97SEli Cohen 
1837e126ba97SEli Cohen static void mlx5_ib_unlock_cqs(struct mlx5_ib_cq *send_cq, struct mlx5_ib_cq *recv_cq)
1838e126ba97SEli Cohen 	__releases(&send_cq->lock) __releases(&recv_cq->lock)
1839e126ba97SEli Cohen {
1840e126ba97SEli Cohen 	if (send_cq) {
1841e126ba97SEli Cohen 		if (recv_cq) {
1842e126ba97SEli Cohen 			if (send_cq->mcq.cqn < recv_cq->mcq.cqn)  {
1843e126ba97SEli Cohen 				spin_unlock(&recv_cq->lock);
184489ea94a7SMaor Gottlieb 				spin_unlock(&send_cq->lock);
1845e126ba97SEli Cohen 			} else if (send_cq->mcq.cqn == recv_cq->mcq.cqn) {
1846e126ba97SEli Cohen 				__release(&recv_cq->lock);
184789ea94a7SMaor Gottlieb 				spin_unlock(&send_cq->lock);
1848e126ba97SEli Cohen 			} else {
1849e126ba97SEli Cohen 				spin_unlock(&send_cq->lock);
185089ea94a7SMaor Gottlieb 				spin_unlock(&recv_cq->lock);
1851e126ba97SEli Cohen 			}
1852e126ba97SEli Cohen 		} else {
18536a4f139aSEli Cohen 			__release(&recv_cq->lock);
185489ea94a7SMaor Gottlieb 			spin_unlock(&send_cq->lock);
1855e126ba97SEli Cohen 		}
1856e126ba97SEli Cohen 	} else if (recv_cq) {
18576a4f139aSEli Cohen 		__release(&send_cq->lock);
185889ea94a7SMaor Gottlieb 		spin_unlock(&recv_cq->lock);
18596a4f139aSEli Cohen 	} else {
18606a4f139aSEli Cohen 		__release(&recv_cq->lock);
18616a4f139aSEli Cohen 		__release(&send_cq->lock);
1862e126ba97SEli Cohen 	}
1863e126ba97SEli Cohen }
1864e126ba97SEli Cohen 
1865e126ba97SEli Cohen static struct mlx5_ib_pd *get_pd(struct mlx5_ib_qp *qp)
1866e126ba97SEli Cohen {
1867e126ba97SEli Cohen 	return to_mpd(qp->ibqp.pd);
1868e126ba97SEli Cohen }
1869e126ba97SEli Cohen 
187089ea94a7SMaor Gottlieb static void get_cqs(enum ib_qp_type qp_type,
187189ea94a7SMaor Gottlieb 		    struct ib_cq *ib_send_cq, struct ib_cq *ib_recv_cq,
1872e126ba97SEli Cohen 		    struct mlx5_ib_cq **send_cq, struct mlx5_ib_cq **recv_cq)
1873e126ba97SEli Cohen {
187489ea94a7SMaor Gottlieb 	switch (qp_type) {
1875e126ba97SEli Cohen 	case IB_QPT_XRC_TGT:
1876e126ba97SEli Cohen 		*send_cq = NULL;
1877e126ba97SEli Cohen 		*recv_cq = NULL;
1878e126ba97SEli Cohen 		break;
1879e126ba97SEli Cohen 	case MLX5_IB_QPT_REG_UMR:
1880e126ba97SEli Cohen 	case IB_QPT_XRC_INI:
188189ea94a7SMaor Gottlieb 		*send_cq = ib_send_cq ? to_mcq(ib_send_cq) : NULL;
1882e126ba97SEli Cohen 		*recv_cq = NULL;
1883e126ba97SEli Cohen 		break;
1884e126ba97SEli Cohen 
1885e126ba97SEli Cohen 	case IB_QPT_SMI:
1886d16e91daSHaggai Eran 	case MLX5_IB_QPT_HW_GSI:
1887e126ba97SEli Cohen 	case IB_QPT_RC:
1888e126ba97SEli Cohen 	case IB_QPT_UC:
1889e126ba97SEli Cohen 	case IB_QPT_UD:
1890e126ba97SEli Cohen 	case IB_QPT_RAW_IPV6:
1891e126ba97SEli Cohen 	case IB_QPT_RAW_ETHERTYPE:
18920fb2ed66Smajd@mellanox.com 	case IB_QPT_RAW_PACKET:
189389ea94a7SMaor Gottlieb 		*send_cq = ib_send_cq ? to_mcq(ib_send_cq) : NULL;
189489ea94a7SMaor Gottlieb 		*recv_cq = ib_recv_cq ? to_mcq(ib_recv_cq) : NULL;
1895e126ba97SEli Cohen 		break;
1896e126ba97SEli Cohen 
1897e126ba97SEli Cohen 	case IB_QPT_MAX:
1898e126ba97SEli Cohen 	default:
1899e126ba97SEli Cohen 		*send_cq = NULL;
1900e126ba97SEli Cohen 		*recv_cq = NULL;
1901e126ba97SEli Cohen 		break;
1902e126ba97SEli Cohen 	}
1903e126ba97SEli Cohen }
1904e126ba97SEli Cohen 
1905ad5f8e96Smajd@mellanox.com static int modify_raw_packet_qp(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
190613eab21fSAviv Heller 				const struct mlx5_modify_raw_qp_param *raw_qp_param,
190713eab21fSAviv Heller 				u8 lag_tx_affinity);
1908ad5f8e96Smajd@mellanox.com 
1909e126ba97SEli Cohen static void destroy_qp_common(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp)
1910e126ba97SEli Cohen {
1911e126ba97SEli Cohen 	struct mlx5_ib_cq *send_cq, *recv_cq;
191219098df2Smajd@mellanox.com 	struct mlx5_ib_qp_base *base = &qp->trans_qp.base;
191389ea94a7SMaor Gottlieb 	unsigned long flags;
1914e126ba97SEli Cohen 	int err;
1915e126ba97SEli Cohen 
191628d61370SYishai Hadas 	if (qp->ibqp.rwq_ind_tbl) {
191728d61370SYishai Hadas 		destroy_rss_raw_qp_tir(dev, qp);
191828d61370SYishai Hadas 		return;
191928d61370SYishai Hadas 	}
192028d61370SYishai Hadas 
19210fb2ed66Smajd@mellanox.com 	base = qp->ibqp.qp_type == IB_QPT_RAW_PACKET ?
19220fb2ed66Smajd@mellanox.com 	       &qp->raw_packet_qp.rq.base :
19230fb2ed66Smajd@mellanox.com 	       &qp->trans_qp.base;
19240fb2ed66Smajd@mellanox.com 
19256aec21f6SHaggai Eran 	if (qp->state != IB_QPS_RESET) {
1926ad5f8e96Smajd@mellanox.com 		if (qp->ibqp.qp_type != IB_QPT_RAW_PACKET) {
19276aec21f6SHaggai Eran 			mlx5_ib_qp_disable_pagefaults(qp);
1928ad5f8e96Smajd@mellanox.com 			err = mlx5_core_qp_modify(dev->mdev,
19291a412fb1SSaeed Mahameed 						  MLX5_CMD_OP_2RST_QP, 0,
19301a412fb1SSaeed Mahameed 						  NULL, &base->mqp);
1931ad5f8e96Smajd@mellanox.com 		} else {
19320680efa2SAlex Vesker 			struct mlx5_modify_raw_qp_param raw_qp_param = {
19330680efa2SAlex Vesker 				.operation = MLX5_CMD_OP_2RST_QP
19340680efa2SAlex Vesker 			};
19350680efa2SAlex Vesker 
193613eab21fSAviv Heller 			err = modify_raw_packet_qp(dev, qp, &raw_qp_param, 0);
1937ad5f8e96Smajd@mellanox.com 		}
1938ad5f8e96Smajd@mellanox.com 		if (err)
1939427c1e7bSmajd@mellanox.com 			mlx5_ib_warn(dev, "mlx5_ib: modify QP 0x%06x to RESET failed\n",
194019098df2Smajd@mellanox.com 				     base->mqp.qpn);
19416aec21f6SHaggai Eran 	}
1942e126ba97SEli Cohen 
194389ea94a7SMaor Gottlieb 	get_cqs(qp->ibqp.qp_type, qp->ibqp.send_cq, qp->ibqp.recv_cq,
194489ea94a7SMaor Gottlieb 		&send_cq, &recv_cq);
194589ea94a7SMaor Gottlieb 
194689ea94a7SMaor Gottlieb 	spin_lock_irqsave(&dev->reset_flow_resource_lock, flags);
194789ea94a7SMaor Gottlieb 	mlx5_ib_lock_cqs(send_cq, recv_cq);
194889ea94a7SMaor Gottlieb 	/* del from lists under both locks above to protect reset flow paths */
194989ea94a7SMaor Gottlieb 	list_del(&qp->qps_list);
195089ea94a7SMaor Gottlieb 	if (send_cq)
195189ea94a7SMaor Gottlieb 		list_del(&qp->cq_send_list);
195289ea94a7SMaor Gottlieb 
195389ea94a7SMaor Gottlieb 	if (recv_cq)
195489ea94a7SMaor Gottlieb 		list_del(&qp->cq_recv_list);
1955e126ba97SEli Cohen 
1956e126ba97SEli Cohen 	if (qp->create_type == MLX5_QP_KERNEL) {
195719098df2Smajd@mellanox.com 		__mlx5_ib_cq_clean(recv_cq, base->mqp.qpn,
1958e126ba97SEli Cohen 				   qp->ibqp.srq ? to_msrq(qp->ibqp.srq) : NULL);
1959e126ba97SEli Cohen 		if (send_cq != recv_cq)
196019098df2Smajd@mellanox.com 			__mlx5_ib_cq_clean(send_cq, base->mqp.qpn,
196119098df2Smajd@mellanox.com 					   NULL);
1962e126ba97SEli Cohen 	}
196389ea94a7SMaor Gottlieb 	mlx5_ib_unlock_cqs(send_cq, recv_cq);
196489ea94a7SMaor Gottlieb 	spin_unlock_irqrestore(&dev->reset_flow_resource_lock, flags);
1965e126ba97SEli Cohen 
19660fb2ed66Smajd@mellanox.com 	if (qp->ibqp.qp_type == IB_QPT_RAW_PACKET) {
19670fb2ed66Smajd@mellanox.com 		destroy_raw_packet_qp(dev, qp);
19680fb2ed66Smajd@mellanox.com 	} else {
196919098df2Smajd@mellanox.com 		err = mlx5_core_destroy_qp(dev->mdev, &base->mqp);
1970e126ba97SEli Cohen 		if (err)
19710fb2ed66Smajd@mellanox.com 			mlx5_ib_warn(dev, "failed to destroy QP 0x%x\n",
19720fb2ed66Smajd@mellanox.com 				     base->mqp.qpn);
19730fb2ed66Smajd@mellanox.com 	}
1974e126ba97SEli Cohen 
1975e126ba97SEli Cohen 	if (qp->create_type == MLX5_QP_KERNEL)
1976e126ba97SEli Cohen 		destroy_qp_kernel(dev, qp);
1977e126ba97SEli Cohen 	else if (qp->create_type == MLX5_QP_USER)
197819098df2Smajd@mellanox.com 		destroy_qp_user(&get_pd(qp)->ibpd, qp, base);
1979e126ba97SEli Cohen }
1980e126ba97SEli Cohen 
1981e126ba97SEli Cohen static const char *ib_qp_type_str(enum ib_qp_type type)
1982e126ba97SEli Cohen {
1983e126ba97SEli Cohen 	switch (type) {
1984e126ba97SEli Cohen 	case IB_QPT_SMI:
1985e126ba97SEli Cohen 		return "IB_QPT_SMI";
1986e126ba97SEli Cohen 	case IB_QPT_GSI:
1987e126ba97SEli Cohen 		return "IB_QPT_GSI";
1988e126ba97SEli Cohen 	case IB_QPT_RC:
1989e126ba97SEli Cohen 		return "IB_QPT_RC";
1990e126ba97SEli Cohen 	case IB_QPT_UC:
1991e126ba97SEli Cohen 		return "IB_QPT_UC";
1992e126ba97SEli Cohen 	case IB_QPT_UD:
1993e126ba97SEli Cohen 		return "IB_QPT_UD";
1994e126ba97SEli Cohen 	case IB_QPT_RAW_IPV6:
1995e126ba97SEli Cohen 		return "IB_QPT_RAW_IPV6";
1996e126ba97SEli Cohen 	case IB_QPT_RAW_ETHERTYPE:
1997e126ba97SEli Cohen 		return "IB_QPT_RAW_ETHERTYPE";
1998e126ba97SEli Cohen 	case IB_QPT_XRC_INI:
1999e126ba97SEli Cohen 		return "IB_QPT_XRC_INI";
2000e126ba97SEli Cohen 	case IB_QPT_XRC_TGT:
2001e126ba97SEli Cohen 		return "IB_QPT_XRC_TGT";
2002e126ba97SEli Cohen 	case IB_QPT_RAW_PACKET:
2003e126ba97SEli Cohen 		return "IB_QPT_RAW_PACKET";
2004e126ba97SEli Cohen 	case MLX5_IB_QPT_REG_UMR:
2005e126ba97SEli Cohen 		return "MLX5_IB_QPT_REG_UMR";
2006e126ba97SEli Cohen 	case IB_QPT_MAX:
2007e126ba97SEli Cohen 	default:
2008e126ba97SEli Cohen 		return "Invalid QP type";
2009e126ba97SEli Cohen 	}
2010e126ba97SEli Cohen }
2011e126ba97SEli Cohen 
2012e126ba97SEli Cohen struct ib_qp *mlx5_ib_create_qp(struct ib_pd *pd,
2013e126ba97SEli Cohen 				struct ib_qp_init_attr *init_attr,
2014e126ba97SEli Cohen 				struct ib_udata *udata)
2015e126ba97SEli Cohen {
2016e126ba97SEli Cohen 	struct mlx5_ib_dev *dev;
2017e126ba97SEli Cohen 	struct mlx5_ib_qp *qp;
2018e126ba97SEli Cohen 	u16 xrcdn = 0;
2019e126ba97SEli Cohen 	int err;
2020e126ba97SEli Cohen 
2021e126ba97SEli Cohen 	if (pd) {
2022e126ba97SEli Cohen 		dev = to_mdev(pd->device);
20230fb2ed66Smajd@mellanox.com 
20240fb2ed66Smajd@mellanox.com 		if (init_attr->qp_type == IB_QPT_RAW_PACKET) {
20250fb2ed66Smajd@mellanox.com 			if (!pd->uobject) {
20260fb2ed66Smajd@mellanox.com 				mlx5_ib_dbg(dev, "Raw Packet QP is not supported for kernel consumers\n");
20270fb2ed66Smajd@mellanox.com 				return ERR_PTR(-EINVAL);
20280fb2ed66Smajd@mellanox.com 			} else if (!to_mucontext(pd->uobject->context)->cqe_version) {
20290fb2ed66Smajd@mellanox.com 				mlx5_ib_dbg(dev, "Raw Packet QP is only supported for CQE version > 0\n");
20300fb2ed66Smajd@mellanox.com 				return ERR_PTR(-EINVAL);
20310fb2ed66Smajd@mellanox.com 			}
20320fb2ed66Smajd@mellanox.com 		}
203309f16cf5SMajd Dibbiny 	} else {
203409f16cf5SMajd Dibbiny 		/* being cautious here */
203509f16cf5SMajd Dibbiny 		if (init_attr->qp_type != IB_QPT_XRC_TGT &&
203609f16cf5SMajd Dibbiny 		    init_attr->qp_type != MLX5_IB_QPT_REG_UMR) {
203709f16cf5SMajd Dibbiny 			pr_warn("%s: no PD for transport %s\n", __func__,
203809f16cf5SMajd Dibbiny 				ib_qp_type_str(init_attr->qp_type));
203909f16cf5SMajd Dibbiny 			return ERR_PTR(-EINVAL);
204009f16cf5SMajd Dibbiny 		}
204109f16cf5SMajd Dibbiny 		dev = to_mdev(to_mxrcd(init_attr->xrcd)->ibxrcd.device);
2042e126ba97SEli Cohen 	}
2043e126ba97SEli Cohen 
2044e126ba97SEli Cohen 	switch (init_attr->qp_type) {
2045e126ba97SEli Cohen 	case IB_QPT_XRC_TGT:
2046e126ba97SEli Cohen 	case IB_QPT_XRC_INI:
2047938fe83cSSaeed Mahameed 		if (!MLX5_CAP_GEN(dev->mdev, xrc)) {
2048e126ba97SEli Cohen 			mlx5_ib_dbg(dev, "XRC not supported\n");
2049e126ba97SEli Cohen 			return ERR_PTR(-ENOSYS);
2050e126ba97SEli Cohen 		}
2051e126ba97SEli Cohen 		init_attr->recv_cq = NULL;
2052e126ba97SEli Cohen 		if (init_attr->qp_type == IB_QPT_XRC_TGT) {
2053e126ba97SEli Cohen 			xrcdn = to_mxrcd(init_attr->xrcd)->xrcdn;
2054e126ba97SEli Cohen 			init_attr->send_cq = NULL;
2055e126ba97SEli Cohen 		}
2056e126ba97SEli Cohen 
2057e126ba97SEli Cohen 		/* fall through */
20580fb2ed66Smajd@mellanox.com 	case IB_QPT_RAW_PACKET:
2059e126ba97SEli Cohen 	case IB_QPT_RC:
2060e126ba97SEli Cohen 	case IB_QPT_UC:
2061e126ba97SEli Cohen 	case IB_QPT_UD:
2062e126ba97SEli Cohen 	case IB_QPT_SMI:
2063d16e91daSHaggai Eran 	case MLX5_IB_QPT_HW_GSI:
2064e126ba97SEli Cohen 	case MLX5_IB_QPT_REG_UMR:
2065e126ba97SEli Cohen 		qp = kzalloc(sizeof(*qp), GFP_KERNEL);
2066e126ba97SEli Cohen 		if (!qp)
2067e126ba97SEli Cohen 			return ERR_PTR(-ENOMEM);
2068e126ba97SEli Cohen 
2069e126ba97SEli Cohen 		err = create_qp_common(dev, pd, init_attr, udata, qp);
2070e126ba97SEli Cohen 		if (err) {
2071e126ba97SEli Cohen 			mlx5_ib_dbg(dev, "create_qp_common failed\n");
2072e126ba97SEli Cohen 			kfree(qp);
2073e126ba97SEli Cohen 			return ERR_PTR(err);
2074e126ba97SEli Cohen 		}
2075e126ba97SEli Cohen 
2076e126ba97SEli Cohen 		if (is_qp0(init_attr->qp_type))
2077e126ba97SEli Cohen 			qp->ibqp.qp_num = 0;
2078e126ba97SEli Cohen 		else if (is_qp1(init_attr->qp_type))
2079e126ba97SEli Cohen 			qp->ibqp.qp_num = 1;
2080e126ba97SEli Cohen 		else
208119098df2Smajd@mellanox.com 			qp->ibqp.qp_num = qp->trans_qp.base.mqp.qpn;
2082e126ba97SEli Cohen 
2083e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "ib qpnum 0x%x, mlx qpn 0x%x, rcqn 0x%x, scqn 0x%x\n",
208419098df2Smajd@mellanox.com 			    qp->ibqp.qp_num, qp->trans_qp.base.mqp.qpn,
208519098df2Smajd@mellanox.com 			    to_mcq(init_attr->recv_cq)->mcq.cqn,
2086e126ba97SEli Cohen 			    to_mcq(init_attr->send_cq)->mcq.cqn);
2087e126ba97SEli Cohen 
208819098df2Smajd@mellanox.com 		qp->trans_qp.xrcdn = xrcdn;
2089e126ba97SEli Cohen 
2090e126ba97SEli Cohen 		break;
2091e126ba97SEli Cohen 
2092d16e91daSHaggai Eran 	case IB_QPT_GSI:
2093d16e91daSHaggai Eran 		return mlx5_ib_gsi_create_qp(pd, init_attr);
2094d16e91daSHaggai Eran 
2095e126ba97SEli Cohen 	case IB_QPT_RAW_IPV6:
2096e126ba97SEli Cohen 	case IB_QPT_RAW_ETHERTYPE:
2097e126ba97SEli Cohen 	case IB_QPT_MAX:
2098e126ba97SEli Cohen 	default:
2099e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "unsupported qp type %d\n",
2100e126ba97SEli Cohen 			    init_attr->qp_type);
2101e126ba97SEli Cohen 		/* Don't support raw QPs */
2102e126ba97SEli Cohen 		return ERR_PTR(-EINVAL);
2103e126ba97SEli Cohen 	}
2104e126ba97SEli Cohen 
2105e126ba97SEli Cohen 	return &qp->ibqp;
2106e126ba97SEli Cohen }
2107e126ba97SEli Cohen 
2108e126ba97SEli Cohen int mlx5_ib_destroy_qp(struct ib_qp *qp)
2109e126ba97SEli Cohen {
2110e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(qp->device);
2111e126ba97SEli Cohen 	struct mlx5_ib_qp *mqp = to_mqp(qp);
2112e126ba97SEli Cohen 
2113d16e91daSHaggai Eran 	if (unlikely(qp->qp_type == IB_QPT_GSI))
2114d16e91daSHaggai Eran 		return mlx5_ib_gsi_destroy_qp(qp);
2115d16e91daSHaggai Eran 
2116e126ba97SEli Cohen 	destroy_qp_common(dev, mqp);
2117e126ba97SEli Cohen 
2118e126ba97SEli Cohen 	kfree(mqp);
2119e126ba97SEli Cohen 
2120e126ba97SEli Cohen 	return 0;
2121e126ba97SEli Cohen }
2122e126ba97SEli Cohen 
2123e126ba97SEli Cohen static __be32 to_mlx5_access_flags(struct mlx5_ib_qp *qp, const struct ib_qp_attr *attr,
2124e126ba97SEli Cohen 				   int attr_mask)
2125e126ba97SEli Cohen {
2126e126ba97SEli Cohen 	u32 hw_access_flags = 0;
2127e126ba97SEli Cohen 	u8 dest_rd_atomic;
2128e126ba97SEli Cohen 	u32 access_flags;
2129e126ba97SEli Cohen 
2130e126ba97SEli Cohen 	if (attr_mask & IB_QP_MAX_DEST_RD_ATOMIC)
2131e126ba97SEli Cohen 		dest_rd_atomic = attr->max_dest_rd_atomic;
2132e126ba97SEli Cohen 	else
213319098df2Smajd@mellanox.com 		dest_rd_atomic = qp->trans_qp.resp_depth;
2134e126ba97SEli Cohen 
2135e126ba97SEli Cohen 	if (attr_mask & IB_QP_ACCESS_FLAGS)
2136e126ba97SEli Cohen 		access_flags = attr->qp_access_flags;
2137e126ba97SEli Cohen 	else
213819098df2Smajd@mellanox.com 		access_flags = qp->trans_qp.atomic_rd_en;
2139e126ba97SEli Cohen 
2140e126ba97SEli Cohen 	if (!dest_rd_atomic)
2141e126ba97SEli Cohen 		access_flags &= IB_ACCESS_REMOTE_WRITE;
2142e126ba97SEli Cohen 
2143e126ba97SEli Cohen 	if (access_flags & IB_ACCESS_REMOTE_READ)
2144e126ba97SEli Cohen 		hw_access_flags |= MLX5_QP_BIT_RRE;
2145e126ba97SEli Cohen 	if (access_flags & IB_ACCESS_REMOTE_ATOMIC)
2146e126ba97SEli Cohen 		hw_access_flags |= (MLX5_QP_BIT_RAE | MLX5_ATOMIC_MODE_CX);
2147e126ba97SEli Cohen 	if (access_flags & IB_ACCESS_REMOTE_WRITE)
2148e126ba97SEli Cohen 		hw_access_flags |= MLX5_QP_BIT_RWE;
2149e126ba97SEli Cohen 
2150e126ba97SEli Cohen 	return cpu_to_be32(hw_access_flags);
2151e126ba97SEli Cohen }
2152e126ba97SEli Cohen 
2153e126ba97SEli Cohen enum {
2154e126ba97SEli Cohen 	MLX5_PATH_FLAG_FL	= 1 << 0,
2155e126ba97SEli Cohen 	MLX5_PATH_FLAG_FREE_AR	= 1 << 1,
2156e126ba97SEli Cohen 	MLX5_PATH_FLAG_COUNTER	= 1 << 2,
2157e126ba97SEli Cohen };
2158e126ba97SEli Cohen 
2159e126ba97SEli Cohen static int ib_rate_to_mlx5(struct mlx5_ib_dev *dev, u8 rate)
2160e126ba97SEli Cohen {
2161e126ba97SEli Cohen 	if (rate == IB_RATE_PORT_CURRENT) {
2162e126ba97SEli Cohen 		return 0;
2163e126ba97SEli Cohen 	} else if (rate < IB_RATE_2_5_GBPS || rate > IB_RATE_300_GBPS) {
2164e126ba97SEli Cohen 		return -EINVAL;
2165e126ba97SEli Cohen 	} else {
2166e126ba97SEli Cohen 		while (rate != IB_RATE_2_5_GBPS &&
2167e126ba97SEli Cohen 		       !(1 << (rate + MLX5_STAT_RATE_OFFSET) &
2168938fe83cSSaeed Mahameed 			 MLX5_CAP_GEN(dev->mdev, stat_rate_support)))
2169e126ba97SEli Cohen 			--rate;
2170e126ba97SEli Cohen 	}
2171e126ba97SEli Cohen 
2172e126ba97SEli Cohen 	return rate + MLX5_STAT_RATE_OFFSET;
2173e126ba97SEli Cohen }
2174e126ba97SEli Cohen 
217575850d0bSmajd@mellanox.com static int modify_raw_packet_eth_prio(struct mlx5_core_dev *dev,
217675850d0bSmajd@mellanox.com 				      struct mlx5_ib_sq *sq, u8 sl)
217775850d0bSmajd@mellanox.com {
217875850d0bSmajd@mellanox.com 	void *in;
217975850d0bSmajd@mellanox.com 	void *tisc;
218075850d0bSmajd@mellanox.com 	int inlen;
218175850d0bSmajd@mellanox.com 	int err;
218275850d0bSmajd@mellanox.com 
218375850d0bSmajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(modify_tis_in);
218475850d0bSmajd@mellanox.com 	in = mlx5_vzalloc(inlen);
218575850d0bSmajd@mellanox.com 	if (!in)
218675850d0bSmajd@mellanox.com 		return -ENOMEM;
218775850d0bSmajd@mellanox.com 
218875850d0bSmajd@mellanox.com 	MLX5_SET(modify_tis_in, in, bitmask.prio, 1);
218975850d0bSmajd@mellanox.com 
219075850d0bSmajd@mellanox.com 	tisc = MLX5_ADDR_OF(modify_tis_in, in, ctx);
219175850d0bSmajd@mellanox.com 	MLX5_SET(tisc, tisc, prio, ((sl & 0x7) << 1));
219275850d0bSmajd@mellanox.com 
219375850d0bSmajd@mellanox.com 	err = mlx5_core_modify_tis(dev, sq->tisn, in, inlen);
219475850d0bSmajd@mellanox.com 
219575850d0bSmajd@mellanox.com 	kvfree(in);
219675850d0bSmajd@mellanox.com 
219775850d0bSmajd@mellanox.com 	return err;
219875850d0bSmajd@mellanox.com }
219975850d0bSmajd@mellanox.com 
220013eab21fSAviv Heller static int modify_raw_packet_tx_affinity(struct mlx5_core_dev *dev,
220113eab21fSAviv Heller 					 struct mlx5_ib_sq *sq, u8 tx_affinity)
220213eab21fSAviv Heller {
220313eab21fSAviv Heller 	void *in;
220413eab21fSAviv Heller 	void *tisc;
220513eab21fSAviv Heller 	int inlen;
220613eab21fSAviv Heller 	int err;
220713eab21fSAviv Heller 
220813eab21fSAviv Heller 	inlen = MLX5_ST_SZ_BYTES(modify_tis_in);
220913eab21fSAviv Heller 	in = mlx5_vzalloc(inlen);
221013eab21fSAviv Heller 	if (!in)
221113eab21fSAviv Heller 		return -ENOMEM;
221213eab21fSAviv Heller 
221313eab21fSAviv Heller 	MLX5_SET(modify_tis_in, in, bitmask.lag_tx_port_affinity, 1);
221413eab21fSAviv Heller 
221513eab21fSAviv Heller 	tisc = MLX5_ADDR_OF(modify_tis_in, in, ctx);
221613eab21fSAviv Heller 	MLX5_SET(tisc, tisc, lag_tx_port_affinity, tx_affinity);
221713eab21fSAviv Heller 
221813eab21fSAviv Heller 	err = mlx5_core_modify_tis(dev, sq->tisn, in, inlen);
221913eab21fSAviv Heller 
222013eab21fSAviv Heller 	kvfree(in);
222113eab21fSAviv Heller 
222213eab21fSAviv Heller 	return err;
222313eab21fSAviv Heller }
222413eab21fSAviv Heller 
222575850d0bSmajd@mellanox.com static int mlx5_set_path(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
222675850d0bSmajd@mellanox.com 			 const struct ib_ah_attr *ah,
2227e126ba97SEli Cohen 			 struct mlx5_qp_path *path, u8 port, int attr_mask,
2228f879ee8dSAchiad Shochat 			 u32 path_flags, const struct ib_qp_attr *attr,
2229f879ee8dSAchiad Shochat 			 bool alt)
2230e126ba97SEli Cohen {
22312811ba51SAchiad Shochat 	enum rdma_link_layer ll = rdma_port_get_link_layer(&dev->ib_dev, port);
2232e126ba97SEli Cohen 	int err;
2233e126ba97SEli Cohen 
2234e126ba97SEli Cohen 	if (attr_mask & IB_QP_PKEY_INDEX)
2235f879ee8dSAchiad Shochat 		path->pkey_index = cpu_to_be16(alt ? attr->alt_pkey_index :
2236f879ee8dSAchiad Shochat 						     attr->pkey_index);
2237e126ba97SEli Cohen 
2238e126ba97SEli Cohen 	if (ah->ah_flags & IB_AH_GRH) {
2239938fe83cSSaeed Mahameed 		if (ah->grh.sgid_index >=
2240938fe83cSSaeed Mahameed 		    dev->mdev->port_caps[port - 1].gid_table_len) {
2241f4f01b54SJoe Perches 			pr_err("sgid_index (%u) too large. max is %d\n",
2242938fe83cSSaeed Mahameed 			       ah->grh.sgid_index,
2243938fe83cSSaeed Mahameed 			       dev->mdev->port_caps[port - 1].gid_table_len);
2244f83b4263SEli Cohen 			return -EINVAL;
2245f83b4263SEli Cohen 		}
22462811ba51SAchiad Shochat 	}
22472811ba51SAchiad Shochat 
22482811ba51SAchiad Shochat 	if (ll == IB_LINK_LAYER_ETHERNET) {
22492811ba51SAchiad Shochat 		if (!(ah->ah_flags & IB_AH_GRH))
22502811ba51SAchiad Shochat 			return -EINVAL;
22512811ba51SAchiad Shochat 		memcpy(path->rmac, ah->dmac, sizeof(ah->dmac));
22522811ba51SAchiad Shochat 		path->udp_sport = mlx5_get_roce_udp_sport(dev, port,
22532811ba51SAchiad Shochat 							  ah->grh.sgid_index);
22542811ba51SAchiad Shochat 		path->dci_cfi_prio_sl = (ah->sl & 0x7) << 4;
22552811ba51SAchiad Shochat 	} else {
2256d3ae2bdeSNoa Osherovich 		path->fl_free_ar = (path_flags & MLX5_PATH_FLAG_FL) ? 0x80 : 0;
2257d3ae2bdeSNoa Osherovich 		path->fl_free_ar |=
2258d3ae2bdeSNoa Osherovich 			(path_flags & MLX5_PATH_FLAG_FREE_AR) ? 0x40 : 0;
22592811ba51SAchiad Shochat 		path->rlid = cpu_to_be16(ah->dlid);
22602811ba51SAchiad Shochat 		path->grh_mlid = ah->src_path_bits & 0x7f;
22612811ba51SAchiad Shochat 		if (ah->ah_flags & IB_AH_GRH)
2262e126ba97SEli Cohen 			path->grh_mlid	|= 1 << 7;
22632811ba51SAchiad Shochat 		path->dci_cfi_prio_sl = ah->sl & 0xf;
22642811ba51SAchiad Shochat 	}
22652811ba51SAchiad Shochat 
22662811ba51SAchiad Shochat 	if (ah->ah_flags & IB_AH_GRH) {
2267e126ba97SEli Cohen 		path->mgid_index = ah->grh.sgid_index;
2268e126ba97SEli Cohen 		path->hop_limit  = ah->grh.hop_limit;
2269e126ba97SEli Cohen 		path->tclass_flowlabel =
2270e126ba97SEli Cohen 			cpu_to_be32((ah->grh.traffic_class << 20) |
2271e126ba97SEli Cohen 				    (ah->grh.flow_label));
2272e126ba97SEli Cohen 		memcpy(path->rgid, ah->grh.dgid.raw, 16);
2273e126ba97SEli Cohen 	}
2274e126ba97SEli Cohen 
2275e126ba97SEli Cohen 	err = ib_rate_to_mlx5(dev, ah->static_rate);
2276e126ba97SEli Cohen 	if (err < 0)
2277e126ba97SEli Cohen 		return err;
2278e126ba97SEli Cohen 	path->static_rate = err;
2279e126ba97SEli Cohen 	path->port = port;
2280e126ba97SEli Cohen 
2281e126ba97SEli Cohen 	if (attr_mask & IB_QP_TIMEOUT)
2282f879ee8dSAchiad Shochat 		path->ackto_lt = (alt ? attr->alt_timeout : attr->timeout) << 3;
2283e126ba97SEli Cohen 
228475850d0bSmajd@mellanox.com 	if ((qp->ibqp.qp_type == IB_QPT_RAW_PACKET) && qp->sq.wqe_cnt)
228575850d0bSmajd@mellanox.com 		return modify_raw_packet_eth_prio(dev->mdev,
228675850d0bSmajd@mellanox.com 						  &qp->raw_packet_qp.sq,
228775850d0bSmajd@mellanox.com 						  ah->sl & 0xf);
228875850d0bSmajd@mellanox.com 
2289e126ba97SEli Cohen 	return 0;
2290e126ba97SEli Cohen }
2291e126ba97SEli Cohen 
2292e126ba97SEli Cohen static enum mlx5_qp_optpar opt_mask[MLX5_QP_NUM_STATE][MLX5_QP_NUM_STATE][MLX5_QP_ST_MAX] = {
2293e126ba97SEli Cohen 	[MLX5_QP_STATE_INIT] = {
2294e126ba97SEli Cohen 		[MLX5_QP_STATE_INIT] = {
2295e126ba97SEli Cohen 			[MLX5_QP_ST_RC] = MLX5_QP_OPTPAR_RRE		|
2296e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RAE		|
2297e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE		|
2298e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PKEY_INDEX	|
2299e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PRI_PORT,
2300e126ba97SEli Cohen 			[MLX5_QP_ST_UC] = MLX5_QP_OPTPAR_RWE		|
2301e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PKEY_INDEX	|
2302e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PRI_PORT,
2303e126ba97SEli Cohen 			[MLX5_QP_ST_UD] = MLX5_QP_OPTPAR_PKEY_INDEX	|
2304e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_Q_KEY		|
2305e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PRI_PORT,
2306e126ba97SEli Cohen 		},
2307e126ba97SEli Cohen 		[MLX5_QP_STATE_RTR] = {
2308e126ba97SEli Cohen 			[MLX5_QP_ST_RC] = MLX5_QP_OPTPAR_ALT_ADDR_PATH  |
2309e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RRE            |
2310e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RAE            |
2311e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE            |
2312e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PKEY_INDEX,
2313e126ba97SEli Cohen 			[MLX5_QP_ST_UC] = MLX5_QP_OPTPAR_ALT_ADDR_PATH  |
2314e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE            |
2315e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PKEY_INDEX,
2316e126ba97SEli Cohen 			[MLX5_QP_ST_UD] = MLX5_QP_OPTPAR_PKEY_INDEX     |
2317e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_Q_KEY,
2318e126ba97SEli Cohen 			[MLX5_QP_ST_MLX] = MLX5_QP_OPTPAR_PKEY_INDEX	|
2319e126ba97SEli Cohen 					   MLX5_QP_OPTPAR_Q_KEY,
2320a4774e90SEli Cohen 			[MLX5_QP_ST_XRC] = MLX5_QP_OPTPAR_ALT_ADDR_PATH |
2321a4774e90SEli Cohen 					  MLX5_QP_OPTPAR_RRE            |
2322a4774e90SEli Cohen 					  MLX5_QP_OPTPAR_RAE            |
2323a4774e90SEli Cohen 					  MLX5_QP_OPTPAR_RWE            |
2324a4774e90SEli Cohen 					  MLX5_QP_OPTPAR_PKEY_INDEX,
2325e126ba97SEli Cohen 		},
2326e126ba97SEli Cohen 	},
2327e126ba97SEli Cohen 	[MLX5_QP_STATE_RTR] = {
2328e126ba97SEli Cohen 		[MLX5_QP_STATE_RTS] = {
2329e126ba97SEli Cohen 			[MLX5_QP_ST_RC] = MLX5_QP_OPTPAR_ALT_ADDR_PATH	|
2330e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RRE		|
2331e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RAE		|
2332e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE		|
2333e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PM_STATE	|
2334e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RNR_TIMEOUT,
2335e126ba97SEli Cohen 			[MLX5_QP_ST_UC] = MLX5_QP_OPTPAR_ALT_ADDR_PATH	|
2336e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE		|
2337e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_PM_STATE,
2338e126ba97SEli Cohen 			[MLX5_QP_ST_UD] = MLX5_QP_OPTPAR_Q_KEY,
2339e126ba97SEli Cohen 		},
2340e126ba97SEli Cohen 	},
2341e126ba97SEli Cohen 	[MLX5_QP_STATE_RTS] = {
2342e126ba97SEli Cohen 		[MLX5_QP_STATE_RTS] = {
2343e126ba97SEli Cohen 			[MLX5_QP_ST_RC] = MLX5_QP_OPTPAR_RRE		|
2344e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RAE		|
2345e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RWE		|
2346e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_RNR_TIMEOUT	|
2347c2a3431eSEli Cohen 					  MLX5_QP_OPTPAR_PM_STATE	|
2348c2a3431eSEli Cohen 					  MLX5_QP_OPTPAR_ALT_ADDR_PATH,
2349e126ba97SEli Cohen 			[MLX5_QP_ST_UC] = MLX5_QP_OPTPAR_RWE		|
2350c2a3431eSEli Cohen 					  MLX5_QP_OPTPAR_PM_STATE	|
2351c2a3431eSEli Cohen 					  MLX5_QP_OPTPAR_ALT_ADDR_PATH,
2352e126ba97SEli Cohen 			[MLX5_QP_ST_UD] = MLX5_QP_OPTPAR_Q_KEY		|
2353e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_SRQN		|
2354e126ba97SEli Cohen 					  MLX5_QP_OPTPAR_CQN_RCV,
2355e126ba97SEli Cohen 		},
2356e126ba97SEli Cohen 	},
2357e126ba97SEli Cohen 	[MLX5_QP_STATE_SQER] = {
2358e126ba97SEli Cohen 		[MLX5_QP_STATE_RTS] = {
2359e126ba97SEli Cohen 			[MLX5_QP_ST_UD]	 = MLX5_QP_OPTPAR_Q_KEY,
2360e126ba97SEli Cohen 			[MLX5_QP_ST_MLX] = MLX5_QP_OPTPAR_Q_KEY,
236175959f56SEli Cohen 			[MLX5_QP_ST_UC]	 = MLX5_QP_OPTPAR_RWE,
2362a4774e90SEli Cohen 			[MLX5_QP_ST_RC]	 = MLX5_QP_OPTPAR_RNR_TIMEOUT	|
2363a4774e90SEli Cohen 					   MLX5_QP_OPTPAR_RWE		|
2364a4774e90SEli Cohen 					   MLX5_QP_OPTPAR_RAE		|
2365a4774e90SEli Cohen 					   MLX5_QP_OPTPAR_RRE,
2366e126ba97SEli Cohen 		},
2367e126ba97SEli Cohen 	},
2368e126ba97SEli Cohen };
2369e126ba97SEli Cohen 
2370e126ba97SEli Cohen static int ib_nr_to_mlx5_nr(int ib_mask)
2371e126ba97SEli Cohen {
2372e126ba97SEli Cohen 	switch (ib_mask) {
2373e126ba97SEli Cohen 	case IB_QP_STATE:
2374e126ba97SEli Cohen 		return 0;
2375e126ba97SEli Cohen 	case IB_QP_CUR_STATE:
2376e126ba97SEli Cohen 		return 0;
2377e126ba97SEli Cohen 	case IB_QP_EN_SQD_ASYNC_NOTIFY:
2378e126ba97SEli Cohen 		return 0;
2379e126ba97SEli Cohen 	case IB_QP_ACCESS_FLAGS:
2380e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_RWE | MLX5_QP_OPTPAR_RRE |
2381e126ba97SEli Cohen 			MLX5_QP_OPTPAR_RAE;
2382e126ba97SEli Cohen 	case IB_QP_PKEY_INDEX:
2383e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_PKEY_INDEX;
2384e126ba97SEli Cohen 	case IB_QP_PORT:
2385e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_PRI_PORT;
2386e126ba97SEli Cohen 	case IB_QP_QKEY:
2387e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_Q_KEY;
2388e126ba97SEli Cohen 	case IB_QP_AV:
2389e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_PRIMARY_ADDR_PATH |
2390e126ba97SEli Cohen 			MLX5_QP_OPTPAR_PRI_PORT;
2391e126ba97SEli Cohen 	case IB_QP_PATH_MTU:
2392e126ba97SEli Cohen 		return 0;
2393e126ba97SEli Cohen 	case IB_QP_TIMEOUT:
2394e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_ACK_TIMEOUT;
2395e126ba97SEli Cohen 	case IB_QP_RETRY_CNT:
2396e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_RETRY_COUNT;
2397e126ba97SEli Cohen 	case IB_QP_RNR_RETRY:
2398e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_RNR_RETRY;
2399e126ba97SEli Cohen 	case IB_QP_RQ_PSN:
2400e126ba97SEli Cohen 		return 0;
2401e126ba97SEli Cohen 	case IB_QP_MAX_QP_RD_ATOMIC:
2402e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_SRA_MAX;
2403e126ba97SEli Cohen 	case IB_QP_ALT_PATH:
2404e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_ALT_ADDR_PATH;
2405e126ba97SEli Cohen 	case IB_QP_MIN_RNR_TIMER:
2406e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_RNR_TIMEOUT;
2407e126ba97SEli Cohen 	case IB_QP_SQ_PSN:
2408e126ba97SEli Cohen 		return 0;
2409e126ba97SEli Cohen 	case IB_QP_MAX_DEST_RD_ATOMIC:
2410e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_RRA_MAX | MLX5_QP_OPTPAR_RWE |
2411e126ba97SEli Cohen 			MLX5_QP_OPTPAR_RRE | MLX5_QP_OPTPAR_RAE;
2412e126ba97SEli Cohen 	case IB_QP_PATH_MIG_STATE:
2413e126ba97SEli Cohen 		return MLX5_QP_OPTPAR_PM_STATE;
2414e126ba97SEli Cohen 	case IB_QP_CAP:
2415e126ba97SEli Cohen 		return 0;
2416e126ba97SEli Cohen 	case IB_QP_DEST_QPN:
2417e126ba97SEli Cohen 		return 0;
2418e126ba97SEli Cohen 	}
2419e126ba97SEli Cohen 	return 0;
2420e126ba97SEli Cohen }
2421e126ba97SEli Cohen 
2422e126ba97SEli Cohen static int ib_mask_to_mlx5_opt(int ib_mask)
2423e126ba97SEli Cohen {
2424e126ba97SEli Cohen 	int result = 0;
2425e126ba97SEli Cohen 	int i;
2426e126ba97SEli Cohen 
2427e126ba97SEli Cohen 	for (i = 0; i < 8 * sizeof(int); i++) {
2428e126ba97SEli Cohen 		if ((1 << i) & ib_mask)
2429e126ba97SEli Cohen 			result |= ib_nr_to_mlx5_nr(1 << i);
2430e126ba97SEli Cohen 	}
2431e126ba97SEli Cohen 
2432e126ba97SEli Cohen 	return result;
2433e126ba97SEli Cohen }
2434e126ba97SEli Cohen 
2435eb49ab0cSAlex Vesker static int modify_raw_packet_qp_rq(struct mlx5_ib_dev *dev,
2436eb49ab0cSAlex Vesker 				   struct mlx5_ib_rq *rq, int new_state,
2437eb49ab0cSAlex Vesker 				   const struct mlx5_modify_raw_qp_param *raw_qp_param)
2438ad5f8e96Smajd@mellanox.com {
2439ad5f8e96Smajd@mellanox.com 	void *in;
2440ad5f8e96Smajd@mellanox.com 	void *rqc;
2441ad5f8e96Smajd@mellanox.com 	int inlen;
2442ad5f8e96Smajd@mellanox.com 	int err;
2443ad5f8e96Smajd@mellanox.com 
2444ad5f8e96Smajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(modify_rq_in);
2445ad5f8e96Smajd@mellanox.com 	in = mlx5_vzalloc(inlen);
2446ad5f8e96Smajd@mellanox.com 	if (!in)
2447ad5f8e96Smajd@mellanox.com 		return -ENOMEM;
2448ad5f8e96Smajd@mellanox.com 
2449ad5f8e96Smajd@mellanox.com 	MLX5_SET(modify_rq_in, in, rq_state, rq->state);
2450ad5f8e96Smajd@mellanox.com 
2451ad5f8e96Smajd@mellanox.com 	rqc = MLX5_ADDR_OF(modify_rq_in, in, ctx);
2452ad5f8e96Smajd@mellanox.com 	MLX5_SET(rqc, rqc, state, new_state);
2453ad5f8e96Smajd@mellanox.com 
2454eb49ab0cSAlex Vesker 	if (raw_qp_param->set_mask & MLX5_RAW_QP_MOD_SET_RQ_Q_CTR_ID) {
2455eb49ab0cSAlex Vesker 		if (MLX5_CAP_GEN(dev->mdev, modify_rq_counter_set_id)) {
2456eb49ab0cSAlex Vesker 			MLX5_SET64(modify_rq_in, in, modify_bitmask,
2457eb49ab0cSAlex Vesker 				   MLX5_MODIFY_RQ_IN_MODIFY_BITMASK_MODIFY_RQ_COUNTER_SET_ID);
2458eb49ab0cSAlex Vesker 			MLX5_SET(rqc, rqc, counter_set_id, raw_qp_param->rq_q_ctr_id);
2459eb49ab0cSAlex Vesker 		} else
2460eb49ab0cSAlex Vesker 			pr_info_once("%s: RAW PACKET QP counters are not supported on current FW\n",
2461eb49ab0cSAlex Vesker 				     dev->ib_dev.name);
2462eb49ab0cSAlex Vesker 	}
2463eb49ab0cSAlex Vesker 
2464eb49ab0cSAlex Vesker 	err = mlx5_core_modify_rq(dev->mdev, rq->base.mqp.qpn, in, inlen);
2465ad5f8e96Smajd@mellanox.com 	if (err)
2466ad5f8e96Smajd@mellanox.com 		goto out;
2467ad5f8e96Smajd@mellanox.com 
2468ad5f8e96Smajd@mellanox.com 	rq->state = new_state;
2469ad5f8e96Smajd@mellanox.com 
2470ad5f8e96Smajd@mellanox.com out:
2471ad5f8e96Smajd@mellanox.com 	kvfree(in);
2472ad5f8e96Smajd@mellanox.com 	return err;
2473ad5f8e96Smajd@mellanox.com }
2474ad5f8e96Smajd@mellanox.com 
2475ad5f8e96Smajd@mellanox.com static int modify_raw_packet_qp_sq(struct mlx5_core_dev *dev,
24767d29f349SBodong Wang 				   struct mlx5_ib_sq *sq,
24777d29f349SBodong Wang 				   int new_state,
24787d29f349SBodong Wang 				   const struct mlx5_modify_raw_qp_param *raw_qp_param)
2479ad5f8e96Smajd@mellanox.com {
24807d29f349SBodong Wang 	struct mlx5_ib_qp *ibqp = sq->base.container_mibqp;
24817d29f349SBodong Wang 	u32 old_rate = ibqp->rate_limit;
24827d29f349SBodong Wang 	u32 new_rate = old_rate;
24837d29f349SBodong Wang 	u16 rl_index = 0;
2484ad5f8e96Smajd@mellanox.com 	void *in;
2485ad5f8e96Smajd@mellanox.com 	void *sqc;
2486ad5f8e96Smajd@mellanox.com 	int inlen;
2487ad5f8e96Smajd@mellanox.com 	int err;
2488ad5f8e96Smajd@mellanox.com 
2489ad5f8e96Smajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(modify_sq_in);
2490ad5f8e96Smajd@mellanox.com 	in = mlx5_vzalloc(inlen);
2491ad5f8e96Smajd@mellanox.com 	if (!in)
2492ad5f8e96Smajd@mellanox.com 		return -ENOMEM;
2493ad5f8e96Smajd@mellanox.com 
2494ad5f8e96Smajd@mellanox.com 	MLX5_SET(modify_sq_in, in, sq_state, sq->state);
2495ad5f8e96Smajd@mellanox.com 
2496ad5f8e96Smajd@mellanox.com 	sqc = MLX5_ADDR_OF(modify_sq_in, in, ctx);
2497ad5f8e96Smajd@mellanox.com 	MLX5_SET(sqc, sqc, state, new_state);
2498ad5f8e96Smajd@mellanox.com 
24997d29f349SBodong Wang 	if (raw_qp_param->set_mask & MLX5_RAW_QP_RATE_LIMIT) {
25007d29f349SBodong Wang 		if (new_state != MLX5_SQC_STATE_RDY)
25017d29f349SBodong Wang 			pr_warn("%s: Rate limit can only be changed when SQ is moving to RDY\n",
25027d29f349SBodong Wang 				__func__);
25037d29f349SBodong Wang 		else
25047d29f349SBodong Wang 			new_rate = raw_qp_param->rate_limit;
25057d29f349SBodong Wang 	}
2506ad5f8e96Smajd@mellanox.com 
25077d29f349SBodong Wang 	if (old_rate != new_rate) {
25087d29f349SBodong Wang 		if (new_rate) {
25097d29f349SBodong Wang 			err = mlx5_rl_add_rate(dev, new_rate, &rl_index);
25107d29f349SBodong Wang 			if (err) {
25117d29f349SBodong Wang 				pr_err("Failed configuring rate %u: %d\n",
25127d29f349SBodong Wang 				       new_rate, err);
25137d29f349SBodong Wang 				goto out;
25147d29f349SBodong Wang 			}
25157d29f349SBodong Wang 		}
25167d29f349SBodong Wang 
25177d29f349SBodong Wang 		MLX5_SET64(modify_sq_in, in, modify_bitmask, 1);
25187d29f349SBodong Wang 		MLX5_SET(sqc, sqc, packet_pacing_rate_limit_index, rl_index);
25197d29f349SBodong Wang 	}
25207d29f349SBodong Wang 
25217d29f349SBodong Wang 	err = mlx5_core_modify_sq(dev, sq->base.mqp.qpn, in, inlen);
25227d29f349SBodong Wang 	if (err) {
25237d29f349SBodong Wang 		/* Remove new rate from table if failed */
25247d29f349SBodong Wang 		if (new_rate &&
25257d29f349SBodong Wang 		    old_rate != new_rate)
25267d29f349SBodong Wang 			mlx5_rl_remove_rate(dev, new_rate);
25277d29f349SBodong Wang 		goto out;
25287d29f349SBodong Wang 	}
25297d29f349SBodong Wang 
25307d29f349SBodong Wang 	/* Only remove the old rate after new rate was set */
25317d29f349SBodong Wang 	if ((old_rate &&
25327d29f349SBodong Wang 	    (old_rate != new_rate)) ||
25337d29f349SBodong Wang 	    (new_state != MLX5_SQC_STATE_RDY))
25347d29f349SBodong Wang 		mlx5_rl_remove_rate(dev, old_rate);
25357d29f349SBodong Wang 
25367d29f349SBodong Wang 	ibqp->rate_limit = new_rate;
2537ad5f8e96Smajd@mellanox.com 	sq->state = new_state;
2538ad5f8e96Smajd@mellanox.com 
2539ad5f8e96Smajd@mellanox.com out:
2540ad5f8e96Smajd@mellanox.com 	kvfree(in);
2541ad5f8e96Smajd@mellanox.com 	return err;
2542ad5f8e96Smajd@mellanox.com }
2543ad5f8e96Smajd@mellanox.com 
2544ad5f8e96Smajd@mellanox.com static int modify_raw_packet_qp(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
254513eab21fSAviv Heller 				const struct mlx5_modify_raw_qp_param *raw_qp_param,
254613eab21fSAviv Heller 				u8 tx_affinity)
2547ad5f8e96Smajd@mellanox.com {
2548ad5f8e96Smajd@mellanox.com 	struct mlx5_ib_raw_packet_qp *raw_packet_qp = &qp->raw_packet_qp;
2549ad5f8e96Smajd@mellanox.com 	struct mlx5_ib_rq *rq = &raw_packet_qp->rq;
2550ad5f8e96Smajd@mellanox.com 	struct mlx5_ib_sq *sq = &raw_packet_qp->sq;
25517d29f349SBodong Wang 	int modify_rq = !!qp->rq.wqe_cnt;
25527d29f349SBodong Wang 	int modify_sq = !!qp->sq.wqe_cnt;
2553ad5f8e96Smajd@mellanox.com 	int rq_state;
2554ad5f8e96Smajd@mellanox.com 	int sq_state;
2555ad5f8e96Smajd@mellanox.com 	int err;
2556ad5f8e96Smajd@mellanox.com 
25570680efa2SAlex Vesker 	switch (raw_qp_param->operation) {
2558ad5f8e96Smajd@mellanox.com 	case MLX5_CMD_OP_RST2INIT_QP:
2559ad5f8e96Smajd@mellanox.com 		rq_state = MLX5_RQC_STATE_RDY;
2560ad5f8e96Smajd@mellanox.com 		sq_state = MLX5_SQC_STATE_RDY;
2561ad5f8e96Smajd@mellanox.com 		break;
2562ad5f8e96Smajd@mellanox.com 	case MLX5_CMD_OP_2ERR_QP:
2563ad5f8e96Smajd@mellanox.com 		rq_state = MLX5_RQC_STATE_ERR;
2564ad5f8e96Smajd@mellanox.com 		sq_state = MLX5_SQC_STATE_ERR;
2565ad5f8e96Smajd@mellanox.com 		break;
2566ad5f8e96Smajd@mellanox.com 	case MLX5_CMD_OP_2RST_QP:
2567ad5f8e96Smajd@mellanox.com 		rq_state = MLX5_RQC_STATE_RST;
2568ad5f8e96Smajd@mellanox.com 		sq_state = MLX5_SQC_STATE_RST;
2569ad5f8e96Smajd@mellanox.com 		break;
2570ad5f8e96Smajd@mellanox.com 	case MLX5_CMD_OP_RTR2RTS_QP:
2571ad5f8e96Smajd@mellanox.com 	case MLX5_CMD_OP_RTS2RTS_QP:
25727d29f349SBodong Wang 		if (raw_qp_param->set_mask ==
25737d29f349SBodong Wang 		    MLX5_RAW_QP_RATE_LIMIT) {
25747d29f349SBodong Wang 			modify_rq = 0;
25757d29f349SBodong Wang 			sq_state = sq->state;
25767d29f349SBodong Wang 		} else {
25777d29f349SBodong Wang 			return raw_qp_param->set_mask ? -EINVAL : 0;
25787d29f349SBodong Wang 		}
25797d29f349SBodong Wang 		break;
25807d29f349SBodong Wang 	case MLX5_CMD_OP_INIT2INIT_QP:
25817d29f349SBodong Wang 	case MLX5_CMD_OP_INIT2RTR_QP:
2582eb49ab0cSAlex Vesker 		if (raw_qp_param->set_mask)
2583eb49ab0cSAlex Vesker 			return -EINVAL;
2584eb49ab0cSAlex Vesker 		else
2585ad5f8e96Smajd@mellanox.com 			return 0;
2586ad5f8e96Smajd@mellanox.com 	default:
2587ad5f8e96Smajd@mellanox.com 		WARN_ON(1);
2588ad5f8e96Smajd@mellanox.com 		return -EINVAL;
2589ad5f8e96Smajd@mellanox.com 	}
2590ad5f8e96Smajd@mellanox.com 
25917d29f349SBodong Wang 	if (modify_rq) {
2592eb49ab0cSAlex Vesker 		err =  modify_raw_packet_qp_rq(dev, rq, rq_state, raw_qp_param);
2593ad5f8e96Smajd@mellanox.com 		if (err)
2594ad5f8e96Smajd@mellanox.com 			return err;
2595ad5f8e96Smajd@mellanox.com 	}
2596ad5f8e96Smajd@mellanox.com 
25977d29f349SBodong Wang 	if (modify_sq) {
259813eab21fSAviv Heller 		if (tx_affinity) {
259913eab21fSAviv Heller 			err = modify_raw_packet_tx_affinity(dev->mdev, sq,
260013eab21fSAviv Heller 							    tx_affinity);
260113eab21fSAviv Heller 			if (err)
260213eab21fSAviv Heller 				return err;
260313eab21fSAviv Heller 		}
260413eab21fSAviv Heller 
26057d29f349SBodong Wang 		return modify_raw_packet_qp_sq(dev->mdev, sq, sq_state, raw_qp_param);
260613eab21fSAviv Heller 	}
2607ad5f8e96Smajd@mellanox.com 
2608ad5f8e96Smajd@mellanox.com 	return 0;
2609ad5f8e96Smajd@mellanox.com }
2610ad5f8e96Smajd@mellanox.com 
2611e126ba97SEli Cohen static int __mlx5_ib_modify_qp(struct ib_qp *ibqp,
2612e126ba97SEli Cohen 			       const struct ib_qp_attr *attr, int attr_mask,
2613e126ba97SEli Cohen 			       enum ib_qp_state cur_state, enum ib_qp_state new_state)
2614e126ba97SEli Cohen {
2615427c1e7bSmajd@mellanox.com 	static const u16 optab[MLX5_QP_NUM_STATE][MLX5_QP_NUM_STATE] = {
2616427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_RST] = {
2617427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
2618427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
2619427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_INIT]	= MLX5_CMD_OP_RST2INIT_QP,
2620427c1e7bSmajd@mellanox.com 		},
2621427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_INIT]  = {
2622427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
2623427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
2624427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_INIT]	= MLX5_CMD_OP_INIT2INIT_QP,
2625427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RTR]	= MLX5_CMD_OP_INIT2RTR_QP,
2626427c1e7bSmajd@mellanox.com 		},
2627427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_RTR]   = {
2628427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
2629427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
2630427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RTS]	= MLX5_CMD_OP_RTR2RTS_QP,
2631427c1e7bSmajd@mellanox.com 		},
2632427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_RTS]   = {
2633427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
2634427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
2635427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RTS]	= MLX5_CMD_OP_RTS2RTS_QP,
2636427c1e7bSmajd@mellanox.com 		},
2637427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_SQD] = {
2638427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
2639427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
2640427c1e7bSmajd@mellanox.com 		},
2641427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_SQER] = {
2642427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
2643427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
2644427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RTS]	= MLX5_CMD_OP_SQERR2RTS_QP,
2645427c1e7bSmajd@mellanox.com 		},
2646427c1e7bSmajd@mellanox.com 		[MLX5_QP_STATE_ERR] = {
2647427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_RST]	= MLX5_CMD_OP_2RST_QP,
2648427c1e7bSmajd@mellanox.com 			[MLX5_QP_STATE_ERR]	= MLX5_CMD_OP_2ERR_QP,
2649427c1e7bSmajd@mellanox.com 		}
2650427c1e7bSmajd@mellanox.com 	};
2651427c1e7bSmajd@mellanox.com 
2652e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
2653e126ba97SEli Cohen 	struct mlx5_ib_qp *qp = to_mqp(ibqp);
265419098df2Smajd@mellanox.com 	struct mlx5_ib_qp_base *base = &qp->trans_qp.base;
2655e126ba97SEli Cohen 	struct mlx5_ib_cq *send_cq, *recv_cq;
2656e126ba97SEli Cohen 	struct mlx5_qp_context *context;
2657e126ba97SEli Cohen 	struct mlx5_ib_pd *pd;
2658eb49ab0cSAlex Vesker 	struct mlx5_ib_port *mibport = NULL;
2659e126ba97SEli Cohen 	enum mlx5_qp_state mlx5_cur, mlx5_new;
2660e126ba97SEli Cohen 	enum mlx5_qp_optpar optpar;
2661e126ba97SEli Cohen 	int mlx5_st;
2662e126ba97SEli Cohen 	int err;
2663427c1e7bSmajd@mellanox.com 	u16 op;
266413eab21fSAviv Heller 	u8 tx_affinity = 0;
2665e126ba97SEli Cohen 
26661a412fb1SSaeed Mahameed 	context = kzalloc(sizeof(*context), GFP_KERNEL);
26671a412fb1SSaeed Mahameed 	if (!context)
2668e126ba97SEli Cohen 		return -ENOMEM;
2669e126ba97SEli Cohen 
2670e126ba97SEli Cohen 	err = to_mlx5_st(ibqp->qp_type);
2671158abf86SHaggai Eran 	if (err < 0) {
2672158abf86SHaggai Eran 		mlx5_ib_dbg(dev, "unsupported qp type %d\n", ibqp->qp_type);
2673e126ba97SEli Cohen 		goto out;
2674158abf86SHaggai Eran 	}
2675e126ba97SEli Cohen 
2676e126ba97SEli Cohen 	context->flags = cpu_to_be32(err << 16);
2677e126ba97SEli Cohen 
2678e126ba97SEli Cohen 	if (!(attr_mask & IB_QP_PATH_MIG_STATE)) {
2679e126ba97SEli Cohen 		context->flags |= cpu_to_be32(MLX5_QP_PM_MIGRATED << 11);
2680e126ba97SEli Cohen 	} else {
2681e126ba97SEli Cohen 		switch (attr->path_mig_state) {
2682e126ba97SEli Cohen 		case IB_MIG_MIGRATED:
2683e126ba97SEli Cohen 			context->flags |= cpu_to_be32(MLX5_QP_PM_MIGRATED << 11);
2684e126ba97SEli Cohen 			break;
2685e126ba97SEli Cohen 		case IB_MIG_REARM:
2686e126ba97SEli Cohen 			context->flags |= cpu_to_be32(MLX5_QP_PM_REARM << 11);
2687e126ba97SEli Cohen 			break;
2688e126ba97SEli Cohen 		case IB_MIG_ARMED:
2689e126ba97SEli Cohen 			context->flags |= cpu_to_be32(MLX5_QP_PM_ARMED << 11);
2690e126ba97SEli Cohen 			break;
2691e126ba97SEli Cohen 		}
2692e126ba97SEli Cohen 	}
2693e126ba97SEli Cohen 
269413eab21fSAviv Heller 	if ((cur_state == IB_QPS_RESET) && (new_state == IB_QPS_INIT)) {
269513eab21fSAviv Heller 		if ((ibqp->qp_type == IB_QPT_RC) ||
269613eab21fSAviv Heller 		    (ibqp->qp_type == IB_QPT_UD &&
269713eab21fSAviv Heller 		     !(qp->flags & MLX5_IB_QP_SQPN_QP1)) ||
269813eab21fSAviv Heller 		    (ibqp->qp_type == IB_QPT_UC) ||
269913eab21fSAviv Heller 		    (ibqp->qp_type == IB_QPT_RAW_PACKET) ||
270013eab21fSAviv Heller 		    (ibqp->qp_type == IB_QPT_XRC_INI) ||
270113eab21fSAviv Heller 		    (ibqp->qp_type == IB_QPT_XRC_TGT)) {
270213eab21fSAviv Heller 			if (mlx5_lag_is_active(dev->mdev)) {
270313eab21fSAviv Heller 				tx_affinity = (unsigned int)atomic_add_return(1,
270413eab21fSAviv Heller 						&dev->roce.next_port) %
270513eab21fSAviv Heller 						MLX5_MAX_PORTS + 1;
270613eab21fSAviv Heller 				context->flags |= cpu_to_be32(tx_affinity << 24);
270713eab21fSAviv Heller 			}
270813eab21fSAviv Heller 		}
270913eab21fSAviv Heller 	}
271013eab21fSAviv Heller 
2711d16e91daSHaggai Eran 	if (is_sqp(ibqp->qp_type)) {
2712e126ba97SEli Cohen 		context->mtu_msgmax = (IB_MTU_256 << 5) | 8;
2713e126ba97SEli Cohen 	} else if (ibqp->qp_type == IB_QPT_UD ||
2714e126ba97SEli Cohen 		   ibqp->qp_type == MLX5_IB_QPT_REG_UMR) {
2715e126ba97SEli Cohen 		context->mtu_msgmax = (IB_MTU_4096 << 5) | 12;
2716e126ba97SEli Cohen 	} else if (attr_mask & IB_QP_PATH_MTU) {
2717e126ba97SEli Cohen 		if (attr->path_mtu < IB_MTU_256 ||
2718e126ba97SEli Cohen 		    attr->path_mtu > IB_MTU_4096) {
2719e126ba97SEli Cohen 			mlx5_ib_warn(dev, "invalid mtu %d\n", attr->path_mtu);
2720e126ba97SEli Cohen 			err = -EINVAL;
2721e126ba97SEli Cohen 			goto out;
2722e126ba97SEli Cohen 		}
2723938fe83cSSaeed Mahameed 		context->mtu_msgmax = (attr->path_mtu << 5) |
2724938fe83cSSaeed Mahameed 				      (u8)MLX5_CAP_GEN(dev->mdev, log_max_msg);
2725e126ba97SEli Cohen 	}
2726e126ba97SEli Cohen 
2727e126ba97SEli Cohen 	if (attr_mask & IB_QP_DEST_QPN)
2728e126ba97SEli Cohen 		context->log_pg_sz_remote_qpn = cpu_to_be32(attr->dest_qp_num);
2729e126ba97SEli Cohen 
2730e126ba97SEli Cohen 	if (attr_mask & IB_QP_PKEY_INDEX)
2731d3ae2bdeSNoa Osherovich 		context->pri_path.pkey_index = cpu_to_be16(attr->pkey_index);
2732e126ba97SEli Cohen 
2733e126ba97SEli Cohen 	/* todo implement counter_index functionality */
2734e126ba97SEli Cohen 
2735e126ba97SEli Cohen 	if (is_sqp(ibqp->qp_type))
2736e126ba97SEli Cohen 		context->pri_path.port = qp->port;
2737e126ba97SEli Cohen 
2738e126ba97SEli Cohen 	if (attr_mask & IB_QP_PORT)
2739e126ba97SEli Cohen 		context->pri_path.port = attr->port_num;
2740e126ba97SEli Cohen 
2741e126ba97SEli Cohen 	if (attr_mask & IB_QP_AV) {
274275850d0bSmajd@mellanox.com 		err = mlx5_set_path(dev, qp, &attr->ah_attr, &context->pri_path,
2743e126ba97SEli Cohen 				    attr_mask & IB_QP_PORT ? attr->port_num : qp->port,
2744f879ee8dSAchiad Shochat 				    attr_mask, 0, attr, false);
2745e126ba97SEli Cohen 		if (err)
2746e126ba97SEli Cohen 			goto out;
2747e126ba97SEli Cohen 	}
2748e126ba97SEli Cohen 
2749e126ba97SEli Cohen 	if (attr_mask & IB_QP_TIMEOUT)
2750e126ba97SEli Cohen 		context->pri_path.ackto_lt |= attr->timeout << 3;
2751e126ba97SEli Cohen 
2752e126ba97SEli Cohen 	if (attr_mask & IB_QP_ALT_PATH) {
275375850d0bSmajd@mellanox.com 		err = mlx5_set_path(dev, qp, &attr->alt_ah_attr,
275475850d0bSmajd@mellanox.com 				    &context->alt_path,
2755f879ee8dSAchiad Shochat 				    attr->alt_port_num,
2756f879ee8dSAchiad Shochat 				    attr_mask | IB_QP_PKEY_INDEX | IB_QP_TIMEOUT,
2757f879ee8dSAchiad Shochat 				    0, attr, true);
2758e126ba97SEli Cohen 		if (err)
2759e126ba97SEli Cohen 			goto out;
2760e126ba97SEli Cohen 	}
2761e126ba97SEli Cohen 
2762e126ba97SEli Cohen 	pd = get_pd(qp);
276389ea94a7SMaor Gottlieb 	get_cqs(qp->ibqp.qp_type, qp->ibqp.send_cq, qp->ibqp.recv_cq,
276489ea94a7SMaor Gottlieb 		&send_cq, &recv_cq);
2765e126ba97SEli Cohen 
2766e126ba97SEli Cohen 	context->flags_pd = cpu_to_be32(pd ? pd->pdn : to_mpd(dev->devr.p0)->pdn);
2767e126ba97SEli Cohen 	context->cqn_send = send_cq ? cpu_to_be32(send_cq->mcq.cqn) : 0;
2768e126ba97SEli Cohen 	context->cqn_recv = recv_cq ? cpu_to_be32(recv_cq->mcq.cqn) : 0;
2769e126ba97SEli Cohen 	context->params1  = cpu_to_be32(MLX5_IB_ACK_REQ_FREQ << 28);
2770e126ba97SEli Cohen 
2771e126ba97SEli Cohen 	if (attr_mask & IB_QP_RNR_RETRY)
2772e126ba97SEli Cohen 		context->params1 |= cpu_to_be32(attr->rnr_retry << 13);
2773e126ba97SEli Cohen 
2774e126ba97SEli Cohen 	if (attr_mask & IB_QP_RETRY_CNT)
2775e126ba97SEli Cohen 		context->params1 |= cpu_to_be32(attr->retry_cnt << 16);
2776e126ba97SEli Cohen 
2777e126ba97SEli Cohen 	if (attr_mask & IB_QP_MAX_QP_RD_ATOMIC) {
2778e126ba97SEli Cohen 		if (attr->max_rd_atomic)
2779e126ba97SEli Cohen 			context->params1 |=
2780e126ba97SEli Cohen 				cpu_to_be32(fls(attr->max_rd_atomic - 1) << 21);
2781e126ba97SEli Cohen 	}
2782e126ba97SEli Cohen 
2783e126ba97SEli Cohen 	if (attr_mask & IB_QP_SQ_PSN)
2784e126ba97SEli Cohen 		context->next_send_psn = cpu_to_be32(attr->sq_psn);
2785e126ba97SEli Cohen 
2786e126ba97SEli Cohen 	if (attr_mask & IB_QP_MAX_DEST_RD_ATOMIC) {
2787e126ba97SEli Cohen 		if (attr->max_dest_rd_atomic)
2788e126ba97SEli Cohen 			context->params2 |=
2789e126ba97SEli Cohen 				cpu_to_be32(fls(attr->max_dest_rd_atomic - 1) << 21);
2790e126ba97SEli Cohen 	}
2791e126ba97SEli Cohen 
2792e126ba97SEli Cohen 	if (attr_mask & (IB_QP_ACCESS_FLAGS | IB_QP_MAX_DEST_RD_ATOMIC))
2793e126ba97SEli Cohen 		context->params2 |= to_mlx5_access_flags(qp, attr, attr_mask);
2794e126ba97SEli Cohen 
2795e126ba97SEli Cohen 	if (attr_mask & IB_QP_MIN_RNR_TIMER)
2796e126ba97SEli Cohen 		context->rnr_nextrecvpsn |= cpu_to_be32(attr->min_rnr_timer << 24);
2797e126ba97SEli Cohen 
2798e126ba97SEli Cohen 	if (attr_mask & IB_QP_RQ_PSN)
2799e126ba97SEli Cohen 		context->rnr_nextrecvpsn |= cpu_to_be32(attr->rq_psn);
2800e126ba97SEli Cohen 
2801e126ba97SEli Cohen 	if (attr_mask & IB_QP_QKEY)
2802e126ba97SEli Cohen 		context->qkey = cpu_to_be32(attr->qkey);
2803e126ba97SEli Cohen 
2804e126ba97SEli Cohen 	if (qp->rq.wqe_cnt && cur_state == IB_QPS_RESET && new_state == IB_QPS_INIT)
2805e126ba97SEli Cohen 		context->db_rec_addr = cpu_to_be64(qp->db.dma);
2806e126ba97SEli Cohen 
28070837e86aSMark Bloch 	if (cur_state == IB_QPS_RESET && new_state == IB_QPS_INIT) {
28080837e86aSMark Bloch 		u8 port_num = (attr_mask & IB_QP_PORT ? attr->port_num :
28090837e86aSMark Bloch 			       qp->port) - 1;
2810eb49ab0cSAlex Vesker 		mibport = &dev->port[port_num];
28110837e86aSMark Bloch 		context->qp_counter_set_usr_page |=
2812321a9e3eSAlex Vesker 			cpu_to_be32((u32)(mibport->q_cnt_id) << 24);
28130837e86aSMark Bloch 	}
28140837e86aSMark Bloch 
2815e126ba97SEli Cohen 	if (!ibqp->uobject && cur_state == IB_QPS_RESET && new_state == IB_QPS_INIT)
2816e126ba97SEli Cohen 		context->sq_crq_size |= cpu_to_be16(1 << 4);
2817e126ba97SEli Cohen 
2818b11a4f9cSHaggai Eran 	if (qp->flags & MLX5_IB_QP_SQPN_QP1)
2819b11a4f9cSHaggai Eran 		context->deth_sqpn = cpu_to_be32(1);
2820e126ba97SEli Cohen 
2821e126ba97SEli Cohen 	mlx5_cur = to_mlx5_state(cur_state);
2822e126ba97SEli Cohen 	mlx5_new = to_mlx5_state(new_state);
2823e126ba97SEli Cohen 	mlx5_st = to_mlx5_st(ibqp->qp_type);
282407c9113fSEli Cohen 	if (mlx5_st < 0)
2825e126ba97SEli Cohen 		goto out;
2826e126ba97SEli Cohen 
28276aec21f6SHaggai Eran 	/* If moving to a reset or error state, we must disable page faults on
28286aec21f6SHaggai Eran 	 * this QP and flush all current page faults. Otherwise a stale page
28296aec21f6SHaggai Eran 	 * fault may attempt to work on this QP after it is reset and moved
28306aec21f6SHaggai Eran 	 * again to RTS, and may cause the driver and the device to get out of
28316aec21f6SHaggai Eran 	 * sync. */
28326aec21f6SHaggai Eran 	if (cur_state != IB_QPS_RESET && cur_state != IB_QPS_ERR &&
2833ad5f8e96Smajd@mellanox.com 	    (new_state == IB_QPS_RESET || new_state == IB_QPS_ERR) &&
2834ad5f8e96Smajd@mellanox.com 	    (qp->ibqp.qp_type != IB_QPT_RAW_PACKET))
28356aec21f6SHaggai Eran 		mlx5_ib_qp_disable_pagefaults(qp);
28366aec21f6SHaggai Eran 
2837427c1e7bSmajd@mellanox.com 	if (mlx5_cur >= MLX5_QP_NUM_STATE || mlx5_new >= MLX5_QP_NUM_STATE ||
2838427c1e7bSmajd@mellanox.com 	    !optab[mlx5_cur][mlx5_new])
2839427c1e7bSmajd@mellanox.com 		goto out;
2840427c1e7bSmajd@mellanox.com 
2841427c1e7bSmajd@mellanox.com 	op = optab[mlx5_cur][mlx5_new];
2842e126ba97SEli Cohen 	optpar = ib_mask_to_mlx5_opt(attr_mask);
2843e126ba97SEli Cohen 	optpar &= opt_mask[mlx5_cur][mlx5_new][mlx5_st];
2844ad5f8e96Smajd@mellanox.com 
28450680efa2SAlex Vesker 	if (qp->ibqp.qp_type == IB_QPT_RAW_PACKET) {
28460680efa2SAlex Vesker 		struct mlx5_modify_raw_qp_param raw_qp_param = {};
28470680efa2SAlex Vesker 
28480680efa2SAlex Vesker 		raw_qp_param.operation = op;
2849eb49ab0cSAlex Vesker 		if (cur_state == IB_QPS_RESET && new_state == IB_QPS_INIT) {
2850eb49ab0cSAlex Vesker 			raw_qp_param.rq_q_ctr_id = mibport->q_cnt_id;
2851eb49ab0cSAlex Vesker 			raw_qp_param.set_mask |= MLX5_RAW_QP_MOD_SET_RQ_Q_CTR_ID;
2852eb49ab0cSAlex Vesker 		}
28537d29f349SBodong Wang 
28547d29f349SBodong Wang 		if (attr_mask & IB_QP_RATE_LIMIT) {
28557d29f349SBodong Wang 			raw_qp_param.rate_limit = attr->rate_limit;
28567d29f349SBodong Wang 			raw_qp_param.set_mask |= MLX5_RAW_QP_RATE_LIMIT;
28577d29f349SBodong Wang 		}
28587d29f349SBodong Wang 
285913eab21fSAviv Heller 		err = modify_raw_packet_qp(dev, qp, &raw_qp_param, tx_affinity);
28600680efa2SAlex Vesker 	} else {
28611a412fb1SSaeed Mahameed 		err = mlx5_core_qp_modify(dev->mdev, op, optpar, context,
286219098df2Smajd@mellanox.com 					  &base->mqp);
28630680efa2SAlex Vesker 	}
28640680efa2SAlex Vesker 
2865e126ba97SEli Cohen 	if (err)
2866e126ba97SEli Cohen 		goto out;
2867e126ba97SEli Cohen 
2868ad5f8e96Smajd@mellanox.com 	if (cur_state == IB_QPS_RESET && new_state == IB_QPS_INIT &&
2869ad5f8e96Smajd@mellanox.com 	    (qp->ibqp.qp_type != IB_QPT_RAW_PACKET))
28706aec21f6SHaggai Eran 		mlx5_ib_qp_enable_pagefaults(qp);
28716aec21f6SHaggai Eran 
2872e126ba97SEli Cohen 	qp->state = new_state;
2873e126ba97SEli Cohen 
2874e126ba97SEli Cohen 	if (attr_mask & IB_QP_ACCESS_FLAGS)
287519098df2Smajd@mellanox.com 		qp->trans_qp.atomic_rd_en = attr->qp_access_flags;
2876e126ba97SEli Cohen 	if (attr_mask & IB_QP_MAX_DEST_RD_ATOMIC)
287719098df2Smajd@mellanox.com 		qp->trans_qp.resp_depth = attr->max_dest_rd_atomic;
2878e126ba97SEli Cohen 	if (attr_mask & IB_QP_PORT)
2879e126ba97SEli Cohen 		qp->port = attr->port_num;
2880e126ba97SEli Cohen 	if (attr_mask & IB_QP_ALT_PATH)
288119098df2Smajd@mellanox.com 		qp->trans_qp.alt_port = attr->alt_port_num;
2882e126ba97SEli Cohen 
2883e126ba97SEli Cohen 	/*
2884e126ba97SEli Cohen 	 * If we moved a kernel QP to RESET, clean up all old CQ
2885e126ba97SEli Cohen 	 * entries and reinitialize the QP.
2886e126ba97SEli Cohen 	 */
2887e126ba97SEli Cohen 	if (new_state == IB_QPS_RESET && !ibqp->uobject) {
288819098df2Smajd@mellanox.com 		mlx5_ib_cq_clean(recv_cq, base->mqp.qpn,
2889e126ba97SEli Cohen 				 ibqp->srq ? to_msrq(ibqp->srq) : NULL);
2890e126ba97SEli Cohen 		if (send_cq != recv_cq)
289119098df2Smajd@mellanox.com 			mlx5_ib_cq_clean(send_cq, base->mqp.qpn, NULL);
2892e126ba97SEli Cohen 
2893e126ba97SEli Cohen 		qp->rq.head = 0;
2894e126ba97SEli Cohen 		qp->rq.tail = 0;
2895e126ba97SEli Cohen 		qp->sq.head = 0;
2896e126ba97SEli Cohen 		qp->sq.tail = 0;
2897e126ba97SEli Cohen 		qp->sq.cur_post = 0;
2898e126ba97SEli Cohen 		qp->sq.last_poll = 0;
2899e126ba97SEli Cohen 		qp->db.db[MLX5_RCV_DBR] = 0;
2900e126ba97SEli Cohen 		qp->db.db[MLX5_SND_DBR] = 0;
2901e126ba97SEli Cohen 	}
2902e126ba97SEli Cohen 
2903e126ba97SEli Cohen out:
29041a412fb1SSaeed Mahameed 	kfree(context);
2905e126ba97SEli Cohen 	return err;
2906e126ba97SEli Cohen }
2907e126ba97SEli Cohen 
2908e126ba97SEli Cohen int mlx5_ib_modify_qp(struct ib_qp *ibqp, struct ib_qp_attr *attr,
2909e126ba97SEli Cohen 		      int attr_mask, struct ib_udata *udata)
2910e126ba97SEli Cohen {
2911e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
2912e126ba97SEli Cohen 	struct mlx5_ib_qp *qp = to_mqp(ibqp);
2913d16e91daSHaggai Eran 	enum ib_qp_type qp_type;
2914e126ba97SEli Cohen 	enum ib_qp_state cur_state, new_state;
2915e126ba97SEli Cohen 	int err = -EINVAL;
2916e126ba97SEli Cohen 	int port;
29172811ba51SAchiad Shochat 	enum rdma_link_layer ll = IB_LINK_LAYER_UNSPECIFIED;
2918e126ba97SEli Cohen 
291928d61370SYishai Hadas 	if (ibqp->rwq_ind_tbl)
292028d61370SYishai Hadas 		return -ENOSYS;
292128d61370SYishai Hadas 
2922d16e91daSHaggai Eran 	if (unlikely(ibqp->qp_type == IB_QPT_GSI))
2923d16e91daSHaggai Eran 		return mlx5_ib_gsi_modify_qp(ibqp, attr, attr_mask);
2924d16e91daSHaggai Eran 
2925d16e91daSHaggai Eran 	qp_type = (unlikely(ibqp->qp_type == MLX5_IB_QPT_HW_GSI)) ?
2926d16e91daSHaggai Eran 		IB_QPT_GSI : ibqp->qp_type;
2927d16e91daSHaggai Eran 
2928e126ba97SEli Cohen 	mutex_lock(&qp->mutex);
2929e126ba97SEli Cohen 
2930e126ba97SEli Cohen 	cur_state = attr_mask & IB_QP_CUR_STATE ? attr->cur_qp_state : qp->state;
2931e126ba97SEli Cohen 	new_state = attr_mask & IB_QP_STATE ? attr->qp_state : cur_state;
2932e126ba97SEli Cohen 
29332811ba51SAchiad Shochat 	if (!(cur_state == new_state && cur_state == IB_QPS_RESET)) {
29342811ba51SAchiad Shochat 		port = attr_mask & IB_QP_PORT ? attr->port_num : qp->port;
29352811ba51SAchiad Shochat 		ll = dev->ib_dev.get_link_layer(&dev->ib_dev, port);
29362811ba51SAchiad Shochat 	}
29372811ba51SAchiad Shochat 
2938d16e91daSHaggai Eran 	if (qp_type != MLX5_IB_QPT_REG_UMR &&
2939d16e91daSHaggai Eran 	    !ib_modify_qp_is_ok(cur_state, new_state, qp_type, attr_mask, ll)) {
2940158abf86SHaggai Eran 		mlx5_ib_dbg(dev, "invalid QP state transition from %d to %d, qp_type %d, attr_mask 0x%x\n",
2941158abf86SHaggai Eran 			    cur_state, new_state, ibqp->qp_type, attr_mask);
2942e126ba97SEli Cohen 		goto out;
2943158abf86SHaggai Eran 	}
2944e126ba97SEli Cohen 
2945e126ba97SEli Cohen 	if ((attr_mask & IB_QP_PORT) &&
2946938fe83cSSaeed Mahameed 	    (attr->port_num == 0 ||
2947158abf86SHaggai Eran 	     attr->port_num > MLX5_CAP_GEN(dev->mdev, num_ports))) {
2948158abf86SHaggai Eran 		mlx5_ib_dbg(dev, "invalid port number %d. number of ports is %d\n",
2949158abf86SHaggai Eran 			    attr->port_num, dev->num_ports);
2950e126ba97SEli Cohen 		goto out;
2951158abf86SHaggai Eran 	}
2952e126ba97SEli Cohen 
2953e126ba97SEli Cohen 	if (attr_mask & IB_QP_PKEY_INDEX) {
2954e126ba97SEli Cohen 		port = attr_mask & IB_QP_PORT ? attr->port_num : qp->port;
2955938fe83cSSaeed Mahameed 		if (attr->pkey_index >=
2956158abf86SHaggai Eran 		    dev->mdev->port_caps[port - 1].pkey_table_len) {
2957158abf86SHaggai Eran 			mlx5_ib_dbg(dev, "invalid pkey index %d\n",
2958158abf86SHaggai Eran 				    attr->pkey_index);
2959e126ba97SEli Cohen 			goto out;
2960e126ba97SEli Cohen 		}
2961158abf86SHaggai Eran 	}
2962e126ba97SEli Cohen 
2963e126ba97SEli Cohen 	if (attr_mask & IB_QP_MAX_QP_RD_ATOMIC &&
2964938fe83cSSaeed Mahameed 	    attr->max_rd_atomic >
2965158abf86SHaggai Eran 	    (1 << MLX5_CAP_GEN(dev->mdev, log_max_ra_res_qp))) {
2966158abf86SHaggai Eran 		mlx5_ib_dbg(dev, "invalid max_rd_atomic value %d\n",
2967158abf86SHaggai Eran 			    attr->max_rd_atomic);
2968e126ba97SEli Cohen 		goto out;
2969158abf86SHaggai Eran 	}
2970e126ba97SEli Cohen 
2971e126ba97SEli Cohen 	if (attr_mask & IB_QP_MAX_DEST_RD_ATOMIC &&
2972938fe83cSSaeed Mahameed 	    attr->max_dest_rd_atomic >
2973158abf86SHaggai Eran 	    (1 << MLX5_CAP_GEN(dev->mdev, log_max_ra_req_qp))) {
2974158abf86SHaggai Eran 		mlx5_ib_dbg(dev, "invalid max_dest_rd_atomic value %d\n",
2975158abf86SHaggai Eran 			    attr->max_dest_rd_atomic);
2976e126ba97SEli Cohen 		goto out;
2977158abf86SHaggai Eran 	}
2978e126ba97SEli Cohen 
2979e126ba97SEli Cohen 	if (cur_state == new_state && cur_state == IB_QPS_RESET) {
2980e126ba97SEli Cohen 		err = 0;
2981e126ba97SEli Cohen 		goto out;
2982e126ba97SEli Cohen 	}
2983e126ba97SEli Cohen 
2984e126ba97SEli Cohen 	err = __mlx5_ib_modify_qp(ibqp, attr, attr_mask, cur_state, new_state);
2985e126ba97SEli Cohen 
2986e126ba97SEli Cohen out:
2987e126ba97SEli Cohen 	mutex_unlock(&qp->mutex);
2988e126ba97SEli Cohen 	return err;
2989e126ba97SEli Cohen }
2990e126ba97SEli Cohen 
2991e126ba97SEli Cohen static int mlx5_wq_overflow(struct mlx5_ib_wq *wq, int nreq, struct ib_cq *ib_cq)
2992e126ba97SEli Cohen {
2993e126ba97SEli Cohen 	struct mlx5_ib_cq *cq;
2994e126ba97SEli Cohen 	unsigned cur;
2995e126ba97SEli Cohen 
2996e126ba97SEli Cohen 	cur = wq->head - wq->tail;
2997e126ba97SEli Cohen 	if (likely(cur + nreq < wq->max_post))
2998e126ba97SEli Cohen 		return 0;
2999e126ba97SEli Cohen 
3000e126ba97SEli Cohen 	cq = to_mcq(ib_cq);
3001e126ba97SEli Cohen 	spin_lock(&cq->lock);
3002e126ba97SEli Cohen 	cur = wq->head - wq->tail;
3003e126ba97SEli Cohen 	spin_unlock(&cq->lock);
3004e126ba97SEli Cohen 
3005e126ba97SEli Cohen 	return cur + nreq >= wq->max_post;
3006e126ba97SEli Cohen }
3007e126ba97SEli Cohen 
3008e126ba97SEli Cohen static __always_inline void set_raddr_seg(struct mlx5_wqe_raddr_seg *rseg,
3009e126ba97SEli Cohen 					  u64 remote_addr, u32 rkey)
3010e126ba97SEli Cohen {
3011e126ba97SEli Cohen 	rseg->raddr    = cpu_to_be64(remote_addr);
3012e126ba97SEli Cohen 	rseg->rkey     = cpu_to_be32(rkey);
3013e126ba97SEli Cohen 	rseg->reserved = 0;
3014e126ba97SEli Cohen }
3015e126ba97SEli Cohen 
3016f0313965SErez Shitrit static void *set_eth_seg(struct mlx5_wqe_eth_seg *eseg,
3017f0313965SErez Shitrit 			 struct ib_send_wr *wr, void *qend,
3018f0313965SErez Shitrit 			 struct mlx5_ib_qp *qp, int *size)
3019f0313965SErez Shitrit {
3020f0313965SErez Shitrit 	void *seg = eseg;
3021f0313965SErez Shitrit 
3022f0313965SErez Shitrit 	memset(eseg, 0, sizeof(struct mlx5_wqe_eth_seg));
3023f0313965SErez Shitrit 
3024f0313965SErez Shitrit 	if (wr->send_flags & IB_SEND_IP_CSUM)
3025f0313965SErez Shitrit 		eseg->cs_flags = MLX5_ETH_WQE_L3_CSUM |
3026f0313965SErez Shitrit 				 MLX5_ETH_WQE_L4_CSUM;
3027f0313965SErez Shitrit 
3028f0313965SErez Shitrit 	seg += sizeof(struct mlx5_wqe_eth_seg);
3029f0313965SErez Shitrit 	*size += sizeof(struct mlx5_wqe_eth_seg) / 16;
3030f0313965SErez Shitrit 
3031f0313965SErez Shitrit 	if (wr->opcode == IB_WR_LSO) {
3032f0313965SErez Shitrit 		struct ib_ud_wr *ud_wr = container_of(wr, struct ib_ud_wr, wr);
3033f0313965SErez Shitrit 		int size_of_inl_hdr_start = sizeof(eseg->inline_hdr_start);
3034f0313965SErez Shitrit 		u64 left, leftlen, copysz;
3035f0313965SErez Shitrit 		void *pdata = ud_wr->header;
3036f0313965SErez Shitrit 
3037f0313965SErez Shitrit 		left = ud_wr->hlen;
3038f0313965SErez Shitrit 		eseg->mss = cpu_to_be16(ud_wr->mss);
3039f0313965SErez Shitrit 		eseg->inline_hdr_sz = cpu_to_be16(left);
3040f0313965SErez Shitrit 
3041f0313965SErez Shitrit 		/*
3042f0313965SErez Shitrit 		 * check if there is space till the end of queue, if yes,
3043f0313965SErez Shitrit 		 * copy all in one shot, otherwise copy till the end of queue,
3044f0313965SErez Shitrit 		 * rollback and than the copy the left
3045f0313965SErez Shitrit 		 */
3046f0313965SErez Shitrit 		leftlen = qend - (void *)eseg->inline_hdr_start;
3047f0313965SErez Shitrit 		copysz = min_t(u64, leftlen, left);
3048f0313965SErez Shitrit 
3049f0313965SErez Shitrit 		memcpy(seg - size_of_inl_hdr_start, pdata, copysz);
3050f0313965SErez Shitrit 
3051f0313965SErez Shitrit 		if (likely(copysz > size_of_inl_hdr_start)) {
3052f0313965SErez Shitrit 			seg += ALIGN(copysz - size_of_inl_hdr_start, 16);
3053f0313965SErez Shitrit 			*size += ALIGN(copysz - size_of_inl_hdr_start, 16) / 16;
3054f0313965SErez Shitrit 		}
3055f0313965SErez Shitrit 
3056f0313965SErez Shitrit 		if (unlikely(copysz < left)) { /* the last wqe in the queue */
3057f0313965SErez Shitrit 			seg = mlx5_get_send_wqe(qp, 0);
3058f0313965SErez Shitrit 			left -= copysz;
3059f0313965SErez Shitrit 			pdata += copysz;
3060f0313965SErez Shitrit 			memcpy(seg, pdata, left);
3061f0313965SErez Shitrit 			seg += ALIGN(left, 16);
3062f0313965SErez Shitrit 			*size += ALIGN(left, 16) / 16;
3063f0313965SErez Shitrit 		}
3064f0313965SErez Shitrit 	}
3065f0313965SErez Shitrit 
3066f0313965SErez Shitrit 	return seg;
3067f0313965SErez Shitrit }
3068f0313965SErez Shitrit 
3069e126ba97SEli Cohen static void set_datagram_seg(struct mlx5_wqe_datagram_seg *dseg,
3070e126ba97SEli Cohen 			     struct ib_send_wr *wr)
3071e126ba97SEli Cohen {
3072e622f2f4SChristoph Hellwig 	memcpy(&dseg->av, &to_mah(ud_wr(wr)->ah)->av, sizeof(struct mlx5_av));
3073e622f2f4SChristoph Hellwig 	dseg->av.dqp_dct = cpu_to_be32(ud_wr(wr)->remote_qpn | MLX5_EXTENDED_UD_AV);
3074e622f2f4SChristoph Hellwig 	dseg->av.key.qkey.qkey = cpu_to_be32(ud_wr(wr)->remote_qkey);
3075e126ba97SEli Cohen }
3076e126ba97SEli Cohen 
3077e126ba97SEli Cohen static void set_data_ptr_seg(struct mlx5_wqe_data_seg *dseg, struct ib_sge *sg)
3078e126ba97SEli Cohen {
3079e126ba97SEli Cohen 	dseg->byte_count = cpu_to_be32(sg->length);
3080e126ba97SEli Cohen 	dseg->lkey       = cpu_to_be32(sg->lkey);
3081e126ba97SEli Cohen 	dseg->addr       = cpu_to_be64(sg->addr);
3082e126ba97SEli Cohen }
3083e126ba97SEli Cohen 
3084e126ba97SEli Cohen static __be16 get_klm_octo(int npages)
3085e126ba97SEli Cohen {
3086e126ba97SEli Cohen 	return cpu_to_be16(ALIGN(npages, 8) / 2);
3087e126ba97SEli Cohen }
3088e126ba97SEli Cohen 
3089e126ba97SEli Cohen static __be64 frwr_mkey_mask(void)
3090e126ba97SEli Cohen {
3091e126ba97SEli Cohen 	u64 result;
3092e126ba97SEli Cohen 
3093e126ba97SEli Cohen 	result = MLX5_MKEY_MASK_LEN		|
3094e126ba97SEli Cohen 		MLX5_MKEY_MASK_PAGE_SIZE	|
3095e126ba97SEli Cohen 		MLX5_MKEY_MASK_START_ADDR	|
3096e126ba97SEli Cohen 		MLX5_MKEY_MASK_EN_RINVAL	|
3097e126ba97SEli Cohen 		MLX5_MKEY_MASK_KEY		|
3098e126ba97SEli Cohen 		MLX5_MKEY_MASK_LR		|
3099e126ba97SEli Cohen 		MLX5_MKEY_MASK_LW		|
3100e126ba97SEli Cohen 		MLX5_MKEY_MASK_RR		|
3101e126ba97SEli Cohen 		MLX5_MKEY_MASK_RW		|
3102e126ba97SEli Cohen 		MLX5_MKEY_MASK_A		|
3103e126ba97SEli Cohen 		MLX5_MKEY_MASK_SMALL_FENCE	|
3104e126ba97SEli Cohen 		MLX5_MKEY_MASK_FREE;
3105e126ba97SEli Cohen 
3106e126ba97SEli Cohen 	return cpu_to_be64(result);
3107e126ba97SEli Cohen }
3108e126ba97SEli Cohen 
3109e6631814SSagi Grimberg static __be64 sig_mkey_mask(void)
3110e6631814SSagi Grimberg {
3111e6631814SSagi Grimberg 	u64 result;
3112e6631814SSagi Grimberg 
3113e6631814SSagi Grimberg 	result = MLX5_MKEY_MASK_LEN		|
3114e6631814SSagi Grimberg 		MLX5_MKEY_MASK_PAGE_SIZE	|
3115e6631814SSagi Grimberg 		MLX5_MKEY_MASK_START_ADDR	|
3116d5436ba0SSagi Grimberg 		MLX5_MKEY_MASK_EN_SIGERR	|
3117e6631814SSagi Grimberg 		MLX5_MKEY_MASK_EN_RINVAL	|
3118e6631814SSagi Grimberg 		MLX5_MKEY_MASK_KEY		|
3119e6631814SSagi Grimberg 		MLX5_MKEY_MASK_LR		|
3120e6631814SSagi Grimberg 		MLX5_MKEY_MASK_LW		|
3121e6631814SSagi Grimberg 		MLX5_MKEY_MASK_RR		|
3122e6631814SSagi Grimberg 		MLX5_MKEY_MASK_RW		|
3123e6631814SSagi Grimberg 		MLX5_MKEY_MASK_SMALL_FENCE	|
3124e6631814SSagi Grimberg 		MLX5_MKEY_MASK_FREE		|
3125e6631814SSagi Grimberg 		MLX5_MKEY_MASK_BSF_EN;
3126e6631814SSagi Grimberg 
3127e6631814SSagi Grimberg 	return cpu_to_be64(result);
3128e6631814SSagi Grimberg }
3129e6631814SSagi Grimberg 
31308a187ee5SSagi Grimberg static void set_reg_umr_seg(struct mlx5_wqe_umr_ctrl_seg *umr,
31318a187ee5SSagi Grimberg 				struct mlx5_ib_mr *mr)
31328a187ee5SSagi Grimberg {
31338a187ee5SSagi Grimberg 	int ndescs = mr->ndescs;
31348a187ee5SSagi Grimberg 
31358a187ee5SSagi Grimberg 	memset(umr, 0, sizeof(*umr));
3136b005d316SSagi Grimberg 
3137ec22eb53SSaeed Mahameed 	if (mr->access_mode == MLX5_MKC_ACCESS_MODE_KLMS)
3138b005d316SSagi Grimberg 		/* KLMs take twice the size of MTTs */
3139b005d316SSagi Grimberg 		ndescs *= 2;
3140b005d316SSagi Grimberg 
31418a187ee5SSagi Grimberg 	umr->flags = MLX5_UMR_CHECK_NOT_FREE;
31428a187ee5SSagi Grimberg 	umr->klm_octowords = get_klm_octo(ndescs);
31438a187ee5SSagi Grimberg 	umr->mkey_mask = frwr_mkey_mask();
31448a187ee5SSagi Grimberg }
31458a187ee5SSagi Grimberg 
3146dd01e66aSSagi Grimberg static void set_linv_umr_seg(struct mlx5_wqe_umr_ctrl_seg *umr)
3147e126ba97SEli Cohen {
3148e126ba97SEli Cohen 	memset(umr, 0, sizeof(*umr));
3149e126ba97SEli Cohen 	umr->mkey_mask = cpu_to_be64(MLX5_MKEY_MASK_FREE);
31502d221588SMax Gurtovoy 	umr->flags = MLX5_UMR_INLINE;
3151e126ba97SEli Cohen }
3152e126ba97SEli Cohen 
3153578e7264SMaor Gottlieb static __be64 get_umr_reg_mr_mask(int atomic)
3154e126ba97SEli Cohen {
3155968e78ddSHaggai Eran 	u64 result;
3156e126ba97SEli Cohen 
3157968e78ddSHaggai Eran 	result = MLX5_MKEY_MASK_LEN		|
3158e126ba97SEli Cohen 		 MLX5_MKEY_MASK_PAGE_SIZE	|
3159e126ba97SEli Cohen 		 MLX5_MKEY_MASK_START_ADDR	|
3160e126ba97SEli Cohen 		 MLX5_MKEY_MASK_PD		|
3161e126ba97SEli Cohen 		 MLX5_MKEY_MASK_LR		|
3162e126ba97SEli Cohen 		 MLX5_MKEY_MASK_LW		|
3163746b5583SEli Cohen 		 MLX5_MKEY_MASK_KEY		|
3164e126ba97SEli Cohen 		 MLX5_MKEY_MASK_RR		|
3165e126ba97SEli Cohen 		 MLX5_MKEY_MASK_RW		|
3166e126ba97SEli Cohen 		 MLX5_MKEY_MASK_FREE;
3167968e78ddSHaggai Eran 
3168578e7264SMaor Gottlieb 	if (atomic)
3169578e7264SMaor Gottlieb 		result |= MLX5_MKEY_MASK_A;
3170578e7264SMaor Gottlieb 
3171968e78ddSHaggai Eran 	return cpu_to_be64(result);
3172968e78ddSHaggai Eran }
3173968e78ddSHaggai Eran 
3174968e78ddSHaggai Eran static __be64 get_umr_unreg_mr_mask(void)
3175968e78ddSHaggai Eran {
3176968e78ddSHaggai Eran 	u64 result;
3177968e78ddSHaggai Eran 
3178968e78ddSHaggai Eran 	result = MLX5_MKEY_MASK_FREE;
3179968e78ddSHaggai Eran 
3180968e78ddSHaggai Eran 	return cpu_to_be64(result);
3181968e78ddSHaggai Eran }
3182968e78ddSHaggai Eran 
3183968e78ddSHaggai Eran static __be64 get_umr_update_mtt_mask(void)
3184968e78ddSHaggai Eran {
3185968e78ddSHaggai Eran 	u64 result;
3186968e78ddSHaggai Eran 
3187968e78ddSHaggai Eran 	result = MLX5_MKEY_MASK_FREE;
3188968e78ddSHaggai Eran 
3189968e78ddSHaggai Eran 	return cpu_to_be64(result);
3190968e78ddSHaggai Eran }
3191968e78ddSHaggai Eran 
319256e11d62SNoa Osherovich static __be64 get_umr_update_translation_mask(void)
319356e11d62SNoa Osherovich {
319456e11d62SNoa Osherovich 	u64 result;
319556e11d62SNoa Osherovich 
319656e11d62SNoa Osherovich 	result = MLX5_MKEY_MASK_LEN |
319756e11d62SNoa Osherovich 		 MLX5_MKEY_MASK_PAGE_SIZE |
319856e11d62SNoa Osherovich 		 MLX5_MKEY_MASK_START_ADDR |
319956e11d62SNoa Osherovich 		 MLX5_MKEY_MASK_KEY |
320056e11d62SNoa Osherovich 		 MLX5_MKEY_MASK_FREE;
320156e11d62SNoa Osherovich 
320256e11d62SNoa Osherovich 	return cpu_to_be64(result);
320356e11d62SNoa Osherovich }
320456e11d62SNoa Osherovich 
320556e11d62SNoa Osherovich static __be64 get_umr_update_access_mask(void)
320656e11d62SNoa Osherovich {
320756e11d62SNoa Osherovich 	u64 result;
320856e11d62SNoa Osherovich 
320956e11d62SNoa Osherovich 	result = MLX5_MKEY_MASK_LW |
321056e11d62SNoa Osherovich 		 MLX5_MKEY_MASK_RR |
321156e11d62SNoa Osherovich 		 MLX5_MKEY_MASK_RW |
321256e11d62SNoa Osherovich 		 MLX5_MKEY_MASK_A |
321356e11d62SNoa Osherovich 		 MLX5_MKEY_MASK_KEY |
321456e11d62SNoa Osherovich 		 MLX5_MKEY_MASK_FREE;
321556e11d62SNoa Osherovich 
321656e11d62SNoa Osherovich 	return cpu_to_be64(result);
321756e11d62SNoa Osherovich }
321856e11d62SNoa Osherovich 
321956e11d62SNoa Osherovich static __be64 get_umr_update_pd_mask(void)
322056e11d62SNoa Osherovich {
322156e11d62SNoa Osherovich 	u64 result;
322256e11d62SNoa Osherovich 
322356e11d62SNoa Osherovich 	result = MLX5_MKEY_MASK_PD |
322456e11d62SNoa Osherovich 		 MLX5_MKEY_MASK_KEY |
322556e11d62SNoa Osherovich 		 MLX5_MKEY_MASK_FREE;
322656e11d62SNoa Osherovich 
322756e11d62SNoa Osherovich 	return cpu_to_be64(result);
322856e11d62SNoa Osherovich }
322956e11d62SNoa Osherovich 
3230968e78ddSHaggai Eran static void set_reg_umr_segment(struct mlx5_wqe_umr_ctrl_seg *umr,
3231578e7264SMaor Gottlieb 				struct ib_send_wr *wr, int atomic)
3232968e78ddSHaggai Eran {
3233e622f2f4SChristoph Hellwig 	struct mlx5_umr_wr *umrwr = umr_wr(wr);
3234968e78ddSHaggai Eran 
3235968e78ddSHaggai Eran 	memset(umr, 0, sizeof(*umr));
3236968e78ddSHaggai Eran 
3237968e78ddSHaggai Eran 	if (wr->send_flags & MLX5_IB_SEND_UMR_FAIL_IF_FREE)
3238968e78ddSHaggai Eran 		umr->flags = MLX5_UMR_CHECK_FREE; /* fail if free */
3239968e78ddSHaggai Eran 	else
3240968e78ddSHaggai Eran 		umr->flags = MLX5_UMR_CHECK_NOT_FREE; /* fail if not free */
3241968e78ddSHaggai Eran 
3242968e78ddSHaggai Eran 	if (!(wr->send_flags & MLX5_IB_SEND_UMR_UNREG)) {
3243968e78ddSHaggai Eran 		umr->klm_octowords = get_klm_octo(umrwr->npages);
3244968e78ddSHaggai Eran 		if (wr->send_flags & MLX5_IB_SEND_UMR_UPDATE_MTT) {
3245968e78ddSHaggai Eran 			umr->mkey_mask = get_umr_update_mtt_mask();
3246968e78ddSHaggai Eran 			umr->bsf_octowords = get_klm_octo(umrwr->target.offset);
3247968e78ddSHaggai Eran 			umr->flags |= MLX5_UMR_TRANSLATION_OFFSET_EN;
3248968e78ddSHaggai Eran 		}
324956e11d62SNoa Osherovich 		if (wr->send_flags & MLX5_IB_SEND_UMR_UPDATE_TRANSLATION)
325056e11d62SNoa Osherovich 			umr->mkey_mask |= get_umr_update_translation_mask();
325156e11d62SNoa Osherovich 		if (wr->send_flags & MLX5_IB_SEND_UMR_UPDATE_ACCESS)
325256e11d62SNoa Osherovich 			umr->mkey_mask |= get_umr_update_access_mask();
325356e11d62SNoa Osherovich 		if (wr->send_flags & MLX5_IB_SEND_UMR_UPDATE_PD)
325456e11d62SNoa Osherovich 			umr->mkey_mask |= get_umr_update_pd_mask();
325556e11d62SNoa Osherovich 		if (!umr->mkey_mask)
3256578e7264SMaor Gottlieb 			umr->mkey_mask = get_umr_reg_mr_mask(atomic);
3257968e78ddSHaggai Eran 	} else {
3258968e78ddSHaggai Eran 		umr->mkey_mask = get_umr_unreg_mr_mask();
3259e126ba97SEli Cohen 	}
3260e126ba97SEli Cohen 
3261e126ba97SEli Cohen 	if (!wr->num_sge)
3262968e78ddSHaggai Eran 		umr->flags |= MLX5_UMR_INLINE;
3263e126ba97SEli Cohen }
3264e126ba97SEli Cohen 
3265e126ba97SEli Cohen static u8 get_umr_flags(int acc)
3266e126ba97SEli Cohen {
3267e126ba97SEli Cohen 	return (acc & IB_ACCESS_REMOTE_ATOMIC ? MLX5_PERM_ATOMIC       : 0) |
3268e126ba97SEli Cohen 	       (acc & IB_ACCESS_REMOTE_WRITE  ? MLX5_PERM_REMOTE_WRITE : 0) |
3269e126ba97SEli Cohen 	       (acc & IB_ACCESS_REMOTE_READ   ? MLX5_PERM_REMOTE_READ  : 0) |
3270e126ba97SEli Cohen 	       (acc & IB_ACCESS_LOCAL_WRITE   ? MLX5_PERM_LOCAL_WRITE  : 0) |
32712ac45934SSagi Grimberg 		MLX5_PERM_LOCAL_READ | MLX5_PERM_UMR_EN;
3272e126ba97SEli Cohen }
3273e126ba97SEli Cohen 
32748a187ee5SSagi Grimberg static void set_reg_mkey_seg(struct mlx5_mkey_seg *seg,
32758a187ee5SSagi Grimberg 			     struct mlx5_ib_mr *mr,
32768a187ee5SSagi Grimberg 			     u32 key, int access)
32778a187ee5SSagi Grimberg {
32788a187ee5SSagi Grimberg 	int ndescs = ALIGN(mr->ndescs, 8) >> 1;
32798a187ee5SSagi Grimberg 
32808a187ee5SSagi Grimberg 	memset(seg, 0, sizeof(*seg));
3281b005d316SSagi Grimberg 
3282ec22eb53SSaeed Mahameed 	if (mr->access_mode == MLX5_MKC_ACCESS_MODE_MTT)
3283b005d316SSagi Grimberg 		seg->log2_page_size = ilog2(mr->ibmr.page_size);
3284ec22eb53SSaeed Mahameed 	else if (mr->access_mode == MLX5_MKC_ACCESS_MODE_KLMS)
3285b005d316SSagi Grimberg 		/* KLMs take twice the size of MTTs */
3286b005d316SSagi Grimberg 		ndescs *= 2;
3287b005d316SSagi Grimberg 
3288b005d316SSagi Grimberg 	seg->flags = get_umr_flags(access) | mr->access_mode;
32898a187ee5SSagi Grimberg 	seg->qpn_mkey7_0 = cpu_to_be32((key & 0xff) | 0xffffff00);
32908a187ee5SSagi Grimberg 	seg->flags_pd = cpu_to_be32(MLX5_MKEY_REMOTE_INVAL);
32918a187ee5SSagi Grimberg 	seg->start_addr = cpu_to_be64(mr->ibmr.iova);
32928a187ee5SSagi Grimberg 	seg->len = cpu_to_be64(mr->ibmr.length);
32938a187ee5SSagi Grimberg 	seg->xlt_oct_size = cpu_to_be32(ndescs);
32948a187ee5SSagi Grimberg }
32958a187ee5SSagi Grimberg 
3296dd01e66aSSagi Grimberg static void set_linv_mkey_seg(struct mlx5_mkey_seg *seg)
3297e126ba97SEli Cohen {
3298e126ba97SEli Cohen 	memset(seg, 0, sizeof(*seg));
3299968e78ddSHaggai Eran 	seg->status = MLX5_MKEY_STATUS_FREE;
3300e126ba97SEli Cohen }
3301e126ba97SEli Cohen 
3302e126ba97SEli Cohen static void set_reg_mkey_segment(struct mlx5_mkey_seg *seg, struct ib_send_wr *wr)
3303e126ba97SEli Cohen {
3304e622f2f4SChristoph Hellwig 	struct mlx5_umr_wr *umrwr = umr_wr(wr);
3305968e78ddSHaggai Eran 
3306e126ba97SEli Cohen 	memset(seg, 0, sizeof(*seg));
3307e126ba97SEli Cohen 	if (wr->send_flags & MLX5_IB_SEND_UMR_UNREG) {
3308968e78ddSHaggai Eran 		seg->status = MLX5_MKEY_STATUS_FREE;
3309e126ba97SEli Cohen 		return;
3310e126ba97SEli Cohen 	}
3311e126ba97SEli Cohen 
3312968e78ddSHaggai Eran 	seg->flags = convert_access(umrwr->access_flags);
3313968e78ddSHaggai Eran 	if (!(wr->send_flags & MLX5_IB_SEND_UMR_UPDATE_MTT)) {
331456e11d62SNoa Osherovich 		if (umrwr->pd)
3315968e78ddSHaggai Eran 			seg->flags_pd = cpu_to_be32(to_mpd(umrwr->pd)->pdn);
3316968e78ddSHaggai Eran 		seg->start_addr = cpu_to_be64(umrwr->target.virt_addr);
3317968e78ddSHaggai Eran 	}
3318968e78ddSHaggai Eran 	seg->len = cpu_to_be64(umrwr->length);
3319968e78ddSHaggai Eran 	seg->log2_page_size = umrwr->page_shift;
3320746b5583SEli Cohen 	seg->qpn_mkey7_0 = cpu_to_be32(0xffffff00 |
3321968e78ddSHaggai Eran 				       mlx5_mkey_variant(umrwr->mkey));
3322e126ba97SEli Cohen }
3323e126ba97SEli Cohen 
33248a187ee5SSagi Grimberg static void set_reg_data_seg(struct mlx5_wqe_data_seg *dseg,
33258a187ee5SSagi Grimberg 			     struct mlx5_ib_mr *mr,
33268a187ee5SSagi Grimberg 			     struct mlx5_ib_pd *pd)
33278a187ee5SSagi Grimberg {
33288a187ee5SSagi Grimberg 	int bcount = mr->desc_size * mr->ndescs;
33298a187ee5SSagi Grimberg 
33308a187ee5SSagi Grimberg 	dseg->addr = cpu_to_be64(mr->desc_map);
33318a187ee5SSagi Grimberg 	dseg->byte_count = cpu_to_be32(ALIGN(bcount, 64));
33328a187ee5SSagi Grimberg 	dseg->lkey = cpu_to_be32(pd->ibpd.local_dma_lkey);
33338a187ee5SSagi Grimberg }
33348a187ee5SSagi Grimberg 
3335e126ba97SEli Cohen static __be32 send_ieth(struct ib_send_wr *wr)
3336e126ba97SEli Cohen {
3337e126ba97SEli Cohen 	switch (wr->opcode) {
3338e126ba97SEli Cohen 	case IB_WR_SEND_WITH_IMM:
3339e126ba97SEli Cohen 	case IB_WR_RDMA_WRITE_WITH_IMM:
3340e126ba97SEli Cohen 		return wr->ex.imm_data;
3341e126ba97SEli Cohen 
3342e126ba97SEli Cohen 	case IB_WR_SEND_WITH_INV:
3343e126ba97SEli Cohen 		return cpu_to_be32(wr->ex.invalidate_rkey);
3344e126ba97SEli Cohen 
3345e126ba97SEli Cohen 	default:
3346e126ba97SEli Cohen 		return 0;
3347e126ba97SEli Cohen 	}
3348e126ba97SEli Cohen }
3349e126ba97SEli Cohen 
3350e126ba97SEli Cohen static u8 calc_sig(void *wqe, int size)
3351e126ba97SEli Cohen {
3352e126ba97SEli Cohen 	u8 *p = wqe;
3353e126ba97SEli Cohen 	u8 res = 0;
3354e126ba97SEli Cohen 	int i;
3355e126ba97SEli Cohen 
3356e126ba97SEli Cohen 	for (i = 0; i < size; i++)
3357e126ba97SEli Cohen 		res ^= p[i];
3358e126ba97SEli Cohen 
3359e126ba97SEli Cohen 	return ~res;
3360e126ba97SEli Cohen }
3361e126ba97SEli Cohen 
3362e126ba97SEli Cohen static u8 wq_sig(void *wqe)
3363e126ba97SEli Cohen {
3364e126ba97SEli Cohen 	return calc_sig(wqe, (*((u8 *)wqe + 8) & 0x3f) << 4);
3365e126ba97SEli Cohen }
3366e126ba97SEli Cohen 
3367e126ba97SEli Cohen static int set_data_inl_seg(struct mlx5_ib_qp *qp, struct ib_send_wr *wr,
3368e126ba97SEli Cohen 			    void *wqe, int *sz)
3369e126ba97SEli Cohen {
3370e126ba97SEli Cohen 	struct mlx5_wqe_inline_seg *seg;
3371e126ba97SEli Cohen 	void *qend = qp->sq.qend;
3372e126ba97SEli Cohen 	void *addr;
3373e126ba97SEli Cohen 	int inl = 0;
3374e126ba97SEli Cohen 	int copy;
3375e126ba97SEli Cohen 	int len;
3376e126ba97SEli Cohen 	int i;
3377e126ba97SEli Cohen 
3378e126ba97SEli Cohen 	seg = wqe;
3379e126ba97SEli Cohen 	wqe += sizeof(*seg);
3380e126ba97SEli Cohen 	for (i = 0; i < wr->num_sge; i++) {
3381e126ba97SEli Cohen 		addr = (void *)(unsigned long)(wr->sg_list[i].addr);
3382e126ba97SEli Cohen 		len  = wr->sg_list[i].length;
3383e126ba97SEli Cohen 		inl += len;
3384e126ba97SEli Cohen 
3385e126ba97SEli Cohen 		if (unlikely(inl > qp->max_inline_data))
3386e126ba97SEli Cohen 			return -ENOMEM;
3387e126ba97SEli Cohen 
3388e126ba97SEli Cohen 		if (unlikely(wqe + len > qend)) {
3389e126ba97SEli Cohen 			copy = qend - wqe;
3390e126ba97SEli Cohen 			memcpy(wqe, addr, copy);
3391e126ba97SEli Cohen 			addr += copy;
3392e126ba97SEli Cohen 			len -= copy;
3393e126ba97SEli Cohen 			wqe = mlx5_get_send_wqe(qp, 0);
3394e126ba97SEli Cohen 		}
3395e126ba97SEli Cohen 		memcpy(wqe, addr, len);
3396e126ba97SEli Cohen 		wqe += len;
3397e126ba97SEli Cohen 	}
3398e126ba97SEli Cohen 
3399e126ba97SEli Cohen 	seg->byte_count = cpu_to_be32(inl | MLX5_INLINE_SEG);
3400e126ba97SEli Cohen 
3401e126ba97SEli Cohen 	*sz = ALIGN(inl + sizeof(seg->byte_count), 16) / 16;
3402e126ba97SEli Cohen 
3403e126ba97SEli Cohen 	return 0;
3404e126ba97SEli Cohen }
3405e126ba97SEli Cohen 
3406e6631814SSagi Grimberg static u16 prot_field_size(enum ib_signature_type type)
3407e6631814SSagi Grimberg {
3408e6631814SSagi Grimberg 	switch (type) {
3409e6631814SSagi Grimberg 	case IB_SIG_TYPE_T10_DIF:
3410e6631814SSagi Grimberg 		return MLX5_DIF_SIZE;
3411e6631814SSagi Grimberg 	default:
3412e6631814SSagi Grimberg 		return 0;
3413e6631814SSagi Grimberg 	}
3414e6631814SSagi Grimberg }
3415e6631814SSagi Grimberg 
3416e6631814SSagi Grimberg static u8 bs_selector(int block_size)
3417e6631814SSagi Grimberg {
3418e6631814SSagi Grimberg 	switch (block_size) {
3419e6631814SSagi Grimberg 	case 512:	    return 0x1;
3420e6631814SSagi Grimberg 	case 520:	    return 0x2;
3421e6631814SSagi Grimberg 	case 4096:	    return 0x3;
3422e6631814SSagi Grimberg 	case 4160:	    return 0x4;
3423e6631814SSagi Grimberg 	case 1073741824:    return 0x5;
3424e6631814SSagi Grimberg 	default:	    return 0;
3425e6631814SSagi Grimberg 	}
3426e6631814SSagi Grimberg }
3427e6631814SSagi Grimberg 
342878eda2bbSSagi Grimberg static void mlx5_fill_inl_bsf(struct ib_sig_domain *domain,
3429142537f4SSagi Grimberg 			      struct mlx5_bsf_inl *inl)
3430e6631814SSagi Grimberg {
3431142537f4SSagi Grimberg 	/* Valid inline section and allow BSF refresh */
3432142537f4SSagi Grimberg 	inl->vld_refresh = cpu_to_be16(MLX5_BSF_INL_VALID |
3433142537f4SSagi Grimberg 				       MLX5_BSF_REFRESH_DIF);
3434142537f4SSagi Grimberg 	inl->dif_apptag = cpu_to_be16(domain->sig.dif.app_tag);
3435142537f4SSagi Grimberg 	inl->dif_reftag = cpu_to_be32(domain->sig.dif.ref_tag);
3436142537f4SSagi Grimberg 	/* repeating block */
3437142537f4SSagi Grimberg 	inl->rp_inv_seed = MLX5_BSF_REPEAT_BLOCK;
3438142537f4SSagi Grimberg 	inl->sig_type = domain->sig.dif.bg_type == IB_T10DIF_CRC ?
3439142537f4SSagi Grimberg 			MLX5_DIF_CRC : MLX5_DIF_IPCS;
3440e6631814SSagi Grimberg 
344178eda2bbSSagi Grimberg 	if (domain->sig.dif.ref_remap)
344278eda2bbSSagi Grimberg 		inl->dif_inc_ref_guard_check |= MLX5_BSF_INC_REFTAG;
3443e6631814SSagi Grimberg 
344478eda2bbSSagi Grimberg 	if (domain->sig.dif.app_escape) {
344578eda2bbSSagi Grimberg 		if (domain->sig.dif.ref_escape)
344678eda2bbSSagi Grimberg 			inl->dif_inc_ref_guard_check |= MLX5_BSF_APPREF_ESCAPE;
344778eda2bbSSagi Grimberg 		else
344878eda2bbSSagi Grimberg 			inl->dif_inc_ref_guard_check |= MLX5_BSF_APPTAG_ESCAPE;
3449e6631814SSagi Grimberg 	}
3450e6631814SSagi Grimberg 
345178eda2bbSSagi Grimberg 	inl->dif_app_bitmask_check =
345278eda2bbSSagi Grimberg 		cpu_to_be16(domain->sig.dif.apptag_check_mask);
3453e6631814SSagi Grimberg }
3454e6631814SSagi Grimberg 
3455e6631814SSagi Grimberg static int mlx5_set_bsf(struct ib_mr *sig_mr,
3456e6631814SSagi Grimberg 			struct ib_sig_attrs *sig_attrs,
3457e6631814SSagi Grimberg 			struct mlx5_bsf *bsf, u32 data_size)
3458e6631814SSagi Grimberg {
3459e6631814SSagi Grimberg 	struct mlx5_core_sig_ctx *msig = to_mmr(sig_mr)->sig;
3460e6631814SSagi Grimberg 	struct mlx5_bsf_basic *basic = &bsf->basic;
3461e6631814SSagi Grimberg 	struct ib_sig_domain *mem = &sig_attrs->mem;
3462e6631814SSagi Grimberg 	struct ib_sig_domain *wire = &sig_attrs->wire;
3463e6631814SSagi Grimberg 
3464c7f44fbdSSagi Grimberg 	memset(bsf, 0, sizeof(*bsf));
3465e6631814SSagi Grimberg 
3466142537f4SSagi Grimberg 	/* Basic + Extended + Inline */
3467142537f4SSagi Grimberg 	basic->bsf_size_sbs = 1 << 7;
3468e6631814SSagi Grimberg 	/* Input domain check byte mask */
3469e6631814SSagi Grimberg 	basic->check_byte_mask = sig_attrs->check_mask;
347078eda2bbSSagi Grimberg 	basic->raw_data_size = cpu_to_be32(data_size);
347178eda2bbSSagi Grimberg 
347278eda2bbSSagi Grimberg 	/* Memory domain */
347378eda2bbSSagi Grimberg 	switch (sig_attrs->mem.sig_type) {
347478eda2bbSSagi Grimberg 	case IB_SIG_TYPE_NONE:
347578eda2bbSSagi Grimberg 		break;
347678eda2bbSSagi Grimberg 	case IB_SIG_TYPE_T10_DIF:
347778eda2bbSSagi Grimberg 		basic->mem.bs_selector = bs_selector(mem->sig.dif.pi_interval);
347878eda2bbSSagi Grimberg 		basic->m_bfs_psv = cpu_to_be32(msig->psv_memory.psv_idx);
347978eda2bbSSagi Grimberg 		mlx5_fill_inl_bsf(mem, &bsf->m_inl);
348078eda2bbSSagi Grimberg 		break;
348178eda2bbSSagi Grimberg 	default:
348278eda2bbSSagi Grimberg 		return -EINVAL;
348378eda2bbSSagi Grimberg 	}
348478eda2bbSSagi Grimberg 
348578eda2bbSSagi Grimberg 	/* Wire domain */
348678eda2bbSSagi Grimberg 	switch (sig_attrs->wire.sig_type) {
348778eda2bbSSagi Grimberg 	case IB_SIG_TYPE_NONE:
348878eda2bbSSagi Grimberg 		break;
348978eda2bbSSagi Grimberg 	case IB_SIG_TYPE_T10_DIF:
3490e6631814SSagi Grimberg 		if (mem->sig.dif.pi_interval == wire->sig.dif.pi_interval &&
349178eda2bbSSagi Grimberg 		    mem->sig_type == wire->sig_type) {
3492e6631814SSagi Grimberg 			/* Same block structure */
3493142537f4SSagi Grimberg 			basic->bsf_size_sbs |= 1 << 4;
3494e6631814SSagi Grimberg 			if (mem->sig.dif.bg_type == wire->sig.dif.bg_type)
3495fd22f78cSSagi Grimberg 				basic->wire.copy_byte_mask |= MLX5_CPY_GRD_MASK;
3496c7f44fbdSSagi Grimberg 			if (mem->sig.dif.app_tag == wire->sig.dif.app_tag)
3497fd22f78cSSagi Grimberg 				basic->wire.copy_byte_mask |= MLX5_CPY_APP_MASK;
3498c7f44fbdSSagi Grimberg 			if (mem->sig.dif.ref_tag == wire->sig.dif.ref_tag)
3499fd22f78cSSagi Grimberg 				basic->wire.copy_byte_mask |= MLX5_CPY_REF_MASK;
3500e6631814SSagi Grimberg 		} else
3501e6631814SSagi Grimberg 			basic->wire.bs_selector = bs_selector(wire->sig.dif.pi_interval);
3502e6631814SSagi Grimberg 
3503142537f4SSagi Grimberg 		basic->w_bfs_psv = cpu_to_be32(msig->psv_wire.psv_idx);
350478eda2bbSSagi Grimberg 		mlx5_fill_inl_bsf(wire, &bsf->w_inl);
3505e6631814SSagi Grimberg 		break;
3506e6631814SSagi Grimberg 	default:
3507e6631814SSagi Grimberg 		return -EINVAL;
3508e6631814SSagi Grimberg 	}
3509e6631814SSagi Grimberg 
3510e6631814SSagi Grimberg 	return 0;
3511e6631814SSagi Grimberg }
3512e6631814SSagi Grimberg 
3513e622f2f4SChristoph Hellwig static int set_sig_data_segment(struct ib_sig_handover_wr *wr,
3514e622f2f4SChristoph Hellwig 				struct mlx5_ib_qp *qp, void **seg, int *size)
3515e6631814SSagi Grimberg {
3516e622f2f4SChristoph Hellwig 	struct ib_sig_attrs *sig_attrs = wr->sig_attrs;
3517e622f2f4SChristoph Hellwig 	struct ib_mr *sig_mr = wr->sig_mr;
3518e6631814SSagi Grimberg 	struct mlx5_bsf *bsf;
3519e622f2f4SChristoph Hellwig 	u32 data_len = wr->wr.sg_list->length;
3520e622f2f4SChristoph Hellwig 	u32 data_key = wr->wr.sg_list->lkey;
3521e622f2f4SChristoph Hellwig 	u64 data_va = wr->wr.sg_list->addr;
3522e6631814SSagi Grimberg 	int ret;
3523e6631814SSagi Grimberg 	int wqe_size;
3524e6631814SSagi Grimberg 
3525e622f2f4SChristoph Hellwig 	if (!wr->prot ||
3526e622f2f4SChristoph Hellwig 	    (data_key == wr->prot->lkey &&
3527e622f2f4SChristoph Hellwig 	     data_va == wr->prot->addr &&
3528e622f2f4SChristoph Hellwig 	     data_len == wr->prot->length)) {
3529e6631814SSagi Grimberg 		/**
3530e6631814SSagi Grimberg 		 * Source domain doesn't contain signature information
35315c273b16SSagi Grimberg 		 * or data and protection are interleaved in memory.
3532e6631814SSagi Grimberg 		 * So need construct:
3533e6631814SSagi Grimberg 		 *                  ------------------
3534e6631814SSagi Grimberg 		 *                 |     data_klm     |
3535e6631814SSagi Grimberg 		 *                  ------------------
3536e6631814SSagi Grimberg 		 *                 |       BSF        |
3537e6631814SSagi Grimberg 		 *                  ------------------
3538e6631814SSagi Grimberg 		 **/
3539e6631814SSagi Grimberg 		struct mlx5_klm *data_klm = *seg;
3540e6631814SSagi Grimberg 
3541e6631814SSagi Grimberg 		data_klm->bcount = cpu_to_be32(data_len);
3542e6631814SSagi Grimberg 		data_klm->key = cpu_to_be32(data_key);
3543e6631814SSagi Grimberg 		data_klm->va = cpu_to_be64(data_va);
3544e6631814SSagi Grimberg 		wqe_size = ALIGN(sizeof(*data_klm), 64);
3545e6631814SSagi Grimberg 	} else {
3546e6631814SSagi Grimberg 		/**
3547e6631814SSagi Grimberg 		 * Source domain contains signature information
3548e6631814SSagi Grimberg 		 * So need construct a strided block format:
3549e6631814SSagi Grimberg 		 *               ---------------------------
3550e6631814SSagi Grimberg 		 *              |     stride_block_ctrl     |
3551e6631814SSagi Grimberg 		 *               ---------------------------
3552e6631814SSagi Grimberg 		 *              |          data_klm         |
3553e6631814SSagi Grimberg 		 *               ---------------------------
3554e6631814SSagi Grimberg 		 *              |          prot_klm         |
3555e6631814SSagi Grimberg 		 *               ---------------------------
3556e6631814SSagi Grimberg 		 *              |             BSF           |
3557e6631814SSagi Grimberg 		 *               ---------------------------
3558e6631814SSagi Grimberg 		 **/
3559e6631814SSagi Grimberg 		struct mlx5_stride_block_ctrl_seg *sblock_ctrl;
3560e6631814SSagi Grimberg 		struct mlx5_stride_block_entry *data_sentry;
3561e6631814SSagi Grimberg 		struct mlx5_stride_block_entry *prot_sentry;
3562e622f2f4SChristoph Hellwig 		u32 prot_key = wr->prot->lkey;
3563e622f2f4SChristoph Hellwig 		u64 prot_va = wr->prot->addr;
3564e6631814SSagi Grimberg 		u16 block_size = sig_attrs->mem.sig.dif.pi_interval;
3565e6631814SSagi Grimberg 		int prot_size;
3566e6631814SSagi Grimberg 
3567e6631814SSagi Grimberg 		sblock_ctrl = *seg;
3568e6631814SSagi Grimberg 		data_sentry = (void *)sblock_ctrl + sizeof(*sblock_ctrl);
3569e6631814SSagi Grimberg 		prot_sentry = (void *)data_sentry + sizeof(*data_sentry);
3570e6631814SSagi Grimberg 
3571e6631814SSagi Grimberg 		prot_size = prot_field_size(sig_attrs->mem.sig_type);
3572e6631814SSagi Grimberg 		if (!prot_size) {
3573e6631814SSagi Grimberg 			pr_err("Bad block size given: %u\n", block_size);
3574e6631814SSagi Grimberg 			return -EINVAL;
3575e6631814SSagi Grimberg 		}
3576e6631814SSagi Grimberg 		sblock_ctrl->bcount_per_cycle = cpu_to_be32(block_size +
3577e6631814SSagi Grimberg 							    prot_size);
3578e6631814SSagi Grimberg 		sblock_ctrl->op = cpu_to_be32(MLX5_STRIDE_BLOCK_OP);
3579e6631814SSagi Grimberg 		sblock_ctrl->repeat_count = cpu_to_be32(data_len / block_size);
3580e6631814SSagi Grimberg 		sblock_ctrl->num_entries = cpu_to_be16(2);
3581e6631814SSagi Grimberg 
3582e6631814SSagi Grimberg 		data_sentry->bcount = cpu_to_be16(block_size);
3583e6631814SSagi Grimberg 		data_sentry->key = cpu_to_be32(data_key);
3584e6631814SSagi Grimberg 		data_sentry->va = cpu_to_be64(data_va);
35855c273b16SSagi Grimberg 		data_sentry->stride = cpu_to_be16(block_size);
35865c273b16SSagi Grimberg 
3587e6631814SSagi Grimberg 		prot_sentry->bcount = cpu_to_be16(prot_size);
3588e6631814SSagi Grimberg 		prot_sentry->key = cpu_to_be32(prot_key);
3589e6631814SSagi Grimberg 		prot_sentry->va = cpu_to_be64(prot_va);
3590e6631814SSagi Grimberg 		prot_sentry->stride = cpu_to_be16(prot_size);
35915c273b16SSagi Grimberg 
3592e6631814SSagi Grimberg 		wqe_size = ALIGN(sizeof(*sblock_ctrl) + sizeof(*data_sentry) +
3593e6631814SSagi Grimberg 				 sizeof(*prot_sentry), 64);
3594e6631814SSagi Grimberg 	}
3595e6631814SSagi Grimberg 
3596e6631814SSagi Grimberg 	*seg += wqe_size;
3597e6631814SSagi Grimberg 	*size += wqe_size / 16;
3598e6631814SSagi Grimberg 	if (unlikely((*seg == qp->sq.qend)))
3599e6631814SSagi Grimberg 		*seg = mlx5_get_send_wqe(qp, 0);
3600e6631814SSagi Grimberg 
3601e6631814SSagi Grimberg 	bsf = *seg;
3602e6631814SSagi Grimberg 	ret = mlx5_set_bsf(sig_mr, sig_attrs, bsf, data_len);
3603e6631814SSagi Grimberg 	if (ret)
3604e6631814SSagi Grimberg 		return -EINVAL;
3605e6631814SSagi Grimberg 
3606e6631814SSagi Grimberg 	*seg += sizeof(*bsf);
3607e6631814SSagi Grimberg 	*size += sizeof(*bsf) / 16;
3608e6631814SSagi Grimberg 	if (unlikely((*seg == qp->sq.qend)))
3609e6631814SSagi Grimberg 		*seg = mlx5_get_send_wqe(qp, 0);
3610e6631814SSagi Grimberg 
3611e6631814SSagi Grimberg 	return 0;
3612e6631814SSagi Grimberg }
3613e6631814SSagi Grimberg 
3614e6631814SSagi Grimberg static void set_sig_mkey_segment(struct mlx5_mkey_seg *seg,
3615e622f2f4SChristoph Hellwig 				 struct ib_sig_handover_wr *wr, u32 nelements,
3616e6631814SSagi Grimberg 				 u32 length, u32 pdn)
3617e6631814SSagi Grimberg {
3618e622f2f4SChristoph Hellwig 	struct ib_mr *sig_mr = wr->sig_mr;
3619e6631814SSagi Grimberg 	u32 sig_key = sig_mr->rkey;
3620d5436ba0SSagi Grimberg 	u8 sigerr = to_mmr(sig_mr)->sig->sigerr_count & 1;
3621e6631814SSagi Grimberg 
3622e6631814SSagi Grimberg 	memset(seg, 0, sizeof(*seg));
3623e6631814SSagi Grimberg 
3624e622f2f4SChristoph Hellwig 	seg->flags = get_umr_flags(wr->access_flags) |
3625ec22eb53SSaeed Mahameed 				   MLX5_MKC_ACCESS_MODE_KLMS;
3626e6631814SSagi Grimberg 	seg->qpn_mkey7_0 = cpu_to_be32((sig_key & 0xff) | 0xffffff00);
3627d5436ba0SSagi Grimberg 	seg->flags_pd = cpu_to_be32(MLX5_MKEY_REMOTE_INVAL | sigerr << 26 |
3628e6631814SSagi Grimberg 				    MLX5_MKEY_BSF_EN | pdn);
3629e6631814SSagi Grimberg 	seg->len = cpu_to_be64(length);
3630e6631814SSagi Grimberg 	seg->xlt_oct_size = cpu_to_be32(be16_to_cpu(get_klm_octo(nelements)));
3631e6631814SSagi Grimberg 	seg->bsfs_octo_size = cpu_to_be32(MLX5_MKEY_BSF_OCTO_SIZE);
3632e6631814SSagi Grimberg }
3633e6631814SSagi Grimberg 
3634e6631814SSagi Grimberg static void set_sig_umr_segment(struct mlx5_wqe_umr_ctrl_seg *umr,
3635e622f2f4SChristoph Hellwig 				u32 nelements)
3636e6631814SSagi Grimberg {
3637e6631814SSagi Grimberg 	memset(umr, 0, sizeof(*umr));
3638e6631814SSagi Grimberg 
3639e6631814SSagi Grimberg 	umr->flags = MLX5_FLAGS_INLINE | MLX5_FLAGS_CHECK_FREE;
3640e6631814SSagi Grimberg 	umr->klm_octowords = get_klm_octo(nelements);
3641e6631814SSagi Grimberg 	umr->bsf_octowords = cpu_to_be16(MLX5_MKEY_BSF_OCTO_SIZE);
3642e6631814SSagi Grimberg 	umr->mkey_mask = sig_mkey_mask();
3643e6631814SSagi Grimberg }
3644e6631814SSagi Grimberg 
3645e6631814SSagi Grimberg 
3646e622f2f4SChristoph Hellwig static int set_sig_umr_wr(struct ib_send_wr *send_wr, struct mlx5_ib_qp *qp,
3647e6631814SSagi Grimberg 			  void **seg, int *size)
3648e6631814SSagi Grimberg {
3649e622f2f4SChristoph Hellwig 	struct ib_sig_handover_wr *wr = sig_handover_wr(send_wr);
3650e622f2f4SChristoph Hellwig 	struct mlx5_ib_mr *sig_mr = to_mmr(wr->sig_mr);
3651e6631814SSagi Grimberg 	u32 pdn = get_pd(qp)->pdn;
3652e6631814SSagi Grimberg 	u32 klm_oct_size;
3653e6631814SSagi Grimberg 	int region_len, ret;
3654e6631814SSagi Grimberg 
3655e622f2f4SChristoph Hellwig 	if (unlikely(wr->wr.num_sge != 1) ||
3656e622f2f4SChristoph Hellwig 	    unlikely(wr->access_flags & IB_ACCESS_REMOTE_ATOMIC) ||
3657d5436ba0SSagi Grimberg 	    unlikely(!sig_mr->sig) || unlikely(!qp->signature_en) ||
3658d5436ba0SSagi Grimberg 	    unlikely(!sig_mr->sig->sig_status_checked))
3659e6631814SSagi Grimberg 		return -EINVAL;
3660e6631814SSagi Grimberg 
3661e6631814SSagi Grimberg 	/* length of the protected region, data + protection */
3662e622f2f4SChristoph Hellwig 	region_len = wr->wr.sg_list->length;
3663e622f2f4SChristoph Hellwig 	if (wr->prot &&
3664e622f2f4SChristoph Hellwig 	    (wr->prot->lkey != wr->wr.sg_list->lkey  ||
3665e622f2f4SChristoph Hellwig 	     wr->prot->addr != wr->wr.sg_list->addr  ||
3666e622f2f4SChristoph Hellwig 	     wr->prot->length != wr->wr.sg_list->length))
3667e622f2f4SChristoph Hellwig 		region_len += wr->prot->length;
3668e6631814SSagi Grimberg 
3669e6631814SSagi Grimberg 	/**
3670e6631814SSagi Grimberg 	 * KLM octoword size - if protection was provided
3671e6631814SSagi Grimberg 	 * then we use strided block format (3 octowords),
3672e6631814SSagi Grimberg 	 * else we use single KLM (1 octoword)
3673e6631814SSagi Grimberg 	 **/
3674e622f2f4SChristoph Hellwig 	klm_oct_size = wr->prot ? 3 : 1;
3675e6631814SSagi Grimberg 
3676e622f2f4SChristoph Hellwig 	set_sig_umr_segment(*seg, klm_oct_size);
3677e6631814SSagi Grimberg 	*seg += sizeof(struct mlx5_wqe_umr_ctrl_seg);
3678e6631814SSagi Grimberg 	*size += sizeof(struct mlx5_wqe_umr_ctrl_seg) / 16;
3679e6631814SSagi Grimberg 	if (unlikely((*seg == qp->sq.qend)))
3680e6631814SSagi Grimberg 		*seg = mlx5_get_send_wqe(qp, 0);
3681e6631814SSagi Grimberg 
3682e6631814SSagi Grimberg 	set_sig_mkey_segment(*seg, wr, klm_oct_size, region_len, pdn);
3683e6631814SSagi Grimberg 	*seg += sizeof(struct mlx5_mkey_seg);
3684e6631814SSagi Grimberg 	*size += sizeof(struct mlx5_mkey_seg) / 16;
3685e6631814SSagi Grimberg 	if (unlikely((*seg == qp->sq.qend)))
3686e6631814SSagi Grimberg 		*seg = mlx5_get_send_wqe(qp, 0);
3687e6631814SSagi Grimberg 
3688e6631814SSagi Grimberg 	ret = set_sig_data_segment(wr, qp, seg, size);
3689e6631814SSagi Grimberg 	if (ret)
3690e6631814SSagi Grimberg 		return ret;
3691e6631814SSagi Grimberg 
3692d5436ba0SSagi Grimberg 	sig_mr->sig->sig_status_checked = false;
3693e6631814SSagi Grimberg 	return 0;
3694e6631814SSagi Grimberg }
3695e6631814SSagi Grimberg 
3696e6631814SSagi Grimberg static int set_psv_wr(struct ib_sig_domain *domain,
3697e6631814SSagi Grimberg 		      u32 psv_idx, void **seg, int *size)
3698e6631814SSagi Grimberg {
3699e6631814SSagi Grimberg 	struct mlx5_seg_set_psv *psv_seg = *seg;
3700e6631814SSagi Grimberg 
3701e6631814SSagi Grimberg 	memset(psv_seg, 0, sizeof(*psv_seg));
3702e6631814SSagi Grimberg 	psv_seg->psv_num = cpu_to_be32(psv_idx);
3703e6631814SSagi Grimberg 	switch (domain->sig_type) {
370478eda2bbSSagi Grimberg 	case IB_SIG_TYPE_NONE:
370578eda2bbSSagi Grimberg 		break;
3706e6631814SSagi Grimberg 	case IB_SIG_TYPE_T10_DIF:
3707e6631814SSagi Grimberg 		psv_seg->transient_sig = cpu_to_be32(domain->sig.dif.bg << 16 |
3708e6631814SSagi Grimberg 						     domain->sig.dif.app_tag);
3709e6631814SSagi Grimberg 		psv_seg->ref_tag = cpu_to_be32(domain->sig.dif.ref_tag);
3710e6631814SSagi Grimberg 		break;
3711e6631814SSagi Grimberg 	default:
3712e6631814SSagi Grimberg 		pr_err("Bad signature type given.\n");
3713e6631814SSagi Grimberg 		return 1;
3714e6631814SSagi Grimberg 	}
3715e6631814SSagi Grimberg 
371678eda2bbSSagi Grimberg 	*seg += sizeof(*psv_seg);
371778eda2bbSSagi Grimberg 	*size += sizeof(*psv_seg) / 16;
371878eda2bbSSagi Grimberg 
3719e6631814SSagi Grimberg 	return 0;
3720e6631814SSagi Grimberg }
3721e6631814SSagi Grimberg 
37228a187ee5SSagi Grimberg static int set_reg_wr(struct mlx5_ib_qp *qp,
37238a187ee5SSagi Grimberg 		      struct ib_reg_wr *wr,
37248a187ee5SSagi Grimberg 		      void **seg, int *size)
37258a187ee5SSagi Grimberg {
37268a187ee5SSagi Grimberg 	struct mlx5_ib_mr *mr = to_mmr(wr->mr);
37278a187ee5SSagi Grimberg 	struct mlx5_ib_pd *pd = to_mpd(qp->ibqp.pd);
37288a187ee5SSagi Grimberg 
37298a187ee5SSagi Grimberg 	if (unlikely(wr->wr.send_flags & IB_SEND_INLINE)) {
37308a187ee5SSagi Grimberg 		mlx5_ib_warn(to_mdev(qp->ibqp.device),
37318a187ee5SSagi Grimberg 			     "Invalid IB_SEND_INLINE send flag\n");
37328a187ee5SSagi Grimberg 		return -EINVAL;
37338a187ee5SSagi Grimberg 	}
37348a187ee5SSagi Grimberg 
37358a187ee5SSagi Grimberg 	set_reg_umr_seg(*seg, mr);
37368a187ee5SSagi Grimberg 	*seg += sizeof(struct mlx5_wqe_umr_ctrl_seg);
37378a187ee5SSagi Grimberg 	*size += sizeof(struct mlx5_wqe_umr_ctrl_seg) / 16;
37388a187ee5SSagi Grimberg 	if (unlikely((*seg == qp->sq.qend)))
37398a187ee5SSagi Grimberg 		*seg = mlx5_get_send_wqe(qp, 0);
37408a187ee5SSagi Grimberg 
37418a187ee5SSagi Grimberg 	set_reg_mkey_seg(*seg, mr, wr->key, wr->access);
37428a187ee5SSagi Grimberg 	*seg += sizeof(struct mlx5_mkey_seg);
37438a187ee5SSagi Grimberg 	*size += sizeof(struct mlx5_mkey_seg) / 16;
37448a187ee5SSagi Grimberg 	if (unlikely((*seg == qp->sq.qend)))
37458a187ee5SSagi Grimberg 		*seg = mlx5_get_send_wqe(qp, 0);
37468a187ee5SSagi Grimberg 
37478a187ee5SSagi Grimberg 	set_reg_data_seg(*seg, mr, pd);
37488a187ee5SSagi Grimberg 	*seg += sizeof(struct mlx5_wqe_data_seg);
37498a187ee5SSagi Grimberg 	*size += (sizeof(struct mlx5_wqe_data_seg) / 16);
37508a187ee5SSagi Grimberg 
37518a187ee5SSagi Grimberg 	return 0;
37528a187ee5SSagi Grimberg }
37538a187ee5SSagi Grimberg 
3754dd01e66aSSagi Grimberg static void set_linv_wr(struct mlx5_ib_qp *qp, void **seg, int *size)
3755e126ba97SEli Cohen {
3756dd01e66aSSagi Grimberg 	set_linv_umr_seg(*seg);
3757e126ba97SEli Cohen 	*seg += sizeof(struct mlx5_wqe_umr_ctrl_seg);
3758e126ba97SEli Cohen 	*size += sizeof(struct mlx5_wqe_umr_ctrl_seg) / 16;
3759e126ba97SEli Cohen 	if (unlikely((*seg == qp->sq.qend)))
3760e126ba97SEli Cohen 		*seg = mlx5_get_send_wqe(qp, 0);
3761dd01e66aSSagi Grimberg 	set_linv_mkey_seg(*seg);
3762e126ba97SEli Cohen 	*seg += sizeof(struct mlx5_mkey_seg);
3763e126ba97SEli Cohen 	*size += sizeof(struct mlx5_mkey_seg) / 16;
3764e126ba97SEli Cohen 	if (unlikely((*seg == qp->sq.qend)))
3765e126ba97SEli Cohen 		*seg = mlx5_get_send_wqe(qp, 0);
3766e126ba97SEli Cohen }
3767e126ba97SEli Cohen 
3768e126ba97SEli Cohen static void dump_wqe(struct mlx5_ib_qp *qp, int idx, int size_16)
3769e126ba97SEli Cohen {
3770e126ba97SEli Cohen 	__be32 *p = NULL;
3771e126ba97SEli Cohen 	int tidx = idx;
3772e126ba97SEli Cohen 	int i, j;
3773e126ba97SEli Cohen 
3774e126ba97SEli Cohen 	pr_debug("dump wqe at %p\n", mlx5_get_send_wqe(qp, tidx));
3775e126ba97SEli Cohen 	for (i = 0, j = 0; i < size_16 * 4; i += 4, j += 4) {
3776e126ba97SEli Cohen 		if ((i & 0xf) == 0) {
3777e126ba97SEli Cohen 			void *buf = mlx5_get_send_wqe(qp, tidx);
3778e126ba97SEli Cohen 			tidx = (tidx + 1) & (qp->sq.wqe_cnt - 1);
3779e126ba97SEli Cohen 			p = buf;
3780e126ba97SEli Cohen 			j = 0;
3781e126ba97SEli Cohen 		}
3782e126ba97SEli Cohen 		pr_debug("%08x %08x %08x %08x\n", be32_to_cpu(p[j]),
3783e126ba97SEli Cohen 			 be32_to_cpu(p[j + 1]), be32_to_cpu(p[j + 2]),
3784e126ba97SEli Cohen 			 be32_to_cpu(p[j + 3]));
3785e126ba97SEli Cohen 	}
3786e126ba97SEli Cohen }
3787e126ba97SEli Cohen 
3788e126ba97SEli Cohen static void mlx5_bf_copy(u64 __iomem *dst, u64 *src,
3789e126ba97SEli Cohen 			 unsigned bytecnt, struct mlx5_ib_qp *qp)
3790e126ba97SEli Cohen {
3791e126ba97SEli Cohen 	while (bytecnt > 0) {
3792e126ba97SEli Cohen 		__iowrite64_copy(dst++, src++, 8);
3793e126ba97SEli Cohen 		__iowrite64_copy(dst++, src++, 8);
3794e126ba97SEli Cohen 		__iowrite64_copy(dst++, src++, 8);
3795e126ba97SEli Cohen 		__iowrite64_copy(dst++, src++, 8);
3796e126ba97SEli Cohen 		__iowrite64_copy(dst++, src++, 8);
3797e126ba97SEli Cohen 		__iowrite64_copy(dst++, src++, 8);
3798e126ba97SEli Cohen 		__iowrite64_copy(dst++, src++, 8);
3799e126ba97SEli Cohen 		__iowrite64_copy(dst++, src++, 8);
3800e126ba97SEli Cohen 		bytecnt -= 64;
3801e126ba97SEli Cohen 		if (unlikely(src == qp->sq.qend))
3802e126ba97SEli Cohen 			src = mlx5_get_send_wqe(qp, 0);
3803e126ba97SEli Cohen 	}
3804e126ba97SEli Cohen }
3805e126ba97SEli Cohen 
3806e126ba97SEli Cohen static u8 get_fence(u8 fence, struct ib_send_wr *wr)
3807e126ba97SEli Cohen {
3808e126ba97SEli Cohen 	if (unlikely(wr->opcode == IB_WR_LOCAL_INV &&
3809e126ba97SEli Cohen 		     wr->send_flags & IB_SEND_FENCE))
3810e126ba97SEli Cohen 		return MLX5_FENCE_MODE_STRONG_ORDERING;
3811e126ba97SEli Cohen 
3812e126ba97SEli Cohen 	if (unlikely(fence)) {
3813e126ba97SEli Cohen 		if (wr->send_flags & IB_SEND_FENCE)
3814e126ba97SEli Cohen 			return MLX5_FENCE_MODE_SMALL_AND_FENCE;
3815e126ba97SEli Cohen 		else
3816e126ba97SEli Cohen 			return fence;
3817c9b25495SEli Cohen 	} else if (unlikely(wr->send_flags & IB_SEND_FENCE)) {
3818c9b25495SEli Cohen 		return MLX5_FENCE_MODE_FENCE;
3819e126ba97SEli Cohen 	}
3820c9b25495SEli Cohen 
3821c9b25495SEli Cohen 	return 0;
3822e126ba97SEli Cohen }
3823e126ba97SEli Cohen 
38246e5eadacSSagi Grimberg static int begin_wqe(struct mlx5_ib_qp *qp, void **seg,
38256e5eadacSSagi Grimberg 		     struct mlx5_wqe_ctrl_seg **ctrl,
38266a4f139aSEli Cohen 		     struct ib_send_wr *wr, unsigned *idx,
38276e5eadacSSagi Grimberg 		     int *size, int nreq)
38286e5eadacSSagi Grimberg {
3829b2a232d2SLeon Romanovsky 	if (unlikely(mlx5_wq_overflow(&qp->sq, nreq, qp->ibqp.send_cq)))
3830b2a232d2SLeon Romanovsky 		return -ENOMEM;
38316e5eadacSSagi Grimberg 
38326e5eadacSSagi Grimberg 	*idx = qp->sq.cur_post & (qp->sq.wqe_cnt - 1);
38336e5eadacSSagi Grimberg 	*seg = mlx5_get_send_wqe(qp, *idx);
38346e5eadacSSagi Grimberg 	*ctrl = *seg;
38356e5eadacSSagi Grimberg 	*(uint32_t *)(*seg + 8) = 0;
38366e5eadacSSagi Grimberg 	(*ctrl)->imm = send_ieth(wr);
38376e5eadacSSagi Grimberg 	(*ctrl)->fm_ce_se = qp->sq_signal_bits |
38386e5eadacSSagi Grimberg 		(wr->send_flags & IB_SEND_SIGNALED ?
38396e5eadacSSagi Grimberg 		 MLX5_WQE_CTRL_CQ_UPDATE : 0) |
38406e5eadacSSagi Grimberg 		(wr->send_flags & IB_SEND_SOLICITED ?
38416e5eadacSSagi Grimberg 		 MLX5_WQE_CTRL_SOLICITED : 0);
38426e5eadacSSagi Grimberg 
38436e5eadacSSagi Grimberg 	*seg += sizeof(**ctrl);
38446e5eadacSSagi Grimberg 	*size = sizeof(**ctrl) / 16;
38456e5eadacSSagi Grimberg 
3846b2a232d2SLeon Romanovsky 	return 0;
38476e5eadacSSagi Grimberg }
38486e5eadacSSagi Grimberg 
38496e5eadacSSagi Grimberg static void finish_wqe(struct mlx5_ib_qp *qp,
38506e5eadacSSagi Grimberg 		       struct mlx5_wqe_ctrl_seg *ctrl,
38516e5eadacSSagi Grimberg 		       u8 size, unsigned idx, u64 wr_id,
38526e5eadacSSagi Grimberg 		       int nreq, u8 fence, u8 next_fence,
38536e5eadacSSagi Grimberg 		       u32 mlx5_opcode)
38546e5eadacSSagi Grimberg {
38556e5eadacSSagi Grimberg 	u8 opmod = 0;
38566e5eadacSSagi Grimberg 
38576e5eadacSSagi Grimberg 	ctrl->opmod_idx_opcode = cpu_to_be32(((u32)(qp->sq.cur_post) << 8) |
38586e5eadacSSagi Grimberg 					     mlx5_opcode | ((u32)opmod << 24));
385919098df2Smajd@mellanox.com 	ctrl->qpn_ds = cpu_to_be32(size | (qp->trans_qp.base.mqp.qpn << 8));
38606e5eadacSSagi Grimberg 	ctrl->fm_ce_se |= fence;
38616e5eadacSSagi Grimberg 	qp->fm_cache = next_fence;
38626e5eadacSSagi Grimberg 	if (unlikely(qp->wq_sig))
38636e5eadacSSagi Grimberg 		ctrl->signature = wq_sig(ctrl);
38646e5eadacSSagi Grimberg 
38656e5eadacSSagi Grimberg 	qp->sq.wrid[idx] = wr_id;
38666e5eadacSSagi Grimberg 	qp->sq.w_list[idx].opcode = mlx5_opcode;
38676e5eadacSSagi Grimberg 	qp->sq.wqe_head[idx] = qp->sq.head + nreq;
38686e5eadacSSagi Grimberg 	qp->sq.cur_post += DIV_ROUND_UP(size * 16, MLX5_SEND_WQE_BB);
38696e5eadacSSagi Grimberg 	qp->sq.w_list[idx].next = qp->sq.cur_post;
38706e5eadacSSagi Grimberg }
38716e5eadacSSagi Grimberg 
38726e5eadacSSagi Grimberg 
3873e126ba97SEli Cohen int mlx5_ib_post_send(struct ib_qp *ibqp, struct ib_send_wr *wr,
3874e126ba97SEli Cohen 		      struct ib_send_wr **bad_wr)
3875e126ba97SEli Cohen {
3876e126ba97SEli Cohen 	struct mlx5_wqe_ctrl_seg *ctrl = NULL;  /* compiler warning */
3877e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
387889ea94a7SMaor Gottlieb 	struct mlx5_core_dev *mdev = dev->mdev;
3879d16e91daSHaggai Eran 	struct mlx5_ib_qp *qp;
3880e6631814SSagi Grimberg 	struct mlx5_ib_mr *mr;
3881e126ba97SEli Cohen 	struct mlx5_wqe_data_seg *dpseg;
3882e126ba97SEli Cohen 	struct mlx5_wqe_xrc_seg *xrc;
3883d16e91daSHaggai Eran 	struct mlx5_bf *bf;
3884e126ba97SEli Cohen 	int uninitialized_var(size);
3885d16e91daSHaggai Eran 	void *qend;
3886e126ba97SEli Cohen 	unsigned long flags;
3887e126ba97SEli Cohen 	unsigned idx;
3888e126ba97SEli Cohen 	int err = 0;
3889e126ba97SEli Cohen 	int inl = 0;
3890e126ba97SEli Cohen 	int num_sge;
3891e126ba97SEli Cohen 	void *seg;
3892e126ba97SEli Cohen 	int nreq;
3893e126ba97SEli Cohen 	int i;
3894e126ba97SEli Cohen 	u8 next_fence = 0;
3895e126ba97SEli Cohen 	u8 fence;
3896e126ba97SEli Cohen 
3897d16e91daSHaggai Eran 	if (unlikely(ibqp->qp_type == IB_QPT_GSI))
3898d16e91daSHaggai Eran 		return mlx5_ib_gsi_post_send(ibqp, wr, bad_wr);
3899d16e91daSHaggai Eran 
3900d16e91daSHaggai Eran 	qp = to_mqp(ibqp);
3901d16e91daSHaggai Eran 	bf = qp->bf;
3902d16e91daSHaggai Eran 	qend = qp->sq.qend;
3903d16e91daSHaggai Eran 
3904e126ba97SEli Cohen 	spin_lock_irqsave(&qp->sq.lock, flags);
3905e126ba97SEli Cohen 
390689ea94a7SMaor Gottlieb 	if (mdev->state == MLX5_DEVICE_STATE_INTERNAL_ERROR) {
390789ea94a7SMaor Gottlieb 		err = -EIO;
390889ea94a7SMaor Gottlieb 		*bad_wr = wr;
390989ea94a7SMaor Gottlieb 		nreq = 0;
391089ea94a7SMaor Gottlieb 		goto out;
391189ea94a7SMaor Gottlieb 	}
391289ea94a7SMaor Gottlieb 
3913e126ba97SEli Cohen 	for (nreq = 0; wr; nreq++, wr = wr->next) {
3914a8f731ebSFabian Frederick 		if (unlikely(wr->opcode >= ARRAY_SIZE(mlx5_ib_opcode))) {
3915e126ba97SEli Cohen 			mlx5_ib_warn(dev, "\n");
3916e126ba97SEli Cohen 			err = -EINVAL;
3917e126ba97SEli Cohen 			*bad_wr = wr;
3918e126ba97SEli Cohen 			goto out;
3919e126ba97SEli Cohen 		}
3920e126ba97SEli Cohen 
3921e126ba97SEli Cohen 		fence = qp->fm_cache;
3922e126ba97SEli Cohen 		num_sge = wr->num_sge;
3923e126ba97SEli Cohen 		if (unlikely(num_sge > qp->sq.max_gs)) {
3924e126ba97SEli Cohen 			mlx5_ib_warn(dev, "\n");
392524be409bSChuck Lever 			err = -EINVAL;
3926e126ba97SEli Cohen 			*bad_wr = wr;
3927e126ba97SEli Cohen 			goto out;
3928e126ba97SEli Cohen 		}
3929e126ba97SEli Cohen 
39306e5eadacSSagi Grimberg 		err = begin_wqe(qp, &seg, &ctrl, wr, &idx, &size, nreq);
39316e5eadacSSagi Grimberg 		if (err) {
39326e5eadacSSagi Grimberg 			mlx5_ib_warn(dev, "\n");
39336e5eadacSSagi Grimberg 			err = -ENOMEM;
39346e5eadacSSagi Grimberg 			*bad_wr = wr;
39356e5eadacSSagi Grimberg 			goto out;
39366e5eadacSSagi Grimberg 		}
3937e126ba97SEli Cohen 
3938e126ba97SEli Cohen 		switch (ibqp->qp_type) {
3939e126ba97SEli Cohen 		case IB_QPT_XRC_INI:
3940e126ba97SEli Cohen 			xrc = seg;
3941e126ba97SEli Cohen 			seg += sizeof(*xrc);
3942e126ba97SEli Cohen 			size += sizeof(*xrc) / 16;
3943e126ba97SEli Cohen 			/* fall through */
3944e126ba97SEli Cohen 		case IB_QPT_RC:
3945e126ba97SEli Cohen 			switch (wr->opcode) {
3946e126ba97SEli Cohen 			case IB_WR_RDMA_READ:
3947e126ba97SEli Cohen 			case IB_WR_RDMA_WRITE:
3948e126ba97SEli Cohen 			case IB_WR_RDMA_WRITE_WITH_IMM:
3949e622f2f4SChristoph Hellwig 				set_raddr_seg(seg, rdma_wr(wr)->remote_addr,
3950e622f2f4SChristoph Hellwig 					      rdma_wr(wr)->rkey);
3951e126ba97SEli Cohen 				seg += sizeof(struct mlx5_wqe_raddr_seg);
3952e126ba97SEli Cohen 				size += sizeof(struct mlx5_wqe_raddr_seg) / 16;
3953e126ba97SEli Cohen 				break;
3954e126ba97SEli Cohen 
3955e126ba97SEli Cohen 			case IB_WR_ATOMIC_CMP_AND_SWP:
3956e126ba97SEli Cohen 			case IB_WR_ATOMIC_FETCH_AND_ADD:
3957e126ba97SEli Cohen 			case IB_WR_MASKED_ATOMIC_CMP_AND_SWP:
395881bea28fSEli Cohen 				mlx5_ib_warn(dev, "Atomic operations are not supported yet\n");
395981bea28fSEli Cohen 				err = -ENOSYS;
396081bea28fSEli Cohen 				*bad_wr = wr;
396181bea28fSEli Cohen 				goto out;
3962e126ba97SEli Cohen 
3963e126ba97SEli Cohen 			case IB_WR_LOCAL_INV:
3964e126ba97SEli Cohen 				next_fence = MLX5_FENCE_MODE_INITIATOR_SMALL;
3965e126ba97SEli Cohen 				qp->sq.wr_data[idx] = IB_WR_LOCAL_INV;
3966e126ba97SEli Cohen 				ctrl->imm = cpu_to_be32(wr->ex.invalidate_rkey);
3967dd01e66aSSagi Grimberg 				set_linv_wr(qp, &seg, &size);
3968e126ba97SEli Cohen 				num_sge = 0;
3969e126ba97SEli Cohen 				break;
3970e126ba97SEli Cohen 
39718a187ee5SSagi Grimberg 			case IB_WR_REG_MR:
39728a187ee5SSagi Grimberg 				next_fence = MLX5_FENCE_MODE_INITIATOR_SMALL;
39738a187ee5SSagi Grimberg 				qp->sq.wr_data[idx] = IB_WR_REG_MR;
39748a187ee5SSagi Grimberg 				ctrl->imm = cpu_to_be32(reg_wr(wr)->key);
39758a187ee5SSagi Grimberg 				err = set_reg_wr(qp, reg_wr(wr), &seg, &size);
39768a187ee5SSagi Grimberg 				if (err) {
39778a187ee5SSagi Grimberg 					*bad_wr = wr;
39788a187ee5SSagi Grimberg 					goto out;
39798a187ee5SSagi Grimberg 				}
39808a187ee5SSagi Grimberg 				num_sge = 0;
39818a187ee5SSagi Grimberg 				break;
39828a187ee5SSagi Grimberg 
3983e6631814SSagi Grimberg 			case IB_WR_REG_SIG_MR:
3984e6631814SSagi Grimberg 				qp->sq.wr_data[idx] = IB_WR_REG_SIG_MR;
3985e622f2f4SChristoph Hellwig 				mr = to_mmr(sig_handover_wr(wr)->sig_mr);
3986e6631814SSagi Grimberg 
3987e6631814SSagi Grimberg 				ctrl->imm = cpu_to_be32(mr->ibmr.rkey);
3988e6631814SSagi Grimberg 				err = set_sig_umr_wr(wr, qp, &seg, &size);
3989e6631814SSagi Grimberg 				if (err) {
3990e6631814SSagi Grimberg 					mlx5_ib_warn(dev, "\n");
3991e6631814SSagi Grimberg 					*bad_wr = wr;
3992e6631814SSagi Grimberg 					goto out;
3993e6631814SSagi Grimberg 				}
3994e6631814SSagi Grimberg 
3995e6631814SSagi Grimberg 				finish_wqe(qp, ctrl, size, idx, wr->wr_id,
3996e6631814SSagi Grimberg 					   nreq, get_fence(fence, wr),
3997e6631814SSagi Grimberg 					   next_fence, MLX5_OPCODE_UMR);
3998e6631814SSagi Grimberg 				/*
3999e6631814SSagi Grimberg 				 * SET_PSV WQEs are not signaled and solicited
4000e6631814SSagi Grimberg 				 * on error
4001e6631814SSagi Grimberg 				 */
4002e6631814SSagi Grimberg 				wr->send_flags &= ~IB_SEND_SIGNALED;
4003e6631814SSagi Grimberg 				wr->send_flags |= IB_SEND_SOLICITED;
4004e6631814SSagi Grimberg 				err = begin_wqe(qp, &seg, &ctrl, wr,
4005e6631814SSagi Grimberg 						&idx, &size, nreq);
4006e6631814SSagi Grimberg 				if (err) {
4007e6631814SSagi Grimberg 					mlx5_ib_warn(dev, "\n");
4008e6631814SSagi Grimberg 					err = -ENOMEM;
4009e6631814SSagi Grimberg 					*bad_wr = wr;
4010e6631814SSagi Grimberg 					goto out;
4011e6631814SSagi Grimberg 				}
4012e6631814SSagi Grimberg 
4013e622f2f4SChristoph Hellwig 				err = set_psv_wr(&sig_handover_wr(wr)->sig_attrs->mem,
4014e6631814SSagi Grimberg 						 mr->sig->psv_memory.psv_idx, &seg,
4015e6631814SSagi Grimberg 						 &size);
4016e6631814SSagi Grimberg 				if (err) {
4017e6631814SSagi Grimberg 					mlx5_ib_warn(dev, "\n");
4018e6631814SSagi Grimberg 					*bad_wr = wr;
4019e6631814SSagi Grimberg 					goto out;
4020e6631814SSagi Grimberg 				}
4021e6631814SSagi Grimberg 
4022e6631814SSagi Grimberg 				finish_wqe(qp, ctrl, size, idx, wr->wr_id,
4023e6631814SSagi Grimberg 					   nreq, get_fence(fence, wr),
4024e6631814SSagi Grimberg 					   next_fence, MLX5_OPCODE_SET_PSV);
4025e6631814SSagi Grimberg 				err = begin_wqe(qp, &seg, &ctrl, wr,
4026e6631814SSagi Grimberg 						&idx, &size, nreq);
4027e6631814SSagi Grimberg 				if (err) {
4028e6631814SSagi Grimberg 					mlx5_ib_warn(dev, "\n");
4029e6631814SSagi Grimberg 					err = -ENOMEM;
4030e6631814SSagi Grimberg 					*bad_wr = wr;
4031e6631814SSagi Grimberg 					goto out;
4032e6631814SSagi Grimberg 				}
4033e6631814SSagi Grimberg 
4034e6631814SSagi Grimberg 				next_fence = MLX5_FENCE_MODE_INITIATOR_SMALL;
4035e622f2f4SChristoph Hellwig 				err = set_psv_wr(&sig_handover_wr(wr)->sig_attrs->wire,
4036e6631814SSagi Grimberg 						 mr->sig->psv_wire.psv_idx, &seg,
4037e6631814SSagi Grimberg 						 &size);
4038e6631814SSagi Grimberg 				if (err) {
4039e6631814SSagi Grimberg 					mlx5_ib_warn(dev, "\n");
4040e6631814SSagi Grimberg 					*bad_wr = wr;
4041e6631814SSagi Grimberg 					goto out;
4042e6631814SSagi Grimberg 				}
4043e6631814SSagi Grimberg 
4044e6631814SSagi Grimberg 				finish_wqe(qp, ctrl, size, idx, wr->wr_id,
4045e6631814SSagi Grimberg 					   nreq, get_fence(fence, wr),
4046e6631814SSagi Grimberg 					   next_fence, MLX5_OPCODE_SET_PSV);
4047e6631814SSagi Grimberg 				num_sge = 0;
4048e6631814SSagi Grimberg 				goto skip_psv;
4049e6631814SSagi Grimberg 
4050e126ba97SEli Cohen 			default:
4051e126ba97SEli Cohen 				break;
4052e126ba97SEli Cohen 			}
4053e126ba97SEli Cohen 			break;
4054e126ba97SEli Cohen 
4055e126ba97SEli Cohen 		case IB_QPT_UC:
4056e126ba97SEli Cohen 			switch (wr->opcode) {
4057e126ba97SEli Cohen 			case IB_WR_RDMA_WRITE:
4058e126ba97SEli Cohen 			case IB_WR_RDMA_WRITE_WITH_IMM:
4059e622f2f4SChristoph Hellwig 				set_raddr_seg(seg, rdma_wr(wr)->remote_addr,
4060e622f2f4SChristoph Hellwig 					      rdma_wr(wr)->rkey);
4061e126ba97SEli Cohen 				seg  += sizeof(struct mlx5_wqe_raddr_seg);
4062e126ba97SEli Cohen 				size += sizeof(struct mlx5_wqe_raddr_seg) / 16;
4063e126ba97SEli Cohen 				break;
4064e126ba97SEli Cohen 
4065e126ba97SEli Cohen 			default:
4066e126ba97SEli Cohen 				break;
4067e126ba97SEli Cohen 			}
4068e126ba97SEli Cohen 			break;
4069e126ba97SEli Cohen 
4070e126ba97SEli Cohen 		case IB_QPT_SMI:
4071d16e91daSHaggai Eran 		case MLX5_IB_QPT_HW_GSI:
4072e126ba97SEli Cohen 			set_datagram_seg(seg, wr);
4073e126ba97SEli Cohen 			seg += sizeof(struct mlx5_wqe_datagram_seg);
4074e126ba97SEli Cohen 			size += sizeof(struct mlx5_wqe_datagram_seg) / 16;
4075e126ba97SEli Cohen 			if (unlikely((seg == qend)))
4076e126ba97SEli Cohen 				seg = mlx5_get_send_wqe(qp, 0);
4077e126ba97SEli Cohen 			break;
4078f0313965SErez Shitrit 		case IB_QPT_UD:
4079f0313965SErez Shitrit 			set_datagram_seg(seg, wr);
4080f0313965SErez Shitrit 			seg += sizeof(struct mlx5_wqe_datagram_seg);
4081f0313965SErez Shitrit 			size += sizeof(struct mlx5_wqe_datagram_seg) / 16;
4082e126ba97SEli Cohen 
4083f0313965SErez Shitrit 			if (unlikely((seg == qend)))
4084f0313965SErez Shitrit 				seg = mlx5_get_send_wqe(qp, 0);
4085f0313965SErez Shitrit 
4086f0313965SErez Shitrit 			/* handle qp that supports ud offload */
4087f0313965SErez Shitrit 			if (qp->flags & IB_QP_CREATE_IPOIB_UD_LSO) {
4088f0313965SErez Shitrit 				struct mlx5_wqe_eth_pad *pad;
4089f0313965SErez Shitrit 
4090f0313965SErez Shitrit 				pad = seg;
4091f0313965SErez Shitrit 				memset(pad, 0, sizeof(struct mlx5_wqe_eth_pad));
4092f0313965SErez Shitrit 				seg += sizeof(struct mlx5_wqe_eth_pad);
4093f0313965SErez Shitrit 				size += sizeof(struct mlx5_wqe_eth_pad) / 16;
4094f0313965SErez Shitrit 
4095f0313965SErez Shitrit 				seg = set_eth_seg(seg, wr, qend, qp, &size);
4096f0313965SErez Shitrit 
4097f0313965SErez Shitrit 				if (unlikely((seg == qend)))
4098f0313965SErez Shitrit 					seg = mlx5_get_send_wqe(qp, 0);
4099f0313965SErez Shitrit 			}
4100f0313965SErez Shitrit 			break;
4101e126ba97SEli Cohen 		case MLX5_IB_QPT_REG_UMR:
4102e126ba97SEli Cohen 			if (wr->opcode != MLX5_IB_WR_UMR) {
4103e126ba97SEli Cohen 				err = -EINVAL;
4104e126ba97SEli Cohen 				mlx5_ib_warn(dev, "bad opcode\n");
4105e126ba97SEli Cohen 				goto out;
4106e126ba97SEli Cohen 			}
4107e126ba97SEli Cohen 			qp->sq.wr_data[idx] = MLX5_IB_WR_UMR;
4108e622f2f4SChristoph Hellwig 			ctrl->imm = cpu_to_be32(umr_wr(wr)->mkey);
4109578e7264SMaor Gottlieb 			set_reg_umr_segment(seg, wr, !!(MLX5_CAP_GEN(mdev, atomic)));
4110e126ba97SEli Cohen 			seg += sizeof(struct mlx5_wqe_umr_ctrl_seg);
4111e126ba97SEli Cohen 			size += sizeof(struct mlx5_wqe_umr_ctrl_seg) / 16;
4112e126ba97SEli Cohen 			if (unlikely((seg == qend)))
4113e126ba97SEli Cohen 				seg = mlx5_get_send_wqe(qp, 0);
4114e126ba97SEli Cohen 			set_reg_mkey_segment(seg, wr);
4115e126ba97SEli Cohen 			seg += sizeof(struct mlx5_mkey_seg);
4116e126ba97SEli Cohen 			size += sizeof(struct mlx5_mkey_seg) / 16;
4117e126ba97SEli Cohen 			if (unlikely((seg == qend)))
4118e126ba97SEli Cohen 				seg = mlx5_get_send_wqe(qp, 0);
4119e126ba97SEli Cohen 			break;
4120e126ba97SEli Cohen 
4121e126ba97SEli Cohen 		default:
4122e126ba97SEli Cohen 			break;
4123e126ba97SEli Cohen 		}
4124e126ba97SEli Cohen 
4125e126ba97SEli Cohen 		if (wr->send_flags & IB_SEND_INLINE && num_sge) {
4126e126ba97SEli Cohen 			int uninitialized_var(sz);
4127e126ba97SEli Cohen 
4128e126ba97SEli Cohen 			err = set_data_inl_seg(qp, wr, seg, &sz);
4129e126ba97SEli Cohen 			if (unlikely(err)) {
4130e126ba97SEli Cohen 				mlx5_ib_warn(dev, "\n");
4131e126ba97SEli Cohen 				*bad_wr = wr;
4132e126ba97SEli Cohen 				goto out;
4133e126ba97SEli Cohen 			}
4134e126ba97SEli Cohen 			inl = 1;
4135e126ba97SEli Cohen 			size += sz;
4136e126ba97SEli Cohen 		} else {
4137e126ba97SEli Cohen 			dpseg = seg;
4138e126ba97SEli Cohen 			for (i = 0; i < num_sge; i++) {
4139e126ba97SEli Cohen 				if (unlikely(dpseg == qend)) {
4140e126ba97SEli Cohen 					seg = mlx5_get_send_wqe(qp, 0);
4141e126ba97SEli Cohen 					dpseg = seg;
4142e126ba97SEli Cohen 				}
4143e126ba97SEli Cohen 				if (likely(wr->sg_list[i].length)) {
4144e126ba97SEli Cohen 					set_data_ptr_seg(dpseg, wr->sg_list + i);
4145e126ba97SEli Cohen 					size += sizeof(struct mlx5_wqe_data_seg) / 16;
4146e126ba97SEli Cohen 					dpseg++;
4147e126ba97SEli Cohen 				}
4148e126ba97SEli Cohen 			}
4149e126ba97SEli Cohen 		}
4150e126ba97SEli Cohen 
41516e5eadacSSagi Grimberg 		finish_wqe(qp, ctrl, size, idx, wr->wr_id, nreq,
41526e5eadacSSagi Grimberg 			   get_fence(fence, wr), next_fence,
41536e5eadacSSagi Grimberg 			   mlx5_ib_opcode[wr->opcode]);
4154e6631814SSagi Grimberg skip_psv:
4155e126ba97SEli Cohen 		if (0)
4156e126ba97SEli Cohen 			dump_wqe(qp, idx, size);
4157e126ba97SEli Cohen 	}
4158e126ba97SEli Cohen 
4159e126ba97SEli Cohen out:
4160e126ba97SEli Cohen 	if (likely(nreq)) {
4161e126ba97SEli Cohen 		qp->sq.head += nreq;
4162e126ba97SEli Cohen 
4163e126ba97SEli Cohen 		/* Make sure that descriptors are written before
4164e126ba97SEli Cohen 		 * updating doorbell record and ringing the doorbell
4165e126ba97SEli Cohen 		 */
4166e126ba97SEli Cohen 		wmb();
4167e126ba97SEli Cohen 
4168e126ba97SEli Cohen 		qp->db.db[MLX5_SND_DBR] = cpu_to_be32(qp->sq.cur_post);
4169e126ba97SEli Cohen 
4170ada388f7SEli Cohen 		/* Make sure doorbell record is visible to the HCA before
4171ada388f7SEli Cohen 		 * we hit doorbell */
4172ada388f7SEli Cohen 		wmb();
4173ada388f7SEli Cohen 
4174e126ba97SEli Cohen 		if (bf->need_lock)
4175e126ba97SEli Cohen 			spin_lock(&bf->lock);
41766a4f139aSEli Cohen 		else
41776a4f139aSEli Cohen 			__acquire(&bf->lock);
4178e126ba97SEli Cohen 
4179e126ba97SEli Cohen 		/* TBD enable WC */
4180e126ba97SEli Cohen 		if (0 && nreq == 1 && bf->uuarn && inl && size > 1 && size <= bf->buf_size / 16) {
4181e126ba97SEli Cohen 			mlx5_bf_copy(bf->reg + bf->offset, (u64 *)ctrl, ALIGN(size * 16, 64), qp);
4182e126ba97SEli Cohen 			/* wc_wmb(); */
4183e126ba97SEli Cohen 		} else {
4184e126ba97SEli Cohen 			mlx5_write64((__be32 *)ctrl, bf->regreg + bf->offset,
4185e126ba97SEli Cohen 				     MLX5_GET_DOORBELL_LOCK(&bf->lock32));
4186e126ba97SEli Cohen 			/* Make sure doorbells don't leak out of SQ spinlock
4187e126ba97SEli Cohen 			 * and reach the HCA out of order.
4188e126ba97SEli Cohen 			 */
4189e126ba97SEli Cohen 			mmiowb();
4190e126ba97SEli Cohen 		}
4191e126ba97SEli Cohen 		bf->offset ^= bf->buf_size;
4192e126ba97SEli Cohen 		if (bf->need_lock)
4193e126ba97SEli Cohen 			spin_unlock(&bf->lock);
41946a4f139aSEli Cohen 		else
41956a4f139aSEli Cohen 			__release(&bf->lock);
4196e126ba97SEli Cohen 	}
4197e126ba97SEli Cohen 
4198e126ba97SEli Cohen 	spin_unlock_irqrestore(&qp->sq.lock, flags);
4199e126ba97SEli Cohen 
4200e126ba97SEli Cohen 	return err;
4201e126ba97SEli Cohen }
4202e126ba97SEli Cohen 
4203e126ba97SEli Cohen static void set_sig_seg(struct mlx5_rwqe_sig *sig, int size)
4204e126ba97SEli Cohen {
4205e126ba97SEli Cohen 	sig->signature = calc_sig(sig, size);
4206e126ba97SEli Cohen }
4207e126ba97SEli Cohen 
4208e126ba97SEli Cohen int mlx5_ib_post_recv(struct ib_qp *ibqp, struct ib_recv_wr *wr,
4209e126ba97SEli Cohen 		      struct ib_recv_wr **bad_wr)
4210e126ba97SEli Cohen {
4211e126ba97SEli Cohen 	struct mlx5_ib_qp *qp = to_mqp(ibqp);
4212e126ba97SEli Cohen 	struct mlx5_wqe_data_seg *scat;
4213e126ba97SEli Cohen 	struct mlx5_rwqe_sig *sig;
421489ea94a7SMaor Gottlieb 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
421589ea94a7SMaor Gottlieb 	struct mlx5_core_dev *mdev = dev->mdev;
4216e126ba97SEli Cohen 	unsigned long flags;
4217e126ba97SEli Cohen 	int err = 0;
4218e126ba97SEli Cohen 	int nreq;
4219e126ba97SEli Cohen 	int ind;
4220e126ba97SEli Cohen 	int i;
4221e126ba97SEli Cohen 
4222d16e91daSHaggai Eran 	if (unlikely(ibqp->qp_type == IB_QPT_GSI))
4223d16e91daSHaggai Eran 		return mlx5_ib_gsi_post_recv(ibqp, wr, bad_wr);
4224d16e91daSHaggai Eran 
4225e126ba97SEli Cohen 	spin_lock_irqsave(&qp->rq.lock, flags);
4226e126ba97SEli Cohen 
422789ea94a7SMaor Gottlieb 	if (mdev->state == MLX5_DEVICE_STATE_INTERNAL_ERROR) {
422889ea94a7SMaor Gottlieb 		err = -EIO;
422989ea94a7SMaor Gottlieb 		*bad_wr = wr;
423089ea94a7SMaor Gottlieb 		nreq = 0;
423189ea94a7SMaor Gottlieb 		goto out;
423289ea94a7SMaor Gottlieb 	}
423389ea94a7SMaor Gottlieb 
4234e126ba97SEli Cohen 	ind = qp->rq.head & (qp->rq.wqe_cnt - 1);
4235e126ba97SEli Cohen 
4236e126ba97SEli Cohen 	for (nreq = 0; wr; nreq++, wr = wr->next) {
4237e126ba97SEli Cohen 		if (mlx5_wq_overflow(&qp->rq, nreq, qp->ibqp.recv_cq)) {
4238e126ba97SEli Cohen 			err = -ENOMEM;
4239e126ba97SEli Cohen 			*bad_wr = wr;
4240e126ba97SEli Cohen 			goto out;
4241e126ba97SEli Cohen 		}
4242e126ba97SEli Cohen 
4243e126ba97SEli Cohen 		if (unlikely(wr->num_sge > qp->rq.max_gs)) {
4244e126ba97SEli Cohen 			err = -EINVAL;
4245e126ba97SEli Cohen 			*bad_wr = wr;
4246e126ba97SEli Cohen 			goto out;
4247e126ba97SEli Cohen 		}
4248e126ba97SEli Cohen 
4249e126ba97SEli Cohen 		scat = get_recv_wqe(qp, ind);
4250e126ba97SEli Cohen 		if (qp->wq_sig)
4251e126ba97SEli Cohen 			scat++;
4252e126ba97SEli Cohen 
4253e126ba97SEli Cohen 		for (i = 0; i < wr->num_sge; i++)
4254e126ba97SEli Cohen 			set_data_ptr_seg(scat + i, wr->sg_list + i);
4255e126ba97SEli Cohen 
4256e126ba97SEli Cohen 		if (i < qp->rq.max_gs) {
4257e126ba97SEli Cohen 			scat[i].byte_count = 0;
4258e126ba97SEli Cohen 			scat[i].lkey       = cpu_to_be32(MLX5_INVALID_LKEY);
4259e126ba97SEli Cohen 			scat[i].addr       = 0;
4260e126ba97SEli Cohen 		}
4261e126ba97SEli Cohen 
4262e126ba97SEli Cohen 		if (qp->wq_sig) {
4263e126ba97SEli Cohen 			sig = (struct mlx5_rwqe_sig *)scat;
4264e126ba97SEli Cohen 			set_sig_seg(sig, (qp->rq.max_gs + 1) << 2);
4265e126ba97SEli Cohen 		}
4266e126ba97SEli Cohen 
4267e126ba97SEli Cohen 		qp->rq.wrid[ind] = wr->wr_id;
4268e126ba97SEli Cohen 
4269e126ba97SEli Cohen 		ind = (ind + 1) & (qp->rq.wqe_cnt - 1);
4270e126ba97SEli Cohen 	}
4271e126ba97SEli Cohen 
4272e126ba97SEli Cohen out:
4273e126ba97SEli Cohen 	if (likely(nreq)) {
4274e126ba97SEli Cohen 		qp->rq.head += nreq;
4275e126ba97SEli Cohen 
4276e126ba97SEli Cohen 		/* Make sure that descriptors are written before
4277e126ba97SEli Cohen 		 * doorbell record.
4278e126ba97SEli Cohen 		 */
4279e126ba97SEli Cohen 		wmb();
4280e126ba97SEli Cohen 
4281e126ba97SEli Cohen 		*qp->db.db = cpu_to_be32(qp->rq.head & 0xffff);
4282e126ba97SEli Cohen 	}
4283e126ba97SEli Cohen 
4284e126ba97SEli Cohen 	spin_unlock_irqrestore(&qp->rq.lock, flags);
4285e126ba97SEli Cohen 
4286e126ba97SEli Cohen 	return err;
4287e126ba97SEli Cohen }
4288e126ba97SEli Cohen 
4289e126ba97SEli Cohen static inline enum ib_qp_state to_ib_qp_state(enum mlx5_qp_state mlx5_state)
4290e126ba97SEli Cohen {
4291e126ba97SEli Cohen 	switch (mlx5_state) {
4292e126ba97SEli Cohen 	case MLX5_QP_STATE_RST:      return IB_QPS_RESET;
4293e126ba97SEli Cohen 	case MLX5_QP_STATE_INIT:     return IB_QPS_INIT;
4294e126ba97SEli Cohen 	case MLX5_QP_STATE_RTR:      return IB_QPS_RTR;
4295e126ba97SEli Cohen 	case MLX5_QP_STATE_RTS:      return IB_QPS_RTS;
4296e126ba97SEli Cohen 	case MLX5_QP_STATE_SQ_DRAINING:
4297e126ba97SEli Cohen 	case MLX5_QP_STATE_SQD:      return IB_QPS_SQD;
4298e126ba97SEli Cohen 	case MLX5_QP_STATE_SQER:     return IB_QPS_SQE;
4299e126ba97SEli Cohen 	case MLX5_QP_STATE_ERR:      return IB_QPS_ERR;
4300e126ba97SEli Cohen 	default:		     return -1;
4301e126ba97SEli Cohen 	}
4302e126ba97SEli Cohen }
4303e126ba97SEli Cohen 
4304e126ba97SEli Cohen static inline enum ib_mig_state to_ib_mig_state(int mlx5_mig_state)
4305e126ba97SEli Cohen {
4306e126ba97SEli Cohen 	switch (mlx5_mig_state) {
4307e126ba97SEli Cohen 	case MLX5_QP_PM_ARMED:		return IB_MIG_ARMED;
4308e126ba97SEli Cohen 	case MLX5_QP_PM_REARM:		return IB_MIG_REARM;
4309e126ba97SEli Cohen 	case MLX5_QP_PM_MIGRATED:	return IB_MIG_MIGRATED;
4310e126ba97SEli Cohen 	default: return -1;
4311e126ba97SEli Cohen 	}
4312e126ba97SEli Cohen }
4313e126ba97SEli Cohen 
4314e126ba97SEli Cohen static int to_ib_qp_access_flags(int mlx5_flags)
4315e126ba97SEli Cohen {
4316e126ba97SEli Cohen 	int ib_flags = 0;
4317e126ba97SEli Cohen 
4318e126ba97SEli Cohen 	if (mlx5_flags & MLX5_QP_BIT_RRE)
4319e126ba97SEli Cohen 		ib_flags |= IB_ACCESS_REMOTE_READ;
4320e126ba97SEli Cohen 	if (mlx5_flags & MLX5_QP_BIT_RWE)
4321e126ba97SEli Cohen 		ib_flags |= IB_ACCESS_REMOTE_WRITE;
4322e126ba97SEli Cohen 	if (mlx5_flags & MLX5_QP_BIT_RAE)
4323e126ba97SEli Cohen 		ib_flags |= IB_ACCESS_REMOTE_ATOMIC;
4324e126ba97SEli Cohen 
4325e126ba97SEli Cohen 	return ib_flags;
4326e126ba97SEli Cohen }
4327e126ba97SEli Cohen 
4328e126ba97SEli Cohen static void to_ib_ah_attr(struct mlx5_ib_dev *ibdev, struct ib_ah_attr *ib_ah_attr,
4329e126ba97SEli Cohen 				struct mlx5_qp_path *path)
4330e126ba97SEli Cohen {
43319603b61dSJack Morgenstein 	struct mlx5_core_dev *dev = ibdev->mdev;
4332e126ba97SEli Cohen 
4333e126ba97SEli Cohen 	memset(ib_ah_attr, 0, sizeof(*ib_ah_attr));
4334e126ba97SEli Cohen 	ib_ah_attr->port_num	  = path->port;
4335e126ba97SEli Cohen 
4336c7a08ac7SEli Cohen 	if (ib_ah_attr->port_num == 0 ||
4337938fe83cSSaeed Mahameed 	    ib_ah_attr->port_num > MLX5_CAP_GEN(dev, num_ports))
4338e126ba97SEli Cohen 		return;
4339e126ba97SEli Cohen 
43402811ba51SAchiad Shochat 	ib_ah_attr->sl = path->dci_cfi_prio_sl & 0xf;
4341e126ba97SEli Cohen 
4342e126ba97SEli Cohen 	ib_ah_attr->dlid	  = be16_to_cpu(path->rlid);
4343e126ba97SEli Cohen 	ib_ah_attr->src_path_bits = path->grh_mlid & 0x7f;
4344e126ba97SEli Cohen 	ib_ah_attr->static_rate   = path->static_rate ? path->static_rate - 5 : 0;
4345e126ba97SEli Cohen 	ib_ah_attr->ah_flags      = (path->grh_mlid & (1 << 7)) ? IB_AH_GRH : 0;
4346e126ba97SEli Cohen 	if (ib_ah_attr->ah_flags) {
4347e126ba97SEli Cohen 		ib_ah_attr->grh.sgid_index = path->mgid_index;
4348e126ba97SEli Cohen 		ib_ah_attr->grh.hop_limit  = path->hop_limit;
4349e126ba97SEli Cohen 		ib_ah_attr->grh.traffic_class =
4350e126ba97SEli Cohen 			(be32_to_cpu(path->tclass_flowlabel) >> 20) & 0xff;
4351e126ba97SEli Cohen 		ib_ah_attr->grh.flow_label =
4352e126ba97SEli Cohen 			be32_to_cpu(path->tclass_flowlabel) & 0xfffff;
4353e126ba97SEli Cohen 		memcpy(ib_ah_attr->grh.dgid.raw,
4354e126ba97SEli Cohen 		       path->rgid, sizeof(ib_ah_attr->grh.dgid.raw));
4355e126ba97SEli Cohen 	}
4356e126ba97SEli Cohen }
4357e126ba97SEli Cohen 
43586d2f89dfSmajd@mellanox.com static int query_raw_packet_qp_sq_state(struct mlx5_ib_dev *dev,
43596d2f89dfSmajd@mellanox.com 					struct mlx5_ib_sq *sq,
43606d2f89dfSmajd@mellanox.com 					u8 *sq_state)
4361e126ba97SEli Cohen {
43626d2f89dfSmajd@mellanox.com 	void *out;
43636d2f89dfSmajd@mellanox.com 	void *sqc;
43646d2f89dfSmajd@mellanox.com 	int inlen;
43656d2f89dfSmajd@mellanox.com 	int err;
43666d2f89dfSmajd@mellanox.com 
43676d2f89dfSmajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(query_sq_out);
43686d2f89dfSmajd@mellanox.com 	out = mlx5_vzalloc(inlen);
43696d2f89dfSmajd@mellanox.com 	if (!out)
43706d2f89dfSmajd@mellanox.com 		return -ENOMEM;
43716d2f89dfSmajd@mellanox.com 
43726d2f89dfSmajd@mellanox.com 	err = mlx5_core_query_sq(dev->mdev, sq->base.mqp.qpn, out);
43736d2f89dfSmajd@mellanox.com 	if (err)
43746d2f89dfSmajd@mellanox.com 		goto out;
43756d2f89dfSmajd@mellanox.com 
43766d2f89dfSmajd@mellanox.com 	sqc = MLX5_ADDR_OF(query_sq_out, out, sq_context);
43776d2f89dfSmajd@mellanox.com 	*sq_state = MLX5_GET(sqc, sqc, state);
43786d2f89dfSmajd@mellanox.com 	sq->state = *sq_state;
43796d2f89dfSmajd@mellanox.com 
43806d2f89dfSmajd@mellanox.com out:
43816d2f89dfSmajd@mellanox.com 	kvfree(out);
43826d2f89dfSmajd@mellanox.com 	return err;
43836d2f89dfSmajd@mellanox.com }
43846d2f89dfSmajd@mellanox.com 
43856d2f89dfSmajd@mellanox.com static int query_raw_packet_qp_rq_state(struct mlx5_ib_dev *dev,
43866d2f89dfSmajd@mellanox.com 					struct mlx5_ib_rq *rq,
43876d2f89dfSmajd@mellanox.com 					u8 *rq_state)
43886d2f89dfSmajd@mellanox.com {
43896d2f89dfSmajd@mellanox.com 	void *out;
43906d2f89dfSmajd@mellanox.com 	void *rqc;
43916d2f89dfSmajd@mellanox.com 	int inlen;
43926d2f89dfSmajd@mellanox.com 	int err;
43936d2f89dfSmajd@mellanox.com 
43946d2f89dfSmajd@mellanox.com 	inlen = MLX5_ST_SZ_BYTES(query_rq_out);
43956d2f89dfSmajd@mellanox.com 	out = mlx5_vzalloc(inlen);
43966d2f89dfSmajd@mellanox.com 	if (!out)
43976d2f89dfSmajd@mellanox.com 		return -ENOMEM;
43986d2f89dfSmajd@mellanox.com 
43996d2f89dfSmajd@mellanox.com 	err = mlx5_core_query_rq(dev->mdev, rq->base.mqp.qpn, out);
44006d2f89dfSmajd@mellanox.com 	if (err)
44016d2f89dfSmajd@mellanox.com 		goto out;
44026d2f89dfSmajd@mellanox.com 
44036d2f89dfSmajd@mellanox.com 	rqc = MLX5_ADDR_OF(query_rq_out, out, rq_context);
44046d2f89dfSmajd@mellanox.com 	*rq_state = MLX5_GET(rqc, rqc, state);
44056d2f89dfSmajd@mellanox.com 	rq->state = *rq_state;
44066d2f89dfSmajd@mellanox.com 
44076d2f89dfSmajd@mellanox.com out:
44086d2f89dfSmajd@mellanox.com 	kvfree(out);
44096d2f89dfSmajd@mellanox.com 	return err;
44106d2f89dfSmajd@mellanox.com }
44116d2f89dfSmajd@mellanox.com 
44126d2f89dfSmajd@mellanox.com static int sqrq_state_to_qp_state(u8 sq_state, u8 rq_state,
44136d2f89dfSmajd@mellanox.com 				  struct mlx5_ib_qp *qp, u8 *qp_state)
44146d2f89dfSmajd@mellanox.com {
44156d2f89dfSmajd@mellanox.com 	static const u8 sqrq_trans[MLX5_RQ_NUM_STATE][MLX5_SQ_NUM_STATE] = {
44166d2f89dfSmajd@mellanox.com 		[MLX5_RQC_STATE_RST] = {
44176d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RST]	= IB_QPS_RESET,
44186d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RDY]	= MLX5_QP_STATE_BAD,
44196d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_ERR]	= MLX5_QP_STATE_BAD,
44206d2f89dfSmajd@mellanox.com 			[MLX5_SQ_STATE_NA]	= IB_QPS_RESET,
44216d2f89dfSmajd@mellanox.com 		},
44226d2f89dfSmajd@mellanox.com 		[MLX5_RQC_STATE_RDY] = {
44236d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RST]	= MLX5_QP_STATE_BAD,
44246d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RDY]	= MLX5_QP_STATE,
44256d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_ERR]	= IB_QPS_SQE,
44266d2f89dfSmajd@mellanox.com 			[MLX5_SQ_STATE_NA]	= MLX5_QP_STATE,
44276d2f89dfSmajd@mellanox.com 		},
44286d2f89dfSmajd@mellanox.com 		[MLX5_RQC_STATE_ERR] = {
44296d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RST]    = MLX5_QP_STATE_BAD,
44306d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RDY]	= MLX5_QP_STATE_BAD,
44316d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_ERR]	= IB_QPS_ERR,
44326d2f89dfSmajd@mellanox.com 			[MLX5_SQ_STATE_NA]	= IB_QPS_ERR,
44336d2f89dfSmajd@mellanox.com 		},
44346d2f89dfSmajd@mellanox.com 		[MLX5_RQ_STATE_NA] = {
44356d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RST]    = IB_QPS_RESET,
44366d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_RDY]	= MLX5_QP_STATE,
44376d2f89dfSmajd@mellanox.com 			[MLX5_SQC_STATE_ERR]	= MLX5_QP_STATE,
44386d2f89dfSmajd@mellanox.com 			[MLX5_SQ_STATE_NA]	= MLX5_QP_STATE_BAD,
44396d2f89dfSmajd@mellanox.com 		},
44406d2f89dfSmajd@mellanox.com 	};
44416d2f89dfSmajd@mellanox.com 
44426d2f89dfSmajd@mellanox.com 	*qp_state = sqrq_trans[rq_state][sq_state];
44436d2f89dfSmajd@mellanox.com 
44446d2f89dfSmajd@mellanox.com 	if (*qp_state == MLX5_QP_STATE_BAD) {
44456d2f89dfSmajd@mellanox.com 		WARN(1, "Buggy Raw Packet QP state, SQ 0x%x state: 0x%x, RQ 0x%x state: 0x%x",
44466d2f89dfSmajd@mellanox.com 		     qp->raw_packet_qp.sq.base.mqp.qpn, sq_state,
44476d2f89dfSmajd@mellanox.com 		     qp->raw_packet_qp.rq.base.mqp.qpn, rq_state);
44486d2f89dfSmajd@mellanox.com 		return -EINVAL;
44496d2f89dfSmajd@mellanox.com 	}
44506d2f89dfSmajd@mellanox.com 
44516d2f89dfSmajd@mellanox.com 	if (*qp_state == MLX5_QP_STATE)
44526d2f89dfSmajd@mellanox.com 		*qp_state = qp->state;
44536d2f89dfSmajd@mellanox.com 
44546d2f89dfSmajd@mellanox.com 	return 0;
44556d2f89dfSmajd@mellanox.com }
44566d2f89dfSmajd@mellanox.com 
44576d2f89dfSmajd@mellanox.com static int query_raw_packet_qp_state(struct mlx5_ib_dev *dev,
44586d2f89dfSmajd@mellanox.com 				     struct mlx5_ib_qp *qp,
44596d2f89dfSmajd@mellanox.com 				     u8 *raw_packet_qp_state)
44606d2f89dfSmajd@mellanox.com {
44616d2f89dfSmajd@mellanox.com 	struct mlx5_ib_raw_packet_qp *raw_packet_qp = &qp->raw_packet_qp;
44626d2f89dfSmajd@mellanox.com 	struct mlx5_ib_sq *sq = &raw_packet_qp->sq;
44636d2f89dfSmajd@mellanox.com 	struct mlx5_ib_rq *rq = &raw_packet_qp->rq;
44646d2f89dfSmajd@mellanox.com 	int err;
44656d2f89dfSmajd@mellanox.com 	u8 sq_state = MLX5_SQ_STATE_NA;
44666d2f89dfSmajd@mellanox.com 	u8 rq_state = MLX5_RQ_STATE_NA;
44676d2f89dfSmajd@mellanox.com 
44686d2f89dfSmajd@mellanox.com 	if (qp->sq.wqe_cnt) {
44696d2f89dfSmajd@mellanox.com 		err = query_raw_packet_qp_sq_state(dev, sq, &sq_state);
44706d2f89dfSmajd@mellanox.com 		if (err)
44716d2f89dfSmajd@mellanox.com 			return err;
44726d2f89dfSmajd@mellanox.com 	}
44736d2f89dfSmajd@mellanox.com 
44746d2f89dfSmajd@mellanox.com 	if (qp->rq.wqe_cnt) {
44756d2f89dfSmajd@mellanox.com 		err = query_raw_packet_qp_rq_state(dev, rq, &rq_state);
44766d2f89dfSmajd@mellanox.com 		if (err)
44776d2f89dfSmajd@mellanox.com 			return err;
44786d2f89dfSmajd@mellanox.com 	}
44796d2f89dfSmajd@mellanox.com 
44806d2f89dfSmajd@mellanox.com 	return sqrq_state_to_qp_state(sq_state, rq_state, qp,
44816d2f89dfSmajd@mellanox.com 				      raw_packet_qp_state);
44826d2f89dfSmajd@mellanox.com }
44836d2f89dfSmajd@mellanox.com 
44846d2f89dfSmajd@mellanox.com static int query_qp_attr(struct mlx5_ib_dev *dev, struct mlx5_ib_qp *qp,
44856d2f89dfSmajd@mellanox.com 			 struct ib_qp_attr *qp_attr)
44866d2f89dfSmajd@mellanox.com {
448709a7d9ecSSaeed Mahameed 	int outlen = MLX5_ST_SZ_BYTES(query_qp_out);
4488e126ba97SEli Cohen 	struct mlx5_qp_context *context;
4489e126ba97SEli Cohen 	int mlx5_state;
449009a7d9ecSSaeed Mahameed 	u32 *outb;
4491e126ba97SEli Cohen 	int err = 0;
4492e126ba97SEli Cohen 
449309a7d9ecSSaeed Mahameed 	outb = kzalloc(outlen, GFP_KERNEL);
44946d2f89dfSmajd@mellanox.com 	if (!outb)
44956d2f89dfSmajd@mellanox.com 		return -ENOMEM;
44966d2f89dfSmajd@mellanox.com 
449719098df2Smajd@mellanox.com 	err = mlx5_core_qp_query(dev->mdev, &qp->trans_qp.base.mqp, outb,
449809a7d9ecSSaeed Mahameed 				 outlen);
4499e126ba97SEli Cohen 	if (err)
45006d2f89dfSmajd@mellanox.com 		goto out;
4501e126ba97SEli Cohen 
450209a7d9ecSSaeed Mahameed 	/* FIXME: use MLX5_GET rather than mlx5_qp_context manual struct */
450309a7d9ecSSaeed Mahameed 	context = (struct mlx5_qp_context *)MLX5_ADDR_OF(query_qp_out, outb, qpc);
450409a7d9ecSSaeed Mahameed 
4505e126ba97SEli Cohen 	mlx5_state = be32_to_cpu(context->flags) >> 28;
4506e126ba97SEli Cohen 
4507e126ba97SEli Cohen 	qp->state		     = to_ib_qp_state(mlx5_state);
4508e126ba97SEli Cohen 	qp_attr->path_mtu	     = context->mtu_msgmax >> 5;
4509e126ba97SEli Cohen 	qp_attr->path_mig_state	     =
4510e126ba97SEli Cohen 		to_ib_mig_state((be32_to_cpu(context->flags) >> 11) & 0x3);
4511e126ba97SEli Cohen 	qp_attr->qkey		     = be32_to_cpu(context->qkey);
4512e126ba97SEli Cohen 	qp_attr->rq_psn		     = be32_to_cpu(context->rnr_nextrecvpsn) & 0xffffff;
4513e126ba97SEli Cohen 	qp_attr->sq_psn		     = be32_to_cpu(context->next_send_psn) & 0xffffff;
4514e126ba97SEli Cohen 	qp_attr->dest_qp_num	     = be32_to_cpu(context->log_pg_sz_remote_qpn) & 0xffffff;
4515e126ba97SEli Cohen 	qp_attr->qp_access_flags     =
4516e126ba97SEli Cohen 		to_ib_qp_access_flags(be32_to_cpu(context->params2));
4517e126ba97SEli Cohen 
4518e126ba97SEli Cohen 	if (qp->ibqp.qp_type == IB_QPT_RC || qp->ibqp.qp_type == IB_QPT_UC) {
4519e126ba97SEli Cohen 		to_ib_ah_attr(dev, &qp_attr->ah_attr, &context->pri_path);
4520e126ba97SEli Cohen 		to_ib_ah_attr(dev, &qp_attr->alt_ah_attr, &context->alt_path);
4521d3ae2bdeSNoa Osherovich 		qp_attr->alt_pkey_index =
4522d3ae2bdeSNoa Osherovich 			be16_to_cpu(context->alt_path.pkey_index);
4523e126ba97SEli Cohen 		qp_attr->alt_port_num	= qp_attr->alt_ah_attr.port_num;
4524e126ba97SEli Cohen 	}
4525e126ba97SEli Cohen 
4526d3ae2bdeSNoa Osherovich 	qp_attr->pkey_index = be16_to_cpu(context->pri_path.pkey_index);
4527e126ba97SEli Cohen 	qp_attr->port_num = context->pri_path.port;
4528e126ba97SEli Cohen 
4529e126ba97SEli Cohen 	/* qp_attr->en_sqd_async_notify is only applicable in modify qp */
4530e126ba97SEli Cohen 	qp_attr->sq_draining = mlx5_state == MLX5_QP_STATE_SQ_DRAINING;
4531e126ba97SEli Cohen 
4532e126ba97SEli Cohen 	qp_attr->max_rd_atomic = 1 << ((be32_to_cpu(context->params1) >> 21) & 0x7);
4533e126ba97SEli Cohen 
4534e126ba97SEli Cohen 	qp_attr->max_dest_rd_atomic =
4535e126ba97SEli Cohen 		1 << ((be32_to_cpu(context->params2) >> 21) & 0x7);
4536e126ba97SEli Cohen 	qp_attr->min_rnr_timer	    =
4537e126ba97SEli Cohen 		(be32_to_cpu(context->rnr_nextrecvpsn) >> 24) & 0x1f;
4538e126ba97SEli Cohen 	qp_attr->timeout	    = context->pri_path.ackto_lt >> 3;
4539e126ba97SEli Cohen 	qp_attr->retry_cnt	    = (be32_to_cpu(context->params1) >> 16) & 0x7;
4540e126ba97SEli Cohen 	qp_attr->rnr_retry	    = (be32_to_cpu(context->params1) >> 13) & 0x7;
4541e126ba97SEli Cohen 	qp_attr->alt_timeout	    = context->alt_path.ackto_lt >> 3;
45426d2f89dfSmajd@mellanox.com 
45436d2f89dfSmajd@mellanox.com out:
45446d2f89dfSmajd@mellanox.com 	kfree(outb);
45456d2f89dfSmajd@mellanox.com 	return err;
45466d2f89dfSmajd@mellanox.com }
45476d2f89dfSmajd@mellanox.com 
45486d2f89dfSmajd@mellanox.com int mlx5_ib_query_qp(struct ib_qp *ibqp, struct ib_qp_attr *qp_attr,
45496d2f89dfSmajd@mellanox.com 		     int qp_attr_mask, struct ib_qp_init_attr *qp_init_attr)
45506d2f89dfSmajd@mellanox.com {
45516d2f89dfSmajd@mellanox.com 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
45526d2f89dfSmajd@mellanox.com 	struct mlx5_ib_qp *qp = to_mqp(ibqp);
45536d2f89dfSmajd@mellanox.com 	int err = 0;
45546d2f89dfSmajd@mellanox.com 	u8 raw_packet_qp_state;
45556d2f89dfSmajd@mellanox.com 
455628d61370SYishai Hadas 	if (ibqp->rwq_ind_tbl)
455728d61370SYishai Hadas 		return -ENOSYS;
455828d61370SYishai Hadas 
4559d16e91daSHaggai Eran 	if (unlikely(ibqp->qp_type == IB_QPT_GSI))
4560d16e91daSHaggai Eran 		return mlx5_ib_gsi_query_qp(ibqp, qp_attr, qp_attr_mask,
4561d16e91daSHaggai Eran 					    qp_init_attr);
4562d16e91daSHaggai Eran 
45636d2f89dfSmajd@mellanox.com #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
45646d2f89dfSmajd@mellanox.com 	/*
45656d2f89dfSmajd@mellanox.com 	 * Wait for any outstanding page faults, in case the user frees memory
45666d2f89dfSmajd@mellanox.com 	 * based upon this query's result.
45676d2f89dfSmajd@mellanox.com 	 */
45686d2f89dfSmajd@mellanox.com 	flush_workqueue(mlx5_ib_page_fault_wq);
45696d2f89dfSmajd@mellanox.com #endif
45706d2f89dfSmajd@mellanox.com 
45716d2f89dfSmajd@mellanox.com 	mutex_lock(&qp->mutex);
45726d2f89dfSmajd@mellanox.com 
45736d2f89dfSmajd@mellanox.com 	if (qp->ibqp.qp_type == IB_QPT_RAW_PACKET) {
45746d2f89dfSmajd@mellanox.com 		err = query_raw_packet_qp_state(dev, qp, &raw_packet_qp_state);
45756d2f89dfSmajd@mellanox.com 		if (err)
45766d2f89dfSmajd@mellanox.com 			goto out;
45776d2f89dfSmajd@mellanox.com 		qp->state = raw_packet_qp_state;
45786d2f89dfSmajd@mellanox.com 		qp_attr->port_num = 1;
45796d2f89dfSmajd@mellanox.com 	} else {
45806d2f89dfSmajd@mellanox.com 		err = query_qp_attr(dev, qp, qp_attr);
45816d2f89dfSmajd@mellanox.com 		if (err)
45826d2f89dfSmajd@mellanox.com 			goto out;
45836d2f89dfSmajd@mellanox.com 	}
45846d2f89dfSmajd@mellanox.com 
45856d2f89dfSmajd@mellanox.com 	qp_attr->qp_state	     = qp->state;
4586e126ba97SEli Cohen 	qp_attr->cur_qp_state	     = qp_attr->qp_state;
4587e126ba97SEli Cohen 	qp_attr->cap.max_recv_wr     = qp->rq.wqe_cnt;
4588e126ba97SEli Cohen 	qp_attr->cap.max_recv_sge    = qp->rq.max_gs;
4589e126ba97SEli Cohen 
4590e126ba97SEli Cohen 	if (!ibqp->uobject) {
45910540d814SNoa Osherovich 		qp_attr->cap.max_send_wr  = qp->sq.max_post;
4592e126ba97SEli Cohen 		qp_attr->cap.max_send_sge = qp->sq.max_gs;
45930540d814SNoa Osherovich 		qp_init_attr->qp_context = ibqp->qp_context;
4594e126ba97SEli Cohen 	} else {
4595e126ba97SEli Cohen 		qp_attr->cap.max_send_wr  = 0;
4596e126ba97SEli Cohen 		qp_attr->cap.max_send_sge = 0;
4597e126ba97SEli Cohen 	}
4598e126ba97SEli Cohen 
45990540d814SNoa Osherovich 	qp_init_attr->qp_type = ibqp->qp_type;
46000540d814SNoa Osherovich 	qp_init_attr->recv_cq = ibqp->recv_cq;
46010540d814SNoa Osherovich 	qp_init_attr->send_cq = ibqp->send_cq;
46020540d814SNoa Osherovich 	qp_init_attr->srq = ibqp->srq;
46030540d814SNoa Osherovich 	qp_attr->cap.max_inline_data = qp->max_inline_data;
4604e126ba97SEli Cohen 
4605e126ba97SEli Cohen 	qp_init_attr->cap	     = qp_attr->cap;
4606e126ba97SEli Cohen 
4607e126ba97SEli Cohen 	qp_init_attr->create_flags = 0;
4608e126ba97SEli Cohen 	if (qp->flags & MLX5_IB_QP_BLOCK_MULTICAST_LOOPBACK)
4609e126ba97SEli Cohen 		qp_init_attr->create_flags |= IB_QP_CREATE_BLOCK_MULTICAST_LOOPBACK;
4610e126ba97SEli Cohen 
4611051f2630SLeon Romanovsky 	if (qp->flags & MLX5_IB_QP_CROSS_CHANNEL)
4612051f2630SLeon Romanovsky 		qp_init_attr->create_flags |= IB_QP_CREATE_CROSS_CHANNEL;
4613051f2630SLeon Romanovsky 	if (qp->flags & MLX5_IB_QP_MANAGED_SEND)
4614051f2630SLeon Romanovsky 		qp_init_attr->create_flags |= IB_QP_CREATE_MANAGED_SEND;
4615051f2630SLeon Romanovsky 	if (qp->flags & MLX5_IB_QP_MANAGED_RECV)
4616051f2630SLeon Romanovsky 		qp_init_attr->create_flags |= IB_QP_CREATE_MANAGED_RECV;
4617b11a4f9cSHaggai Eran 	if (qp->flags & MLX5_IB_QP_SQPN_QP1)
4618b11a4f9cSHaggai Eran 		qp_init_attr->create_flags |= mlx5_ib_create_qp_sqpn_qp1();
4619051f2630SLeon Romanovsky 
4620e126ba97SEli Cohen 	qp_init_attr->sq_sig_type = qp->sq_signal_bits & MLX5_WQE_CTRL_CQ_UPDATE ?
4621e126ba97SEli Cohen 		IB_SIGNAL_ALL_WR : IB_SIGNAL_REQ_WR;
4622e126ba97SEli Cohen 
4623e126ba97SEli Cohen out:
4624e126ba97SEli Cohen 	mutex_unlock(&qp->mutex);
4625e126ba97SEli Cohen 	return err;
4626e126ba97SEli Cohen }
4627e126ba97SEli Cohen 
4628e126ba97SEli Cohen struct ib_xrcd *mlx5_ib_alloc_xrcd(struct ib_device *ibdev,
4629e126ba97SEli Cohen 					  struct ib_ucontext *context,
4630e126ba97SEli Cohen 					  struct ib_udata *udata)
4631e126ba97SEli Cohen {
4632e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
4633e126ba97SEli Cohen 	struct mlx5_ib_xrcd *xrcd;
4634e126ba97SEli Cohen 	int err;
4635e126ba97SEli Cohen 
4636938fe83cSSaeed Mahameed 	if (!MLX5_CAP_GEN(dev->mdev, xrc))
4637e126ba97SEli Cohen 		return ERR_PTR(-ENOSYS);
4638e126ba97SEli Cohen 
4639e126ba97SEli Cohen 	xrcd = kmalloc(sizeof(*xrcd), GFP_KERNEL);
4640e126ba97SEli Cohen 	if (!xrcd)
4641e126ba97SEli Cohen 		return ERR_PTR(-ENOMEM);
4642e126ba97SEli Cohen 
46439603b61dSJack Morgenstein 	err = mlx5_core_xrcd_alloc(dev->mdev, &xrcd->xrcdn);
4644e126ba97SEli Cohen 	if (err) {
4645e126ba97SEli Cohen 		kfree(xrcd);
4646e126ba97SEli Cohen 		return ERR_PTR(-ENOMEM);
4647e126ba97SEli Cohen 	}
4648e126ba97SEli Cohen 
4649e126ba97SEli Cohen 	return &xrcd->ibxrcd;
4650e126ba97SEli Cohen }
4651e126ba97SEli Cohen 
4652e126ba97SEli Cohen int mlx5_ib_dealloc_xrcd(struct ib_xrcd *xrcd)
4653e126ba97SEli Cohen {
4654e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(xrcd->device);
4655e126ba97SEli Cohen 	u32 xrcdn = to_mxrcd(xrcd)->xrcdn;
4656e126ba97SEli Cohen 	int err;
4657e126ba97SEli Cohen 
46589603b61dSJack Morgenstein 	err = mlx5_core_xrcd_dealloc(dev->mdev, xrcdn);
4659e126ba97SEli Cohen 	if (err) {
4660e126ba97SEli Cohen 		mlx5_ib_warn(dev, "failed to dealloc xrcdn 0x%x\n", xrcdn);
4661e126ba97SEli Cohen 		return err;
4662e126ba97SEli Cohen 	}
4663e126ba97SEli Cohen 
4664e126ba97SEli Cohen 	kfree(xrcd);
4665e126ba97SEli Cohen 
4666e126ba97SEli Cohen 	return 0;
4667e126ba97SEli Cohen }
466879b20a6cSYishai Hadas 
4669350d0e4cSYishai Hadas static void mlx5_ib_wq_event(struct mlx5_core_qp *core_qp, int type)
4670350d0e4cSYishai Hadas {
4671350d0e4cSYishai Hadas 	struct mlx5_ib_rwq *rwq = to_mibrwq(core_qp);
4672350d0e4cSYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(rwq->ibwq.device);
4673350d0e4cSYishai Hadas 	struct ib_event event;
4674350d0e4cSYishai Hadas 
4675350d0e4cSYishai Hadas 	if (rwq->ibwq.event_handler) {
4676350d0e4cSYishai Hadas 		event.device     = rwq->ibwq.device;
4677350d0e4cSYishai Hadas 		event.element.wq = &rwq->ibwq;
4678350d0e4cSYishai Hadas 		switch (type) {
4679350d0e4cSYishai Hadas 		case MLX5_EVENT_TYPE_WQ_CATAS_ERROR:
4680350d0e4cSYishai Hadas 			event.event = IB_EVENT_WQ_FATAL;
4681350d0e4cSYishai Hadas 			break;
4682350d0e4cSYishai Hadas 		default:
4683350d0e4cSYishai Hadas 			mlx5_ib_warn(dev, "Unexpected event type %d on WQ %06x\n", type, core_qp->qpn);
4684350d0e4cSYishai Hadas 			return;
4685350d0e4cSYishai Hadas 		}
4686350d0e4cSYishai Hadas 
4687350d0e4cSYishai Hadas 		rwq->ibwq.event_handler(&event, rwq->ibwq.wq_context);
4688350d0e4cSYishai Hadas 	}
4689350d0e4cSYishai Hadas }
4690350d0e4cSYishai Hadas 
469179b20a6cSYishai Hadas static int  create_rq(struct mlx5_ib_rwq *rwq, struct ib_pd *pd,
469279b20a6cSYishai Hadas 		      struct ib_wq_init_attr *init_attr)
469379b20a6cSYishai Hadas {
469479b20a6cSYishai Hadas 	struct mlx5_ib_dev *dev;
469579b20a6cSYishai Hadas 	__be64 *rq_pas0;
469679b20a6cSYishai Hadas 	void *in;
469779b20a6cSYishai Hadas 	void *rqc;
469879b20a6cSYishai Hadas 	void *wq;
469979b20a6cSYishai Hadas 	int inlen;
470079b20a6cSYishai Hadas 	int err;
470179b20a6cSYishai Hadas 
470279b20a6cSYishai Hadas 	dev = to_mdev(pd->device);
470379b20a6cSYishai Hadas 
470479b20a6cSYishai Hadas 	inlen = MLX5_ST_SZ_BYTES(create_rq_in) + sizeof(u64) * rwq->rq_num_pas;
470579b20a6cSYishai Hadas 	in = mlx5_vzalloc(inlen);
470679b20a6cSYishai Hadas 	if (!in)
470779b20a6cSYishai Hadas 		return -ENOMEM;
470879b20a6cSYishai Hadas 
470979b20a6cSYishai Hadas 	rqc = MLX5_ADDR_OF(create_rq_in, in, ctx);
471079b20a6cSYishai Hadas 	MLX5_SET(rqc,  rqc, mem_rq_type,
471179b20a6cSYishai Hadas 		 MLX5_RQC_MEM_RQ_TYPE_MEMORY_RQ_INLINE);
471279b20a6cSYishai Hadas 	MLX5_SET(rqc, rqc, user_index, rwq->user_index);
471379b20a6cSYishai Hadas 	MLX5_SET(rqc,  rqc, cqn, to_mcq(init_attr->cq)->mcq.cqn);
471479b20a6cSYishai Hadas 	MLX5_SET(rqc,  rqc, state, MLX5_RQC_STATE_RST);
471579b20a6cSYishai Hadas 	MLX5_SET(rqc,  rqc, flush_in_error_en, 1);
471679b20a6cSYishai Hadas 	wq = MLX5_ADDR_OF(rqc, rqc, wq);
471779b20a6cSYishai Hadas 	MLX5_SET(wq, wq, wq_type, MLX5_WQ_TYPE_CYCLIC);
471879b20a6cSYishai Hadas 	MLX5_SET(wq, wq, end_padding_mode, MLX5_WQ_END_PAD_MODE_ALIGN);
471979b20a6cSYishai Hadas 	MLX5_SET(wq, wq, log_wq_stride, rwq->log_rq_stride);
472079b20a6cSYishai Hadas 	MLX5_SET(wq, wq, log_wq_sz, rwq->log_rq_size);
472179b20a6cSYishai Hadas 	MLX5_SET(wq, wq, pd, to_mpd(pd)->pdn);
472279b20a6cSYishai Hadas 	MLX5_SET(wq, wq, page_offset, rwq->rq_page_offset);
472379b20a6cSYishai Hadas 	MLX5_SET(wq, wq, log_wq_pg_sz, rwq->log_page_size);
472479b20a6cSYishai Hadas 	MLX5_SET(wq, wq, wq_signature, rwq->wq_sig);
472579b20a6cSYishai Hadas 	MLX5_SET64(wq, wq, dbr_addr, rwq->db.dma);
472679b20a6cSYishai Hadas 	rq_pas0 = (__be64 *)MLX5_ADDR_OF(wq, wq, pas);
472779b20a6cSYishai Hadas 	mlx5_ib_populate_pas(dev, rwq->umem, rwq->page_shift, rq_pas0, 0);
4728350d0e4cSYishai Hadas 	err = mlx5_core_create_rq_tracked(dev->mdev, in, inlen, &rwq->core_qp);
472979b20a6cSYishai Hadas 	kvfree(in);
473079b20a6cSYishai Hadas 	return err;
473179b20a6cSYishai Hadas }
473279b20a6cSYishai Hadas 
473379b20a6cSYishai Hadas static int set_user_rq_size(struct mlx5_ib_dev *dev,
473479b20a6cSYishai Hadas 			    struct ib_wq_init_attr *wq_init_attr,
473579b20a6cSYishai Hadas 			    struct mlx5_ib_create_wq *ucmd,
473679b20a6cSYishai Hadas 			    struct mlx5_ib_rwq *rwq)
473779b20a6cSYishai Hadas {
473879b20a6cSYishai Hadas 	/* Sanity check RQ size before proceeding */
473979b20a6cSYishai Hadas 	if (wq_init_attr->max_wr > (1 << MLX5_CAP_GEN(dev->mdev, log_max_wq_sz)))
474079b20a6cSYishai Hadas 		return -EINVAL;
474179b20a6cSYishai Hadas 
474279b20a6cSYishai Hadas 	if (!ucmd->rq_wqe_count)
474379b20a6cSYishai Hadas 		return -EINVAL;
474479b20a6cSYishai Hadas 
474579b20a6cSYishai Hadas 	rwq->wqe_count = ucmd->rq_wqe_count;
474679b20a6cSYishai Hadas 	rwq->wqe_shift = ucmd->rq_wqe_shift;
474779b20a6cSYishai Hadas 	rwq->buf_size = (rwq->wqe_count << rwq->wqe_shift);
474879b20a6cSYishai Hadas 	rwq->log_rq_stride = rwq->wqe_shift;
474979b20a6cSYishai Hadas 	rwq->log_rq_size = ilog2(rwq->wqe_count);
475079b20a6cSYishai Hadas 	return 0;
475179b20a6cSYishai Hadas }
475279b20a6cSYishai Hadas 
475379b20a6cSYishai Hadas static int prepare_user_rq(struct ib_pd *pd,
475479b20a6cSYishai Hadas 			   struct ib_wq_init_attr *init_attr,
475579b20a6cSYishai Hadas 			   struct ib_udata *udata,
475679b20a6cSYishai Hadas 			   struct mlx5_ib_rwq *rwq)
475779b20a6cSYishai Hadas {
475879b20a6cSYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(pd->device);
475979b20a6cSYishai Hadas 	struct mlx5_ib_create_wq ucmd = {};
476079b20a6cSYishai Hadas 	int err;
476179b20a6cSYishai Hadas 	size_t required_cmd_sz;
476279b20a6cSYishai Hadas 
476379b20a6cSYishai Hadas 	required_cmd_sz = offsetof(typeof(ucmd), reserved) + sizeof(ucmd.reserved);
476479b20a6cSYishai Hadas 	if (udata->inlen < required_cmd_sz) {
476579b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "invalid inlen\n");
476679b20a6cSYishai Hadas 		return -EINVAL;
476779b20a6cSYishai Hadas 	}
476879b20a6cSYishai Hadas 
476979b20a6cSYishai Hadas 	if (udata->inlen > sizeof(ucmd) &&
477079b20a6cSYishai Hadas 	    !ib_is_udata_cleared(udata, sizeof(ucmd),
477179b20a6cSYishai Hadas 				 udata->inlen - sizeof(ucmd))) {
477279b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "inlen is not supported\n");
477379b20a6cSYishai Hadas 		return -EOPNOTSUPP;
477479b20a6cSYishai Hadas 	}
477579b20a6cSYishai Hadas 
477679b20a6cSYishai Hadas 	if (ib_copy_from_udata(&ucmd, udata, min(sizeof(ucmd), udata->inlen))) {
477779b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "copy failed\n");
477879b20a6cSYishai Hadas 		return -EFAULT;
477979b20a6cSYishai Hadas 	}
478079b20a6cSYishai Hadas 
478179b20a6cSYishai Hadas 	if (ucmd.comp_mask) {
478279b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "invalid comp mask\n");
478379b20a6cSYishai Hadas 		return -EOPNOTSUPP;
478479b20a6cSYishai Hadas 	}
478579b20a6cSYishai Hadas 
478679b20a6cSYishai Hadas 	if (ucmd.reserved) {
478779b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "invalid reserved\n");
478879b20a6cSYishai Hadas 		return -EOPNOTSUPP;
478979b20a6cSYishai Hadas 	}
479079b20a6cSYishai Hadas 
479179b20a6cSYishai Hadas 	err = set_user_rq_size(dev, init_attr, &ucmd, rwq);
479279b20a6cSYishai Hadas 	if (err) {
479379b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "err %d\n", err);
479479b20a6cSYishai Hadas 		return err;
479579b20a6cSYishai Hadas 	}
479679b20a6cSYishai Hadas 
479779b20a6cSYishai Hadas 	err = create_user_rq(dev, pd, rwq, &ucmd);
479879b20a6cSYishai Hadas 	if (err) {
479979b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "err %d\n", err);
480079b20a6cSYishai Hadas 		if (err)
480179b20a6cSYishai Hadas 			return err;
480279b20a6cSYishai Hadas 	}
480379b20a6cSYishai Hadas 
480479b20a6cSYishai Hadas 	rwq->user_index = ucmd.user_index;
480579b20a6cSYishai Hadas 	return 0;
480679b20a6cSYishai Hadas }
480779b20a6cSYishai Hadas 
480879b20a6cSYishai Hadas struct ib_wq *mlx5_ib_create_wq(struct ib_pd *pd,
480979b20a6cSYishai Hadas 				struct ib_wq_init_attr *init_attr,
481079b20a6cSYishai Hadas 				struct ib_udata *udata)
481179b20a6cSYishai Hadas {
481279b20a6cSYishai Hadas 	struct mlx5_ib_dev *dev;
481379b20a6cSYishai Hadas 	struct mlx5_ib_rwq *rwq;
481479b20a6cSYishai Hadas 	struct mlx5_ib_create_wq_resp resp = {};
481579b20a6cSYishai Hadas 	size_t min_resp_len;
481679b20a6cSYishai Hadas 	int err;
481779b20a6cSYishai Hadas 
481879b20a6cSYishai Hadas 	if (!udata)
481979b20a6cSYishai Hadas 		return ERR_PTR(-ENOSYS);
482079b20a6cSYishai Hadas 
482179b20a6cSYishai Hadas 	min_resp_len = offsetof(typeof(resp), reserved) + sizeof(resp.reserved);
482279b20a6cSYishai Hadas 	if (udata->outlen && udata->outlen < min_resp_len)
482379b20a6cSYishai Hadas 		return ERR_PTR(-EINVAL);
482479b20a6cSYishai Hadas 
482579b20a6cSYishai Hadas 	dev = to_mdev(pd->device);
482679b20a6cSYishai Hadas 	switch (init_attr->wq_type) {
482779b20a6cSYishai Hadas 	case IB_WQT_RQ:
482879b20a6cSYishai Hadas 		rwq = kzalloc(sizeof(*rwq), GFP_KERNEL);
482979b20a6cSYishai Hadas 		if (!rwq)
483079b20a6cSYishai Hadas 			return ERR_PTR(-ENOMEM);
483179b20a6cSYishai Hadas 		err = prepare_user_rq(pd, init_attr, udata, rwq);
483279b20a6cSYishai Hadas 		if (err)
483379b20a6cSYishai Hadas 			goto err;
483479b20a6cSYishai Hadas 		err = create_rq(rwq, pd, init_attr);
483579b20a6cSYishai Hadas 		if (err)
483679b20a6cSYishai Hadas 			goto err_user_rq;
483779b20a6cSYishai Hadas 		break;
483879b20a6cSYishai Hadas 	default:
483979b20a6cSYishai Hadas 		mlx5_ib_dbg(dev, "unsupported wq type %d\n",
484079b20a6cSYishai Hadas 			    init_attr->wq_type);
484179b20a6cSYishai Hadas 		return ERR_PTR(-EINVAL);
484279b20a6cSYishai Hadas 	}
484379b20a6cSYishai Hadas 
4844350d0e4cSYishai Hadas 	rwq->ibwq.wq_num = rwq->core_qp.qpn;
484579b20a6cSYishai Hadas 	rwq->ibwq.state = IB_WQS_RESET;
484679b20a6cSYishai Hadas 	if (udata->outlen) {
484779b20a6cSYishai Hadas 		resp.response_length = offsetof(typeof(resp), response_length) +
484879b20a6cSYishai Hadas 				sizeof(resp.response_length);
484979b20a6cSYishai Hadas 		err = ib_copy_to_udata(udata, &resp, resp.response_length);
485079b20a6cSYishai Hadas 		if (err)
485179b20a6cSYishai Hadas 			goto err_copy;
485279b20a6cSYishai Hadas 	}
485379b20a6cSYishai Hadas 
4854350d0e4cSYishai Hadas 	rwq->core_qp.event = mlx5_ib_wq_event;
4855350d0e4cSYishai Hadas 	rwq->ibwq.event_handler = init_attr->event_handler;
485679b20a6cSYishai Hadas 	return &rwq->ibwq;
485779b20a6cSYishai Hadas 
485879b20a6cSYishai Hadas err_copy:
4859350d0e4cSYishai Hadas 	mlx5_core_destroy_rq_tracked(dev->mdev, &rwq->core_qp);
486079b20a6cSYishai Hadas err_user_rq:
486179b20a6cSYishai Hadas 	destroy_user_rq(pd, rwq);
486279b20a6cSYishai Hadas err:
486379b20a6cSYishai Hadas 	kfree(rwq);
486479b20a6cSYishai Hadas 	return ERR_PTR(err);
486579b20a6cSYishai Hadas }
486679b20a6cSYishai Hadas 
486779b20a6cSYishai Hadas int mlx5_ib_destroy_wq(struct ib_wq *wq)
486879b20a6cSYishai Hadas {
486979b20a6cSYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(wq->device);
487079b20a6cSYishai Hadas 	struct mlx5_ib_rwq *rwq = to_mrwq(wq);
487179b20a6cSYishai Hadas 
4872350d0e4cSYishai Hadas 	mlx5_core_destroy_rq_tracked(dev->mdev, &rwq->core_qp);
487379b20a6cSYishai Hadas 	destroy_user_rq(wq->pd, rwq);
487479b20a6cSYishai Hadas 	kfree(rwq);
487579b20a6cSYishai Hadas 
487679b20a6cSYishai Hadas 	return 0;
487779b20a6cSYishai Hadas }
487879b20a6cSYishai Hadas 
4879c5f90929SYishai Hadas struct ib_rwq_ind_table *mlx5_ib_create_rwq_ind_table(struct ib_device *device,
4880c5f90929SYishai Hadas 						      struct ib_rwq_ind_table_init_attr *init_attr,
4881c5f90929SYishai Hadas 						      struct ib_udata *udata)
4882c5f90929SYishai Hadas {
4883c5f90929SYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(device);
4884c5f90929SYishai Hadas 	struct mlx5_ib_rwq_ind_table *rwq_ind_tbl;
4885c5f90929SYishai Hadas 	int sz = 1 << init_attr->log_ind_tbl_size;
4886c5f90929SYishai Hadas 	struct mlx5_ib_create_rwq_ind_tbl_resp resp = {};
4887c5f90929SYishai Hadas 	size_t min_resp_len;
4888c5f90929SYishai Hadas 	int inlen;
4889c5f90929SYishai Hadas 	int err;
4890c5f90929SYishai Hadas 	int i;
4891c5f90929SYishai Hadas 	u32 *in;
4892c5f90929SYishai Hadas 	void *rqtc;
4893c5f90929SYishai Hadas 
4894c5f90929SYishai Hadas 	if (udata->inlen > 0 &&
4895c5f90929SYishai Hadas 	    !ib_is_udata_cleared(udata, 0,
4896c5f90929SYishai Hadas 				 udata->inlen))
4897c5f90929SYishai Hadas 		return ERR_PTR(-EOPNOTSUPP);
4898c5f90929SYishai Hadas 
4899c5f90929SYishai Hadas 	min_resp_len = offsetof(typeof(resp), reserved) + sizeof(resp.reserved);
4900c5f90929SYishai Hadas 	if (udata->outlen && udata->outlen < min_resp_len)
4901c5f90929SYishai Hadas 		return ERR_PTR(-EINVAL);
4902c5f90929SYishai Hadas 
4903c5f90929SYishai Hadas 	rwq_ind_tbl = kzalloc(sizeof(*rwq_ind_tbl), GFP_KERNEL);
4904c5f90929SYishai Hadas 	if (!rwq_ind_tbl)
4905c5f90929SYishai Hadas 		return ERR_PTR(-ENOMEM);
4906c5f90929SYishai Hadas 
4907c5f90929SYishai Hadas 	inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz;
4908c5f90929SYishai Hadas 	in = mlx5_vzalloc(inlen);
4909c5f90929SYishai Hadas 	if (!in) {
4910c5f90929SYishai Hadas 		err = -ENOMEM;
4911c5f90929SYishai Hadas 		goto err;
4912c5f90929SYishai Hadas 	}
4913c5f90929SYishai Hadas 
4914c5f90929SYishai Hadas 	rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context);
4915c5f90929SYishai Hadas 
4916c5f90929SYishai Hadas 	MLX5_SET(rqtc, rqtc, rqt_actual_size, sz);
4917c5f90929SYishai Hadas 	MLX5_SET(rqtc, rqtc, rqt_max_size, sz);
4918c5f90929SYishai Hadas 
4919c5f90929SYishai Hadas 	for (i = 0; i < sz; i++)
4920c5f90929SYishai Hadas 		MLX5_SET(rqtc, rqtc, rq_num[i], init_attr->ind_tbl[i]->wq_num);
4921c5f90929SYishai Hadas 
4922c5f90929SYishai Hadas 	err = mlx5_core_create_rqt(dev->mdev, in, inlen, &rwq_ind_tbl->rqtn);
4923c5f90929SYishai Hadas 	kvfree(in);
4924c5f90929SYishai Hadas 
4925c5f90929SYishai Hadas 	if (err)
4926c5f90929SYishai Hadas 		goto err;
4927c5f90929SYishai Hadas 
4928c5f90929SYishai Hadas 	rwq_ind_tbl->ib_rwq_ind_tbl.ind_tbl_num = rwq_ind_tbl->rqtn;
4929c5f90929SYishai Hadas 	if (udata->outlen) {
4930c5f90929SYishai Hadas 		resp.response_length = offsetof(typeof(resp), response_length) +
4931c5f90929SYishai Hadas 					sizeof(resp.response_length);
4932c5f90929SYishai Hadas 		err = ib_copy_to_udata(udata, &resp, resp.response_length);
4933c5f90929SYishai Hadas 		if (err)
4934c5f90929SYishai Hadas 			goto err_copy;
4935c5f90929SYishai Hadas 	}
4936c5f90929SYishai Hadas 
4937c5f90929SYishai Hadas 	return &rwq_ind_tbl->ib_rwq_ind_tbl;
4938c5f90929SYishai Hadas 
4939c5f90929SYishai Hadas err_copy:
4940c5f90929SYishai Hadas 	mlx5_core_destroy_rqt(dev->mdev, rwq_ind_tbl->rqtn);
4941c5f90929SYishai Hadas err:
4942c5f90929SYishai Hadas 	kfree(rwq_ind_tbl);
4943c5f90929SYishai Hadas 	return ERR_PTR(err);
4944c5f90929SYishai Hadas }
4945c5f90929SYishai Hadas 
4946c5f90929SYishai Hadas int mlx5_ib_destroy_rwq_ind_table(struct ib_rwq_ind_table *ib_rwq_ind_tbl)
4947c5f90929SYishai Hadas {
4948c5f90929SYishai Hadas 	struct mlx5_ib_rwq_ind_table *rwq_ind_tbl = to_mrwq_ind_table(ib_rwq_ind_tbl);
4949c5f90929SYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(ib_rwq_ind_tbl->device);
4950c5f90929SYishai Hadas 
4951c5f90929SYishai Hadas 	mlx5_core_destroy_rqt(dev->mdev, rwq_ind_tbl->rqtn);
4952c5f90929SYishai Hadas 
4953c5f90929SYishai Hadas 	kfree(rwq_ind_tbl);
4954c5f90929SYishai Hadas 	return 0;
4955c5f90929SYishai Hadas }
4956c5f90929SYishai Hadas 
495779b20a6cSYishai Hadas int mlx5_ib_modify_wq(struct ib_wq *wq, struct ib_wq_attr *wq_attr,
495879b20a6cSYishai Hadas 		      u32 wq_attr_mask, struct ib_udata *udata)
495979b20a6cSYishai Hadas {
496079b20a6cSYishai Hadas 	struct mlx5_ib_dev *dev = to_mdev(wq->device);
496179b20a6cSYishai Hadas 	struct mlx5_ib_rwq *rwq = to_mrwq(wq);
496279b20a6cSYishai Hadas 	struct mlx5_ib_modify_wq ucmd = {};
496379b20a6cSYishai Hadas 	size_t required_cmd_sz;
496479b20a6cSYishai Hadas 	int curr_wq_state;
496579b20a6cSYishai Hadas 	int wq_state;
496679b20a6cSYishai Hadas 	int inlen;
496779b20a6cSYishai Hadas 	int err;
496879b20a6cSYishai Hadas 	void *rqc;
496979b20a6cSYishai Hadas 	void *in;
497079b20a6cSYishai Hadas 
497179b20a6cSYishai Hadas 	required_cmd_sz = offsetof(typeof(ucmd), reserved) + sizeof(ucmd.reserved);
497279b20a6cSYishai Hadas 	if (udata->inlen < required_cmd_sz)
497379b20a6cSYishai Hadas 		return -EINVAL;
497479b20a6cSYishai Hadas 
497579b20a6cSYishai Hadas 	if (udata->inlen > sizeof(ucmd) &&
497679b20a6cSYishai Hadas 	    !ib_is_udata_cleared(udata, sizeof(ucmd),
497779b20a6cSYishai Hadas 				 udata->inlen - sizeof(ucmd)))
497879b20a6cSYishai Hadas 		return -EOPNOTSUPP;
497979b20a6cSYishai Hadas 
498079b20a6cSYishai Hadas 	if (ib_copy_from_udata(&ucmd, udata, min(sizeof(ucmd), udata->inlen)))
498179b20a6cSYishai Hadas 		return -EFAULT;
498279b20a6cSYishai Hadas 
498379b20a6cSYishai Hadas 	if (ucmd.comp_mask || ucmd.reserved)
498479b20a6cSYishai Hadas 		return -EOPNOTSUPP;
498579b20a6cSYishai Hadas 
498679b20a6cSYishai Hadas 	inlen = MLX5_ST_SZ_BYTES(modify_rq_in);
498779b20a6cSYishai Hadas 	in = mlx5_vzalloc(inlen);
498879b20a6cSYishai Hadas 	if (!in)
498979b20a6cSYishai Hadas 		return -ENOMEM;
499079b20a6cSYishai Hadas 
499179b20a6cSYishai Hadas 	rqc = MLX5_ADDR_OF(modify_rq_in, in, ctx);
499279b20a6cSYishai Hadas 
499379b20a6cSYishai Hadas 	curr_wq_state = (wq_attr_mask & IB_WQ_CUR_STATE) ?
499479b20a6cSYishai Hadas 		wq_attr->curr_wq_state : wq->state;
499579b20a6cSYishai Hadas 	wq_state = (wq_attr_mask & IB_WQ_STATE) ?
499679b20a6cSYishai Hadas 		wq_attr->wq_state : curr_wq_state;
499779b20a6cSYishai Hadas 	if (curr_wq_state == IB_WQS_ERR)
499879b20a6cSYishai Hadas 		curr_wq_state = MLX5_RQC_STATE_ERR;
499979b20a6cSYishai Hadas 	if (wq_state == IB_WQS_ERR)
500079b20a6cSYishai Hadas 		wq_state = MLX5_RQC_STATE_ERR;
500179b20a6cSYishai Hadas 	MLX5_SET(modify_rq_in, in, rq_state, curr_wq_state);
500279b20a6cSYishai Hadas 	MLX5_SET(rqc, rqc, state, wq_state);
500379b20a6cSYishai Hadas 
5004350d0e4cSYishai Hadas 	err = mlx5_core_modify_rq(dev->mdev, rwq->core_qp.qpn, in, inlen);
500579b20a6cSYishai Hadas 	kvfree(in);
500679b20a6cSYishai Hadas 	if (!err)
500779b20a6cSYishai Hadas 		rwq->ibwq.state = (wq_state == MLX5_RQC_STATE_ERR) ? IB_WQS_ERR : wq_state;
500879b20a6cSYishai Hadas 
500979b20a6cSYishai Hadas 	return err;
501079b20a6cSYishai Hadas }
5011