xref: /openbmc/linux/drivers/infiniband/hw/efa/efa_verbs.c (revision 93416ab0f994f6cf16fa0c695577f8b19d30c533)
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 
25040909f66SGal Pressman int efa_query_port(struct ib_device *ibdev, u8 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 
32240909f66SGal Pressman int efa_query_gid(struct ib_device *ibdev, u8 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 
33240909f66SGal Pressman int efa_query_pkey(struct ib_device *ibdev, u8 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 
92040909f66SGal Pressman 	if (udata->inlen &&
92140909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, udata->inlen)) {
92240909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
92340909f66SGal Pressman 			  "Incompatible ABI params, udata not cleared\n");
92440909f66SGal Pressman 		return -EINVAL;
92540909f66SGal Pressman 	}
92640909f66SGal Pressman 
92740909f66SGal Pressman 	cur_state = qp_attr_mask & IB_QP_CUR_STATE ? qp_attr->cur_qp_state :
92840909f66SGal Pressman 						     qp->state;
92940909f66SGal Pressman 	new_state = qp_attr_mask & IB_QP_STATE ? qp_attr->qp_state : cur_state;
93040909f66SGal Pressman 
93140909f66SGal Pressman 	err = efa_modify_qp_validate(dev, qp, qp_attr, qp_attr_mask, cur_state,
93240909f66SGal Pressman 				     new_state);
93340909f66SGal Pressman 	if (err)
93440909f66SGal Pressman 		return err;
93540909f66SGal Pressman 
93640909f66SGal Pressman 	params.qp_handle = qp->qp_handle;
93740909f66SGal Pressman 
93840909f66SGal Pressman 	if (qp_attr_mask & IB_QP_STATE) {
939ab67baddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_QP_STATE,
940ab67baddSGal Pressman 			1);
941ab67baddSGal Pressman 		EFA_SET(&params.modify_mask,
942ab67baddSGal Pressman 			EFA_ADMIN_MODIFY_QP_CMD_CUR_QP_STATE, 1);
943*93416ab0SGal Pressman 		params.cur_qp_state = cur_state;
944*93416ab0SGal Pressman 		params.qp_state = new_state;
94540909f66SGal Pressman 	}
94640909f66SGal Pressman 
94740909f66SGal Pressman 	if (qp_attr_mask & IB_QP_EN_SQD_ASYNC_NOTIFY) {
948ab67baddSGal Pressman 		EFA_SET(&params.modify_mask,
949ab67baddSGal Pressman 			EFA_ADMIN_MODIFY_QP_CMD_SQ_DRAINED_ASYNC_NOTIFY, 1);
95040909f66SGal Pressman 		params.sq_drained_async_notify = qp_attr->en_sqd_async_notify;
95140909f66SGal Pressman 	}
95240909f66SGal Pressman 
95340909f66SGal Pressman 	if (qp_attr_mask & IB_QP_QKEY) {
954ab67baddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_QKEY, 1);
95540909f66SGal Pressman 		params.qkey = qp_attr->qkey;
95640909f66SGal Pressman 	}
95740909f66SGal Pressman 
95840909f66SGal Pressman 	if (qp_attr_mask & IB_QP_SQ_PSN) {
959ab67baddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_SQ_PSN, 1);
96040909f66SGal Pressman 		params.sq_psn = qp_attr->sq_psn;
96140909f66SGal Pressman 	}
96240909f66SGal Pressman 
963a4e6a1ddSGal Pressman 	if (qp_attr_mask & IB_QP_RNR_RETRY) {
964a4e6a1ddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_RNR_RETRY,
965a4e6a1ddSGal Pressman 			1);
966a4e6a1ddSGal Pressman 		params.rnr_retry = qp_attr->rnr_retry;
967a4e6a1ddSGal Pressman 	}
968a4e6a1ddSGal Pressman 
96940909f66SGal Pressman 	err = efa_com_modify_qp(&dev->edev, &params);
97040909f66SGal Pressman 	if (err)
97140909f66SGal Pressman 		return err;
97240909f66SGal Pressman 
97340909f66SGal Pressman 	qp->state = new_state;
97440909f66SGal Pressman 
97540909f66SGal Pressman 	return 0;
97640909f66SGal Pressman }
97740909f66SGal Pressman 
97840909f66SGal Pressman static int efa_destroy_cq_idx(struct efa_dev *dev, int cq_idx)
97940909f66SGal Pressman {
98040909f66SGal Pressman 	struct efa_com_destroy_cq_params params = { .cq_idx = cq_idx };
98140909f66SGal Pressman 
98240909f66SGal Pressman 	return efa_com_destroy_cq(&dev->edev, &params);
98340909f66SGal Pressman }
98440909f66SGal Pressman 
98543d781b9SLeon Romanovsky int efa_destroy_cq(struct ib_cq *ibcq, struct ib_udata *udata)
98640909f66SGal Pressman {
98740909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibcq->device);
98840909f66SGal Pressman 	struct efa_cq *cq = to_ecq(ibcq);
98940909f66SGal Pressman 
99040909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
99140909f66SGal Pressman 		  "Destroy cq[%d] virt[0x%p] freed: size[%lu], dma[%pad]\n",
99240909f66SGal Pressman 		  cq->cq_idx, cq->cpu_addr, cq->size, &cq->dma_addr);
99340909f66SGal Pressman 
994e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(cq->mmap_entry);
995ff6629f8SGal Pressman 	efa_destroy_cq_idx(dev, cq->cq_idx);
996ff6629f8SGal Pressman 	efa_free_mapped(dev, cq->cpu_addr, cq->dma_addr, cq->size,
997ff6629f8SGal Pressman 			DMA_FROM_DEVICE);
99843d781b9SLeon Romanovsky 	return 0;
99940909f66SGal Pressman }
100040909f66SGal Pressman 
100140909f66SGal Pressman static int cq_mmap_entries_setup(struct efa_dev *dev, struct efa_cq *cq,
100240909f66SGal Pressman 				 struct efa_ibv_create_cq_resp *resp)
100340909f66SGal Pressman {
100440909f66SGal Pressman 	resp->q_mmap_size = cq->size;
1005e84d3c18SMichal Kalderon 	cq->mmap_entry = efa_user_mmap_entry_insert(&cq->ucontext->ibucontext,
100640909f66SGal Pressman 						    virt_to_phys(cq->cpu_addr),
1007e84d3c18SMichal Kalderon 						    cq->size, EFA_MMAP_DMA_PAGE,
1008e84d3c18SMichal Kalderon 						    &resp->q_mmap_key);
1009e84d3c18SMichal Kalderon 	if (!cq->mmap_entry)
101040909f66SGal Pressman 		return -ENOMEM;
101140909f66SGal Pressman 
101240909f66SGal Pressman 	return 0;
101340909f66SGal Pressman }
101440909f66SGal Pressman 
1015e39afe3dSLeon Romanovsky int efa_create_cq(struct ib_cq *ibcq, const struct ib_cq_init_attr *attr,
101640909f66SGal Pressman 		  struct ib_udata *udata)
101740909f66SGal Pressman {
1018e39afe3dSLeon Romanovsky 	struct efa_ucontext *ucontext = rdma_udata_to_drv_context(
1019e39afe3dSLeon Romanovsky 		udata, struct efa_ucontext, ibucontext);
102040909f66SGal Pressman 	struct efa_ibv_create_cq_resp resp = {};
102140909f66SGal Pressman 	struct efa_com_create_cq_params params;
102240909f66SGal Pressman 	struct efa_com_create_cq_result result;
1023e39afe3dSLeon Romanovsky 	struct ib_device *ibdev = ibcq->device;
102440909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibdev);
102540909f66SGal Pressman 	struct efa_ibv_create_cq cmd = {};
1026e39afe3dSLeon Romanovsky 	struct efa_cq *cq = to_ecq(ibcq);
1027e39afe3dSLeon Romanovsky 	int entries = attr->cqe;
102840909f66SGal Pressman 	int err;
102940909f66SGal Pressman 
103040909f66SGal Pressman 	ibdev_dbg(ibdev, "create_cq entries %d\n", entries);
103140909f66SGal Pressman 
103240909f66SGal Pressman 	if (entries < 1 || entries > dev->dev_attr.max_cq_depth) {
103340909f66SGal Pressman 		ibdev_dbg(ibdev,
103440909f66SGal Pressman 			  "cq: requested entries[%u] non-positive or greater than max[%u]\n",
103540909f66SGal Pressman 			  entries, dev->dev_attr.max_cq_depth);
103640909f66SGal Pressman 		err = -EINVAL;
103740909f66SGal Pressman 		goto err_out;
103840909f66SGal Pressman 	}
103940909f66SGal Pressman 
1040fa8a44f6SLeon Romanovsky 	if (offsetofend(typeof(cmd), num_sub_cqs) > udata->inlen) {
104140909f66SGal Pressman 		ibdev_dbg(ibdev,
104240909f66SGal Pressman 			  "Incompatible ABI params, no input udata\n");
104340909f66SGal Pressman 		err = -EINVAL;
104440909f66SGal Pressman 		goto err_out;
104540909f66SGal Pressman 	}
104640909f66SGal Pressman 
104740909f66SGal Pressman 	if (udata->inlen > sizeof(cmd) &&
104840909f66SGal Pressman 	    !ib_is_udata_cleared(udata, sizeof(cmd),
104940909f66SGal Pressman 				 udata->inlen - sizeof(cmd))) {
105040909f66SGal Pressman 		ibdev_dbg(ibdev,
105140909f66SGal Pressman 			  "Incompatible ABI params, unknown fields in udata\n");
105240909f66SGal Pressman 		err = -EINVAL;
105340909f66SGal Pressman 		goto err_out;
105440909f66SGal Pressman 	}
105540909f66SGal Pressman 
105640909f66SGal Pressman 	err = ib_copy_from_udata(&cmd, udata,
105740909f66SGal Pressman 				 min(sizeof(cmd), udata->inlen));
105840909f66SGal Pressman 	if (err) {
105940909f66SGal Pressman 		ibdev_dbg(ibdev, "Cannot copy udata for create_cq\n");
106040909f66SGal Pressman 		goto err_out;
106140909f66SGal Pressman 	}
106240909f66SGal Pressman 
106340909f66SGal Pressman 	if (cmd.comp_mask || !is_reserved_cleared(cmd.reserved_50)) {
106440909f66SGal Pressman 		ibdev_dbg(ibdev,
106540909f66SGal Pressman 			  "Incompatible ABI params, unknown fields in udata\n");
106640909f66SGal Pressman 		err = -EINVAL;
106740909f66SGal Pressman 		goto err_out;
106840909f66SGal Pressman 	}
106940909f66SGal Pressman 
107040909f66SGal Pressman 	if (!cmd.cq_entry_size) {
107140909f66SGal Pressman 		ibdev_dbg(ibdev,
107240909f66SGal Pressman 			  "Invalid entry size [%u]\n", cmd.cq_entry_size);
107340909f66SGal Pressman 		err = -EINVAL;
107440909f66SGal Pressman 		goto err_out;
107540909f66SGal Pressman 	}
107640909f66SGal Pressman 
107740909f66SGal Pressman 	if (cmd.num_sub_cqs != dev->dev_attr.sub_cqs_per_cq) {
107840909f66SGal Pressman 		ibdev_dbg(ibdev,
107940909f66SGal Pressman 			  "Invalid number of sub cqs[%u] expected[%u]\n",
108040909f66SGal Pressman 			  cmd.num_sub_cqs, dev->dev_attr.sub_cqs_per_cq);
108140909f66SGal Pressman 		err = -EINVAL;
108240909f66SGal Pressman 		goto err_out;
108340909f66SGal Pressman 	}
108440909f66SGal Pressman 
1085e39afe3dSLeon Romanovsky 	cq->ucontext = ucontext;
108640909f66SGal Pressman 	cq->size = PAGE_ALIGN(cmd.cq_entry_size * entries * cmd.num_sub_cqs);
108740909f66SGal Pressman 	cq->cpu_addr = efa_zalloc_mapped(dev, &cq->dma_addr, cq->size,
108840909f66SGal Pressman 					 DMA_FROM_DEVICE);
108940909f66SGal Pressman 	if (!cq->cpu_addr) {
109040909f66SGal Pressman 		err = -ENOMEM;
1091e39afe3dSLeon Romanovsky 		goto err_out;
109240909f66SGal Pressman 	}
109340909f66SGal Pressman 
109440909f66SGal Pressman 	params.uarn = cq->ucontext->uarn;
109540909f66SGal Pressman 	params.cq_depth = entries;
109640909f66SGal Pressman 	params.dma_addr = cq->dma_addr;
109740909f66SGal Pressman 	params.entry_size_in_bytes = cmd.cq_entry_size;
109840909f66SGal Pressman 	params.num_sub_cqs = cmd.num_sub_cqs;
109940909f66SGal Pressman 	err = efa_com_create_cq(&dev->edev, &params, &result);
110040909f66SGal Pressman 	if (err)
110140909f66SGal Pressman 		goto err_free_mapped;
110240909f66SGal Pressman 
110340909f66SGal Pressman 	resp.cq_idx = result.cq_idx;
110440909f66SGal Pressman 	cq->cq_idx = result.cq_idx;
110540909f66SGal Pressman 	cq->ibcq.cqe = result.actual_depth;
110640909f66SGal Pressman 	WARN_ON_ONCE(entries != result.actual_depth);
110740909f66SGal Pressman 
110840909f66SGal Pressman 	err = cq_mmap_entries_setup(dev, cq, &resp);
110940909f66SGal Pressman 	if (err) {
1110e39afe3dSLeon Romanovsky 		ibdev_dbg(ibdev, "Could not setup cq[%u] mmap entries\n",
1111e39afe3dSLeon Romanovsky 			  cq->cq_idx);
111240909f66SGal Pressman 		goto err_destroy_cq;
111340909f66SGal Pressman 	}
111440909f66SGal Pressman 
111540909f66SGal Pressman 	if (udata->outlen) {
111640909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
111740909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
111840909f66SGal Pressman 		if (err) {
111940909f66SGal Pressman 			ibdev_dbg(ibdev,
112040909f66SGal Pressman 				  "Failed to copy udata for create_cq\n");
1121e84d3c18SMichal Kalderon 			goto err_remove_mmap;
112240909f66SGal Pressman 		}
112340909f66SGal Pressman 	}
112440909f66SGal Pressman 
1125e39afe3dSLeon Romanovsky 	ibdev_dbg(ibdev, "Created cq[%d], cq depth[%u]. dma[%pad] virt[0x%p]\n",
112640909f66SGal Pressman 		  cq->cq_idx, result.actual_depth, &cq->dma_addr, cq->cpu_addr);
112740909f66SGal Pressman 
1128e39afe3dSLeon Romanovsky 	return 0;
112940909f66SGal Pressman 
1130e84d3c18SMichal Kalderon err_remove_mmap:
1131e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(cq->mmap_entry);
113240909f66SGal Pressman err_destroy_cq:
113340909f66SGal Pressman 	efa_destroy_cq_idx(dev, cq->cq_idx);
113440909f66SGal Pressman err_free_mapped:
1135ff6629f8SGal Pressman 	efa_free_mapped(dev, cq->cpu_addr, cq->dma_addr, cq->size,
113640909f66SGal Pressman 			DMA_FROM_DEVICE);
1137e84d3c18SMichal Kalderon 
113840909f66SGal Pressman err_out:
1139215b88acSGal Pressman 	atomic64_inc(&dev->stats.create_cq_err);
1140e39afe3dSLeon Romanovsky 	return err;
114140909f66SGal Pressman }
114240909f66SGal Pressman 
114340909f66SGal Pressman static int umem_to_page_list(struct efa_dev *dev,
114440909f66SGal Pressman 			     struct ib_umem *umem,
114540909f66SGal Pressman 			     u64 *page_list,
114640909f66SGal Pressman 			     u32 hp_cnt,
114740909f66SGal Pressman 			     u8 hp_shift)
114840909f66SGal Pressman {
114940909f66SGal Pressman 	u32 pages_in_hp = BIT(hp_shift - PAGE_SHIFT);
115040ddb3f0SGal Pressman 	struct ib_block_iter biter;
115140909f66SGal Pressman 	unsigned int hp_idx = 0;
115240909f66SGal Pressman 
115340909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "hp_cnt[%u], pages_in_hp[%u]\n",
115440909f66SGal Pressman 		  hp_cnt, pages_in_hp);
115540909f66SGal Pressman 
1156ebc24096SJason Gunthorpe 	rdma_umem_for_each_dma_block(umem, &biter, BIT(hp_shift))
115740ddb3f0SGal Pressman 		page_list[hp_idx++] = rdma_block_iter_dma_address(&biter);
115840909f66SGal Pressman 
115940909f66SGal Pressman 	return 0;
116040909f66SGal Pressman }
116140909f66SGal Pressman 
116240909f66SGal Pressman static struct scatterlist *efa_vmalloc_buf_to_sg(u64 *buf, int page_cnt)
116340909f66SGal Pressman {
116440909f66SGal Pressman 	struct scatterlist *sglist;
116540909f66SGal Pressman 	struct page *pg;
116640909f66SGal Pressman 	int i;
116740909f66SGal Pressman 
11683de3c478SJulia Lawall 	sglist = kmalloc_array(page_cnt, sizeof(*sglist), GFP_KERNEL);
116940909f66SGal Pressman 	if (!sglist)
117040909f66SGal Pressman 		return NULL;
117140909f66SGal Pressman 	sg_init_table(sglist, page_cnt);
117240909f66SGal Pressman 	for (i = 0; i < page_cnt; i++) {
117340909f66SGal Pressman 		pg = vmalloc_to_page(buf);
117440909f66SGal Pressman 		if (!pg)
117540909f66SGal Pressman 			goto err;
117640909f66SGal Pressman 		sg_set_page(&sglist[i], pg, PAGE_SIZE, 0);
117740909f66SGal Pressman 		buf += PAGE_SIZE / sizeof(*buf);
117840909f66SGal Pressman 	}
117940909f66SGal Pressman 	return sglist;
118040909f66SGal Pressman 
118140909f66SGal Pressman err:
118240909f66SGal Pressman 	kfree(sglist);
118340909f66SGal Pressman 	return NULL;
118440909f66SGal Pressman }
118540909f66SGal Pressman 
118640909f66SGal Pressman /*
118740909f66SGal Pressman  * create a chunk list of physical pages dma addresses from the supplied
118840909f66SGal Pressman  * scatter gather list
118940909f66SGal Pressman  */
119040909f66SGal Pressman static int pbl_chunk_list_create(struct efa_dev *dev, struct pbl_context *pbl)
119140909f66SGal Pressman {
119240909f66SGal Pressman 	struct pbl_chunk_list *chunk_list = &pbl->phys.indirect.chunk_list;
119340909f66SGal Pressman 	int page_cnt = pbl->phys.indirect.pbl_buf_size_in_pages;
119440909f66SGal Pressman 	struct scatterlist *pages_sgl = pbl->phys.indirect.sgl;
11954d50e084SGal Pressman 	unsigned int chunk_list_size, chunk_idx, payload_idx;
119640909f66SGal Pressman 	int sg_dma_cnt = pbl->phys.indirect.sg_dma_cnt;
119740909f66SGal Pressman 	struct efa_com_ctrl_buff_info *ctrl_buf;
119840909f66SGal Pressman 	u64 *cur_chunk_buf, *prev_chunk_buf;
11994d50e084SGal Pressman 	struct ib_block_iter biter;
120040909f66SGal Pressman 	dma_addr_t dma_addr;
120140909f66SGal Pressman 	int i;
120240909f66SGal Pressman 
120340909f66SGal Pressman 	/* allocate a chunk list that consists of 4KB chunks */
120440909f66SGal Pressman 	chunk_list_size = DIV_ROUND_UP(page_cnt, EFA_PTRS_PER_CHUNK);
120540909f66SGal Pressman 
120640909f66SGal Pressman 	chunk_list->size = chunk_list_size;
120740909f66SGal Pressman 	chunk_list->chunks = kcalloc(chunk_list_size,
120840909f66SGal Pressman 				     sizeof(*chunk_list->chunks),
120940909f66SGal Pressman 				     GFP_KERNEL);
121040909f66SGal Pressman 	if (!chunk_list->chunks)
121140909f66SGal Pressman 		return -ENOMEM;
121240909f66SGal Pressman 
121340909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
121440909f66SGal Pressman 		  "chunk_list_size[%u] - pages[%u]\n", chunk_list_size,
121540909f66SGal Pressman 		  page_cnt);
121640909f66SGal Pressman 
121740909f66SGal Pressman 	/* allocate chunk buffers: */
121840909f66SGal Pressman 	for (i = 0; i < chunk_list_size; i++) {
121940909f66SGal Pressman 		chunk_list->chunks[i].buf = kzalloc(EFA_CHUNK_SIZE, GFP_KERNEL);
122040909f66SGal Pressman 		if (!chunk_list->chunks[i].buf)
122140909f66SGal Pressman 			goto chunk_list_dealloc;
122240909f66SGal Pressman 
122340909f66SGal Pressman 		chunk_list->chunks[i].length = EFA_CHUNK_USED_SIZE;
122440909f66SGal Pressman 	}
122540909f66SGal Pressman 	chunk_list->chunks[chunk_list_size - 1].length =
122640909f66SGal Pressman 		((page_cnt % EFA_PTRS_PER_CHUNK) * EFA_CHUNK_PAYLOAD_PTR_SIZE) +
122740909f66SGal Pressman 			EFA_CHUNK_PTR_SIZE;
122840909f66SGal Pressman 
122940909f66SGal Pressman 	/* fill the dma addresses of sg list pages to chunks: */
123040909f66SGal Pressman 	chunk_idx = 0;
123140909f66SGal Pressman 	payload_idx = 0;
123240909f66SGal Pressman 	cur_chunk_buf = chunk_list->chunks[0].buf;
12334d50e084SGal Pressman 	rdma_for_each_block(pages_sgl, &biter, sg_dma_cnt,
12344d50e084SGal Pressman 			    EFA_CHUNK_PAYLOAD_SIZE) {
123540909f66SGal Pressman 		cur_chunk_buf[payload_idx++] =
12364d50e084SGal Pressman 			rdma_block_iter_dma_address(&biter);
123740909f66SGal Pressman 
123840909f66SGal Pressman 		if (payload_idx == EFA_PTRS_PER_CHUNK) {
123940909f66SGal Pressman 			chunk_idx++;
124040909f66SGal Pressman 			cur_chunk_buf = chunk_list->chunks[chunk_idx].buf;
124140909f66SGal Pressman 			payload_idx = 0;
124240909f66SGal Pressman 		}
124340909f66SGal Pressman 	}
124440909f66SGal Pressman 
124540909f66SGal Pressman 	/* map chunks to dma and fill chunks next ptrs */
124640909f66SGal Pressman 	for (i = chunk_list_size - 1; i >= 0; i--) {
124740909f66SGal Pressman 		dma_addr = dma_map_single(&dev->pdev->dev,
124840909f66SGal Pressman 					  chunk_list->chunks[i].buf,
124940909f66SGal Pressman 					  chunk_list->chunks[i].length,
125040909f66SGal Pressman 					  DMA_TO_DEVICE);
125140909f66SGal Pressman 		if (dma_mapping_error(&dev->pdev->dev, dma_addr)) {
125240909f66SGal Pressman 			ibdev_err(&dev->ibdev,
125340909f66SGal Pressman 				  "chunk[%u] dma_map_failed\n", i);
125440909f66SGal Pressman 			goto chunk_list_unmap;
125540909f66SGal Pressman 		}
125640909f66SGal Pressman 
125740909f66SGal Pressman 		chunk_list->chunks[i].dma_addr = dma_addr;
125840909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
125940909f66SGal Pressman 			  "chunk[%u] mapped at [%pad]\n", i, &dma_addr);
126040909f66SGal Pressman 
126140909f66SGal Pressman 		if (!i)
126240909f66SGal Pressman 			break;
126340909f66SGal Pressman 
126440909f66SGal Pressman 		prev_chunk_buf = chunk_list->chunks[i - 1].buf;
126540909f66SGal Pressman 
126640909f66SGal Pressman 		ctrl_buf = (struct efa_com_ctrl_buff_info *)
126740909f66SGal Pressman 				&prev_chunk_buf[EFA_PTRS_PER_CHUNK];
126840909f66SGal Pressman 		ctrl_buf->length = chunk_list->chunks[i].length;
126940909f66SGal Pressman 
127040909f66SGal Pressman 		efa_com_set_dma_addr(dma_addr,
127140909f66SGal Pressman 				     &ctrl_buf->address.mem_addr_high,
127240909f66SGal Pressman 				     &ctrl_buf->address.mem_addr_low);
127340909f66SGal Pressman 	}
127440909f66SGal Pressman 
127540909f66SGal Pressman 	return 0;
127640909f66SGal Pressman 
127740909f66SGal Pressman chunk_list_unmap:
127840909f66SGal Pressman 	for (; i < chunk_list_size; i++) {
127940909f66SGal Pressman 		dma_unmap_single(&dev->pdev->dev, chunk_list->chunks[i].dma_addr,
128040909f66SGal Pressman 				 chunk_list->chunks[i].length, DMA_TO_DEVICE);
128140909f66SGal Pressman 	}
128240909f66SGal Pressman chunk_list_dealloc:
128340909f66SGal Pressman 	for (i = 0; i < chunk_list_size; i++)
128440909f66SGal Pressman 		kfree(chunk_list->chunks[i].buf);
128540909f66SGal Pressman 
128640909f66SGal Pressman 	kfree(chunk_list->chunks);
128740909f66SGal Pressman 	return -ENOMEM;
128840909f66SGal Pressman }
128940909f66SGal Pressman 
129040909f66SGal Pressman static void pbl_chunk_list_destroy(struct efa_dev *dev, struct pbl_context *pbl)
129140909f66SGal Pressman {
129240909f66SGal Pressman 	struct pbl_chunk_list *chunk_list = &pbl->phys.indirect.chunk_list;
129340909f66SGal Pressman 	int i;
129440909f66SGal Pressman 
129540909f66SGal Pressman 	for (i = 0; i < chunk_list->size; i++) {
129640909f66SGal Pressman 		dma_unmap_single(&dev->pdev->dev, chunk_list->chunks[i].dma_addr,
129740909f66SGal Pressman 				 chunk_list->chunks[i].length, DMA_TO_DEVICE);
129840909f66SGal Pressman 		kfree(chunk_list->chunks[i].buf);
129940909f66SGal Pressman 	}
130040909f66SGal Pressman 
130140909f66SGal Pressman 	kfree(chunk_list->chunks);
130240909f66SGal Pressman }
130340909f66SGal Pressman 
130440909f66SGal Pressman /* initialize pbl continuous mode: map pbl buffer to a dma address. */
130540909f66SGal Pressman static int pbl_continuous_initialize(struct efa_dev *dev,
130640909f66SGal Pressman 				     struct pbl_context *pbl)
130740909f66SGal Pressman {
130840909f66SGal Pressman 	dma_addr_t dma_addr;
130940909f66SGal Pressman 
131040909f66SGal Pressman 	dma_addr = dma_map_single(&dev->pdev->dev, pbl->pbl_buf,
131140909f66SGal Pressman 				  pbl->pbl_buf_size_in_bytes, DMA_TO_DEVICE);
131240909f66SGal Pressman 	if (dma_mapping_error(&dev->pdev->dev, dma_addr)) {
131340909f66SGal Pressman 		ibdev_err(&dev->ibdev, "Unable to map pbl to DMA address\n");
131440909f66SGal Pressman 		return -ENOMEM;
131540909f66SGal Pressman 	}
131640909f66SGal Pressman 
131740909f66SGal Pressman 	pbl->phys.continuous.dma_addr = dma_addr;
131840909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
131940909f66SGal Pressman 		  "pbl continuous - dma_addr = %pad, size[%u]\n",
132040909f66SGal Pressman 		  &dma_addr, pbl->pbl_buf_size_in_bytes);
132140909f66SGal Pressman 
132240909f66SGal Pressman 	return 0;
132340909f66SGal Pressman }
132440909f66SGal Pressman 
132540909f66SGal Pressman /*
132640909f66SGal Pressman  * initialize pbl indirect mode:
132740909f66SGal Pressman  * create a chunk list out of the dma addresses of the physical pages of
132840909f66SGal Pressman  * pbl buffer.
132940909f66SGal Pressman  */
133040909f66SGal Pressman static int pbl_indirect_initialize(struct efa_dev *dev, struct pbl_context *pbl)
133140909f66SGal Pressman {
133240909f66SGal Pressman 	u32 size_in_pages = DIV_ROUND_UP(pbl->pbl_buf_size_in_bytes, PAGE_SIZE);
133340909f66SGal Pressman 	struct scatterlist *sgl;
133440909f66SGal Pressman 	int sg_dma_cnt, err;
133540909f66SGal Pressman 
133640909f66SGal Pressman 	BUILD_BUG_ON(EFA_CHUNK_PAYLOAD_SIZE > PAGE_SIZE);
133740909f66SGal Pressman 	sgl = efa_vmalloc_buf_to_sg(pbl->pbl_buf, size_in_pages);
133840909f66SGal Pressman 	if (!sgl)
133940909f66SGal Pressman 		return -ENOMEM;
134040909f66SGal Pressman 
134140909f66SGal Pressman 	sg_dma_cnt = dma_map_sg(&dev->pdev->dev, sgl, size_in_pages, DMA_TO_DEVICE);
134240909f66SGal Pressman 	if (!sg_dma_cnt) {
134340909f66SGal Pressman 		err = -EINVAL;
134440909f66SGal Pressman 		goto err_map;
134540909f66SGal Pressman 	}
134640909f66SGal Pressman 
134740909f66SGal Pressman 	pbl->phys.indirect.pbl_buf_size_in_pages = size_in_pages;
134840909f66SGal Pressman 	pbl->phys.indirect.sgl = sgl;
134940909f66SGal Pressman 	pbl->phys.indirect.sg_dma_cnt = sg_dma_cnt;
135040909f66SGal Pressman 	err = pbl_chunk_list_create(dev, pbl);
135140909f66SGal Pressman 	if (err) {
135240909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
135340909f66SGal Pressman 			  "chunk_list creation failed[%d]\n", err);
135440909f66SGal Pressman 		goto err_chunk;
135540909f66SGal Pressman 	}
135640909f66SGal Pressman 
135740909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
135840909f66SGal Pressman 		  "pbl indirect - size[%u], chunks[%u]\n",
135940909f66SGal Pressman 		  pbl->pbl_buf_size_in_bytes,
136040909f66SGal Pressman 		  pbl->phys.indirect.chunk_list.size);
136140909f66SGal Pressman 
136240909f66SGal Pressman 	return 0;
136340909f66SGal Pressman 
136440909f66SGal Pressman err_chunk:
136540909f66SGal Pressman 	dma_unmap_sg(&dev->pdev->dev, sgl, size_in_pages, DMA_TO_DEVICE);
136640909f66SGal Pressman err_map:
136740909f66SGal Pressman 	kfree(sgl);
136840909f66SGal Pressman 	return err;
136940909f66SGal Pressman }
137040909f66SGal Pressman 
137140909f66SGal Pressman static void pbl_indirect_terminate(struct efa_dev *dev, struct pbl_context *pbl)
137240909f66SGal Pressman {
137340909f66SGal Pressman 	pbl_chunk_list_destroy(dev, pbl);
137440909f66SGal Pressman 	dma_unmap_sg(&dev->pdev->dev, pbl->phys.indirect.sgl,
137540909f66SGal Pressman 		     pbl->phys.indirect.pbl_buf_size_in_pages, DMA_TO_DEVICE);
137640909f66SGal Pressman 	kfree(pbl->phys.indirect.sgl);
137740909f66SGal Pressman }
137840909f66SGal Pressman 
137940909f66SGal Pressman /* create a page buffer list from a mapped user memory region */
138040909f66SGal Pressman static int pbl_create(struct efa_dev *dev,
138140909f66SGal Pressman 		      struct pbl_context *pbl,
138240909f66SGal Pressman 		      struct ib_umem *umem,
138340909f66SGal Pressman 		      int hp_cnt,
138440909f66SGal Pressman 		      u8 hp_shift)
138540909f66SGal Pressman {
138640909f66SGal Pressman 	int err;
138740909f66SGal Pressman 
138840909f66SGal Pressman 	pbl->pbl_buf_size_in_bytes = hp_cnt * EFA_CHUNK_PAYLOAD_PTR_SIZE;
1389255efcaeSGal Pressman 	pbl->pbl_buf = kvzalloc(pbl->pbl_buf_size_in_bytes, GFP_KERNEL);
1390255efcaeSGal Pressman 	if (!pbl->pbl_buf)
1391255efcaeSGal Pressman 		return -ENOMEM;
1392255efcaeSGal Pressman 
1393255efcaeSGal Pressman 	if (is_vmalloc_addr(pbl->pbl_buf)) {
1394255efcaeSGal Pressman 		pbl->physically_continuous = 0;
1395255efcaeSGal Pressman 		err = umem_to_page_list(dev, umem, pbl->pbl_buf, hp_cnt,
1396255efcaeSGal Pressman 					hp_shift);
1397255efcaeSGal Pressman 		if (err)
1398255efcaeSGal Pressman 			goto err_free;
1399255efcaeSGal Pressman 
1400255efcaeSGal Pressman 		err = pbl_indirect_initialize(dev, pbl);
1401255efcaeSGal Pressman 		if (err)
1402255efcaeSGal Pressman 			goto err_free;
1403255efcaeSGal Pressman 	} else {
140440909f66SGal Pressman 		pbl->physically_continuous = 1;
140540909f66SGal Pressman 		err = umem_to_page_list(dev, umem, pbl->pbl_buf, hp_cnt,
140640909f66SGal Pressman 					hp_shift);
140740909f66SGal Pressman 		if (err)
1408255efcaeSGal Pressman 			goto err_free;
1409255efcaeSGal Pressman 
141040909f66SGal Pressman 		err = pbl_continuous_initialize(dev, pbl);
141140909f66SGal Pressman 		if (err)
1412255efcaeSGal Pressman 			goto err_free;
141340909f66SGal Pressman 	}
141440909f66SGal Pressman 
141540909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
141640909f66SGal Pressman 		  "user_pbl_created: user_pages[%u], continuous[%u]\n",
141740909f66SGal Pressman 		  hp_cnt, pbl->physically_continuous);
141840909f66SGal Pressman 
141940909f66SGal Pressman 	return 0;
142040909f66SGal Pressman 
1421255efcaeSGal Pressman err_free:
1422255efcaeSGal Pressman 	kvfree(pbl->pbl_buf);
142340909f66SGal Pressman 	return err;
142440909f66SGal Pressman }
142540909f66SGal Pressman 
142640909f66SGal Pressman static void pbl_destroy(struct efa_dev *dev, struct pbl_context *pbl)
142740909f66SGal Pressman {
1428255efcaeSGal Pressman 	if (pbl->physically_continuous)
142940909f66SGal Pressman 		dma_unmap_single(&dev->pdev->dev, pbl->phys.continuous.dma_addr,
143040909f66SGal Pressman 				 pbl->pbl_buf_size_in_bytes, DMA_TO_DEVICE);
1431255efcaeSGal Pressman 	else
143240909f66SGal Pressman 		pbl_indirect_terminate(dev, pbl);
1433255efcaeSGal Pressman 
1434255efcaeSGal Pressman 	kvfree(pbl->pbl_buf);
143540909f66SGal Pressman }
143640909f66SGal Pressman 
143740909f66SGal Pressman static int efa_create_inline_pbl(struct efa_dev *dev, struct efa_mr *mr,
143840909f66SGal Pressman 				 struct efa_com_reg_mr_params *params)
143940909f66SGal Pressman {
144040909f66SGal Pressman 	int err;
144140909f66SGal Pressman 
144240909f66SGal Pressman 	params->inline_pbl = 1;
144340909f66SGal Pressman 	err = umem_to_page_list(dev, mr->umem, params->pbl.inline_pbl_array,
144440909f66SGal Pressman 				params->page_num, params->page_shift);
144540909f66SGal Pressman 	if (err)
144640909f66SGal Pressman 		return err;
144740909f66SGal Pressman 
144840909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
144940909f66SGal Pressman 		  "inline_pbl_array - pages[%u]\n", params->page_num);
145040909f66SGal Pressman 
145140909f66SGal Pressman 	return 0;
145240909f66SGal Pressman }
145340909f66SGal Pressman 
145440909f66SGal Pressman static int efa_create_pbl(struct efa_dev *dev,
145540909f66SGal Pressman 			  struct pbl_context *pbl,
145640909f66SGal Pressman 			  struct efa_mr *mr,
145740909f66SGal Pressman 			  struct efa_com_reg_mr_params *params)
145840909f66SGal Pressman {
145940909f66SGal Pressman 	int err;
146040909f66SGal Pressman 
146140909f66SGal Pressman 	err = pbl_create(dev, pbl, mr->umem, params->page_num,
146240909f66SGal Pressman 			 params->page_shift);
146340909f66SGal Pressman 	if (err) {
146440909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Failed to create pbl[%d]\n", err);
146540909f66SGal Pressman 		return err;
146640909f66SGal Pressman 	}
146740909f66SGal Pressman 
146840909f66SGal Pressman 	params->inline_pbl = 0;
146940909f66SGal Pressman 	params->indirect = !pbl->physically_continuous;
147040909f66SGal Pressman 	if (pbl->physically_continuous) {
147140909f66SGal Pressman 		params->pbl.pbl.length = pbl->pbl_buf_size_in_bytes;
147240909f66SGal Pressman 
147340909f66SGal Pressman 		efa_com_set_dma_addr(pbl->phys.continuous.dma_addr,
147440909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_high,
147540909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_low);
147640909f66SGal Pressman 	} else {
147740909f66SGal Pressman 		params->pbl.pbl.length =
147840909f66SGal Pressman 			pbl->phys.indirect.chunk_list.chunks[0].length;
147940909f66SGal Pressman 
148040909f66SGal Pressman 		efa_com_set_dma_addr(pbl->phys.indirect.chunk_list.chunks[0].dma_addr,
148140909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_high,
148240909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_low);
148340909f66SGal Pressman 	}
148440909f66SGal Pressman 
148540909f66SGal Pressman 	return 0;
148640909f66SGal Pressman }
148740909f66SGal Pressman 
148840909f66SGal Pressman struct ib_mr *efa_reg_mr(struct ib_pd *ibpd, u64 start, u64 length,
148940909f66SGal Pressman 			 u64 virt_addr, int access_flags,
149040909f66SGal Pressman 			 struct ib_udata *udata)
149140909f66SGal Pressman {
149240909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibpd->device);
149340909f66SGal Pressman 	struct efa_com_reg_mr_params params = {};
149440909f66SGal Pressman 	struct efa_com_reg_mr_result result = {};
149540909f66SGal Pressman 	struct pbl_context pbl;
1496666e8ff5SDaniel Kranzdorf 	int supp_access_flags;
149740ddb3f0SGal Pressman 	unsigned int pg_sz;
149840909f66SGal Pressman 	struct efa_mr *mr;
149940909f66SGal Pressman 	int inline_size;
150040909f66SGal Pressman 	int err;
150140909f66SGal Pressman 
150233006bd4SMoni Shoua 	if (udata && udata->inlen &&
150340909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, sizeof(udata->inlen))) {
150440909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
150540909f66SGal Pressman 			  "Incompatible ABI params, udata not cleared\n");
150640909f66SGal Pressman 		err = -EINVAL;
150740909f66SGal Pressman 		goto err_out;
150840909f66SGal Pressman 	}
150940909f66SGal Pressman 
1510666e8ff5SDaniel Kranzdorf 	supp_access_flags =
1511666e8ff5SDaniel Kranzdorf 		IB_ACCESS_LOCAL_WRITE |
151234eb009fSGal Pressman 		(EFA_DEV_CAP(dev, RDMA_READ) ? IB_ACCESS_REMOTE_READ : 0);
1513666e8ff5SDaniel Kranzdorf 
1514ba19e166SGal Pressman 	access_flags &= ~IB_ACCESS_OPTIONAL;
1515666e8ff5SDaniel Kranzdorf 	if (access_flags & ~supp_access_flags) {
151640909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
151740909f66SGal Pressman 			  "Unsupported access flags[%#x], supported[%#x]\n",
1518666e8ff5SDaniel Kranzdorf 			  access_flags, supp_access_flags);
151940909f66SGal Pressman 		err = -EOPNOTSUPP;
152040909f66SGal Pressman 		goto err_out;
152140909f66SGal Pressman 	}
152240909f66SGal Pressman 
152340909f66SGal Pressman 	mr = kzalloc(sizeof(*mr), GFP_KERNEL);
152440909f66SGal Pressman 	if (!mr) {
152540909f66SGal Pressman 		err = -ENOMEM;
152640909f66SGal Pressman 		goto err_out;
152740909f66SGal Pressman 	}
152840909f66SGal Pressman 
1529c320e527SMoni Shoua 	mr->umem = ib_umem_get(ibpd->device, start, length, access_flags);
153040909f66SGal Pressman 	if (IS_ERR(mr->umem)) {
153140909f66SGal Pressman 		err = PTR_ERR(mr->umem);
153240909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
153340909f66SGal Pressman 			  "Failed to pin and map user space memory[%d]\n", err);
153440909f66SGal Pressman 		goto err_free;
153540909f66SGal Pressman 	}
153640909f66SGal Pressman 
153740909f66SGal Pressman 	params.pd = to_epd(ibpd)->pdn;
153840909f66SGal Pressman 	params.iova = virt_addr;
153940909f66SGal Pressman 	params.mr_length_in_bytes = length;
1540e6c4f3ffSDaniel Kranzdorf 	params.permissions = access_flags;
154140909f66SGal Pressman 
154240ddb3f0SGal Pressman 	pg_sz = ib_umem_find_best_pgsz(mr->umem,
154340ddb3f0SGal Pressman 				       dev->dev_attr.page_size_cap,
154440ddb3f0SGal Pressman 				       virt_addr);
154540ddb3f0SGal Pressman 	if (!pg_sz) {
154640ddb3f0SGal Pressman 		err = -EOPNOTSUPP;
154740ddb3f0SGal Pressman 		ibdev_dbg(&dev->ibdev, "Failed to find a suitable page size in page_size_cap %#llx\n",
154840ddb3f0SGal Pressman 			  dev->dev_attr.page_size_cap);
154940ddb3f0SGal Pressman 		goto err_unmap;
155040ddb3f0SGal Pressman 	}
155140ddb3f0SGal Pressman 
15521f9b6827SJason Gunthorpe 	params.page_shift = order_base_2(pg_sz);
15531f9b6827SJason Gunthorpe 	params.page_num = ib_umem_num_dma_blocks(mr->umem, pg_sz);
155440ddb3f0SGal Pressman 
155540909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
155640ddb3f0SGal Pressman 		  "start %#llx length %#llx params.page_shift %u params.page_num %u\n",
155740ddb3f0SGal Pressman 		  start, length, params.page_shift, params.page_num);
155840909f66SGal Pressman 
155940909f66SGal Pressman 	inline_size = ARRAY_SIZE(params.pbl.inline_pbl_array);
156040909f66SGal Pressman 	if (params.page_num <= inline_size) {
156140909f66SGal Pressman 		err = efa_create_inline_pbl(dev, mr, &params);
156240909f66SGal Pressman 		if (err)
156340909f66SGal Pressman 			goto err_unmap;
156440909f66SGal Pressman 
156540909f66SGal Pressman 		err = efa_com_register_mr(&dev->edev, &params, &result);
156640909f66SGal Pressman 		if (err)
156740909f66SGal Pressman 			goto err_unmap;
156840909f66SGal Pressman 	} else {
156940909f66SGal Pressman 		err = efa_create_pbl(dev, &pbl, mr, &params);
157040909f66SGal Pressman 		if (err)
157140909f66SGal Pressman 			goto err_unmap;
157240909f66SGal Pressman 
157340909f66SGal Pressman 		err = efa_com_register_mr(&dev->edev, &params, &result);
157440909f66SGal Pressman 		pbl_destroy(dev, &pbl);
157540909f66SGal Pressman 
157640909f66SGal Pressman 		if (err)
157740909f66SGal Pressman 			goto err_unmap;
157840909f66SGal Pressman 	}
157940909f66SGal Pressman 
158040909f66SGal Pressman 	mr->ibmr.lkey = result.l_key;
158140909f66SGal Pressman 	mr->ibmr.rkey = result.r_key;
158240909f66SGal Pressman 	mr->ibmr.length = length;
158340909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Registered mr[%d]\n", mr->ibmr.lkey);
158440909f66SGal Pressman 
158540909f66SGal Pressman 	return &mr->ibmr;
158640909f66SGal Pressman 
158740909f66SGal Pressman err_unmap:
158840909f66SGal Pressman 	ib_umem_release(mr->umem);
158940909f66SGal Pressman err_free:
159040909f66SGal Pressman 	kfree(mr);
159140909f66SGal Pressman err_out:
1592215b88acSGal Pressman 	atomic64_inc(&dev->stats.reg_mr_err);
159340909f66SGal Pressman 	return ERR_PTR(err);
159440909f66SGal Pressman }
159540909f66SGal Pressman 
159640909f66SGal Pressman int efa_dereg_mr(struct ib_mr *ibmr, struct ib_udata *udata)
159740909f66SGal Pressman {
159840909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibmr->device);
159940909f66SGal Pressman 	struct efa_com_dereg_mr_params params;
160040909f66SGal Pressman 	struct efa_mr *mr = to_emr(ibmr);
160140909f66SGal Pressman 	int err;
160240909f66SGal Pressman 
160340909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Deregister mr[%d]\n", ibmr->lkey);
160440909f66SGal Pressman 
160540909f66SGal Pressman 	params.l_key = mr->ibmr.lkey;
160640909f66SGal Pressman 	err = efa_com_dereg_mr(&dev->edev, &params);
160740909f66SGal Pressman 	if (err)
160840909f66SGal Pressman 		return err;
160940909f66SGal Pressman 
1610958b6813SGal Pressman 	ib_umem_release(mr->umem);
161140909f66SGal Pressman 	kfree(mr);
161240909f66SGal Pressman 
161340909f66SGal Pressman 	return 0;
161440909f66SGal Pressman }
161540909f66SGal Pressman 
161640909f66SGal Pressman int efa_get_port_immutable(struct ib_device *ibdev, u8 port_num,
161740909f66SGal Pressman 			   struct ib_port_immutable *immutable)
161840909f66SGal Pressman {
161940909f66SGal Pressman 	struct ib_port_attr attr;
162040909f66SGal Pressman 	int err;
162140909f66SGal Pressman 
162240909f66SGal Pressman 	err = ib_query_port(ibdev, port_num, &attr);
162340909f66SGal Pressman 	if (err) {
162440909f66SGal Pressman 		ibdev_dbg(ibdev, "Couldn't query port err[%d]\n", err);
162540909f66SGal Pressman 		return err;
162640909f66SGal Pressman 	}
162740909f66SGal Pressman 
162840909f66SGal Pressman 	immutable->pkey_tbl_len = attr.pkey_tbl_len;
162940909f66SGal Pressman 	immutable->gid_tbl_len = attr.gid_tbl_len;
163040909f66SGal Pressman 
163140909f66SGal Pressman 	return 0;
163240909f66SGal Pressman }
163340909f66SGal Pressman 
163440909f66SGal Pressman static int efa_dealloc_uar(struct efa_dev *dev, u16 uarn)
163540909f66SGal Pressman {
163640909f66SGal Pressman 	struct efa_com_dealloc_uar_params params = {
163740909f66SGal Pressman 		.uarn = uarn,
163840909f66SGal Pressman 	};
163940909f66SGal Pressman 
164040909f66SGal Pressman 	return efa_com_dealloc_uar(&dev->edev, &params);
164140909f66SGal Pressman }
164240909f66SGal Pressman 
1643a5d87b69SGal Pressman #define EFA_CHECK_USER_COMP(_dev, _comp_mask, _attr, _mask, _attr_str) \
1644a5d87b69SGal Pressman 	(_attr_str = (!(_dev)->dev_attr._attr || ((_comp_mask) & (_mask))) ? \
1645a5d87b69SGal Pressman 		     NULL : #_attr)
1646a5d87b69SGal Pressman 
1647a5d87b69SGal Pressman static int efa_user_comp_handshake(const struct ib_ucontext *ibucontext,
1648a5d87b69SGal Pressman 				   const struct efa_ibv_alloc_ucontext_cmd *cmd)
1649a5d87b69SGal Pressman {
1650a5d87b69SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
1651a5d87b69SGal Pressman 	char *attr_str;
1652a5d87b69SGal Pressman 
1653a5d87b69SGal Pressman 	if (EFA_CHECK_USER_COMP(dev, cmd->comp_mask, max_tx_batch,
1654a5d87b69SGal Pressman 				EFA_ALLOC_UCONTEXT_CMD_COMP_TX_BATCH, attr_str))
1655a5d87b69SGal Pressman 		goto err;
1656a5d87b69SGal Pressman 
1657a5d87b69SGal Pressman 	if (EFA_CHECK_USER_COMP(dev, cmd->comp_mask, min_sq_depth,
1658a5d87b69SGal Pressman 				EFA_ALLOC_UCONTEXT_CMD_COMP_MIN_SQ_WR,
1659a5d87b69SGal Pressman 				attr_str))
1660a5d87b69SGal Pressman 		goto err;
1661a5d87b69SGal Pressman 
1662a5d87b69SGal Pressman 	return 0;
1663a5d87b69SGal Pressman 
1664a5d87b69SGal Pressman err:
1665a5d87b69SGal Pressman 	ibdev_dbg(&dev->ibdev, "Userspace handshake failed for %s attribute\n",
1666a5d87b69SGal Pressman 		  attr_str);
1667a5d87b69SGal Pressman 	return -EOPNOTSUPP;
1668a5d87b69SGal Pressman }
1669a5d87b69SGal Pressman 
167040909f66SGal Pressman int efa_alloc_ucontext(struct ib_ucontext *ibucontext, struct ib_udata *udata)
167140909f66SGal Pressman {
167240909f66SGal Pressman 	struct efa_ucontext *ucontext = to_eucontext(ibucontext);
167340909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
167440909f66SGal Pressman 	struct efa_ibv_alloc_ucontext_resp resp = {};
1675a5d87b69SGal Pressman 	struct efa_ibv_alloc_ucontext_cmd cmd = {};
167640909f66SGal Pressman 	struct efa_com_alloc_uar_result result;
167740909f66SGal Pressman 	int err;
167840909f66SGal Pressman 
167940909f66SGal Pressman 	/*
168040909f66SGal Pressman 	 * it's fine if the driver does not know all request fields,
168140909f66SGal Pressman 	 * we will ack input fields in our response.
168240909f66SGal Pressman 	 */
168340909f66SGal Pressman 
1684a5d87b69SGal Pressman 	err = ib_copy_from_udata(&cmd, udata,
1685a5d87b69SGal Pressman 				 min(sizeof(cmd), udata->inlen));
1686a5d87b69SGal Pressman 	if (err) {
1687a5d87b69SGal Pressman 		ibdev_dbg(&dev->ibdev,
1688a5d87b69SGal Pressman 			  "Cannot copy udata for alloc_ucontext\n");
1689a5d87b69SGal Pressman 		goto err_out;
1690a5d87b69SGal Pressman 	}
1691a5d87b69SGal Pressman 
1692a5d87b69SGal Pressman 	err = efa_user_comp_handshake(ibucontext, &cmd);
1693a5d87b69SGal Pressman 	if (err)
1694a5d87b69SGal Pressman 		goto err_out;
1695a5d87b69SGal Pressman 
169640909f66SGal Pressman 	err = efa_com_alloc_uar(&dev->edev, &result);
169740909f66SGal Pressman 	if (err)
169840909f66SGal Pressman 		goto err_out;
169940909f66SGal Pressman 
170040909f66SGal Pressman 	ucontext->uarn = result.uarn;
170140909f66SGal Pressman 
170240909f66SGal Pressman 	resp.cmds_supp_udata_mask |= EFA_USER_CMDS_SUPP_UDATA_QUERY_DEVICE;
170340909f66SGal Pressman 	resp.cmds_supp_udata_mask |= EFA_USER_CMDS_SUPP_UDATA_CREATE_AH;
170440909f66SGal Pressman 	resp.sub_cqs_per_cq = dev->dev_attr.sub_cqs_per_cq;
170540909f66SGal Pressman 	resp.inline_buf_size = dev->dev_attr.inline_buf_size;
170640909f66SGal Pressman 	resp.max_llq_size = dev->dev_attr.max_llq_size;
1707556c811fSGal Pressman 	resp.max_tx_batch = dev->dev_attr.max_tx_batch;
1708da2924bdSGal Pressman 	resp.min_sq_wr = dev->dev_attr.min_sq_depth;
170940909f66SGal Pressman 
171040909f66SGal Pressman 	err = ib_copy_to_udata(udata, &resp,
171140909f66SGal Pressman 			       min(sizeof(resp), udata->outlen));
171240909f66SGal Pressman 	if (err)
171340909f66SGal Pressman 		goto err_dealloc_uar;
171440909f66SGal Pressman 
171540909f66SGal Pressman 	return 0;
171640909f66SGal Pressman 
171740909f66SGal Pressman err_dealloc_uar:
171840909f66SGal Pressman 	efa_dealloc_uar(dev, result.uarn);
171940909f66SGal Pressman err_out:
1720215b88acSGal Pressman 	atomic64_inc(&dev->stats.alloc_ucontext_err);
172140909f66SGal Pressman 	return err;
172240909f66SGal Pressman }
172340909f66SGal Pressman 
172440909f66SGal Pressman void efa_dealloc_ucontext(struct ib_ucontext *ibucontext)
172540909f66SGal Pressman {
172640909f66SGal Pressman 	struct efa_ucontext *ucontext = to_eucontext(ibucontext);
172740909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
172840909f66SGal Pressman 
172940909f66SGal Pressman 	efa_dealloc_uar(dev, ucontext->uarn);
173040909f66SGal Pressman }
173140909f66SGal Pressman 
1732e84d3c18SMichal Kalderon void efa_mmap_free(struct rdma_user_mmap_entry *rdma_entry)
173340909f66SGal Pressman {
1734e84d3c18SMichal Kalderon 	struct efa_user_mmap_entry *entry = to_emmap(rdma_entry);
173540909f66SGal Pressman 
1736e84d3c18SMichal Kalderon 	kfree(entry);
173740909f66SGal Pressman }
173840909f66SGal Pressman 
1739e84d3c18SMichal Kalderon static int __efa_mmap(struct efa_dev *dev, struct efa_ucontext *ucontext,
1740e84d3c18SMichal Kalderon 		      struct vm_area_struct *vma)
1741e84d3c18SMichal Kalderon {
1742e84d3c18SMichal Kalderon 	struct rdma_user_mmap_entry *rdma_entry;
1743e84d3c18SMichal Kalderon 	struct efa_user_mmap_entry *entry;
1744e84d3c18SMichal Kalderon 	unsigned long va;
1745e84d3c18SMichal Kalderon 	int err = 0;
1746e84d3c18SMichal Kalderon 	u64 pfn;
1747e84d3c18SMichal Kalderon 
1748e84d3c18SMichal Kalderon 	rdma_entry = rdma_user_mmap_entry_get(&ucontext->ibucontext, vma);
1749e84d3c18SMichal Kalderon 	if (!rdma_entry) {
175040909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
1751e84d3c18SMichal Kalderon 			  "pgoff[%#lx] does not have valid entry\n",
1752e84d3c18SMichal Kalderon 			  vma->vm_pgoff);
1753215b88acSGal Pressman 		atomic64_inc(&dev->stats.mmap_err);
1754e84d3c18SMichal Kalderon 		return -EINVAL;
1755e84d3c18SMichal Kalderon 	}
1756e84d3c18SMichal Kalderon 	entry = to_emmap(rdma_entry);
1757e84d3c18SMichal Kalderon 
1758e84d3c18SMichal Kalderon 	ibdev_dbg(&dev->ibdev,
1759e84d3c18SMichal Kalderon 		  "Mapping address[%#llx], length[%#zx], mmap_flag[%d]\n",
1760e84d3c18SMichal Kalderon 		  entry->address, rdma_entry->npages * PAGE_SIZE,
1761e84d3c18SMichal Kalderon 		  entry->mmap_flag);
176240909f66SGal Pressman 
176340909f66SGal Pressman 	pfn = entry->address >> PAGE_SHIFT;
176440909f66SGal Pressman 	switch (entry->mmap_flag) {
176540909f66SGal Pressman 	case EFA_MMAP_IO_NC:
1766e84d3c18SMichal Kalderon 		err = rdma_user_mmap_io(&ucontext->ibucontext, vma, pfn,
1767e84d3c18SMichal Kalderon 					entry->rdma_entry.npages * PAGE_SIZE,
1768c043ff2cSMichal Kalderon 					pgprot_noncached(vma->vm_page_prot),
1769e84d3c18SMichal Kalderon 					rdma_entry);
177040909f66SGal Pressman 		break;
177140909f66SGal Pressman 	case EFA_MMAP_IO_WC:
1772e84d3c18SMichal Kalderon 		err = rdma_user_mmap_io(&ucontext->ibucontext, vma, pfn,
1773e84d3c18SMichal Kalderon 					entry->rdma_entry.npages * PAGE_SIZE,
1774c043ff2cSMichal Kalderon 					pgprot_writecombine(vma->vm_page_prot),
1775e84d3c18SMichal Kalderon 					rdma_entry);
177640909f66SGal Pressman 		break;
177740909f66SGal Pressman 	case EFA_MMAP_DMA_PAGE:
177840909f66SGal Pressman 		for (va = vma->vm_start; va < vma->vm_end;
177940909f66SGal Pressman 		     va += PAGE_SIZE, pfn++) {
178040909f66SGal Pressman 			err = vm_insert_page(vma, va, pfn_to_page(pfn));
178140909f66SGal Pressman 			if (err)
178240909f66SGal Pressman 				break;
178340909f66SGal Pressman 		}
178440909f66SGal Pressman 		break;
178540909f66SGal Pressman 	default:
178640909f66SGal Pressman 		err = -EINVAL;
178740909f66SGal Pressman 	}
178840909f66SGal Pressman 
1789eca5757fSGal Pressman 	if (err) {
179040909f66SGal Pressman 		ibdev_dbg(
179140909f66SGal Pressman 			&dev->ibdev,
1792e84d3c18SMichal Kalderon 			"Couldn't mmap address[%#llx] length[%#zx] mmap_flag[%d] err[%d]\n",
1793e84d3c18SMichal Kalderon 			entry->address, rdma_entry->npages * PAGE_SIZE,
1794e84d3c18SMichal Kalderon 			entry->mmap_flag, err);
1795215b88acSGal Pressman 		atomic64_inc(&dev->stats.mmap_err);
1796eca5757fSGal Pressman 	}
179740909f66SGal Pressman 
1798e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_put(rdma_entry);
1799e84d3c18SMichal Kalderon 	return err;
1800b41f7572SGal Pressman }
1801b41f7572SGal Pressman 
180240909f66SGal Pressman int efa_mmap(struct ib_ucontext *ibucontext,
180340909f66SGal Pressman 	     struct vm_area_struct *vma)
180440909f66SGal Pressman {
180540909f66SGal Pressman 	struct efa_ucontext *ucontext = to_eucontext(ibucontext);
180640909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
1807e84d3c18SMichal Kalderon 	size_t length = vma->vm_end - vma->vm_start;
180840909f66SGal Pressman 
180940909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
1810e84d3c18SMichal Kalderon 		  "start %#lx, end %#lx, length = %#zx, pgoff = %#lx\n",
1811e84d3c18SMichal Kalderon 		  vma->vm_start, vma->vm_end, length, vma->vm_pgoff);
181240909f66SGal Pressman 
1813e84d3c18SMichal Kalderon 	return __efa_mmap(dev, ucontext, vma);
181440909f66SGal Pressman }
181540909f66SGal Pressman 
181640909f66SGal Pressman static int efa_ah_destroy(struct efa_dev *dev, struct efa_ah *ah)
181740909f66SGal Pressman {
181840909f66SGal Pressman 	struct efa_com_destroy_ah_params params = {
181940909f66SGal Pressman 		.ah = ah->ah,
182040909f66SGal Pressman 		.pdn = to_epd(ah->ibah.pd)->pdn,
182140909f66SGal Pressman 	};
182240909f66SGal Pressman 
182340909f66SGal Pressman 	return efa_com_destroy_ah(&dev->edev, &params);
182440909f66SGal Pressman }
182540909f66SGal Pressman 
182640909f66SGal Pressman int efa_create_ah(struct ib_ah *ibah,
1827fa5d010cSMaor Gottlieb 		  struct rdma_ah_init_attr *init_attr,
182840909f66SGal Pressman 		  struct ib_udata *udata)
182940909f66SGal Pressman {
1830fa5d010cSMaor Gottlieb 	struct rdma_ah_attr *ah_attr = init_attr->ah_attr;
183140909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibah->device);
183240909f66SGal Pressman 	struct efa_com_create_ah_params params = {};
183340909f66SGal Pressman 	struct efa_ibv_create_ah_resp resp = {};
183440909f66SGal Pressman 	struct efa_com_create_ah_result result;
183540909f66SGal Pressman 	struct efa_ah *ah = to_eah(ibah);
183640909f66SGal Pressman 	int err;
183740909f66SGal Pressman 
1838fa5d010cSMaor Gottlieb 	if (!(init_attr->flags & RDMA_CREATE_AH_SLEEPABLE)) {
183940909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
184040909f66SGal Pressman 			  "Create address handle is not supported in atomic context\n");
184140909f66SGal Pressman 		err = -EOPNOTSUPP;
184240909f66SGal Pressman 		goto err_out;
184340909f66SGal Pressman 	}
184440909f66SGal Pressman 
184540909f66SGal Pressman 	if (udata->inlen &&
184640909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, udata->inlen)) {
184740909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Incompatible ABI params\n");
184840909f66SGal Pressman 		err = -EINVAL;
184940909f66SGal Pressman 		goto err_out;
185040909f66SGal Pressman 	}
185140909f66SGal Pressman 
185240909f66SGal Pressman 	memcpy(params.dest_addr, ah_attr->grh.dgid.raw,
185340909f66SGal Pressman 	       sizeof(params.dest_addr));
185440909f66SGal Pressman 	params.pdn = to_epd(ibah->pd)->pdn;
185540909f66SGal Pressman 	err = efa_com_create_ah(&dev->edev, &params, &result);
185640909f66SGal Pressman 	if (err)
185740909f66SGal Pressman 		goto err_out;
185840909f66SGal Pressman 
185940909f66SGal Pressman 	memcpy(ah->id, ah_attr->grh.dgid.raw, sizeof(ah->id));
186040909f66SGal Pressman 	ah->ah = result.ah;
186140909f66SGal Pressman 
186240909f66SGal Pressman 	resp.efa_address_handle = result.ah;
186340909f66SGal Pressman 
186440909f66SGal Pressman 	if (udata->outlen) {
186540909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
186640909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
186740909f66SGal Pressman 		if (err) {
186840909f66SGal Pressman 			ibdev_dbg(&dev->ibdev,
186940909f66SGal Pressman 				  "Failed to copy udata for create_ah response\n");
187040909f66SGal Pressman 			goto err_destroy_ah;
187140909f66SGal Pressman 		}
187240909f66SGal Pressman 	}
187340909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Created ah[%d]\n", ah->ah);
187440909f66SGal Pressman 
187540909f66SGal Pressman 	return 0;
187640909f66SGal Pressman 
187740909f66SGal Pressman err_destroy_ah:
187840909f66SGal Pressman 	efa_ah_destroy(dev, ah);
187940909f66SGal Pressman err_out:
1880215b88acSGal Pressman 	atomic64_inc(&dev->stats.create_ah_err);
188140909f66SGal Pressman 	return err;
188240909f66SGal Pressman }
188340909f66SGal Pressman 
18849a9ebf8cSLeon Romanovsky int efa_destroy_ah(struct ib_ah *ibah, u32 flags)
188540909f66SGal Pressman {
188640909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibah->pd->device);
188740909f66SGal Pressman 	struct efa_ah *ah = to_eah(ibah);
188840909f66SGal Pressman 
188940909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Destroy ah[%d]\n", ah->ah);
189040909f66SGal Pressman 
189140909f66SGal Pressman 	if (!(flags & RDMA_DESTROY_AH_SLEEPABLE)) {
189240909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
189340909f66SGal Pressman 			  "Destroy address handle is not supported in atomic context\n");
18949a9ebf8cSLeon Romanovsky 		return -EOPNOTSUPP;
189540909f66SGal Pressman 	}
189640909f66SGal Pressman 
189740909f66SGal Pressman 	efa_ah_destroy(dev, ah);
18989a9ebf8cSLeon Romanovsky 	return 0;
189940909f66SGal Pressman }
190040909f66SGal Pressman 
190116e9111eSGal Pressman struct rdma_hw_stats *efa_alloc_hw_stats(struct ib_device *ibdev, u8 port_num)
190216e9111eSGal Pressman {
190316e9111eSGal Pressman 	return rdma_alloc_hw_stats_struct(efa_stats_names,
190416e9111eSGal Pressman 					  ARRAY_SIZE(efa_stats_names),
190516e9111eSGal Pressman 					  RDMA_HW_STATS_DEFAULT_LIFESPAN);
190616e9111eSGal Pressman }
190716e9111eSGal Pressman 
190816e9111eSGal Pressman int efa_get_hw_stats(struct ib_device *ibdev, struct rdma_hw_stats *stats,
190916e9111eSGal Pressman 		     u8 port_num, int index)
191016e9111eSGal Pressman {
191116e9111eSGal Pressman 	struct efa_com_get_stats_params params = {};
191216e9111eSGal Pressman 	union efa_com_get_stats_result result;
191316e9111eSGal Pressman 	struct efa_dev *dev = to_edev(ibdev);
1914b0cff387SDaniel Kranzdorf 	struct efa_com_rdma_read_stats *rrs;
1915b0cff387SDaniel Kranzdorf 	struct efa_com_messages_stats *ms;
191616e9111eSGal Pressman 	struct efa_com_basic_stats *bs;
191716e9111eSGal Pressman 	struct efa_com_stats_admin *as;
191816e9111eSGal Pressman 	struct efa_stats *s;
191916e9111eSGal Pressman 	int err;
192016e9111eSGal Pressman 
192116e9111eSGal Pressman 	params.scope = EFA_ADMIN_GET_STATS_SCOPE_ALL;
1922b0cff387SDaniel Kranzdorf 	params.type = EFA_ADMIN_GET_STATS_TYPE_BASIC;
192316e9111eSGal Pressman 
192416e9111eSGal Pressman 	err = efa_com_get_stats(&dev->edev, &params, &result);
192516e9111eSGal Pressman 	if (err)
192616e9111eSGal Pressman 		return err;
192716e9111eSGal Pressman 
192816e9111eSGal Pressman 	bs = &result.basic_stats;
192916e9111eSGal Pressman 	stats->value[EFA_TX_BYTES] = bs->tx_bytes;
193016e9111eSGal Pressman 	stats->value[EFA_TX_PKTS] = bs->tx_pkts;
193116e9111eSGal Pressman 	stats->value[EFA_RX_BYTES] = bs->rx_bytes;
193216e9111eSGal Pressman 	stats->value[EFA_RX_PKTS] = bs->rx_pkts;
193316e9111eSGal Pressman 	stats->value[EFA_RX_DROPS] = bs->rx_drops;
193416e9111eSGal Pressman 
1935b0cff387SDaniel Kranzdorf 	params.type = EFA_ADMIN_GET_STATS_TYPE_MESSAGES;
1936b0cff387SDaniel Kranzdorf 	err = efa_com_get_stats(&dev->edev, &params, &result);
1937b0cff387SDaniel Kranzdorf 	if (err)
1938b0cff387SDaniel Kranzdorf 		return err;
1939b0cff387SDaniel Kranzdorf 
1940b0cff387SDaniel Kranzdorf 	ms = &result.messages_stats;
1941b0cff387SDaniel Kranzdorf 	stats->value[EFA_SEND_BYTES] = ms->send_bytes;
1942b0cff387SDaniel Kranzdorf 	stats->value[EFA_SEND_WRS] = ms->send_wrs;
1943b0cff387SDaniel Kranzdorf 	stats->value[EFA_RECV_BYTES] = ms->recv_bytes;
1944b0cff387SDaniel Kranzdorf 	stats->value[EFA_RECV_WRS] = ms->recv_wrs;
1945b0cff387SDaniel Kranzdorf 
1946b0cff387SDaniel Kranzdorf 	params.type = EFA_ADMIN_GET_STATS_TYPE_RDMA_READ;
1947b0cff387SDaniel Kranzdorf 	err = efa_com_get_stats(&dev->edev, &params, &result);
1948b0cff387SDaniel Kranzdorf 	if (err)
1949b0cff387SDaniel Kranzdorf 		return err;
1950b0cff387SDaniel Kranzdorf 
1951b0cff387SDaniel Kranzdorf 	rrs = &result.rdma_read_stats;
1952b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_WRS] = rrs->read_wrs;
1953b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_BYTES] = rrs->read_bytes;
1954b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_WR_ERR] = rrs->read_wr_err;
1955b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_RESP_BYTES] = rrs->read_resp_bytes;
1956b0cff387SDaniel Kranzdorf 
195716e9111eSGal Pressman 	as = &dev->edev.aq.stats;
195816e9111eSGal Pressman 	stats->value[EFA_SUBMITTED_CMDS] = atomic64_read(&as->submitted_cmd);
195916e9111eSGal Pressman 	stats->value[EFA_COMPLETED_CMDS] = atomic64_read(&as->completed_cmd);
1960f86e3437SGal Pressman 	stats->value[EFA_CMDS_ERR] = atomic64_read(&as->cmd_err);
196116e9111eSGal Pressman 	stats->value[EFA_NO_COMPLETION_CMDS] = atomic64_read(&as->no_completion);
196216e9111eSGal Pressman 
196316e9111eSGal Pressman 	s = &dev->stats;
196416e9111eSGal Pressman 	stats->value[EFA_KEEP_ALIVE_RCVD] = atomic64_read(&s->keep_alive_rcvd);
1965215b88acSGal Pressman 	stats->value[EFA_ALLOC_PD_ERR] = atomic64_read(&s->alloc_pd_err);
1966215b88acSGal Pressman 	stats->value[EFA_CREATE_QP_ERR] = atomic64_read(&s->create_qp_err);
1967215b88acSGal Pressman 	stats->value[EFA_CREATE_CQ_ERR] = atomic64_read(&s->create_cq_err);
1968215b88acSGal Pressman 	stats->value[EFA_REG_MR_ERR] = atomic64_read(&s->reg_mr_err);
1969215b88acSGal Pressman 	stats->value[EFA_ALLOC_UCONTEXT_ERR] =
1970215b88acSGal Pressman 		atomic64_read(&s->alloc_ucontext_err);
1971215b88acSGal Pressman 	stats->value[EFA_CREATE_AH_ERR] = atomic64_read(&s->create_ah_err);
1972215b88acSGal Pressman 	stats->value[EFA_MMAP_ERR] = atomic64_read(&s->mmap_err);
197316e9111eSGal Pressman 
197416e9111eSGal Pressman 	return ARRAY_SIZE(efa_stats_names);
197516e9111eSGal Pressman }
197616e9111eSGal Pressman 
197740909f66SGal Pressman enum rdma_link_layer efa_port_link_layer(struct ib_device *ibdev,
197840909f66SGal Pressman 					 u8 port_num)
197940909f66SGal Pressman {
198040909f66SGal Pressman 	return IB_LINK_LAYER_UNSPECIFIED;
198140909f66SGal Pressman }
198240909f66SGal Pressman 
1983