xref: /openbmc/linux/drivers/infiniband/hw/efa/efa_verbs.c (revision 1fb7f8973f51ca1a7ffe61a2c779ed15f57f3d82)
140909f66SGal Pressman // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
240909f66SGal Pressman /*
3ff6629f8SGal Pressman  * Copyright 2018-2020 Amazon.com, Inc. or its affiliates. All rights reserved.
440909f66SGal Pressman  */
540909f66SGal Pressman 
640909f66SGal Pressman #include <linux/vmalloc.h>
71f9b6827SJason Gunthorpe #include <linux/log2.h>
840909f66SGal Pressman 
940909f66SGal Pressman #include <rdma/ib_addr.h>
1040909f66SGal Pressman #include <rdma/ib_umem.h>
1140909f66SGal Pressman #include <rdma/ib_user_verbs.h>
1240909f66SGal Pressman #include <rdma/ib_verbs.h>
1340909f66SGal Pressman #include <rdma/uverbs_ioctl.h>
1440909f66SGal Pressman 
1540909f66SGal Pressman #include "efa.h"
1640909f66SGal Pressman 
1740909f66SGal Pressman enum {
1840909f66SGal Pressman 	EFA_MMAP_DMA_PAGE = 0,
1940909f66SGal Pressman 	EFA_MMAP_IO_WC,
2040909f66SGal Pressman 	EFA_MMAP_IO_NC,
2140909f66SGal Pressman };
2240909f66SGal Pressman 
2340909f66SGal Pressman #define EFA_AENQ_ENABLED_GROUPS \
2440909f66SGal Pressman 	(BIT(EFA_ADMIN_FATAL_ERROR) | BIT(EFA_ADMIN_WARNING) | \
2540909f66SGal Pressman 	 BIT(EFA_ADMIN_NOTIFICATION) | BIT(EFA_ADMIN_KEEP_ALIVE))
2640909f66SGal Pressman 
27e84d3c18SMichal Kalderon struct efa_user_mmap_entry {
28e84d3c18SMichal Kalderon 	struct rdma_user_mmap_entry rdma_entry;
2940909f66SGal Pressman 	u64 address;
3040909f66SGal Pressman 	u8 mmap_flag;
3140909f66SGal Pressman };
3240909f66SGal Pressman 
3316e9111eSGal Pressman #define EFA_DEFINE_STATS(op) \
3416e9111eSGal Pressman 	op(EFA_TX_BYTES, "tx_bytes") \
3516e9111eSGal Pressman 	op(EFA_TX_PKTS, "tx_pkts") \
3616e9111eSGal Pressman 	op(EFA_RX_BYTES, "rx_bytes") \
3716e9111eSGal Pressman 	op(EFA_RX_PKTS, "rx_pkts") \
3816e9111eSGal Pressman 	op(EFA_RX_DROPS, "rx_drops") \
39b0cff387SDaniel Kranzdorf 	op(EFA_SEND_BYTES, "send_bytes") \
40b0cff387SDaniel Kranzdorf 	op(EFA_SEND_WRS, "send_wrs") \
41b0cff387SDaniel Kranzdorf 	op(EFA_RECV_BYTES, "recv_bytes") \
42b0cff387SDaniel Kranzdorf 	op(EFA_RECV_WRS, "recv_wrs") \
43b0cff387SDaniel Kranzdorf 	op(EFA_RDMA_READ_WRS, "rdma_read_wrs") \
44b0cff387SDaniel Kranzdorf 	op(EFA_RDMA_READ_BYTES, "rdma_read_bytes") \
45b0cff387SDaniel Kranzdorf 	op(EFA_RDMA_READ_WR_ERR, "rdma_read_wr_err") \
46b0cff387SDaniel Kranzdorf 	op(EFA_RDMA_READ_RESP_BYTES, "rdma_read_resp_bytes") \
4716e9111eSGal Pressman 	op(EFA_SUBMITTED_CMDS, "submitted_cmds") \
4816e9111eSGal Pressman 	op(EFA_COMPLETED_CMDS, "completed_cmds") \
49f86e3437SGal Pressman 	op(EFA_CMDS_ERR, "cmds_err") \
5016e9111eSGal Pressman 	op(EFA_NO_COMPLETION_CMDS, "no_completion_cmds") \
5116e9111eSGal Pressman 	op(EFA_KEEP_ALIVE_RCVD, "keep_alive_rcvd") \
5216e9111eSGal Pressman 	op(EFA_ALLOC_PD_ERR, "alloc_pd_err") \
5316e9111eSGal Pressman 	op(EFA_CREATE_QP_ERR, "create_qp_err") \
54b2ea69b3SGal Pressman 	op(EFA_CREATE_CQ_ERR, "create_cq_err") \
5516e9111eSGal Pressman 	op(EFA_REG_MR_ERR, "reg_mr_err") \
5616e9111eSGal Pressman 	op(EFA_ALLOC_UCONTEXT_ERR, "alloc_ucontext_err") \
57eca5757fSGal Pressman 	op(EFA_CREATE_AH_ERR, "create_ah_err") \
58eca5757fSGal Pressman 	op(EFA_MMAP_ERR, "mmap_err")
5916e9111eSGal Pressman 
6016e9111eSGal Pressman #define EFA_STATS_ENUM(ename, name) ename,
6116e9111eSGal Pressman #define EFA_STATS_STR(ename, name) [ename] = name,
6216e9111eSGal Pressman 
6316e9111eSGal Pressman enum efa_hw_stats {
6416e9111eSGal Pressman 	EFA_DEFINE_STATS(EFA_STATS_ENUM)
6516e9111eSGal Pressman };
6616e9111eSGal Pressman 
6716e9111eSGal Pressman static const char *const efa_stats_names[] = {
6816e9111eSGal Pressman 	EFA_DEFINE_STATS(EFA_STATS_STR)
6916e9111eSGal Pressman };
7016e9111eSGal Pressman 
7140909f66SGal Pressman #define EFA_CHUNK_PAYLOAD_SHIFT       12
7240909f66SGal Pressman #define EFA_CHUNK_PAYLOAD_SIZE        BIT(EFA_CHUNK_PAYLOAD_SHIFT)
7340909f66SGal Pressman #define EFA_CHUNK_PAYLOAD_PTR_SIZE    8
7440909f66SGal Pressman 
7540909f66SGal Pressman #define EFA_CHUNK_SHIFT               12
7640909f66SGal Pressman #define EFA_CHUNK_SIZE                BIT(EFA_CHUNK_SHIFT)
7740909f66SGal Pressman #define EFA_CHUNK_PTR_SIZE            sizeof(struct efa_com_ctrl_buff_info)
7840909f66SGal Pressman 
7940909f66SGal Pressman #define EFA_PTRS_PER_CHUNK \
8040909f66SGal Pressman 	((EFA_CHUNK_SIZE - EFA_CHUNK_PTR_SIZE) / EFA_CHUNK_PAYLOAD_PTR_SIZE)
8140909f66SGal Pressman 
8240909f66SGal Pressman #define EFA_CHUNK_USED_SIZE \
8340909f66SGal Pressman 	((EFA_PTRS_PER_CHUNK * EFA_CHUNK_PAYLOAD_PTR_SIZE) + EFA_CHUNK_PTR_SIZE)
8440909f66SGal Pressman 
8540909f66SGal Pressman struct pbl_chunk {
8640909f66SGal Pressman 	dma_addr_t dma_addr;
8740909f66SGal Pressman 	u64 *buf;
8840909f66SGal Pressman 	u32 length;
8940909f66SGal Pressman };
9040909f66SGal Pressman 
9140909f66SGal Pressman struct pbl_chunk_list {
9240909f66SGal Pressman 	struct pbl_chunk *chunks;
9340909f66SGal Pressman 	unsigned int size;
9440909f66SGal Pressman };
9540909f66SGal Pressman 
9640909f66SGal Pressman struct pbl_context {
9740909f66SGal Pressman 	union {
9840909f66SGal Pressman 		struct {
9940909f66SGal Pressman 			dma_addr_t dma_addr;
10040909f66SGal Pressman 		} continuous;
10140909f66SGal Pressman 		struct {
10240909f66SGal Pressman 			u32 pbl_buf_size_in_pages;
10340909f66SGal Pressman 			struct scatterlist *sgl;
10440909f66SGal Pressman 			int sg_dma_cnt;
10540909f66SGal Pressman 			struct pbl_chunk_list chunk_list;
10640909f66SGal Pressman 		} indirect;
10740909f66SGal Pressman 	} phys;
10840909f66SGal Pressman 	u64 *pbl_buf;
10940909f66SGal Pressman 	u32 pbl_buf_size_in_bytes;
11040909f66SGal Pressman 	u8 physically_continuous;
11140909f66SGal Pressman };
11240909f66SGal Pressman 
11340909f66SGal Pressman static inline struct efa_dev *to_edev(struct ib_device *ibdev)
11440909f66SGal Pressman {
11540909f66SGal Pressman 	return container_of(ibdev, struct efa_dev, ibdev);
11640909f66SGal Pressman }
11740909f66SGal Pressman 
11840909f66SGal Pressman static inline struct efa_ucontext *to_eucontext(struct ib_ucontext *ibucontext)
11940909f66SGal Pressman {
12040909f66SGal Pressman 	return container_of(ibucontext, struct efa_ucontext, ibucontext);
12140909f66SGal Pressman }
12240909f66SGal Pressman 
12340909f66SGal Pressman static inline struct efa_pd *to_epd(struct ib_pd *ibpd)
12440909f66SGal Pressman {
12540909f66SGal Pressman 	return container_of(ibpd, struct efa_pd, ibpd);
12640909f66SGal Pressman }
12740909f66SGal Pressman 
12840909f66SGal Pressman static inline struct efa_mr *to_emr(struct ib_mr *ibmr)
12940909f66SGal Pressman {
13040909f66SGal Pressman 	return container_of(ibmr, struct efa_mr, ibmr);
13140909f66SGal Pressman }
13240909f66SGal Pressman 
13340909f66SGal Pressman static inline struct efa_qp *to_eqp(struct ib_qp *ibqp)
13440909f66SGal Pressman {
13540909f66SGal Pressman 	return container_of(ibqp, struct efa_qp, ibqp);
13640909f66SGal Pressman }
13740909f66SGal Pressman 
13840909f66SGal Pressman static inline struct efa_cq *to_ecq(struct ib_cq *ibcq)
13940909f66SGal Pressman {
14040909f66SGal Pressman 	return container_of(ibcq, struct efa_cq, ibcq);
14140909f66SGal Pressman }
14240909f66SGal Pressman 
14340909f66SGal Pressman static inline struct efa_ah *to_eah(struct ib_ah *ibah)
14440909f66SGal Pressman {
14540909f66SGal Pressman 	return container_of(ibah, struct efa_ah, ibah);
14640909f66SGal Pressman }
14740909f66SGal Pressman 
148e84d3c18SMichal Kalderon static inline struct efa_user_mmap_entry *
149e84d3c18SMichal Kalderon to_emmap(struct rdma_user_mmap_entry *rdma_entry)
150e84d3c18SMichal Kalderon {
151e84d3c18SMichal Kalderon 	return container_of(rdma_entry, struct efa_user_mmap_entry, rdma_entry);
152e84d3c18SMichal Kalderon }
153e84d3c18SMichal Kalderon 
15434eb009fSGal Pressman #define EFA_DEV_CAP(dev, cap) \
15534eb009fSGal Pressman 	((dev)->dev_attr.device_caps & \
15634eb009fSGal Pressman 	 EFA_ADMIN_FEATURE_DEVICE_ATTR_DESC_##cap##_MASK)
157666e8ff5SDaniel Kranzdorf 
15840909f66SGal Pressman #define is_reserved_cleared(reserved) \
15940909f66SGal Pressman 	!memchr_inv(reserved, 0, sizeof(reserved))
16040909f66SGal Pressman 
16140909f66SGal Pressman static void *efa_zalloc_mapped(struct efa_dev *dev, dma_addr_t *dma_addr,
16240909f66SGal Pressman 			       size_t size, enum dma_data_direction dir)
16340909f66SGal Pressman {
16440909f66SGal Pressman 	void *addr;
16540909f66SGal Pressman 
16640909f66SGal Pressman 	addr = alloc_pages_exact(size, GFP_KERNEL | __GFP_ZERO);
16740909f66SGal Pressman 	if (!addr)
16840909f66SGal Pressman 		return NULL;
16940909f66SGal Pressman 
17040909f66SGal Pressman 	*dma_addr = dma_map_single(&dev->pdev->dev, addr, size, dir);
17140909f66SGal Pressman 	if (dma_mapping_error(&dev->pdev->dev, *dma_addr)) {
17240909f66SGal Pressman 		ibdev_err(&dev->ibdev, "Failed to map DMA address\n");
17340909f66SGal Pressman 		free_pages_exact(addr, size);
17440909f66SGal Pressman 		return NULL;
17540909f66SGal Pressman 	}
17640909f66SGal Pressman 
17740909f66SGal Pressman 	return addr;
17840909f66SGal Pressman }
17940909f66SGal Pressman 
180ff6629f8SGal Pressman static void efa_free_mapped(struct efa_dev *dev, void *cpu_addr,
181ff6629f8SGal Pressman 			    dma_addr_t dma_addr,
182ff6629f8SGal Pressman 			    size_t size, enum dma_data_direction dir)
183ff6629f8SGal Pressman {
184ff6629f8SGal Pressman 	dma_unmap_single(&dev->pdev->dev, dma_addr, size, dir);
185ff6629f8SGal Pressman 	free_pages_exact(cpu_addr, size);
186ff6629f8SGal Pressman }
187ff6629f8SGal Pressman 
18840909f66SGal Pressman int efa_query_device(struct ib_device *ibdev,
18940909f66SGal Pressman 		     struct ib_device_attr *props,
19040909f66SGal Pressman 		     struct ib_udata *udata)
19140909f66SGal Pressman {
19240909f66SGal Pressman 	struct efa_com_get_device_attr_result *dev_attr;
19340909f66SGal Pressman 	struct efa_ibv_ex_query_device_resp resp = {};
19440909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibdev);
19540909f66SGal Pressman 	int err;
19640909f66SGal Pressman 
19740909f66SGal Pressman 	if (udata && udata->inlen &&
19840909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, udata->inlen)) {
19940909f66SGal Pressman 		ibdev_dbg(ibdev,
20040909f66SGal Pressman 			  "Incompatible ABI params, udata not cleared\n");
20140909f66SGal Pressman 		return -EINVAL;
20240909f66SGal Pressman 	}
20340909f66SGal Pressman 
20440909f66SGal Pressman 	dev_attr = &dev->dev_attr;
20540909f66SGal Pressman 
20640909f66SGal Pressman 	memset(props, 0, sizeof(*props));
20740909f66SGal Pressman 	props->max_mr_size = dev_attr->max_mr_pages * PAGE_SIZE;
20840909f66SGal Pressman 	props->page_size_cap = dev_attr->page_size_cap;
20940909f66SGal Pressman 	props->vendor_id = dev->pdev->vendor;
21040909f66SGal Pressman 	props->vendor_part_id = dev->pdev->device;
21140909f66SGal Pressman 	props->hw_ver = dev->pdev->subsystem_device;
21240909f66SGal Pressman 	props->max_qp = dev_attr->max_qp;
21340909f66SGal Pressman 	props->max_cq = dev_attr->max_cq;
21440909f66SGal Pressman 	props->max_pd = dev_attr->max_pd;
21540909f66SGal Pressman 	props->max_mr = dev_attr->max_mr;
21640909f66SGal Pressman 	props->max_ah = dev_attr->max_ah;
21740909f66SGal Pressman 	props->max_cqe = dev_attr->max_cq_depth;
21840909f66SGal Pressman 	props->max_qp_wr = min_t(u32, dev_attr->max_sq_depth,
21940909f66SGal Pressman 				 dev_attr->max_rq_depth);
22040909f66SGal Pressman 	props->max_send_sge = dev_attr->max_sq_sge;
22140909f66SGal Pressman 	props->max_recv_sge = dev_attr->max_rq_sge;
222666e8ff5SDaniel Kranzdorf 	props->max_sge_rd = dev_attr->max_wr_rdma_sge;
2230133654dSGal Pressman 	props->max_pkeys = 1;
22440909f66SGal Pressman 
22540909f66SGal Pressman 	if (udata && udata->outlen) {
22640909f66SGal Pressman 		resp.max_sq_sge = dev_attr->max_sq_sge;
22740909f66SGal Pressman 		resp.max_rq_sge = dev_attr->max_rq_sge;
22840909f66SGal Pressman 		resp.max_sq_wr = dev_attr->max_sq_depth;
22940909f66SGal Pressman 		resp.max_rq_wr = dev_attr->max_rq_depth;
230666e8ff5SDaniel Kranzdorf 		resp.max_rdma_size = dev_attr->max_rdma_size;
231666e8ff5SDaniel Kranzdorf 
23234eb009fSGal Pressman 		if (EFA_DEV_CAP(dev, RDMA_READ))
233666e8ff5SDaniel Kranzdorf 			resp.device_caps |= EFA_QUERY_DEVICE_CAPS_RDMA_READ;
23440909f66SGal Pressman 
235a4e6a1ddSGal Pressman 		if (EFA_DEV_CAP(dev, RNR_RETRY))
236a4e6a1ddSGal Pressman 			resp.device_caps |= EFA_QUERY_DEVICE_CAPS_RNR_RETRY;
237a4e6a1ddSGal Pressman 
23840909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
23940909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
24040909f66SGal Pressman 		if (err) {
24140909f66SGal Pressman 			ibdev_dbg(ibdev,
24240909f66SGal Pressman 				  "Failed to copy udata for query_device\n");
24340909f66SGal Pressman 			return err;
24440909f66SGal Pressman 		}
24540909f66SGal Pressman 	}
24640909f66SGal Pressman 
24740909f66SGal Pressman 	return 0;
24840909f66SGal Pressman }
24940909f66SGal Pressman 
250*1fb7f897SMark Bloch int efa_query_port(struct ib_device *ibdev, u32 port,
25140909f66SGal Pressman 		   struct ib_port_attr *props)
25240909f66SGal Pressman {
25340909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibdev);
25440909f66SGal Pressman 
25540909f66SGal Pressman 	props->lmc = 1;
25640909f66SGal Pressman 
25740909f66SGal Pressman 	props->state = IB_PORT_ACTIVE;
25872a7720fSKamal Heib 	props->phys_state = IB_PORT_PHYS_STATE_LINK_UP;
25940909f66SGal Pressman 	props->gid_tbl_len = 1;
26040909f66SGal Pressman 	props->pkey_tbl_len = 1;
26140909f66SGal Pressman 	props->active_speed = IB_SPEED_EDR;
26240909f66SGal Pressman 	props->active_width = IB_WIDTH_4X;
263bcf7cc53SGal Pressman 	props->max_mtu = ib_mtu_int_to_enum(dev->dev_attr.mtu);
264bcf7cc53SGal Pressman 	props->active_mtu = ib_mtu_int_to_enum(dev->dev_attr.mtu);
265bcf7cc53SGal Pressman 	props->max_msg_sz = dev->dev_attr.mtu;
26640909f66SGal Pressman 	props->max_vl_num = 1;
26740909f66SGal Pressman 
26840909f66SGal Pressman 	return 0;
26940909f66SGal Pressman }
27040909f66SGal Pressman 
27140909f66SGal Pressman int efa_query_qp(struct ib_qp *ibqp, struct ib_qp_attr *qp_attr,
27240909f66SGal Pressman 		 int qp_attr_mask,
27340909f66SGal Pressman 		 struct ib_qp_init_attr *qp_init_attr)
27440909f66SGal Pressman {
27540909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibqp->device);
27640909f66SGal Pressman 	struct efa_com_query_qp_params params = {};
27740909f66SGal Pressman 	struct efa_com_query_qp_result result;
27840909f66SGal Pressman 	struct efa_qp *qp = to_eqp(ibqp);
27940909f66SGal Pressman 	int err;
28040909f66SGal Pressman 
28140909f66SGal Pressman #define EFA_QUERY_QP_SUPP_MASK \
28240909f66SGal Pressman 	(IB_QP_STATE | IB_QP_PKEY_INDEX | IB_QP_PORT | \
283a4e6a1ddSGal Pressman 	 IB_QP_QKEY | IB_QP_SQ_PSN | IB_QP_CAP | IB_QP_RNR_RETRY)
28440909f66SGal Pressman 
28540909f66SGal Pressman 	if (qp_attr_mask & ~EFA_QUERY_QP_SUPP_MASK) {
28640909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
28740909f66SGal Pressman 			  "Unsupported qp_attr_mask[%#x] supported[%#x]\n",
28840909f66SGal Pressman 			  qp_attr_mask, EFA_QUERY_QP_SUPP_MASK);
28940909f66SGal Pressman 		return -EOPNOTSUPP;
29040909f66SGal Pressman 	}
29140909f66SGal Pressman 
29240909f66SGal Pressman 	memset(qp_attr, 0, sizeof(*qp_attr));
29340909f66SGal Pressman 	memset(qp_init_attr, 0, sizeof(*qp_init_attr));
29440909f66SGal Pressman 
29540909f66SGal Pressman 	params.qp_handle = qp->qp_handle;
29640909f66SGal Pressman 	err = efa_com_query_qp(&dev->edev, &params, &result);
29740909f66SGal Pressman 	if (err)
29840909f66SGal Pressman 		return err;
29940909f66SGal Pressman 
30040909f66SGal Pressman 	qp_attr->qp_state = result.qp_state;
30140909f66SGal Pressman 	qp_attr->qkey = result.qkey;
30240909f66SGal Pressman 	qp_attr->sq_psn = result.sq_psn;
30340909f66SGal Pressman 	qp_attr->sq_draining = result.sq_draining;
30440909f66SGal Pressman 	qp_attr->port_num = 1;
305a4e6a1ddSGal Pressman 	qp_attr->rnr_retry = result.rnr_retry;
30640909f66SGal Pressman 
30740909f66SGal Pressman 	qp_attr->cap.max_send_wr = qp->max_send_wr;
30840909f66SGal Pressman 	qp_attr->cap.max_recv_wr = qp->max_recv_wr;
30940909f66SGal Pressman 	qp_attr->cap.max_send_sge = qp->max_send_sge;
31040909f66SGal Pressman 	qp_attr->cap.max_recv_sge = qp->max_recv_sge;
31140909f66SGal Pressman 	qp_attr->cap.max_inline_data = qp->max_inline_data;
31240909f66SGal Pressman 
31340909f66SGal Pressman 	qp_init_attr->qp_type = ibqp->qp_type;
31440909f66SGal Pressman 	qp_init_attr->recv_cq = ibqp->recv_cq;
31540909f66SGal Pressman 	qp_init_attr->send_cq = ibqp->send_cq;
31640909f66SGal Pressman 	qp_init_attr->qp_context = ibqp->qp_context;
31740909f66SGal Pressman 	qp_init_attr->cap = qp_attr->cap;
31840909f66SGal Pressman 
31940909f66SGal Pressman 	return 0;
32040909f66SGal Pressman }
32140909f66SGal Pressman 
322*1fb7f897SMark Bloch int efa_query_gid(struct ib_device *ibdev, u32 port, int index,
32340909f66SGal Pressman 		  union ib_gid *gid)
32440909f66SGal Pressman {
32540909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibdev);
32640909f66SGal Pressman 
327bcf7cc53SGal Pressman 	memcpy(gid->raw, dev->dev_attr.addr, sizeof(dev->dev_attr.addr));
32840909f66SGal Pressman 
32940909f66SGal Pressman 	return 0;
33040909f66SGal Pressman }
33140909f66SGal Pressman 
332*1fb7f897SMark Bloch int efa_query_pkey(struct ib_device *ibdev, u32 port, u16 index,
33340909f66SGal Pressman 		   u16 *pkey)
33440909f66SGal Pressman {
33540909f66SGal Pressman 	if (index > 0)
33640909f66SGal Pressman 		return -EINVAL;
33740909f66SGal Pressman 
33840909f66SGal Pressman 	*pkey = 0xffff;
33940909f66SGal Pressman 	return 0;
34040909f66SGal Pressman }
34140909f66SGal Pressman 
34240909f66SGal Pressman static int efa_pd_dealloc(struct efa_dev *dev, u16 pdn)
34340909f66SGal Pressman {
34440909f66SGal Pressman 	struct efa_com_dealloc_pd_params params = {
34540909f66SGal Pressman 		.pdn = pdn,
34640909f66SGal Pressman 	};
34740909f66SGal Pressman 
34840909f66SGal Pressman 	return efa_com_dealloc_pd(&dev->edev, &params);
34940909f66SGal Pressman }
35040909f66SGal Pressman 
35140909f66SGal Pressman int efa_alloc_pd(struct ib_pd *ibpd, struct ib_udata *udata)
35240909f66SGal Pressman {
35340909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibpd->device);
35440909f66SGal Pressman 	struct efa_ibv_alloc_pd_resp resp = {};
35540909f66SGal Pressman 	struct efa_com_alloc_pd_result result;
35640909f66SGal Pressman 	struct efa_pd *pd = to_epd(ibpd);
35740909f66SGal Pressman 	int err;
35840909f66SGal Pressman 
35940909f66SGal Pressman 	if (udata->inlen &&
36040909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, udata->inlen)) {
36140909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
36240909f66SGal Pressman 			  "Incompatible ABI params, udata not cleared\n");
36340909f66SGal Pressman 		err = -EINVAL;
36440909f66SGal Pressman 		goto err_out;
36540909f66SGal Pressman 	}
36640909f66SGal Pressman 
36740909f66SGal Pressman 	err = efa_com_alloc_pd(&dev->edev, &result);
36840909f66SGal Pressman 	if (err)
36940909f66SGal Pressman 		goto err_out;
37040909f66SGal Pressman 
37140909f66SGal Pressman 	pd->pdn = result.pdn;
37240909f66SGal Pressman 	resp.pdn = result.pdn;
37340909f66SGal Pressman 
37440909f66SGal Pressman 	if (udata->outlen) {
37540909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
37640909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
37740909f66SGal Pressman 		if (err) {
37840909f66SGal Pressman 			ibdev_dbg(&dev->ibdev,
37940909f66SGal Pressman 				  "Failed to copy udata for alloc_pd\n");
38040909f66SGal Pressman 			goto err_dealloc_pd;
38140909f66SGal Pressman 		}
38240909f66SGal Pressman 	}
38340909f66SGal Pressman 
38440909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Allocated pd[%d]\n", pd->pdn);
38540909f66SGal Pressman 
38640909f66SGal Pressman 	return 0;
38740909f66SGal Pressman 
38840909f66SGal Pressman err_dealloc_pd:
38940909f66SGal Pressman 	efa_pd_dealloc(dev, result.pdn);
39040909f66SGal Pressman err_out:
391215b88acSGal Pressman 	atomic64_inc(&dev->stats.alloc_pd_err);
39240909f66SGal Pressman 	return err;
39340909f66SGal Pressman }
39440909f66SGal Pressman 
39591a7c58fSLeon Romanovsky int efa_dealloc_pd(struct ib_pd *ibpd, struct ib_udata *udata)
39640909f66SGal Pressman {
39740909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibpd->device);
39840909f66SGal Pressman 	struct efa_pd *pd = to_epd(ibpd);
39940909f66SGal Pressman 
40040909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Dealloc pd[%d]\n", pd->pdn);
40140909f66SGal Pressman 	efa_pd_dealloc(dev, pd->pdn);
40291a7c58fSLeon Romanovsky 	return 0;
40340909f66SGal Pressman }
40440909f66SGal Pressman 
40540909f66SGal Pressman static int efa_destroy_qp_handle(struct efa_dev *dev, u32 qp_handle)
40640909f66SGal Pressman {
40740909f66SGal Pressman 	struct efa_com_destroy_qp_params params = { .qp_handle = qp_handle };
40840909f66SGal Pressman 
40940909f66SGal Pressman 	return efa_com_destroy_qp(&dev->edev, &params);
41040909f66SGal Pressman }
41140909f66SGal Pressman 
4120428c6efSGal Pressman static void efa_qp_user_mmap_entries_remove(struct efa_qp *qp)
413e84d3c18SMichal Kalderon {
414e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(qp->rq_mmap_entry);
415e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(qp->rq_db_mmap_entry);
416e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(qp->llq_desc_mmap_entry);
417e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(qp->sq_db_mmap_entry);
418e84d3c18SMichal Kalderon }
419e84d3c18SMichal Kalderon 
42040909f66SGal Pressman int efa_destroy_qp(struct ib_qp *ibqp, struct ib_udata *udata)
42140909f66SGal Pressman {
42240909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibqp->pd->device);
42340909f66SGal Pressman 	struct efa_qp *qp = to_eqp(ibqp);
42440909f66SGal Pressman 	int err;
42540909f66SGal Pressman 
42640909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Destroy qp[%u]\n", ibqp->qp_num);
427ff6629f8SGal Pressman 
428ff6629f8SGal Pressman 	efa_qp_user_mmap_entries_remove(qp);
429ff6629f8SGal Pressman 
43040909f66SGal Pressman 	err = efa_destroy_qp_handle(dev, qp->qp_handle);
43140909f66SGal Pressman 	if (err)
43240909f66SGal Pressman 		return err;
43340909f66SGal Pressman 
43440909f66SGal Pressman 	if (qp->rq_cpu_addr) {
43540909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
43640909f66SGal Pressman 			  "qp->cpu_addr[0x%p] freed: size[%lu], dma[%pad]\n",
43740909f66SGal Pressman 			  qp->rq_cpu_addr, qp->rq_size,
43840909f66SGal Pressman 			  &qp->rq_dma_addr);
439ff6629f8SGal Pressman 		efa_free_mapped(dev, qp->rq_cpu_addr, qp->rq_dma_addr,
440ff6629f8SGal Pressman 				qp->rq_size, DMA_TO_DEVICE);
44140909f66SGal Pressman 	}
44240909f66SGal Pressman 
44340909f66SGal Pressman 	kfree(qp);
44440909f66SGal Pressman 	return 0;
44540909f66SGal Pressman }
44640909f66SGal Pressman 
447e84d3c18SMichal Kalderon static struct rdma_user_mmap_entry*
448e84d3c18SMichal Kalderon efa_user_mmap_entry_insert(struct ib_ucontext *ucontext,
449e84d3c18SMichal Kalderon 			   u64 address, size_t length,
450e84d3c18SMichal Kalderon 			   u8 mmap_flag, u64 *offset)
451e84d3c18SMichal Kalderon {
452e84d3c18SMichal Kalderon 	struct efa_user_mmap_entry *entry = kzalloc(sizeof(*entry), GFP_KERNEL);
453e84d3c18SMichal Kalderon 	int err;
454e84d3c18SMichal Kalderon 
455e84d3c18SMichal Kalderon 	if (!entry)
456e84d3c18SMichal Kalderon 		return NULL;
457e84d3c18SMichal Kalderon 
458e84d3c18SMichal Kalderon 	entry->address = address;
459e84d3c18SMichal Kalderon 	entry->mmap_flag = mmap_flag;
460e84d3c18SMichal Kalderon 
461e84d3c18SMichal Kalderon 	err = rdma_user_mmap_entry_insert(ucontext, &entry->rdma_entry,
462e84d3c18SMichal Kalderon 					  length);
463e84d3c18SMichal Kalderon 	if (err) {
464e84d3c18SMichal Kalderon 		kfree(entry);
465e84d3c18SMichal Kalderon 		return NULL;
466e84d3c18SMichal Kalderon 	}
467e84d3c18SMichal Kalderon 	*offset = rdma_user_mmap_get_offset(&entry->rdma_entry);
468e84d3c18SMichal Kalderon 
469e84d3c18SMichal Kalderon 	return &entry->rdma_entry;
470e84d3c18SMichal Kalderon }
471e84d3c18SMichal Kalderon 
47240909f66SGal Pressman static int qp_mmap_entries_setup(struct efa_qp *qp,
47340909f66SGal Pressman 				 struct efa_dev *dev,
47440909f66SGal Pressman 				 struct efa_ucontext *ucontext,
47540909f66SGal Pressman 				 struct efa_com_create_qp_params *params,
47640909f66SGal Pressman 				 struct efa_ibv_create_qp_resp *resp)
47740909f66SGal Pressman {
478e84d3c18SMichal Kalderon 	size_t length;
479e84d3c18SMichal Kalderon 	u64 address;
480e84d3c18SMichal Kalderon 
481e84d3c18SMichal Kalderon 	address = dev->db_bar_addr + resp->sq_db_offset;
482e84d3c18SMichal Kalderon 	qp->sq_db_mmap_entry =
483e84d3c18SMichal Kalderon 		efa_user_mmap_entry_insert(&ucontext->ibucontext,
484e84d3c18SMichal Kalderon 					   address,
485e84d3c18SMichal Kalderon 					   PAGE_SIZE, EFA_MMAP_IO_NC,
486e84d3c18SMichal Kalderon 					   &resp->sq_db_mmap_key);
487e84d3c18SMichal Kalderon 	if (!qp->sq_db_mmap_entry)
48840909f66SGal Pressman 		return -ENOMEM;
48940909f66SGal Pressman 
49040909f66SGal Pressman 	resp->sq_db_offset &= ~PAGE_MASK;
49140909f66SGal Pressman 
492e84d3c18SMichal Kalderon 	address = dev->mem_bar_addr + resp->llq_desc_offset;
493e84d3c18SMichal Kalderon 	length = PAGE_ALIGN(params->sq_ring_size_in_bytes +
494e84d3c18SMichal Kalderon 			    (resp->llq_desc_offset & ~PAGE_MASK));
495e84d3c18SMichal Kalderon 
496e84d3c18SMichal Kalderon 	qp->llq_desc_mmap_entry =
497e84d3c18SMichal Kalderon 		efa_user_mmap_entry_insert(&ucontext->ibucontext,
498e84d3c18SMichal Kalderon 					   address, length,
499e84d3c18SMichal Kalderon 					   EFA_MMAP_IO_WC,
500e84d3c18SMichal Kalderon 					   &resp->llq_desc_mmap_key);
501e84d3c18SMichal Kalderon 	if (!qp->llq_desc_mmap_entry)
502e84d3c18SMichal Kalderon 		goto err_remove_mmap;
50340909f66SGal Pressman 
50440909f66SGal Pressman 	resp->llq_desc_offset &= ~PAGE_MASK;
50540909f66SGal Pressman 
50640909f66SGal Pressman 	if (qp->rq_size) {
507e84d3c18SMichal Kalderon 		address = dev->db_bar_addr + resp->rq_db_offset;
508e84d3c18SMichal Kalderon 
509e84d3c18SMichal Kalderon 		qp->rq_db_mmap_entry =
510e84d3c18SMichal Kalderon 			efa_user_mmap_entry_insert(&ucontext->ibucontext,
511e84d3c18SMichal Kalderon 						   address, PAGE_SIZE,
512e84d3c18SMichal Kalderon 						   EFA_MMAP_IO_NC,
513e84d3c18SMichal Kalderon 						   &resp->rq_db_mmap_key);
514e84d3c18SMichal Kalderon 		if (!qp->rq_db_mmap_entry)
515e84d3c18SMichal Kalderon 			goto err_remove_mmap;
51640909f66SGal Pressman 
51740909f66SGal Pressman 		resp->rq_db_offset &= ~PAGE_MASK;
51840909f66SGal Pressman 
519e84d3c18SMichal Kalderon 		address = virt_to_phys(qp->rq_cpu_addr);
520e84d3c18SMichal Kalderon 		qp->rq_mmap_entry =
521e84d3c18SMichal Kalderon 			efa_user_mmap_entry_insert(&ucontext->ibucontext,
522e84d3c18SMichal Kalderon 						   address, qp->rq_size,
523e84d3c18SMichal Kalderon 						   EFA_MMAP_DMA_PAGE,
524e84d3c18SMichal Kalderon 						   &resp->rq_mmap_key);
525e84d3c18SMichal Kalderon 		if (!qp->rq_mmap_entry)
526e84d3c18SMichal Kalderon 			goto err_remove_mmap;
52740909f66SGal Pressman 
52840909f66SGal Pressman 		resp->rq_mmap_size = qp->rq_size;
52940909f66SGal Pressman 	}
53040909f66SGal Pressman 
53140909f66SGal Pressman 	return 0;
532e84d3c18SMichal Kalderon 
533e84d3c18SMichal Kalderon err_remove_mmap:
5340428c6efSGal Pressman 	efa_qp_user_mmap_entries_remove(qp);
535e84d3c18SMichal Kalderon 
536e84d3c18SMichal Kalderon 	return -ENOMEM;
53740909f66SGal Pressman }
53840909f66SGal Pressman 
53940909f66SGal Pressman static int efa_qp_validate_cap(struct efa_dev *dev,
54040909f66SGal Pressman 			       struct ib_qp_init_attr *init_attr)
54140909f66SGal Pressman {
54240909f66SGal Pressman 	if (init_attr->cap.max_send_wr > dev->dev_attr.max_sq_depth) {
54340909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
54440909f66SGal Pressman 			  "qp: requested send wr[%u] exceeds the max[%u]\n",
54540909f66SGal Pressman 			  init_attr->cap.max_send_wr,
54640909f66SGal Pressman 			  dev->dev_attr.max_sq_depth);
54740909f66SGal Pressman 		return -EINVAL;
54840909f66SGal Pressman 	}
54940909f66SGal Pressman 	if (init_attr->cap.max_recv_wr > dev->dev_attr.max_rq_depth) {
55040909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
55140909f66SGal Pressman 			  "qp: requested receive wr[%u] exceeds the max[%u]\n",
55240909f66SGal Pressman 			  init_attr->cap.max_recv_wr,
55340909f66SGal Pressman 			  dev->dev_attr.max_rq_depth);
55440909f66SGal Pressman 		return -EINVAL;
55540909f66SGal Pressman 	}
55640909f66SGal Pressman 	if (init_attr->cap.max_send_sge > dev->dev_attr.max_sq_sge) {
55740909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
55840909f66SGal Pressman 			  "qp: requested sge send[%u] exceeds the max[%u]\n",
55940909f66SGal Pressman 			  init_attr->cap.max_send_sge, dev->dev_attr.max_sq_sge);
56040909f66SGal Pressman 		return -EINVAL;
56140909f66SGal Pressman 	}
56240909f66SGal Pressman 	if (init_attr->cap.max_recv_sge > dev->dev_attr.max_rq_sge) {
56340909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
56440909f66SGal Pressman 			  "qp: requested sge recv[%u] exceeds the max[%u]\n",
56540909f66SGal Pressman 			  init_attr->cap.max_recv_sge, dev->dev_attr.max_rq_sge);
56640909f66SGal Pressman 		return -EINVAL;
56740909f66SGal Pressman 	}
56840909f66SGal Pressman 	if (init_attr->cap.max_inline_data > dev->dev_attr.inline_buf_size) {
56940909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
57040909f66SGal Pressman 			  "qp: requested inline data[%u] exceeds the max[%u]\n",
57140909f66SGal Pressman 			  init_attr->cap.max_inline_data,
57240909f66SGal Pressman 			  dev->dev_attr.inline_buf_size);
57340909f66SGal Pressman 		return -EINVAL;
57440909f66SGal Pressman 	}
57540909f66SGal Pressman 
57640909f66SGal Pressman 	return 0;
57740909f66SGal Pressman }
57840909f66SGal Pressman 
57940909f66SGal Pressman static int efa_qp_validate_attr(struct efa_dev *dev,
58040909f66SGal Pressman 				struct ib_qp_init_attr *init_attr)
58140909f66SGal Pressman {
58240909f66SGal Pressman 	if (init_attr->qp_type != IB_QPT_DRIVER &&
58340909f66SGal Pressman 	    init_attr->qp_type != IB_QPT_UD) {
58440909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
58540909f66SGal Pressman 			  "Unsupported qp type %d\n", init_attr->qp_type);
58640909f66SGal Pressman 		return -EOPNOTSUPP;
58740909f66SGal Pressman 	}
58840909f66SGal Pressman 
58940909f66SGal Pressman 	if (init_attr->srq) {
59040909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "SRQ is not supported\n");
59140909f66SGal Pressman 		return -EOPNOTSUPP;
59240909f66SGal Pressman 	}
59340909f66SGal Pressman 
59440909f66SGal Pressman 	if (init_attr->create_flags) {
59540909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Unsupported create flags\n");
59640909f66SGal Pressman 		return -EOPNOTSUPP;
59740909f66SGal Pressman 	}
59840909f66SGal Pressman 
59940909f66SGal Pressman 	return 0;
60040909f66SGal Pressman }
60140909f66SGal Pressman 
60240909f66SGal Pressman struct ib_qp *efa_create_qp(struct ib_pd *ibpd,
60340909f66SGal Pressman 			    struct ib_qp_init_attr *init_attr,
60440909f66SGal Pressman 			    struct ib_udata *udata)
60540909f66SGal Pressman {
60640909f66SGal Pressman 	struct efa_com_create_qp_params create_qp_params = {};
60740909f66SGal Pressman 	struct efa_com_create_qp_result create_qp_resp;
60840909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibpd->device);
60940909f66SGal Pressman 	struct efa_ibv_create_qp_resp resp = {};
61040909f66SGal Pressman 	struct efa_ibv_create_qp cmd = {};
61140909f66SGal Pressman 	struct efa_ucontext *ucontext;
61240909f66SGal Pressman 	struct efa_qp *qp;
61340909f66SGal Pressman 	int err;
61440909f66SGal Pressman 
61540909f66SGal Pressman 	ucontext = rdma_udata_to_drv_context(udata, struct efa_ucontext,
61640909f66SGal Pressman 					     ibucontext);
61740909f66SGal Pressman 
61840909f66SGal Pressman 	err = efa_qp_validate_cap(dev, init_attr);
61940909f66SGal Pressman 	if (err)
62040909f66SGal Pressman 		goto err_out;
62140909f66SGal Pressman 
62240909f66SGal Pressman 	err = efa_qp_validate_attr(dev, init_attr);
62340909f66SGal Pressman 	if (err)
62440909f66SGal Pressman 		goto err_out;
62540909f66SGal Pressman 
626fa8a44f6SLeon Romanovsky 	if (offsetofend(typeof(cmd), driver_qp_type) > udata->inlen) {
62740909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
62840909f66SGal Pressman 			  "Incompatible ABI params, no input udata\n");
62940909f66SGal Pressman 		err = -EINVAL;
63040909f66SGal Pressman 		goto err_out;
63140909f66SGal Pressman 	}
63240909f66SGal Pressman 
63340909f66SGal Pressman 	if (udata->inlen > sizeof(cmd) &&
63440909f66SGal Pressman 	    !ib_is_udata_cleared(udata, sizeof(cmd),
63540909f66SGal Pressman 				 udata->inlen - sizeof(cmd))) {
63640909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
63740909f66SGal Pressman 			  "Incompatible ABI params, unknown fields in udata\n");
63840909f66SGal Pressman 		err = -EINVAL;
63940909f66SGal Pressman 		goto err_out;
64040909f66SGal Pressman 	}
64140909f66SGal Pressman 
64240909f66SGal Pressman 	err = ib_copy_from_udata(&cmd, udata,
64340909f66SGal Pressman 				 min(sizeof(cmd), udata->inlen));
64440909f66SGal Pressman 	if (err) {
64540909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
64640909f66SGal Pressman 			  "Cannot copy udata for create_qp\n");
64740909f66SGal Pressman 		goto err_out;
64840909f66SGal Pressman 	}
64940909f66SGal Pressman 
65040909f66SGal Pressman 	if (cmd.comp_mask) {
65140909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
65240909f66SGal Pressman 			  "Incompatible ABI params, unknown fields in udata\n");
65340909f66SGal Pressman 		err = -EINVAL;
65440909f66SGal Pressman 		goto err_out;
65540909f66SGal Pressman 	}
65640909f66SGal Pressman 
65740909f66SGal Pressman 	qp = kzalloc(sizeof(*qp), GFP_KERNEL);
65840909f66SGal Pressman 	if (!qp) {
65940909f66SGal Pressman 		err = -ENOMEM;
66040909f66SGal Pressman 		goto err_out;
66140909f66SGal Pressman 	}
66240909f66SGal Pressman 
66340909f66SGal Pressman 	create_qp_params.uarn = ucontext->uarn;
66440909f66SGal Pressman 	create_qp_params.pd = to_epd(ibpd)->pdn;
66540909f66SGal Pressman 
66640909f66SGal Pressman 	if (init_attr->qp_type == IB_QPT_UD) {
66740909f66SGal Pressman 		create_qp_params.qp_type = EFA_ADMIN_QP_TYPE_UD;
66840909f66SGal Pressman 	} else if (cmd.driver_qp_type == EFA_QP_DRIVER_TYPE_SRD) {
66940909f66SGal Pressman 		create_qp_params.qp_type = EFA_ADMIN_QP_TYPE_SRD;
67040909f66SGal Pressman 	} else {
67140909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
67240909f66SGal Pressman 			  "Unsupported qp type %d driver qp type %d\n",
67340909f66SGal Pressman 			  init_attr->qp_type, cmd.driver_qp_type);
67440909f66SGal Pressman 		err = -EOPNOTSUPP;
67540909f66SGal Pressman 		goto err_free_qp;
67640909f66SGal Pressman 	}
67740909f66SGal Pressman 
67840909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Create QP: qp type %d driver qp type %#x\n",
67940909f66SGal Pressman 		  init_attr->qp_type, cmd.driver_qp_type);
68040909f66SGal Pressman 	create_qp_params.send_cq_idx = to_ecq(init_attr->send_cq)->cq_idx;
68140909f66SGal Pressman 	create_qp_params.recv_cq_idx = to_ecq(init_attr->recv_cq)->cq_idx;
68240909f66SGal Pressman 	create_qp_params.sq_depth = init_attr->cap.max_send_wr;
68340909f66SGal Pressman 	create_qp_params.sq_ring_size_in_bytes = cmd.sq_ring_size;
68440909f66SGal Pressman 
68540909f66SGal Pressman 	create_qp_params.rq_depth = init_attr->cap.max_recv_wr;
68640909f66SGal Pressman 	create_qp_params.rq_ring_size_in_bytes = cmd.rq_ring_size;
68740909f66SGal Pressman 	qp->rq_size = PAGE_ALIGN(create_qp_params.rq_ring_size_in_bytes);
68840909f66SGal Pressman 	if (qp->rq_size) {
68940909f66SGal Pressman 		qp->rq_cpu_addr = efa_zalloc_mapped(dev, &qp->rq_dma_addr,
69040909f66SGal Pressman 						    qp->rq_size, DMA_TO_DEVICE);
69140909f66SGal Pressman 		if (!qp->rq_cpu_addr) {
69240909f66SGal Pressman 			err = -ENOMEM;
69340909f66SGal Pressman 			goto err_free_qp;
69440909f66SGal Pressman 		}
69540909f66SGal Pressman 
69640909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
69740909f66SGal Pressman 			  "qp->cpu_addr[0x%p] allocated: size[%lu], dma[%pad]\n",
69840909f66SGal Pressman 			  qp->rq_cpu_addr, qp->rq_size, &qp->rq_dma_addr);
69940909f66SGal Pressman 		create_qp_params.rq_base_addr = qp->rq_dma_addr;
70040909f66SGal Pressman 	}
70140909f66SGal Pressman 
70240909f66SGal Pressman 	err = efa_com_create_qp(&dev->edev, &create_qp_params,
70340909f66SGal Pressman 				&create_qp_resp);
70440909f66SGal Pressman 	if (err)
70540909f66SGal Pressman 		goto err_free_mapped;
70640909f66SGal Pressman 
70740909f66SGal Pressman 	resp.sq_db_offset = create_qp_resp.sq_db_offset;
70840909f66SGal Pressman 	resp.rq_db_offset = create_qp_resp.rq_db_offset;
70940909f66SGal Pressman 	resp.llq_desc_offset = create_qp_resp.llq_descriptors_offset;
71040909f66SGal Pressman 	resp.send_sub_cq_idx = create_qp_resp.send_sub_cq_idx;
71140909f66SGal Pressman 	resp.recv_sub_cq_idx = create_qp_resp.recv_sub_cq_idx;
71240909f66SGal Pressman 
71340909f66SGal Pressman 	err = qp_mmap_entries_setup(qp, dev, ucontext, &create_qp_params,
71440909f66SGal Pressman 				    &resp);
71540909f66SGal Pressman 	if (err)
71640909f66SGal Pressman 		goto err_destroy_qp;
71740909f66SGal Pressman 
71840909f66SGal Pressman 	qp->qp_handle = create_qp_resp.qp_handle;
71940909f66SGal Pressman 	qp->ibqp.qp_num = create_qp_resp.qp_num;
72040909f66SGal Pressman 	qp->ibqp.qp_type = init_attr->qp_type;
72140909f66SGal Pressman 	qp->max_send_wr = init_attr->cap.max_send_wr;
72240909f66SGal Pressman 	qp->max_recv_wr = init_attr->cap.max_recv_wr;
72340909f66SGal Pressman 	qp->max_send_sge = init_attr->cap.max_send_sge;
72440909f66SGal Pressman 	qp->max_recv_sge = init_attr->cap.max_recv_sge;
72540909f66SGal Pressman 	qp->max_inline_data = init_attr->cap.max_inline_data;
72640909f66SGal Pressman 
72740909f66SGal Pressman 	if (udata->outlen) {
72840909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
72940909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
73040909f66SGal Pressman 		if (err) {
73140909f66SGal Pressman 			ibdev_dbg(&dev->ibdev,
73240909f66SGal Pressman 				  "Failed to copy udata for qp[%u]\n",
73340909f66SGal Pressman 				  create_qp_resp.qp_num);
734e84d3c18SMichal Kalderon 			goto err_remove_mmap_entries;
73540909f66SGal Pressman 		}
73640909f66SGal Pressman 	}
73740909f66SGal Pressman 
73840909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Created qp[%d]\n", qp->ibqp.qp_num);
73940909f66SGal Pressman 
74040909f66SGal Pressman 	return &qp->ibqp;
74140909f66SGal Pressman 
742e84d3c18SMichal Kalderon err_remove_mmap_entries:
7430428c6efSGal Pressman 	efa_qp_user_mmap_entries_remove(qp);
74440909f66SGal Pressman err_destroy_qp:
74540909f66SGal Pressman 	efa_destroy_qp_handle(dev, create_qp_resp.qp_handle);
74640909f66SGal Pressman err_free_mapped:
747ff6629f8SGal Pressman 	if (qp->rq_size)
748ff6629f8SGal Pressman 		efa_free_mapped(dev, qp->rq_cpu_addr, qp->rq_dma_addr,
749ff6629f8SGal Pressman 				qp->rq_size, DMA_TO_DEVICE);
75040909f66SGal Pressman err_free_qp:
75140909f66SGal Pressman 	kfree(qp);
75240909f66SGal Pressman err_out:
753215b88acSGal Pressman 	atomic64_inc(&dev->stats.create_qp_err);
75440909f66SGal Pressman 	return ERR_PTR(err);
75540909f66SGal Pressman }
75640909f66SGal Pressman 
75722c50e06SGal Pressman static const struct {
75822c50e06SGal Pressman 	int			valid;
75922c50e06SGal Pressman 	enum ib_qp_attr_mask	req_param;
76022c50e06SGal Pressman 	enum ib_qp_attr_mask	opt_param;
76122c50e06SGal Pressman } srd_qp_state_table[IB_QPS_ERR + 1][IB_QPS_ERR + 1] = {
76222c50e06SGal Pressman 	[IB_QPS_RESET] = {
76322c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
76422c50e06SGal Pressman 		[IB_QPS_INIT]  = {
76522c50e06SGal Pressman 			.valid = 1,
76622c50e06SGal Pressman 			.req_param = IB_QP_PKEY_INDEX |
76722c50e06SGal Pressman 				     IB_QP_PORT |
76822c50e06SGal Pressman 				     IB_QP_QKEY,
76922c50e06SGal Pressman 		},
77022c50e06SGal Pressman 	},
77122c50e06SGal Pressman 	[IB_QPS_INIT] = {
77222c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
77322c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
77422c50e06SGal Pressman 		[IB_QPS_INIT]  = {
77522c50e06SGal Pressman 			.valid = 1,
77622c50e06SGal Pressman 			.opt_param = IB_QP_PKEY_INDEX |
77722c50e06SGal Pressman 				     IB_QP_PORT |
77822c50e06SGal Pressman 				     IB_QP_QKEY,
77922c50e06SGal Pressman 		},
78022c50e06SGal Pressman 		[IB_QPS_RTR]   = {
78122c50e06SGal Pressman 			.valid = 1,
78222c50e06SGal Pressman 			.opt_param = IB_QP_PKEY_INDEX |
78322c50e06SGal Pressman 				     IB_QP_QKEY,
78422c50e06SGal Pressman 		},
78522c50e06SGal Pressman 	},
78622c50e06SGal Pressman 	[IB_QPS_RTR] = {
78722c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
78822c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
78922c50e06SGal Pressman 		[IB_QPS_RTS]   = {
79022c50e06SGal Pressman 			.valid = 1,
79122c50e06SGal Pressman 			.req_param = IB_QP_SQ_PSN,
79222c50e06SGal Pressman 			.opt_param = IB_QP_CUR_STATE |
793a4e6a1ddSGal Pressman 				     IB_QP_QKEY |
794a4e6a1ddSGal Pressman 				     IB_QP_RNR_RETRY,
795a4e6a1ddSGal Pressman 
79622c50e06SGal Pressman 		}
79722c50e06SGal Pressman 	},
79822c50e06SGal Pressman 	[IB_QPS_RTS] = {
79922c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
80022c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
80122c50e06SGal Pressman 		[IB_QPS_RTS]   = {
80222c50e06SGal Pressman 			.valid = 1,
80322c50e06SGal Pressman 			.opt_param = IB_QP_CUR_STATE |
80422c50e06SGal Pressman 				     IB_QP_QKEY,
80522c50e06SGal Pressman 		},
80622c50e06SGal Pressman 		[IB_QPS_SQD] = {
80722c50e06SGal Pressman 			.valid = 1,
80822c50e06SGal Pressman 			.opt_param = IB_QP_EN_SQD_ASYNC_NOTIFY,
80922c50e06SGal Pressman 		},
81022c50e06SGal Pressman 	},
81122c50e06SGal Pressman 	[IB_QPS_SQD] = {
81222c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
81322c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
81422c50e06SGal Pressman 		[IB_QPS_RTS]   = {
81522c50e06SGal Pressman 			.valid = 1,
81622c50e06SGal Pressman 			.opt_param = IB_QP_CUR_STATE |
81722c50e06SGal Pressman 				     IB_QP_QKEY,
81822c50e06SGal Pressman 		},
81922c50e06SGal Pressman 		[IB_QPS_SQD] = {
82022c50e06SGal Pressman 			.valid = 1,
82122c50e06SGal Pressman 			.opt_param = IB_QP_PKEY_INDEX |
82222c50e06SGal Pressman 				     IB_QP_QKEY,
82322c50e06SGal Pressman 		}
82422c50e06SGal Pressman 	},
82522c50e06SGal Pressman 	[IB_QPS_SQE] = {
82622c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
82722c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
82822c50e06SGal Pressman 		[IB_QPS_RTS]   = {
82922c50e06SGal Pressman 			.valid = 1,
83022c50e06SGal Pressman 			.opt_param = IB_QP_CUR_STATE |
83122c50e06SGal Pressman 				     IB_QP_QKEY,
83222c50e06SGal Pressman 		}
83322c50e06SGal Pressman 	},
83422c50e06SGal Pressman 	[IB_QPS_ERR] = {
83522c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
83622c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
83722c50e06SGal Pressman 	}
83822c50e06SGal Pressman };
83922c50e06SGal Pressman 
84022c50e06SGal Pressman static bool efa_modify_srd_qp_is_ok(enum ib_qp_state cur_state,
84122c50e06SGal Pressman 				    enum ib_qp_state next_state,
84222c50e06SGal Pressman 				    enum ib_qp_attr_mask mask)
84322c50e06SGal Pressman {
84422c50e06SGal Pressman 	enum ib_qp_attr_mask req_param, opt_param;
84522c50e06SGal Pressman 
84622c50e06SGal Pressman 	if (mask & IB_QP_CUR_STATE  &&
84722c50e06SGal Pressman 	    cur_state != IB_QPS_RTR && cur_state != IB_QPS_RTS &&
84822c50e06SGal Pressman 	    cur_state != IB_QPS_SQD && cur_state != IB_QPS_SQE)
84922c50e06SGal Pressman 		return false;
85022c50e06SGal Pressman 
85122c50e06SGal Pressman 	if (!srd_qp_state_table[cur_state][next_state].valid)
85222c50e06SGal Pressman 		return false;
85322c50e06SGal Pressman 
85422c50e06SGal Pressman 	req_param = srd_qp_state_table[cur_state][next_state].req_param;
85522c50e06SGal Pressman 	opt_param = srd_qp_state_table[cur_state][next_state].opt_param;
85622c50e06SGal Pressman 
85722c50e06SGal Pressman 	if ((mask & req_param) != req_param)
85822c50e06SGal Pressman 		return false;
85922c50e06SGal Pressman 
86022c50e06SGal Pressman 	if (mask & ~(req_param | opt_param | IB_QP_STATE))
86122c50e06SGal Pressman 		return false;
86222c50e06SGal Pressman 
86322c50e06SGal Pressman 	return true;
86422c50e06SGal Pressman }
86522c50e06SGal Pressman 
86640909f66SGal Pressman static int efa_modify_qp_validate(struct efa_dev *dev, struct efa_qp *qp,
86740909f66SGal Pressman 				  struct ib_qp_attr *qp_attr, int qp_attr_mask,
86840909f66SGal Pressman 				  enum ib_qp_state cur_state,
86940909f66SGal Pressman 				  enum ib_qp_state new_state)
87040909f66SGal Pressman {
87122c50e06SGal Pressman 	int err;
87222c50e06SGal Pressman 
87340909f66SGal Pressman #define EFA_MODIFY_QP_SUPP_MASK \
87440909f66SGal Pressman 	(IB_QP_STATE | IB_QP_CUR_STATE | IB_QP_EN_SQD_ASYNC_NOTIFY | \
875a4e6a1ddSGal Pressman 	 IB_QP_PKEY_INDEX | IB_QP_PORT | IB_QP_QKEY | IB_QP_SQ_PSN | \
876a4e6a1ddSGal Pressman 	 IB_QP_RNR_RETRY)
87740909f66SGal Pressman 
87840909f66SGal Pressman 	if (qp_attr_mask & ~EFA_MODIFY_QP_SUPP_MASK) {
87940909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
88040909f66SGal Pressman 			  "Unsupported qp_attr_mask[%#x] supported[%#x]\n",
88140909f66SGal Pressman 			  qp_attr_mask, EFA_MODIFY_QP_SUPP_MASK);
88240909f66SGal Pressman 		return -EOPNOTSUPP;
88340909f66SGal Pressman 	}
88440909f66SGal Pressman 
88522c50e06SGal Pressman 	if (qp->ibqp.qp_type == IB_QPT_DRIVER)
88622c50e06SGal Pressman 		err = !efa_modify_srd_qp_is_ok(cur_state, new_state,
88722c50e06SGal Pressman 					       qp_attr_mask);
88822c50e06SGal Pressman 	else
88922c50e06SGal Pressman 		err = !ib_modify_qp_is_ok(cur_state, new_state, IB_QPT_UD,
89022c50e06SGal Pressman 					  qp_attr_mask);
89122c50e06SGal Pressman 
89222c50e06SGal Pressman 	if (err) {
89340909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Invalid modify QP parameters\n");
89440909f66SGal Pressman 		return -EINVAL;
89540909f66SGal Pressman 	}
89640909f66SGal Pressman 
89740909f66SGal Pressman 	if ((qp_attr_mask & IB_QP_PORT) && qp_attr->port_num != 1) {
89840909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Can't change port num\n");
89940909f66SGal Pressman 		return -EOPNOTSUPP;
90040909f66SGal Pressman 	}
90140909f66SGal Pressman 
90240909f66SGal Pressman 	if ((qp_attr_mask & IB_QP_PKEY_INDEX) && qp_attr->pkey_index) {
90340909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Can't change pkey index\n");
90440909f66SGal Pressman 		return -EOPNOTSUPP;
90540909f66SGal Pressman 	}
90640909f66SGal Pressman 
90740909f66SGal Pressman 	return 0;
90840909f66SGal Pressman }
90940909f66SGal Pressman 
91040909f66SGal Pressman int efa_modify_qp(struct ib_qp *ibqp, struct ib_qp_attr *qp_attr,
91140909f66SGal Pressman 		  int qp_attr_mask, struct ib_udata *udata)
91240909f66SGal Pressman {
91340909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibqp->device);
91440909f66SGal Pressman 	struct efa_com_modify_qp_params params = {};
91540909f66SGal Pressman 	struct efa_qp *qp = to_eqp(ibqp);
91640909f66SGal Pressman 	enum ib_qp_state cur_state;
91740909f66SGal Pressman 	enum ib_qp_state new_state;
91840909f66SGal Pressman 	int err;
91940909f66SGal Pressman 
92026e990baSJason Gunthorpe 	if (qp_attr_mask & ~IB_QP_ATTR_STANDARD_BITS)
92126e990baSJason Gunthorpe 		return -EOPNOTSUPP;
92226e990baSJason Gunthorpe 
92340909f66SGal Pressman 	if (udata->inlen &&
92440909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, udata->inlen)) {
92540909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
92640909f66SGal Pressman 			  "Incompatible ABI params, udata not cleared\n");
92740909f66SGal Pressman 		return -EINVAL;
92840909f66SGal Pressman 	}
92940909f66SGal Pressman 
93040909f66SGal Pressman 	cur_state = qp_attr_mask & IB_QP_CUR_STATE ? qp_attr->cur_qp_state :
93140909f66SGal Pressman 						     qp->state;
93240909f66SGal Pressman 	new_state = qp_attr_mask & IB_QP_STATE ? qp_attr->qp_state : cur_state;
93340909f66SGal Pressman 
93440909f66SGal Pressman 	err = efa_modify_qp_validate(dev, qp, qp_attr, qp_attr_mask, cur_state,
93540909f66SGal Pressman 				     new_state);
93640909f66SGal Pressman 	if (err)
93740909f66SGal Pressman 		return err;
93840909f66SGal Pressman 
93940909f66SGal Pressman 	params.qp_handle = qp->qp_handle;
94040909f66SGal Pressman 
94140909f66SGal Pressman 	if (qp_attr_mask & IB_QP_STATE) {
942ab67baddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_QP_STATE,
943ab67baddSGal Pressman 			1);
944ab67baddSGal Pressman 		EFA_SET(&params.modify_mask,
945ab67baddSGal Pressman 			EFA_ADMIN_MODIFY_QP_CMD_CUR_QP_STATE, 1);
94693416ab0SGal Pressman 		params.cur_qp_state = cur_state;
94793416ab0SGal Pressman 		params.qp_state = new_state;
94840909f66SGal Pressman 	}
94940909f66SGal Pressman 
95040909f66SGal Pressman 	if (qp_attr_mask & IB_QP_EN_SQD_ASYNC_NOTIFY) {
951ab67baddSGal Pressman 		EFA_SET(&params.modify_mask,
952ab67baddSGal Pressman 			EFA_ADMIN_MODIFY_QP_CMD_SQ_DRAINED_ASYNC_NOTIFY, 1);
95340909f66SGal Pressman 		params.sq_drained_async_notify = qp_attr->en_sqd_async_notify;
95440909f66SGal Pressman 	}
95540909f66SGal Pressman 
95640909f66SGal Pressman 	if (qp_attr_mask & IB_QP_QKEY) {
957ab67baddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_QKEY, 1);
95840909f66SGal Pressman 		params.qkey = qp_attr->qkey;
95940909f66SGal Pressman 	}
96040909f66SGal Pressman 
96140909f66SGal Pressman 	if (qp_attr_mask & IB_QP_SQ_PSN) {
962ab67baddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_SQ_PSN, 1);
96340909f66SGal Pressman 		params.sq_psn = qp_attr->sq_psn;
96440909f66SGal Pressman 	}
96540909f66SGal Pressman 
966a4e6a1ddSGal Pressman 	if (qp_attr_mask & IB_QP_RNR_RETRY) {
967a4e6a1ddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_RNR_RETRY,
968a4e6a1ddSGal Pressman 			1);
969a4e6a1ddSGal Pressman 		params.rnr_retry = qp_attr->rnr_retry;
970a4e6a1ddSGal Pressman 	}
971a4e6a1ddSGal Pressman 
97240909f66SGal Pressman 	err = efa_com_modify_qp(&dev->edev, &params);
97340909f66SGal Pressman 	if (err)
97440909f66SGal Pressman 		return err;
97540909f66SGal Pressman 
97640909f66SGal Pressman 	qp->state = new_state;
97740909f66SGal Pressman 
97840909f66SGal Pressman 	return 0;
97940909f66SGal Pressman }
98040909f66SGal Pressman 
98140909f66SGal Pressman static int efa_destroy_cq_idx(struct efa_dev *dev, int cq_idx)
98240909f66SGal Pressman {
98340909f66SGal Pressman 	struct efa_com_destroy_cq_params params = { .cq_idx = cq_idx };
98440909f66SGal Pressman 
98540909f66SGal Pressman 	return efa_com_destroy_cq(&dev->edev, &params);
98640909f66SGal Pressman }
98740909f66SGal Pressman 
98843d781b9SLeon Romanovsky int efa_destroy_cq(struct ib_cq *ibcq, struct ib_udata *udata)
98940909f66SGal Pressman {
99040909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibcq->device);
99140909f66SGal Pressman 	struct efa_cq *cq = to_ecq(ibcq);
99240909f66SGal Pressman 
99340909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
99440909f66SGal Pressman 		  "Destroy cq[%d] virt[0x%p] freed: size[%lu], dma[%pad]\n",
99540909f66SGal Pressman 		  cq->cq_idx, cq->cpu_addr, cq->size, &cq->dma_addr);
99640909f66SGal Pressman 
997e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(cq->mmap_entry);
998ff6629f8SGal Pressman 	efa_destroy_cq_idx(dev, cq->cq_idx);
999ff6629f8SGal Pressman 	efa_free_mapped(dev, cq->cpu_addr, cq->dma_addr, cq->size,
1000ff6629f8SGal Pressman 			DMA_FROM_DEVICE);
100143d781b9SLeon Romanovsky 	return 0;
100240909f66SGal Pressman }
100340909f66SGal Pressman 
100440909f66SGal Pressman static int cq_mmap_entries_setup(struct efa_dev *dev, struct efa_cq *cq,
100540909f66SGal Pressman 				 struct efa_ibv_create_cq_resp *resp)
100640909f66SGal Pressman {
100740909f66SGal Pressman 	resp->q_mmap_size = cq->size;
1008e84d3c18SMichal Kalderon 	cq->mmap_entry = efa_user_mmap_entry_insert(&cq->ucontext->ibucontext,
100940909f66SGal Pressman 						    virt_to_phys(cq->cpu_addr),
1010e84d3c18SMichal Kalderon 						    cq->size, EFA_MMAP_DMA_PAGE,
1011e84d3c18SMichal Kalderon 						    &resp->q_mmap_key);
1012e84d3c18SMichal Kalderon 	if (!cq->mmap_entry)
101340909f66SGal Pressman 		return -ENOMEM;
101440909f66SGal Pressman 
101540909f66SGal Pressman 	return 0;
101640909f66SGal Pressman }
101740909f66SGal Pressman 
1018e39afe3dSLeon Romanovsky int efa_create_cq(struct ib_cq *ibcq, const struct ib_cq_init_attr *attr,
101940909f66SGal Pressman 		  struct ib_udata *udata)
102040909f66SGal Pressman {
1021e39afe3dSLeon Romanovsky 	struct efa_ucontext *ucontext = rdma_udata_to_drv_context(
1022e39afe3dSLeon Romanovsky 		udata, struct efa_ucontext, ibucontext);
102340909f66SGal Pressman 	struct efa_ibv_create_cq_resp resp = {};
102440909f66SGal Pressman 	struct efa_com_create_cq_params params;
102540909f66SGal Pressman 	struct efa_com_create_cq_result result;
1026e39afe3dSLeon Romanovsky 	struct ib_device *ibdev = ibcq->device;
102740909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibdev);
102840909f66SGal Pressman 	struct efa_ibv_create_cq cmd = {};
1029e39afe3dSLeon Romanovsky 	struct efa_cq *cq = to_ecq(ibcq);
1030e39afe3dSLeon Romanovsky 	int entries = attr->cqe;
103140909f66SGal Pressman 	int err;
103240909f66SGal Pressman 
103340909f66SGal Pressman 	ibdev_dbg(ibdev, "create_cq entries %d\n", entries);
103440909f66SGal Pressman 
10351c407cb5SJason Gunthorpe 	if (attr->flags)
10361c407cb5SJason Gunthorpe 		return -EOPNOTSUPP;
10371c407cb5SJason Gunthorpe 
103840909f66SGal Pressman 	if (entries < 1 || entries > dev->dev_attr.max_cq_depth) {
103940909f66SGal Pressman 		ibdev_dbg(ibdev,
104040909f66SGal Pressman 			  "cq: requested entries[%u] non-positive or greater than max[%u]\n",
104140909f66SGal Pressman 			  entries, dev->dev_attr.max_cq_depth);
104240909f66SGal Pressman 		err = -EINVAL;
104340909f66SGal Pressman 		goto err_out;
104440909f66SGal Pressman 	}
104540909f66SGal Pressman 
1046fa8a44f6SLeon Romanovsky 	if (offsetofend(typeof(cmd), num_sub_cqs) > udata->inlen) {
104740909f66SGal Pressman 		ibdev_dbg(ibdev,
104840909f66SGal Pressman 			  "Incompatible ABI params, no input udata\n");
104940909f66SGal Pressman 		err = -EINVAL;
105040909f66SGal Pressman 		goto err_out;
105140909f66SGal Pressman 	}
105240909f66SGal Pressman 
105340909f66SGal Pressman 	if (udata->inlen > sizeof(cmd) &&
105440909f66SGal Pressman 	    !ib_is_udata_cleared(udata, sizeof(cmd),
105540909f66SGal Pressman 				 udata->inlen - sizeof(cmd))) {
105640909f66SGal Pressman 		ibdev_dbg(ibdev,
105740909f66SGal Pressman 			  "Incompatible ABI params, unknown fields in udata\n");
105840909f66SGal Pressman 		err = -EINVAL;
105940909f66SGal Pressman 		goto err_out;
106040909f66SGal Pressman 	}
106140909f66SGal Pressman 
106240909f66SGal Pressman 	err = ib_copy_from_udata(&cmd, udata,
106340909f66SGal Pressman 				 min(sizeof(cmd), udata->inlen));
106440909f66SGal Pressman 	if (err) {
106540909f66SGal Pressman 		ibdev_dbg(ibdev, "Cannot copy udata for create_cq\n");
106640909f66SGal Pressman 		goto err_out;
106740909f66SGal Pressman 	}
106840909f66SGal Pressman 
106940909f66SGal Pressman 	if (cmd.comp_mask || !is_reserved_cleared(cmd.reserved_50)) {
107040909f66SGal Pressman 		ibdev_dbg(ibdev,
107140909f66SGal Pressman 			  "Incompatible ABI params, unknown fields in udata\n");
107240909f66SGal Pressman 		err = -EINVAL;
107340909f66SGal Pressman 		goto err_out;
107440909f66SGal Pressman 	}
107540909f66SGal Pressman 
107640909f66SGal Pressman 	if (!cmd.cq_entry_size) {
107740909f66SGal Pressman 		ibdev_dbg(ibdev,
107840909f66SGal Pressman 			  "Invalid entry size [%u]\n", cmd.cq_entry_size);
107940909f66SGal Pressman 		err = -EINVAL;
108040909f66SGal Pressman 		goto err_out;
108140909f66SGal Pressman 	}
108240909f66SGal Pressman 
108340909f66SGal Pressman 	if (cmd.num_sub_cqs != dev->dev_attr.sub_cqs_per_cq) {
108440909f66SGal Pressman 		ibdev_dbg(ibdev,
108540909f66SGal Pressman 			  "Invalid number of sub cqs[%u] expected[%u]\n",
108640909f66SGal Pressman 			  cmd.num_sub_cqs, dev->dev_attr.sub_cqs_per_cq);
108740909f66SGal Pressman 		err = -EINVAL;
108840909f66SGal Pressman 		goto err_out;
108940909f66SGal Pressman 	}
109040909f66SGal Pressman 
1091e39afe3dSLeon Romanovsky 	cq->ucontext = ucontext;
109240909f66SGal Pressman 	cq->size = PAGE_ALIGN(cmd.cq_entry_size * entries * cmd.num_sub_cqs);
109340909f66SGal Pressman 	cq->cpu_addr = efa_zalloc_mapped(dev, &cq->dma_addr, cq->size,
109440909f66SGal Pressman 					 DMA_FROM_DEVICE);
109540909f66SGal Pressman 	if (!cq->cpu_addr) {
109640909f66SGal Pressman 		err = -ENOMEM;
1097e39afe3dSLeon Romanovsky 		goto err_out;
109840909f66SGal Pressman 	}
109940909f66SGal Pressman 
110040909f66SGal Pressman 	params.uarn = cq->ucontext->uarn;
110140909f66SGal Pressman 	params.cq_depth = entries;
110240909f66SGal Pressman 	params.dma_addr = cq->dma_addr;
110340909f66SGal Pressman 	params.entry_size_in_bytes = cmd.cq_entry_size;
110440909f66SGal Pressman 	params.num_sub_cqs = cmd.num_sub_cqs;
110540909f66SGal Pressman 	err = efa_com_create_cq(&dev->edev, &params, &result);
110640909f66SGal Pressman 	if (err)
110740909f66SGal Pressman 		goto err_free_mapped;
110840909f66SGal Pressman 
110940909f66SGal Pressman 	resp.cq_idx = result.cq_idx;
111040909f66SGal Pressman 	cq->cq_idx = result.cq_idx;
111140909f66SGal Pressman 	cq->ibcq.cqe = result.actual_depth;
111240909f66SGal Pressman 	WARN_ON_ONCE(entries != result.actual_depth);
111340909f66SGal Pressman 
111440909f66SGal Pressman 	err = cq_mmap_entries_setup(dev, cq, &resp);
111540909f66SGal Pressman 	if (err) {
1116e39afe3dSLeon Romanovsky 		ibdev_dbg(ibdev, "Could not setup cq[%u] mmap entries\n",
1117e39afe3dSLeon Romanovsky 			  cq->cq_idx);
111840909f66SGal Pressman 		goto err_destroy_cq;
111940909f66SGal Pressman 	}
112040909f66SGal Pressman 
112140909f66SGal Pressman 	if (udata->outlen) {
112240909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
112340909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
112440909f66SGal Pressman 		if (err) {
112540909f66SGal Pressman 			ibdev_dbg(ibdev,
112640909f66SGal Pressman 				  "Failed to copy udata for create_cq\n");
1127e84d3c18SMichal Kalderon 			goto err_remove_mmap;
112840909f66SGal Pressman 		}
112940909f66SGal Pressman 	}
113040909f66SGal Pressman 
1131e39afe3dSLeon Romanovsky 	ibdev_dbg(ibdev, "Created cq[%d], cq depth[%u]. dma[%pad] virt[0x%p]\n",
113240909f66SGal Pressman 		  cq->cq_idx, result.actual_depth, &cq->dma_addr, cq->cpu_addr);
113340909f66SGal Pressman 
1134e39afe3dSLeon Romanovsky 	return 0;
113540909f66SGal Pressman 
1136e84d3c18SMichal Kalderon err_remove_mmap:
1137e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(cq->mmap_entry);
113840909f66SGal Pressman err_destroy_cq:
113940909f66SGal Pressman 	efa_destroy_cq_idx(dev, cq->cq_idx);
114040909f66SGal Pressman err_free_mapped:
1141ff6629f8SGal Pressman 	efa_free_mapped(dev, cq->cpu_addr, cq->dma_addr, cq->size,
114240909f66SGal Pressman 			DMA_FROM_DEVICE);
1143e84d3c18SMichal Kalderon 
114440909f66SGal Pressman err_out:
1145215b88acSGal Pressman 	atomic64_inc(&dev->stats.create_cq_err);
1146e39afe3dSLeon Romanovsky 	return err;
114740909f66SGal Pressman }
114840909f66SGal Pressman 
114940909f66SGal Pressman static int umem_to_page_list(struct efa_dev *dev,
115040909f66SGal Pressman 			     struct ib_umem *umem,
115140909f66SGal Pressman 			     u64 *page_list,
115240909f66SGal Pressman 			     u32 hp_cnt,
115340909f66SGal Pressman 			     u8 hp_shift)
115440909f66SGal Pressman {
115540909f66SGal Pressman 	u32 pages_in_hp = BIT(hp_shift - PAGE_SHIFT);
115640ddb3f0SGal Pressman 	struct ib_block_iter biter;
115740909f66SGal Pressman 	unsigned int hp_idx = 0;
115840909f66SGal Pressman 
115940909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "hp_cnt[%u], pages_in_hp[%u]\n",
116040909f66SGal Pressman 		  hp_cnt, pages_in_hp);
116140909f66SGal Pressman 
1162ebc24096SJason Gunthorpe 	rdma_umem_for_each_dma_block(umem, &biter, BIT(hp_shift))
116340ddb3f0SGal Pressman 		page_list[hp_idx++] = rdma_block_iter_dma_address(&biter);
116440909f66SGal Pressman 
116540909f66SGal Pressman 	return 0;
116640909f66SGal Pressman }
116740909f66SGal Pressman 
116840909f66SGal Pressman static struct scatterlist *efa_vmalloc_buf_to_sg(u64 *buf, int page_cnt)
116940909f66SGal Pressman {
117040909f66SGal Pressman 	struct scatterlist *sglist;
117140909f66SGal Pressman 	struct page *pg;
117240909f66SGal Pressman 	int i;
117340909f66SGal Pressman 
11743de3c478SJulia Lawall 	sglist = kmalloc_array(page_cnt, sizeof(*sglist), GFP_KERNEL);
117540909f66SGal Pressman 	if (!sglist)
117640909f66SGal Pressman 		return NULL;
117740909f66SGal Pressman 	sg_init_table(sglist, page_cnt);
117840909f66SGal Pressman 	for (i = 0; i < page_cnt; i++) {
117940909f66SGal Pressman 		pg = vmalloc_to_page(buf);
118040909f66SGal Pressman 		if (!pg)
118140909f66SGal Pressman 			goto err;
118240909f66SGal Pressman 		sg_set_page(&sglist[i], pg, PAGE_SIZE, 0);
118340909f66SGal Pressman 		buf += PAGE_SIZE / sizeof(*buf);
118440909f66SGal Pressman 	}
118540909f66SGal Pressman 	return sglist;
118640909f66SGal Pressman 
118740909f66SGal Pressman err:
118840909f66SGal Pressman 	kfree(sglist);
118940909f66SGal Pressman 	return NULL;
119040909f66SGal Pressman }
119140909f66SGal Pressman 
119240909f66SGal Pressman /*
119340909f66SGal Pressman  * create a chunk list of physical pages dma addresses from the supplied
119440909f66SGal Pressman  * scatter gather list
119540909f66SGal Pressman  */
119640909f66SGal Pressman static int pbl_chunk_list_create(struct efa_dev *dev, struct pbl_context *pbl)
119740909f66SGal Pressman {
119840909f66SGal Pressman 	struct pbl_chunk_list *chunk_list = &pbl->phys.indirect.chunk_list;
119940909f66SGal Pressman 	int page_cnt = pbl->phys.indirect.pbl_buf_size_in_pages;
120040909f66SGal Pressman 	struct scatterlist *pages_sgl = pbl->phys.indirect.sgl;
12014d50e084SGal Pressman 	unsigned int chunk_list_size, chunk_idx, payload_idx;
120240909f66SGal Pressman 	int sg_dma_cnt = pbl->phys.indirect.sg_dma_cnt;
120340909f66SGal Pressman 	struct efa_com_ctrl_buff_info *ctrl_buf;
120440909f66SGal Pressman 	u64 *cur_chunk_buf, *prev_chunk_buf;
12054d50e084SGal Pressman 	struct ib_block_iter biter;
120640909f66SGal Pressman 	dma_addr_t dma_addr;
120740909f66SGal Pressman 	int i;
120840909f66SGal Pressman 
120940909f66SGal Pressman 	/* allocate a chunk list that consists of 4KB chunks */
121040909f66SGal Pressman 	chunk_list_size = DIV_ROUND_UP(page_cnt, EFA_PTRS_PER_CHUNK);
121140909f66SGal Pressman 
121240909f66SGal Pressman 	chunk_list->size = chunk_list_size;
121340909f66SGal Pressman 	chunk_list->chunks = kcalloc(chunk_list_size,
121440909f66SGal Pressman 				     sizeof(*chunk_list->chunks),
121540909f66SGal Pressman 				     GFP_KERNEL);
121640909f66SGal Pressman 	if (!chunk_list->chunks)
121740909f66SGal Pressman 		return -ENOMEM;
121840909f66SGal Pressman 
121940909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
122040909f66SGal Pressman 		  "chunk_list_size[%u] - pages[%u]\n", chunk_list_size,
122140909f66SGal Pressman 		  page_cnt);
122240909f66SGal Pressman 
122340909f66SGal Pressman 	/* allocate chunk buffers: */
122440909f66SGal Pressman 	for (i = 0; i < chunk_list_size; i++) {
122540909f66SGal Pressman 		chunk_list->chunks[i].buf = kzalloc(EFA_CHUNK_SIZE, GFP_KERNEL);
122640909f66SGal Pressman 		if (!chunk_list->chunks[i].buf)
122740909f66SGal Pressman 			goto chunk_list_dealloc;
122840909f66SGal Pressman 
122940909f66SGal Pressman 		chunk_list->chunks[i].length = EFA_CHUNK_USED_SIZE;
123040909f66SGal Pressman 	}
123140909f66SGal Pressman 	chunk_list->chunks[chunk_list_size - 1].length =
123240909f66SGal Pressman 		((page_cnt % EFA_PTRS_PER_CHUNK) * EFA_CHUNK_PAYLOAD_PTR_SIZE) +
123340909f66SGal Pressman 			EFA_CHUNK_PTR_SIZE;
123440909f66SGal Pressman 
123540909f66SGal Pressman 	/* fill the dma addresses of sg list pages to chunks: */
123640909f66SGal Pressman 	chunk_idx = 0;
123740909f66SGal Pressman 	payload_idx = 0;
123840909f66SGal Pressman 	cur_chunk_buf = chunk_list->chunks[0].buf;
12394d50e084SGal Pressman 	rdma_for_each_block(pages_sgl, &biter, sg_dma_cnt,
12404d50e084SGal Pressman 			    EFA_CHUNK_PAYLOAD_SIZE) {
124140909f66SGal Pressman 		cur_chunk_buf[payload_idx++] =
12424d50e084SGal Pressman 			rdma_block_iter_dma_address(&biter);
124340909f66SGal Pressman 
124440909f66SGal Pressman 		if (payload_idx == EFA_PTRS_PER_CHUNK) {
124540909f66SGal Pressman 			chunk_idx++;
124640909f66SGal Pressman 			cur_chunk_buf = chunk_list->chunks[chunk_idx].buf;
124740909f66SGal Pressman 			payload_idx = 0;
124840909f66SGal Pressman 		}
124940909f66SGal Pressman 	}
125040909f66SGal Pressman 
125140909f66SGal Pressman 	/* map chunks to dma and fill chunks next ptrs */
125240909f66SGal Pressman 	for (i = chunk_list_size - 1; i >= 0; i--) {
125340909f66SGal Pressman 		dma_addr = dma_map_single(&dev->pdev->dev,
125440909f66SGal Pressman 					  chunk_list->chunks[i].buf,
125540909f66SGal Pressman 					  chunk_list->chunks[i].length,
125640909f66SGal Pressman 					  DMA_TO_DEVICE);
125740909f66SGal Pressman 		if (dma_mapping_error(&dev->pdev->dev, dma_addr)) {
125840909f66SGal Pressman 			ibdev_err(&dev->ibdev,
125940909f66SGal Pressman 				  "chunk[%u] dma_map_failed\n", i);
126040909f66SGal Pressman 			goto chunk_list_unmap;
126140909f66SGal Pressman 		}
126240909f66SGal Pressman 
126340909f66SGal Pressman 		chunk_list->chunks[i].dma_addr = dma_addr;
126440909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
126540909f66SGal Pressman 			  "chunk[%u] mapped at [%pad]\n", i, &dma_addr);
126640909f66SGal Pressman 
126740909f66SGal Pressman 		if (!i)
126840909f66SGal Pressman 			break;
126940909f66SGal Pressman 
127040909f66SGal Pressman 		prev_chunk_buf = chunk_list->chunks[i - 1].buf;
127140909f66SGal Pressman 
127240909f66SGal Pressman 		ctrl_buf = (struct efa_com_ctrl_buff_info *)
127340909f66SGal Pressman 				&prev_chunk_buf[EFA_PTRS_PER_CHUNK];
127440909f66SGal Pressman 		ctrl_buf->length = chunk_list->chunks[i].length;
127540909f66SGal Pressman 
127640909f66SGal Pressman 		efa_com_set_dma_addr(dma_addr,
127740909f66SGal Pressman 				     &ctrl_buf->address.mem_addr_high,
127840909f66SGal Pressman 				     &ctrl_buf->address.mem_addr_low);
127940909f66SGal Pressman 	}
128040909f66SGal Pressman 
128140909f66SGal Pressman 	return 0;
128240909f66SGal Pressman 
128340909f66SGal Pressman chunk_list_unmap:
128440909f66SGal Pressman 	for (; i < chunk_list_size; i++) {
128540909f66SGal Pressman 		dma_unmap_single(&dev->pdev->dev, chunk_list->chunks[i].dma_addr,
128640909f66SGal Pressman 				 chunk_list->chunks[i].length, DMA_TO_DEVICE);
128740909f66SGal Pressman 	}
128840909f66SGal Pressman chunk_list_dealloc:
128940909f66SGal Pressman 	for (i = 0; i < chunk_list_size; i++)
129040909f66SGal Pressman 		kfree(chunk_list->chunks[i].buf);
129140909f66SGal Pressman 
129240909f66SGal Pressman 	kfree(chunk_list->chunks);
129340909f66SGal Pressman 	return -ENOMEM;
129440909f66SGal Pressman }
129540909f66SGal Pressman 
129640909f66SGal Pressman static void pbl_chunk_list_destroy(struct efa_dev *dev, struct pbl_context *pbl)
129740909f66SGal Pressman {
129840909f66SGal Pressman 	struct pbl_chunk_list *chunk_list = &pbl->phys.indirect.chunk_list;
129940909f66SGal Pressman 	int i;
130040909f66SGal Pressman 
130140909f66SGal Pressman 	for (i = 0; i < chunk_list->size; i++) {
130240909f66SGal Pressman 		dma_unmap_single(&dev->pdev->dev, chunk_list->chunks[i].dma_addr,
130340909f66SGal Pressman 				 chunk_list->chunks[i].length, DMA_TO_DEVICE);
130440909f66SGal Pressman 		kfree(chunk_list->chunks[i].buf);
130540909f66SGal Pressman 	}
130640909f66SGal Pressman 
130740909f66SGal Pressman 	kfree(chunk_list->chunks);
130840909f66SGal Pressman }
130940909f66SGal Pressman 
131040909f66SGal Pressman /* initialize pbl continuous mode: map pbl buffer to a dma address. */
131140909f66SGal Pressman static int pbl_continuous_initialize(struct efa_dev *dev,
131240909f66SGal Pressman 				     struct pbl_context *pbl)
131340909f66SGal Pressman {
131440909f66SGal Pressman 	dma_addr_t dma_addr;
131540909f66SGal Pressman 
131640909f66SGal Pressman 	dma_addr = dma_map_single(&dev->pdev->dev, pbl->pbl_buf,
131740909f66SGal Pressman 				  pbl->pbl_buf_size_in_bytes, DMA_TO_DEVICE);
131840909f66SGal Pressman 	if (dma_mapping_error(&dev->pdev->dev, dma_addr)) {
131940909f66SGal Pressman 		ibdev_err(&dev->ibdev, "Unable to map pbl to DMA address\n");
132040909f66SGal Pressman 		return -ENOMEM;
132140909f66SGal Pressman 	}
132240909f66SGal Pressman 
132340909f66SGal Pressman 	pbl->phys.continuous.dma_addr = dma_addr;
132440909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
132540909f66SGal Pressman 		  "pbl continuous - dma_addr = %pad, size[%u]\n",
132640909f66SGal Pressman 		  &dma_addr, pbl->pbl_buf_size_in_bytes);
132740909f66SGal Pressman 
132840909f66SGal Pressman 	return 0;
132940909f66SGal Pressman }
133040909f66SGal Pressman 
133140909f66SGal Pressman /*
133240909f66SGal Pressman  * initialize pbl indirect mode:
133340909f66SGal Pressman  * create a chunk list out of the dma addresses of the physical pages of
133440909f66SGal Pressman  * pbl buffer.
133540909f66SGal Pressman  */
133640909f66SGal Pressman static int pbl_indirect_initialize(struct efa_dev *dev, struct pbl_context *pbl)
133740909f66SGal Pressman {
133840909f66SGal Pressman 	u32 size_in_pages = DIV_ROUND_UP(pbl->pbl_buf_size_in_bytes, PAGE_SIZE);
133940909f66SGal Pressman 	struct scatterlist *sgl;
134040909f66SGal Pressman 	int sg_dma_cnt, err;
134140909f66SGal Pressman 
134240909f66SGal Pressman 	BUILD_BUG_ON(EFA_CHUNK_PAYLOAD_SIZE > PAGE_SIZE);
134340909f66SGal Pressman 	sgl = efa_vmalloc_buf_to_sg(pbl->pbl_buf, size_in_pages);
134440909f66SGal Pressman 	if (!sgl)
134540909f66SGal Pressman 		return -ENOMEM;
134640909f66SGal Pressman 
134740909f66SGal Pressman 	sg_dma_cnt = dma_map_sg(&dev->pdev->dev, sgl, size_in_pages, DMA_TO_DEVICE);
134840909f66SGal Pressman 	if (!sg_dma_cnt) {
134940909f66SGal Pressman 		err = -EINVAL;
135040909f66SGal Pressman 		goto err_map;
135140909f66SGal Pressman 	}
135240909f66SGal Pressman 
135340909f66SGal Pressman 	pbl->phys.indirect.pbl_buf_size_in_pages = size_in_pages;
135440909f66SGal Pressman 	pbl->phys.indirect.sgl = sgl;
135540909f66SGal Pressman 	pbl->phys.indirect.sg_dma_cnt = sg_dma_cnt;
135640909f66SGal Pressman 	err = pbl_chunk_list_create(dev, pbl);
135740909f66SGal Pressman 	if (err) {
135840909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
135940909f66SGal Pressman 			  "chunk_list creation failed[%d]\n", err);
136040909f66SGal Pressman 		goto err_chunk;
136140909f66SGal Pressman 	}
136240909f66SGal Pressman 
136340909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
136440909f66SGal Pressman 		  "pbl indirect - size[%u], chunks[%u]\n",
136540909f66SGal Pressman 		  pbl->pbl_buf_size_in_bytes,
136640909f66SGal Pressman 		  pbl->phys.indirect.chunk_list.size);
136740909f66SGal Pressman 
136840909f66SGal Pressman 	return 0;
136940909f66SGal Pressman 
137040909f66SGal Pressman err_chunk:
137140909f66SGal Pressman 	dma_unmap_sg(&dev->pdev->dev, sgl, size_in_pages, DMA_TO_DEVICE);
137240909f66SGal Pressman err_map:
137340909f66SGal Pressman 	kfree(sgl);
137440909f66SGal Pressman 	return err;
137540909f66SGal Pressman }
137640909f66SGal Pressman 
137740909f66SGal Pressman static void pbl_indirect_terminate(struct efa_dev *dev, struct pbl_context *pbl)
137840909f66SGal Pressman {
137940909f66SGal Pressman 	pbl_chunk_list_destroy(dev, pbl);
138040909f66SGal Pressman 	dma_unmap_sg(&dev->pdev->dev, pbl->phys.indirect.sgl,
138140909f66SGal Pressman 		     pbl->phys.indirect.pbl_buf_size_in_pages, DMA_TO_DEVICE);
138240909f66SGal Pressman 	kfree(pbl->phys.indirect.sgl);
138340909f66SGal Pressman }
138440909f66SGal Pressman 
138540909f66SGal Pressman /* create a page buffer list from a mapped user memory region */
138640909f66SGal Pressman static int pbl_create(struct efa_dev *dev,
138740909f66SGal Pressman 		      struct pbl_context *pbl,
138840909f66SGal Pressman 		      struct ib_umem *umem,
138940909f66SGal Pressman 		      int hp_cnt,
139040909f66SGal Pressman 		      u8 hp_shift)
139140909f66SGal Pressman {
139240909f66SGal Pressman 	int err;
139340909f66SGal Pressman 
139440909f66SGal Pressman 	pbl->pbl_buf_size_in_bytes = hp_cnt * EFA_CHUNK_PAYLOAD_PTR_SIZE;
1395255efcaeSGal Pressman 	pbl->pbl_buf = kvzalloc(pbl->pbl_buf_size_in_bytes, GFP_KERNEL);
1396255efcaeSGal Pressman 	if (!pbl->pbl_buf)
1397255efcaeSGal Pressman 		return -ENOMEM;
1398255efcaeSGal Pressman 
1399255efcaeSGal Pressman 	if (is_vmalloc_addr(pbl->pbl_buf)) {
1400255efcaeSGal Pressman 		pbl->physically_continuous = 0;
1401255efcaeSGal Pressman 		err = umem_to_page_list(dev, umem, pbl->pbl_buf, hp_cnt,
1402255efcaeSGal Pressman 					hp_shift);
1403255efcaeSGal Pressman 		if (err)
1404255efcaeSGal Pressman 			goto err_free;
1405255efcaeSGal Pressman 
1406255efcaeSGal Pressman 		err = pbl_indirect_initialize(dev, pbl);
1407255efcaeSGal Pressman 		if (err)
1408255efcaeSGal Pressman 			goto err_free;
1409255efcaeSGal Pressman 	} else {
141040909f66SGal Pressman 		pbl->physically_continuous = 1;
141140909f66SGal Pressman 		err = umem_to_page_list(dev, umem, pbl->pbl_buf, hp_cnt,
141240909f66SGal Pressman 					hp_shift);
141340909f66SGal Pressman 		if (err)
1414255efcaeSGal Pressman 			goto err_free;
1415255efcaeSGal Pressman 
141640909f66SGal Pressman 		err = pbl_continuous_initialize(dev, pbl);
141740909f66SGal Pressman 		if (err)
1418255efcaeSGal Pressman 			goto err_free;
141940909f66SGal Pressman 	}
142040909f66SGal Pressman 
142140909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
142240909f66SGal Pressman 		  "user_pbl_created: user_pages[%u], continuous[%u]\n",
142340909f66SGal Pressman 		  hp_cnt, pbl->physically_continuous);
142440909f66SGal Pressman 
142540909f66SGal Pressman 	return 0;
142640909f66SGal Pressman 
1427255efcaeSGal Pressman err_free:
1428255efcaeSGal Pressman 	kvfree(pbl->pbl_buf);
142940909f66SGal Pressman 	return err;
143040909f66SGal Pressman }
143140909f66SGal Pressman 
143240909f66SGal Pressman static void pbl_destroy(struct efa_dev *dev, struct pbl_context *pbl)
143340909f66SGal Pressman {
1434255efcaeSGal Pressman 	if (pbl->physically_continuous)
143540909f66SGal Pressman 		dma_unmap_single(&dev->pdev->dev, pbl->phys.continuous.dma_addr,
143640909f66SGal Pressman 				 pbl->pbl_buf_size_in_bytes, DMA_TO_DEVICE);
1437255efcaeSGal Pressman 	else
143840909f66SGal Pressman 		pbl_indirect_terminate(dev, pbl);
1439255efcaeSGal Pressman 
1440255efcaeSGal Pressman 	kvfree(pbl->pbl_buf);
144140909f66SGal Pressman }
144240909f66SGal Pressman 
144340909f66SGal Pressman static int efa_create_inline_pbl(struct efa_dev *dev, struct efa_mr *mr,
144440909f66SGal Pressman 				 struct efa_com_reg_mr_params *params)
144540909f66SGal Pressman {
144640909f66SGal Pressman 	int err;
144740909f66SGal Pressman 
144840909f66SGal Pressman 	params->inline_pbl = 1;
144940909f66SGal Pressman 	err = umem_to_page_list(dev, mr->umem, params->pbl.inline_pbl_array,
145040909f66SGal Pressman 				params->page_num, params->page_shift);
145140909f66SGal Pressman 	if (err)
145240909f66SGal Pressman 		return err;
145340909f66SGal Pressman 
145440909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
145540909f66SGal Pressman 		  "inline_pbl_array - pages[%u]\n", params->page_num);
145640909f66SGal Pressman 
145740909f66SGal Pressman 	return 0;
145840909f66SGal Pressman }
145940909f66SGal Pressman 
146040909f66SGal Pressman static int efa_create_pbl(struct efa_dev *dev,
146140909f66SGal Pressman 			  struct pbl_context *pbl,
146240909f66SGal Pressman 			  struct efa_mr *mr,
146340909f66SGal Pressman 			  struct efa_com_reg_mr_params *params)
146440909f66SGal Pressman {
146540909f66SGal Pressman 	int err;
146640909f66SGal Pressman 
146740909f66SGal Pressman 	err = pbl_create(dev, pbl, mr->umem, params->page_num,
146840909f66SGal Pressman 			 params->page_shift);
146940909f66SGal Pressman 	if (err) {
147040909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Failed to create pbl[%d]\n", err);
147140909f66SGal Pressman 		return err;
147240909f66SGal Pressman 	}
147340909f66SGal Pressman 
147440909f66SGal Pressman 	params->inline_pbl = 0;
147540909f66SGal Pressman 	params->indirect = !pbl->physically_continuous;
147640909f66SGal Pressman 	if (pbl->physically_continuous) {
147740909f66SGal Pressman 		params->pbl.pbl.length = pbl->pbl_buf_size_in_bytes;
147840909f66SGal Pressman 
147940909f66SGal Pressman 		efa_com_set_dma_addr(pbl->phys.continuous.dma_addr,
148040909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_high,
148140909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_low);
148240909f66SGal Pressman 	} else {
148340909f66SGal Pressman 		params->pbl.pbl.length =
148440909f66SGal Pressman 			pbl->phys.indirect.chunk_list.chunks[0].length;
148540909f66SGal Pressman 
148640909f66SGal Pressman 		efa_com_set_dma_addr(pbl->phys.indirect.chunk_list.chunks[0].dma_addr,
148740909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_high,
148840909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_low);
148940909f66SGal Pressman 	}
149040909f66SGal Pressman 
149140909f66SGal Pressman 	return 0;
149240909f66SGal Pressman }
149340909f66SGal Pressman 
149440909f66SGal Pressman struct ib_mr *efa_reg_mr(struct ib_pd *ibpd, u64 start, u64 length,
149540909f66SGal Pressman 			 u64 virt_addr, int access_flags,
149640909f66SGal Pressman 			 struct ib_udata *udata)
149740909f66SGal Pressman {
149840909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibpd->device);
149940909f66SGal Pressman 	struct efa_com_reg_mr_params params = {};
150040909f66SGal Pressman 	struct efa_com_reg_mr_result result = {};
150140909f66SGal Pressman 	struct pbl_context pbl;
1502666e8ff5SDaniel Kranzdorf 	int supp_access_flags;
150340ddb3f0SGal Pressman 	unsigned int pg_sz;
150440909f66SGal Pressman 	struct efa_mr *mr;
150540909f66SGal Pressman 	int inline_size;
150640909f66SGal Pressman 	int err;
150740909f66SGal Pressman 
150833006bd4SMoni Shoua 	if (udata && udata->inlen &&
150940909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, sizeof(udata->inlen))) {
151040909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
151140909f66SGal Pressman 			  "Incompatible ABI params, udata not cleared\n");
151240909f66SGal Pressman 		err = -EINVAL;
151340909f66SGal Pressman 		goto err_out;
151440909f66SGal Pressman 	}
151540909f66SGal Pressman 
1516666e8ff5SDaniel Kranzdorf 	supp_access_flags =
1517666e8ff5SDaniel Kranzdorf 		IB_ACCESS_LOCAL_WRITE |
151834eb009fSGal Pressman 		(EFA_DEV_CAP(dev, RDMA_READ) ? IB_ACCESS_REMOTE_READ : 0);
1519666e8ff5SDaniel Kranzdorf 
1520ba19e166SGal Pressman 	access_flags &= ~IB_ACCESS_OPTIONAL;
1521666e8ff5SDaniel Kranzdorf 	if (access_flags & ~supp_access_flags) {
152240909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
152340909f66SGal Pressman 			  "Unsupported access flags[%#x], supported[%#x]\n",
1524666e8ff5SDaniel Kranzdorf 			  access_flags, supp_access_flags);
152540909f66SGal Pressman 		err = -EOPNOTSUPP;
152640909f66SGal Pressman 		goto err_out;
152740909f66SGal Pressman 	}
152840909f66SGal Pressman 
152940909f66SGal Pressman 	mr = kzalloc(sizeof(*mr), GFP_KERNEL);
153040909f66SGal Pressman 	if (!mr) {
153140909f66SGal Pressman 		err = -ENOMEM;
153240909f66SGal Pressman 		goto err_out;
153340909f66SGal Pressman 	}
153440909f66SGal Pressman 
1535c320e527SMoni Shoua 	mr->umem = ib_umem_get(ibpd->device, start, length, access_flags);
153640909f66SGal Pressman 	if (IS_ERR(mr->umem)) {
153740909f66SGal Pressman 		err = PTR_ERR(mr->umem);
153840909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
153940909f66SGal Pressman 			  "Failed to pin and map user space memory[%d]\n", err);
154040909f66SGal Pressman 		goto err_free;
154140909f66SGal Pressman 	}
154240909f66SGal Pressman 
154340909f66SGal Pressman 	params.pd = to_epd(ibpd)->pdn;
154440909f66SGal Pressman 	params.iova = virt_addr;
154540909f66SGal Pressman 	params.mr_length_in_bytes = length;
1546e6c4f3ffSDaniel Kranzdorf 	params.permissions = access_flags;
154740909f66SGal Pressman 
154840ddb3f0SGal Pressman 	pg_sz = ib_umem_find_best_pgsz(mr->umem,
154940ddb3f0SGal Pressman 				       dev->dev_attr.page_size_cap,
155040ddb3f0SGal Pressman 				       virt_addr);
155140ddb3f0SGal Pressman 	if (!pg_sz) {
155240ddb3f0SGal Pressman 		err = -EOPNOTSUPP;
155340ddb3f0SGal Pressman 		ibdev_dbg(&dev->ibdev, "Failed to find a suitable page size in page_size_cap %#llx\n",
155440ddb3f0SGal Pressman 			  dev->dev_attr.page_size_cap);
155540ddb3f0SGal Pressman 		goto err_unmap;
155640ddb3f0SGal Pressman 	}
155740ddb3f0SGal Pressman 
15581f9b6827SJason Gunthorpe 	params.page_shift = order_base_2(pg_sz);
15591f9b6827SJason Gunthorpe 	params.page_num = ib_umem_num_dma_blocks(mr->umem, pg_sz);
156040ddb3f0SGal Pressman 
156140909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
156240ddb3f0SGal Pressman 		  "start %#llx length %#llx params.page_shift %u params.page_num %u\n",
156340ddb3f0SGal Pressman 		  start, length, params.page_shift, params.page_num);
156440909f66SGal Pressman 
156540909f66SGal Pressman 	inline_size = ARRAY_SIZE(params.pbl.inline_pbl_array);
156640909f66SGal Pressman 	if (params.page_num <= inline_size) {
156740909f66SGal Pressman 		err = efa_create_inline_pbl(dev, mr, &params);
156840909f66SGal Pressman 		if (err)
156940909f66SGal Pressman 			goto err_unmap;
157040909f66SGal Pressman 
157140909f66SGal Pressman 		err = efa_com_register_mr(&dev->edev, &params, &result);
157240909f66SGal Pressman 		if (err)
157340909f66SGal Pressman 			goto err_unmap;
157440909f66SGal Pressman 	} else {
157540909f66SGal Pressman 		err = efa_create_pbl(dev, &pbl, mr, &params);
157640909f66SGal Pressman 		if (err)
157740909f66SGal Pressman 			goto err_unmap;
157840909f66SGal Pressman 
157940909f66SGal Pressman 		err = efa_com_register_mr(&dev->edev, &params, &result);
158040909f66SGal Pressman 		pbl_destroy(dev, &pbl);
158140909f66SGal Pressman 
158240909f66SGal Pressman 		if (err)
158340909f66SGal Pressman 			goto err_unmap;
158440909f66SGal Pressman 	}
158540909f66SGal Pressman 
158640909f66SGal Pressman 	mr->ibmr.lkey = result.l_key;
158740909f66SGal Pressman 	mr->ibmr.rkey = result.r_key;
158840909f66SGal Pressman 	mr->ibmr.length = length;
158940909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Registered mr[%d]\n", mr->ibmr.lkey);
159040909f66SGal Pressman 
159140909f66SGal Pressman 	return &mr->ibmr;
159240909f66SGal Pressman 
159340909f66SGal Pressman err_unmap:
159440909f66SGal Pressman 	ib_umem_release(mr->umem);
159540909f66SGal Pressman err_free:
159640909f66SGal Pressman 	kfree(mr);
159740909f66SGal Pressman err_out:
1598215b88acSGal Pressman 	atomic64_inc(&dev->stats.reg_mr_err);
159940909f66SGal Pressman 	return ERR_PTR(err);
160040909f66SGal Pressman }
160140909f66SGal Pressman 
160240909f66SGal Pressman int efa_dereg_mr(struct ib_mr *ibmr, struct ib_udata *udata)
160340909f66SGal Pressman {
160440909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibmr->device);
160540909f66SGal Pressman 	struct efa_com_dereg_mr_params params;
160640909f66SGal Pressman 	struct efa_mr *mr = to_emr(ibmr);
160740909f66SGal Pressman 	int err;
160840909f66SGal Pressman 
160940909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Deregister mr[%d]\n", ibmr->lkey);
161040909f66SGal Pressman 
161140909f66SGal Pressman 	params.l_key = mr->ibmr.lkey;
161240909f66SGal Pressman 	err = efa_com_dereg_mr(&dev->edev, &params);
161340909f66SGal Pressman 	if (err)
161440909f66SGal Pressman 		return err;
161540909f66SGal Pressman 
1616958b6813SGal Pressman 	ib_umem_release(mr->umem);
161740909f66SGal Pressman 	kfree(mr);
161840909f66SGal Pressman 
161940909f66SGal Pressman 	return 0;
162040909f66SGal Pressman }
162140909f66SGal Pressman 
1622*1fb7f897SMark Bloch int efa_get_port_immutable(struct ib_device *ibdev, u32 port_num,
162340909f66SGal Pressman 			   struct ib_port_immutable *immutable)
162440909f66SGal Pressman {
162540909f66SGal Pressman 	struct ib_port_attr attr;
162640909f66SGal Pressman 	int err;
162740909f66SGal Pressman 
162840909f66SGal Pressman 	err = ib_query_port(ibdev, port_num, &attr);
162940909f66SGal Pressman 	if (err) {
163040909f66SGal Pressman 		ibdev_dbg(ibdev, "Couldn't query port err[%d]\n", err);
163140909f66SGal Pressman 		return err;
163240909f66SGal Pressman 	}
163340909f66SGal Pressman 
163440909f66SGal Pressman 	immutable->pkey_tbl_len = attr.pkey_tbl_len;
163540909f66SGal Pressman 	immutable->gid_tbl_len = attr.gid_tbl_len;
163640909f66SGal Pressman 
163740909f66SGal Pressman 	return 0;
163840909f66SGal Pressman }
163940909f66SGal Pressman 
164040909f66SGal Pressman static int efa_dealloc_uar(struct efa_dev *dev, u16 uarn)
164140909f66SGal Pressman {
164240909f66SGal Pressman 	struct efa_com_dealloc_uar_params params = {
164340909f66SGal Pressman 		.uarn = uarn,
164440909f66SGal Pressman 	};
164540909f66SGal Pressman 
164640909f66SGal Pressman 	return efa_com_dealloc_uar(&dev->edev, &params);
164740909f66SGal Pressman }
164840909f66SGal Pressman 
1649a5d87b69SGal Pressman #define EFA_CHECK_USER_COMP(_dev, _comp_mask, _attr, _mask, _attr_str) \
1650a5d87b69SGal Pressman 	(_attr_str = (!(_dev)->dev_attr._attr || ((_comp_mask) & (_mask))) ? \
1651a5d87b69SGal Pressman 		     NULL : #_attr)
1652a5d87b69SGal Pressman 
1653a5d87b69SGal Pressman static int efa_user_comp_handshake(const struct ib_ucontext *ibucontext,
1654a5d87b69SGal Pressman 				   const struct efa_ibv_alloc_ucontext_cmd *cmd)
1655a5d87b69SGal Pressman {
1656a5d87b69SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
1657a5d87b69SGal Pressman 	char *attr_str;
1658a5d87b69SGal Pressman 
1659a5d87b69SGal Pressman 	if (EFA_CHECK_USER_COMP(dev, cmd->comp_mask, max_tx_batch,
1660a5d87b69SGal Pressman 				EFA_ALLOC_UCONTEXT_CMD_COMP_TX_BATCH, attr_str))
1661a5d87b69SGal Pressman 		goto err;
1662a5d87b69SGal Pressman 
1663a5d87b69SGal Pressman 	if (EFA_CHECK_USER_COMP(dev, cmd->comp_mask, min_sq_depth,
1664a5d87b69SGal Pressman 				EFA_ALLOC_UCONTEXT_CMD_COMP_MIN_SQ_WR,
1665a5d87b69SGal Pressman 				attr_str))
1666a5d87b69SGal Pressman 		goto err;
1667a5d87b69SGal Pressman 
1668a5d87b69SGal Pressman 	return 0;
1669a5d87b69SGal Pressman 
1670a5d87b69SGal Pressman err:
1671a5d87b69SGal Pressman 	ibdev_dbg(&dev->ibdev, "Userspace handshake failed for %s attribute\n",
1672a5d87b69SGal Pressman 		  attr_str);
1673a5d87b69SGal Pressman 	return -EOPNOTSUPP;
1674a5d87b69SGal Pressman }
1675a5d87b69SGal Pressman 
167640909f66SGal Pressman int efa_alloc_ucontext(struct ib_ucontext *ibucontext, struct ib_udata *udata)
167740909f66SGal Pressman {
167840909f66SGal Pressman 	struct efa_ucontext *ucontext = to_eucontext(ibucontext);
167940909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
168040909f66SGal Pressman 	struct efa_ibv_alloc_ucontext_resp resp = {};
1681a5d87b69SGal Pressman 	struct efa_ibv_alloc_ucontext_cmd cmd = {};
168240909f66SGal Pressman 	struct efa_com_alloc_uar_result result;
168340909f66SGal Pressman 	int err;
168440909f66SGal Pressman 
168540909f66SGal Pressman 	/*
168640909f66SGal Pressman 	 * it's fine if the driver does not know all request fields,
168740909f66SGal Pressman 	 * we will ack input fields in our response.
168840909f66SGal Pressman 	 */
168940909f66SGal Pressman 
1690a5d87b69SGal Pressman 	err = ib_copy_from_udata(&cmd, udata,
1691a5d87b69SGal Pressman 				 min(sizeof(cmd), udata->inlen));
1692a5d87b69SGal Pressman 	if (err) {
1693a5d87b69SGal Pressman 		ibdev_dbg(&dev->ibdev,
1694a5d87b69SGal Pressman 			  "Cannot copy udata for alloc_ucontext\n");
1695a5d87b69SGal Pressman 		goto err_out;
1696a5d87b69SGal Pressman 	}
1697a5d87b69SGal Pressman 
1698a5d87b69SGal Pressman 	err = efa_user_comp_handshake(ibucontext, &cmd);
1699a5d87b69SGal Pressman 	if (err)
1700a5d87b69SGal Pressman 		goto err_out;
1701a5d87b69SGal Pressman 
170240909f66SGal Pressman 	err = efa_com_alloc_uar(&dev->edev, &result);
170340909f66SGal Pressman 	if (err)
170440909f66SGal Pressman 		goto err_out;
170540909f66SGal Pressman 
170640909f66SGal Pressman 	ucontext->uarn = result.uarn;
170740909f66SGal Pressman 
170840909f66SGal Pressman 	resp.cmds_supp_udata_mask |= EFA_USER_CMDS_SUPP_UDATA_QUERY_DEVICE;
170940909f66SGal Pressman 	resp.cmds_supp_udata_mask |= EFA_USER_CMDS_SUPP_UDATA_CREATE_AH;
171040909f66SGal Pressman 	resp.sub_cqs_per_cq = dev->dev_attr.sub_cqs_per_cq;
171140909f66SGal Pressman 	resp.inline_buf_size = dev->dev_attr.inline_buf_size;
171240909f66SGal Pressman 	resp.max_llq_size = dev->dev_attr.max_llq_size;
1713556c811fSGal Pressman 	resp.max_tx_batch = dev->dev_attr.max_tx_batch;
1714da2924bdSGal Pressman 	resp.min_sq_wr = dev->dev_attr.min_sq_depth;
171540909f66SGal Pressman 
171640909f66SGal Pressman 	err = ib_copy_to_udata(udata, &resp,
171740909f66SGal Pressman 			       min(sizeof(resp), udata->outlen));
171840909f66SGal Pressman 	if (err)
171940909f66SGal Pressman 		goto err_dealloc_uar;
172040909f66SGal Pressman 
172140909f66SGal Pressman 	return 0;
172240909f66SGal Pressman 
172340909f66SGal Pressman err_dealloc_uar:
172440909f66SGal Pressman 	efa_dealloc_uar(dev, result.uarn);
172540909f66SGal Pressman err_out:
1726215b88acSGal Pressman 	atomic64_inc(&dev->stats.alloc_ucontext_err);
172740909f66SGal Pressman 	return err;
172840909f66SGal Pressman }
172940909f66SGal Pressman 
173040909f66SGal Pressman void efa_dealloc_ucontext(struct ib_ucontext *ibucontext)
173140909f66SGal Pressman {
173240909f66SGal Pressman 	struct efa_ucontext *ucontext = to_eucontext(ibucontext);
173340909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
173440909f66SGal Pressman 
173540909f66SGal Pressman 	efa_dealloc_uar(dev, ucontext->uarn);
173640909f66SGal Pressman }
173740909f66SGal Pressman 
1738e84d3c18SMichal Kalderon void efa_mmap_free(struct rdma_user_mmap_entry *rdma_entry)
173940909f66SGal Pressman {
1740e84d3c18SMichal Kalderon 	struct efa_user_mmap_entry *entry = to_emmap(rdma_entry);
174140909f66SGal Pressman 
1742e84d3c18SMichal Kalderon 	kfree(entry);
174340909f66SGal Pressman }
174440909f66SGal Pressman 
1745e84d3c18SMichal Kalderon static int __efa_mmap(struct efa_dev *dev, struct efa_ucontext *ucontext,
1746e84d3c18SMichal Kalderon 		      struct vm_area_struct *vma)
1747e84d3c18SMichal Kalderon {
1748e84d3c18SMichal Kalderon 	struct rdma_user_mmap_entry *rdma_entry;
1749e84d3c18SMichal Kalderon 	struct efa_user_mmap_entry *entry;
1750e84d3c18SMichal Kalderon 	unsigned long va;
1751e84d3c18SMichal Kalderon 	int err = 0;
1752e84d3c18SMichal Kalderon 	u64 pfn;
1753e84d3c18SMichal Kalderon 
1754e84d3c18SMichal Kalderon 	rdma_entry = rdma_user_mmap_entry_get(&ucontext->ibucontext, vma);
1755e84d3c18SMichal Kalderon 	if (!rdma_entry) {
175640909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
1757e84d3c18SMichal Kalderon 			  "pgoff[%#lx] does not have valid entry\n",
1758e84d3c18SMichal Kalderon 			  vma->vm_pgoff);
1759215b88acSGal Pressman 		atomic64_inc(&dev->stats.mmap_err);
1760e84d3c18SMichal Kalderon 		return -EINVAL;
1761e84d3c18SMichal Kalderon 	}
1762e84d3c18SMichal Kalderon 	entry = to_emmap(rdma_entry);
1763e84d3c18SMichal Kalderon 
1764e84d3c18SMichal Kalderon 	ibdev_dbg(&dev->ibdev,
1765e84d3c18SMichal Kalderon 		  "Mapping address[%#llx], length[%#zx], mmap_flag[%d]\n",
1766e84d3c18SMichal Kalderon 		  entry->address, rdma_entry->npages * PAGE_SIZE,
1767e84d3c18SMichal Kalderon 		  entry->mmap_flag);
176840909f66SGal Pressman 
176940909f66SGal Pressman 	pfn = entry->address >> PAGE_SHIFT;
177040909f66SGal Pressman 	switch (entry->mmap_flag) {
177140909f66SGal Pressman 	case EFA_MMAP_IO_NC:
1772e84d3c18SMichal Kalderon 		err = rdma_user_mmap_io(&ucontext->ibucontext, vma, pfn,
1773e84d3c18SMichal Kalderon 					entry->rdma_entry.npages * PAGE_SIZE,
1774c043ff2cSMichal Kalderon 					pgprot_noncached(vma->vm_page_prot),
1775e84d3c18SMichal Kalderon 					rdma_entry);
177640909f66SGal Pressman 		break;
177740909f66SGal Pressman 	case EFA_MMAP_IO_WC:
1778e84d3c18SMichal Kalderon 		err = rdma_user_mmap_io(&ucontext->ibucontext, vma, pfn,
1779e84d3c18SMichal Kalderon 					entry->rdma_entry.npages * PAGE_SIZE,
1780c043ff2cSMichal Kalderon 					pgprot_writecombine(vma->vm_page_prot),
1781e84d3c18SMichal Kalderon 					rdma_entry);
178240909f66SGal Pressman 		break;
178340909f66SGal Pressman 	case EFA_MMAP_DMA_PAGE:
178440909f66SGal Pressman 		for (va = vma->vm_start; va < vma->vm_end;
178540909f66SGal Pressman 		     va += PAGE_SIZE, pfn++) {
178640909f66SGal Pressman 			err = vm_insert_page(vma, va, pfn_to_page(pfn));
178740909f66SGal Pressman 			if (err)
178840909f66SGal Pressman 				break;
178940909f66SGal Pressman 		}
179040909f66SGal Pressman 		break;
179140909f66SGal Pressman 	default:
179240909f66SGal Pressman 		err = -EINVAL;
179340909f66SGal Pressman 	}
179440909f66SGal Pressman 
1795eca5757fSGal Pressman 	if (err) {
179640909f66SGal Pressman 		ibdev_dbg(
179740909f66SGal Pressman 			&dev->ibdev,
1798e84d3c18SMichal Kalderon 			"Couldn't mmap address[%#llx] length[%#zx] mmap_flag[%d] err[%d]\n",
1799e84d3c18SMichal Kalderon 			entry->address, rdma_entry->npages * PAGE_SIZE,
1800e84d3c18SMichal Kalderon 			entry->mmap_flag, err);
1801215b88acSGal Pressman 		atomic64_inc(&dev->stats.mmap_err);
1802eca5757fSGal Pressman 	}
180340909f66SGal Pressman 
1804e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_put(rdma_entry);
1805e84d3c18SMichal Kalderon 	return err;
1806b41f7572SGal Pressman }
1807b41f7572SGal Pressman 
180840909f66SGal Pressman int efa_mmap(struct ib_ucontext *ibucontext,
180940909f66SGal Pressman 	     struct vm_area_struct *vma)
181040909f66SGal Pressman {
181140909f66SGal Pressman 	struct efa_ucontext *ucontext = to_eucontext(ibucontext);
181240909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
1813e84d3c18SMichal Kalderon 	size_t length = vma->vm_end - vma->vm_start;
181440909f66SGal Pressman 
181540909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
1816e84d3c18SMichal Kalderon 		  "start %#lx, end %#lx, length = %#zx, pgoff = %#lx\n",
1817e84d3c18SMichal Kalderon 		  vma->vm_start, vma->vm_end, length, vma->vm_pgoff);
181840909f66SGal Pressman 
1819e84d3c18SMichal Kalderon 	return __efa_mmap(dev, ucontext, vma);
182040909f66SGal Pressman }
182140909f66SGal Pressman 
182240909f66SGal Pressman static int efa_ah_destroy(struct efa_dev *dev, struct efa_ah *ah)
182340909f66SGal Pressman {
182440909f66SGal Pressman 	struct efa_com_destroy_ah_params params = {
182540909f66SGal Pressman 		.ah = ah->ah,
182640909f66SGal Pressman 		.pdn = to_epd(ah->ibah.pd)->pdn,
182740909f66SGal Pressman 	};
182840909f66SGal Pressman 
182940909f66SGal Pressman 	return efa_com_destroy_ah(&dev->edev, &params);
183040909f66SGal Pressman }
183140909f66SGal Pressman 
183240909f66SGal Pressman int efa_create_ah(struct ib_ah *ibah,
1833fa5d010cSMaor Gottlieb 		  struct rdma_ah_init_attr *init_attr,
183440909f66SGal Pressman 		  struct ib_udata *udata)
183540909f66SGal Pressman {
1836fa5d010cSMaor Gottlieb 	struct rdma_ah_attr *ah_attr = init_attr->ah_attr;
183740909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibah->device);
183840909f66SGal Pressman 	struct efa_com_create_ah_params params = {};
183940909f66SGal Pressman 	struct efa_ibv_create_ah_resp resp = {};
184040909f66SGal Pressman 	struct efa_com_create_ah_result result;
184140909f66SGal Pressman 	struct efa_ah *ah = to_eah(ibah);
184240909f66SGal Pressman 	int err;
184340909f66SGal Pressman 
1844fa5d010cSMaor Gottlieb 	if (!(init_attr->flags & RDMA_CREATE_AH_SLEEPABLE)) {
184540909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
184640909f66SGal Pressman 			  "Create address handle is not supported in atomic context\n");
184740909f66SGal Pressman 		err = -EOPNOTSUPP;
184840909f66SGal Pressman 		goto err_out;
184940909f66SGal Pressman 	}
185040909f66SGal Pressman 
185140909f66SGal Pressman 	if (udata->inlen &&
185240909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, udata->inlen)) {
185340909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Incompatible ABI params\n");
185440909f66SGal Pressman 		err = -EINVAL;
185540909f66SGal Pressman 		goto err_out;
185640909f66SGal Pressman 	}
185740909f66SGal Pressman 
185840909f66SGal Pressman 	memcpy(params.dest_addr, ah_attr->grh.dgid.raw,
185940909f66SGal Pressman 	       sizeof(params.dest_addr));
186040909f66SGal Pressman 	params.pdn = to_epd(ibah->pd)->pdn;
186140909f66SGal Pressman 	err = efa_com_create_ah(&dev->edev, &params, &result);
186240909f66SGal Pressman 	if (err)
186340909f66SGal Pressman 		goto err_out;
186440909f66SGal Pressman 
186540909f66SGal Pressman 	memcpy(ah->id, ah_attr->grh.dgid.raw, sizeof(ah->id));
186640909f66SGal Pressman 	ah->ah = result.ah;
186740909f66SGal Pressman 
186840909f66SGal Pressman 	resp.efa_address_handle = result.ah;
186940909f66SGal Pressman 
187040909f66SGal Pressman 	if (udata->outlen) {
187140909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
187240909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
187340909f66SGal Pressman 		if (err) {
187440909f66SGal Pressman 			ibdev_dbg(&dev->ibdev,
187540909f66SGal Pressman 				  "Failed to copy udata for create_ah response\n");
187640909f66SGal Pressman 			goto err_destroy_ah;
187740909f66SGal Pressman 		}
187840909f66SGal Pressman 	}
187940909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Created ah[%d]\n", ah->ah);
188040909f66SGal Pressman 
188140909f66SGal Pressman 	return 0;
188240909f66SGal Pressman 
188340909f66SGal Pressman err_destroy_ah:
188440909f66SGal Pressman 	efa_ah_destroy(dev, ah);
188540909f66SGal Pressman err_out:
1886215b88acSGal Pressman 	atomic64_inc(&dev->stats.create_ah_err);
188740909f66SGal Pressman 	return err;
188840909f66SGal Pressman }
188940909f66SGal Pressman 
18909a9ebf8cSLeon Romanovsky int efa_destroy_ah(struct ib_ah *ibah, u32 flags)
189140909f66SGal Pressman {
189240909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibah->pd->device);
189340909f66SGal Pressman 	struct efa_ah *ah = to_eah(ibah);
189440909f66SGal Pressman 
189540909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Destroy ah[%d]\n", ah->ah);
189640909f66SGal Pressman 
189740909f66SGal Pressman 	if (!(flags & RDMA_DESTROY_AH_SLEEPABLE)) {
189840909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
189940909f66SGal Pressman 			  "Destroy address handle is not supported in atomic context\n");
19009a9ebf8cSLeon Romanovsky 		return -EOPNOTSUPP;
190140909f66SGal Pressman 	}
190240909f66SGal Pressman 
190340909f66SGal Pressman 	efa_ah_destroy(dev, ah);
19049a9ebf8cSLeon Romanovsky 	return 0;
190540909f66SGal Pressman }
190640909f66SGal Pressman 
1907*1fb7f897SMark Bloch struct rdma_hw_stats *efa_alloc_hw_stats(struct ib_device *ibdev, u32 port_num)
190816e9111eSGal Pressman {
190916e9111eSGal Pressman 	return rdma_alloc_hw_stats_struct(efa_stats_names,
191016e9111eSGal Pressman 					  ARRAY_SIZE(efa_stats_names),
191116e9111eSGal Pressman 					  RDMA_HW_STATS_DEFAULT_LIFESPAN);
191216e9111eSGal Pressman }
191316e9111eSGal Pressman 
191416e9111eSGal Pressman int efa_get_hw_stats(struct ib_device *ibdev, struct rdma_hw_stats *stats,
1915*1fb7f897SMark Bloch 		     u32 port_num, int index)
191616e9111eSGal Pressman {
191716e9111eSGal Pressman 	struct efa_com_get_stats_params params = {};
191816e9111eSGal Pressman 	union efa_com_get_stats_result result;
191916e9111eSGal Pressman 	struct efa_dev *dev = to_edev(ibdev);
1920b0cff387SDaniel Kranzdorf 	struct efa_com_rdma_read_stats *rrs;
1921b0cff387SDaniel Kranzdorf 	struct efa_com_messages_stats *ms;
192216e9111eSGal Pressman 	struct efa_com_basic_stats *bs;
192316e9111eSGal Pressman 	struct efa_com_stats_admin *as;
192416e9111eSGal Pressman 	struct efa_stats *s;
192516e9111eSGal Pressman 	int err;
192616e9111eSGal Pressman 
192716e9111eSGal Pressman 	params.scope = EFA_ADMIN_GET_STATS_SCOPE_ALL;
1928b0cff387SDaniel Kranzdorf 	params.type = EFA_ADMIN_GET_STATS_TYPE_BASIC;
192916e9111eSGal Pressman 
193016e9111eSGal Pressman 	err = efa_com_get_stats(&dev->edev, &params, &result);
193116e9111eSGal Pressman 	if (err)
193216e9111eSGal Pressman 		return err;
193316e9111eSGal Pressman 
193416e9111eSGal Pressman 	bs = &result.basic_stats;
193516e9111eSGal Pressman 	stats->value[EFA_TX_BYTES] = bs->tx_bytes;
193616e9111eSGal Pressman 	stats->value[EFA_TX_PKTS] = bs->tx_pkts;
193716e9111eSGal Pressman 	stats->value[EFA_RX_BYTES] = bs->rx_bytes;
193816e9111eSGal Pressman 	stats->value[EFA_RX_PKTS] = bs->rx_pkts;
193916e9111eSGal Pressman 	stats->value[EFA_RX_DROPS] = bs->rx_drops;
194016e9111eSGal Pressman 
1941b0cff387SDaniel Kranzdorf 	params.type = EFA_ADMIN_GET_STATS_TYPE_MESSAGES;
1942b0cff387SDaniel Kranzdorf 	err = efa_com_get_stats(&dev->edev, &params, &result);
1943b0cff387SDaniel Kranzdorf 	if (err)
1944b0cff387SDaniel Kranzdorf 		return err;
1945b0cff387SDaniel Kranzdorf 
1946b0cff387SDaniel Kranzdorf 	ms = &result.messages_stats;
1947b0cff387SDaniel Kranzdorf 	stats->value[EFA_SEND_BYTES] = ms->send_bytes;
1948b0cff387SDaniel Kranzdorf 	stats->value[EFA_SEND_WRS] = ms->send_wrs;
1949b0cff387SDaniel Kranzdorf 	stats->value[EFA_RECV_BYTES] = ms->recv_bytes;
1950b0cff387SDaniel Kranzdorf 	stats->value[EFA_RECV_WRS] = ms->recv_wrs;
1951b0cff387SDaniel Kranzdorf 
1952b0cff387SDaniel Kranzdorf 	params.type = EFA_ADMIN_GET_STATS_TYPE_RDMA_READ;
1953b0cff387SDaniel Kranzdorf 	err = efa_com_get_stats(&dev->edev, &params, &result);
1954b0cff387SDaniel Kranzdorf 	if (err)
1955b0cff387SDaniel Kranzdorf 		return err;
1956b0cff387SDaniel Kranzdorf 
1957b0cff387SDaniel Kranzdorf 	rrs = &result.rdma_read_stats;
1958b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_WRS] = rrs->read_wrs;
1959b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_BYTES] = rrs->read_bytes;
1960b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_WR_ERR] = rrs->read_wr_err;
1961b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_RESP_BYTES] = rrs->read_resp_bytes;
1962b0cff387SDaniel Kranzdorf 
196316e9111eSGal Pressman 	as = &dev->edev.aq.stats;
196416e9111eSGal Pressman 	stats->value[EFA_SUBMITTED_CMDS] = atomic64_read(&as->submitted_cmd);
196516e9111eSGal Pressman 	stats->value[EFA_COMPLETED_CMDS] = atomic64_read(&as->completed_cmd);
1966f86e3437SGal Pressman 	stats->value[EFA_CMDS_ERR] = atomic64_read(&as->cmd_err);
196716e9111eSGal Pressman 	stats->value[EFA_NO_COMPLETION_CMDS] = atomic64_read(&as->no_completion);
196816e9111eSGal Pressman 
196916e9111eSGal Pressman 	s = &dev->stats;
197016e9111eSGal Pressman 	stats->value[EFA_KEEP_ALIVE_RCVD] = atomic64_read(&s->keep_alive_rcvd);
1971215b88acSGal Pressman 	stats->value[EFA_ALLOC_PD_ERR] = atomic64_read(&s->alloc_pd_err);
1972215b88acSGal Pressman 	stats->value[EFA_CREATE_QP_ERR] = atomic64_read(&s->create_qp_err);
1973215b88acSGal Pressman 	stats->value[EFA_CREATE_CQ_ERR] = atomic64_read(&s->create_cq_err);
1974215b88acSGal Pressman 	stats->value[EFA_REG_MR_ERR] = atomic64_read(&s->reg_mr_err);
1975215b88acSGal Pressman 	stats->value[EFA_ALLOC_UCONTEXT_ERR] =
1976215b88acSGal Pressman 		atomic64_read(&s->alloc_ucontext_err);
1977215b88acSGal Pressman 	stats->value[EFA_CREATE_AH_ERR] = atomic64_read(&s->create_ah_err);
1978215b88acSGal Pressman 	stats->value[EFA_MMAP_ERR] = atomic64_read(&s->mmap_err);
197916e9111eSGal Pressman 
198016e9111eSGal Pressman 	return ARRAY_SIZE(efa_stats_names);
198116e9111eSGal Pressman }
198216e9111eSGal Pressman 
198340909f66SGal Pressman enum rdma_link_layer efa_port_link_layer(struct ib_device *ibdev,
1984*1fb7f897SMark Bloch 					 u32 port_num)
198540909f66SGal Pressman {
198640909f66SGal Pressman 	return IB_LINK_LAYER_UNSPECIFIED;
198740909f66SGal Pressman }
198840909f66SGal Pressman 
1989