xref: /openbmc/linux/drivers/infiniband/hw/efa/efa_verbs.c (revision 514aee660df493cd673154a6ba6bab745ec47b8c)
140909f66SGal Pressman // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
240909f66SGal Pressman /*
38c1b4316SGal Pressman  * Copyright 2018-2021 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 
338c1b4316SGal Pressman #define EFA_DEFINE_DEVICE_STATS(op) \
3416e9111eSGal Pressman 	op(EFA_SUBMITTED_CMDS, "submitted_cmds") \
3516e9111eSGal Pressman 	op(EFA_COMPLETED_CMDS, "completed_cmds") \
36f86e3437SGal Pressman 	op(EFA_CMDS_ERR, "cmds_err") \
3716e9111eSGal Pressman 	op(EFA_NO_COMPLETION_CMDS, "no_completion_cmds") \
3816e9111eSGal Pressman 	op(EFA_KEEP_ALIVE_RCVD, "keep_alive_rcvd") \
3916e9111eSGal Pressman 	op(EFA_ALLOC_PD_ERR, "alloc_pd_err") \
4016e9111eSGal Pressman 	op(EFA_CREATE_QP_ERR, "create_qp_err") \
41b2ea69b3SGal Pressman 	op(EFA_CREATE_CQ_ERR, "create_cq_err") \
4216e9111eSGal Pressman 	op(EFA_REG_MR_ERR, "reg_mr_err") \
4316e9111eSGal Pressman 	op(EFA_ALLOC_UCONTEXT_ERR, "alloc_ucontext_err") \
44eca5757fSGal Pressman 	op(EFA_CREATE_AH_ERR, "create_ah_err") \
45eca5757fSGal Pressman 	op(EFA_MMAP_ERR, "mmap_err")
4616e9111eSGal Pressman 
478c1b4316SGal Pressman #define EFA_DEFINE_PORT_STATS(op) \
488c1b4316SGal Pressman 	op(EFA_TX_BYTES, "tx_bytes") \
498c1b4316SGal Pressman 	op(EFA_TX_PKTS, "tx_pkts") \
508c1b4316SGal Pressman 	op(EFA_RX_BYTES, "rx_bytes") \
518c1b4316SGal Pressman 	op(EFA_RX_PKTS, "rx_pkts") \
528c1b4316SGal Pressman 	op(EFA_RX_DROPS, "rx_drops") \
538c1b4316SGal Pressman 	op(EFA_SEND_BYTES, "send_bytes") \
548c1b4316SGal Pressman 	op(EFA_SEND_WRS, "send_wrs") \
558c1b4316SGal Pressman 	op(EFA_RECV_BYTES, "recv_bytes") \
568c1b4316SGal Pressman 	op(EFA_RECV_WRS, "recv_wrs") \
578c1b4316SGal Pressman 	op(EFA_RDMA_READ_WRS, "rdma_read_wrs") \
588c1b4316SGal Pressman 	op(EFA_RDMA_READ_BYTES, "rdma_read_bytes") \
598c1b4316SGal Pressman 	op(EFA_RDMA_READ_WR_ERR, "rdma_read_wr_err") \
608c1b4316SGal Pressman 	op(EFA_RDMA_READ_RESP_BYTES, "rdma_read_resp_bytes") \
618c1b4316SGal Pressman 
6216e9111eSGal Pressman #define EFA_STATS_ENUM(ename, name) ename,
6316e9111eSGal Pressman #define EFA_STATS_STR(ename, name) [ename] = name,
6416e9111eSGal Pressman 
658c1b4316SGal Pressman enum efa_hw_device_stats {
668c1b4316SGal Pressman 	EFA_DEFINE_DEVICE_STATS(EFA_STATS_ENUM)
6716e9111eSGal Pressman };
6816e9111eSGal Pressman 
698c1b4316SGal Pressman static const char *const efa_device_stats_names[] = {
708c1b4316SGal Pressman 	EFA_DEFINE_DEVICE_STATS(EFA_STATS_STR)
718c1b4316SGal Pressman };
728c1b4316SGal Pressman 
738c1b4316SGal Pressman enum efa_hw_port_stats {
748c1b4316SGal Pressman 	EFA_DEFINE_PORT_STATS(EFA_STATS_ENUM)
758c1b4316SGal Pressman };
768c1b4316SGal Pressman 
778c1b4316SGal Pressman static const char *const efa_port_stats_names[] = {
788c1b4316SGal Pressman 	EFA_DEFINE_PORT_STATS(EFA_STATS_STR)
7916e9111eSGal Pressman };
8016e9111eSGal Pressman 
8140909f66SGal Pressman #define EFA_CHUNK_PAYLOAD_SHIFT       12
8240909f66SGal Pressman #define EFA_CHUNK_PAYLOAD_SIZE        BIT(EFA_CHUNK_PAYLOAD_SHIFT)
8340909f66SGal Pressman #define EFA_CHUNK_PAYLOAD_PTR_SIZE    8
8440909f66SGal Pressman 
8540909f66SGal Pressman #define EFA_CHUNK_SHIFT               12
8640909f66SGal Pressman #define EFA_CHUNK_SIZE                BIT(EFA_CHUNK_SHIFT)
8740909f66SGal Pressman #define EFA_CHUNK_PTR_SIZE            sizeof(struct efa_com_ctrl_buff_info)
8840909f66SGal Pressman 
8940909f66SGal Pressman #define EFA_PTRS_PER_CHUNK \
9040909f66SGal Pressman 	((EFA_CHUNK_SIZE - EFA_CHUNK_PTR_SIZE) / EFA_CHUNK_PAYLOAD_PTR_SIZE)
9140909f66SGal Pressman 
9240909f66SGal Pressman #define EFA_CHUNK_USED_SIZE \
9340909f66SGal Pressman 	((EFA_PTRS_PER_CHUNK * EFA_CHUNK_PAYLOAD_PTR_SIZE) + EFA_CHUNK_PTR_SIZE)
9440909f66SGal Pressman 
9540909f66SGal Pressman struct pbl_chunk {
9640909f66SGal Pressman 	dma_addr_t dma_addr;
9740909f66SGal Pressman 	u64 *buf;
9840909f66SGal Pressman 	u32 length;
9940909f66SGal Pressman };
10040909f66SGal Pressman 
10140909f66SGal Pressman struct pbl_chunk_list {
10240909f66SGal Pressman 	struct pbl_chunk *chunks;
10340909f66SGal Pressman 	unsigned int size;
10440909f66SGal Pressman };
10540909f66SGal Pressman 
10640909f66SGal Pressman struct pbl_context {
10740909f66SGal Pressman 	union {
10840909f66SGal Pressman 		struct {
10940909f66SGal Pressman 			dma_addr_t dma_addr;
11040909f66SGal Pressman 		} continuous;
11140909f66SGal Pressman 		struct {
11240909f66SGal Pressman 			u32 pbl_buf_size_in_pages;
11340909f66SGal Pressman 			struct scatterlist *sgl;
11440909f66SGal Pressman 			int sg_dma_cnt;
11540909f66SGal Pressman 			struct pbl_chunk_list chunk_list;
11640909f66SGal Pressman 		} indirect;
11740909f66SGal Pressman 	} phys;
11840909f66SGal Pressman 	u64 *pbl_buf;
11940909f66SGal Pressman 	u32 pbl_buf_size_in_bytes;
12040909f66SGal Pressman 	u8 physically_continuous;
12140909f66SGal Pressman };
12240909f66SGal Pressman 
12340909f66SGal Pressman static inline struct efa_dev *to_edev(struct ib_device *ibdev)
12440909f66SGal Pressman {
12540909f66SGal Pressman 	return container_of(ibdev, struct efa_dev, ibdev);
12640909f66SGal Pressman }
12740909f66SGal Pressman 
12840909f66SGal Pressman static inline struct efa_ucontext *to_eucontext(struct ib_ucontext *ibucontext)
12940909f66SGal Pressman {
13040909f66SGal Pressman 	return container_of(ibucontext, struct efa_ucontext, ibucontext);
13140909f66SGal Pressman }
13240909f66SGal Pressman 
13340909f66SGal Pressman static inline struct efa_pd *to_epd(struct ib_pd *ibpd)
13440909f66SGal Pressman {
13540909f66SGal Pressman 	return container_of(ibpd, struct efa_pd, ibpd);
13640909f66SGal Pressman }
13740909f66SGal Pressman 
13840909f66SGal Pressman static inline struct efa_mr *to_emr(struct ib_mr *ibmr)
13940909f66SGal Pressman {
14040909f66SGal Pressman 	return container_of(ibmr, struct efa_mr, ibmr);
14140909f66SGal Pressman }
14240909f66SGal Pressman 
14340909f66SGal Pressman static inline struct efa_qp *to_eqp(struct ib_qp *ibqp)
14440909f66SGal Pressman {
14540909f66SGal Pressman 	return container_of(ibqp, struct efa_qp, ibqp);
14640909f66SGal Pressman }
14740909f66SGal Pressman 
14840909f66SGal Pressman static inline struct efa_cq *to_ecq(struct ib_cq *ibcq)
14940909f66SGal Pressman {
15040909f66SGal Pressman 	return container_of(ibcq, struct efa_cq, ibcq);
15140909f66SGal Pressman }
15240909f66SGal Pressman 
15340909f66SGal Pressman static inline struct efa_ah *to_eah(struct ib_ah *ibah)
15440909f66SGal Pressman {
15540909f66SGal Pressman 	return container_of(ibah, struct efa_ah, ibah);
15640909f66SGal Pressman }
15740909f66SGal Pressman 
158e84d3c18SMichal Kalderon static inline struct efa_user_mmap_entry *
159e84d3c18SMichal Kalderon to_emmap(struct rdma_user_mmap_entry *rdma_entry)
160e84d3c18SMichal Kalderon {
161e84d3c18SMichal Kalderon 	return container_of(rdma_entry, struct efa_user_mmap_entry, rdma_entry);
162e84d3c18SMichal Kalderon }
163e84d3c18SMichal Kalderon 
16434eb009fSGal Pressman #define EFA_DEV_CAP(dev, cap) \
16534eb009fSGal Pressman 	((dev)->dev_attr.device_caps & \
16634eb009fSGal Pressman 	 EFA_ADMIN_FEATURE_DEVICE_ATTR_DESC_##cap##_MASK)
167666e8ff5SDaniel Kranzdorf 
16840909f66SGal Pressman #define is_reserved_cleared(reserved) \
16940909f66SGal Pressman 	!memchr_inv(reserved, 0, sizeof(reserved))
17040909f66SGal Pressman 
17140909f66SGal Pressman static void *efa_zalloc_mapped(struct efa_dev *dev, dma_addr_t *dma_addr,
17240909f66SGal Pressman 			       size_t size, enum dma_data_direction dir)
17340909f66SGal Pressman {
17440909f66SGal Pressman 	void *addr;
17540909f66SGal Pressman 
17640909f66SGal Pressman 	addr = alloc_pages_exact(size, GFP_KERNEL | __GFP_ZERO);
17740909f66SGal Pressman 	if (!addr)
17840909f66SGal Pressman 		return NULL;
17940909f66SGal Pressman 
18040909f66SGal Pressman 	*dma_addr = dma_map_single(&dev->pdev->dev, addr, size, dir);
18140909f66SGal Pressman 	if (dma_mapping_error(&dev->pdev->dev, *dma_addr)) {
18240909f66SGal Pressman 		ibdev_err(&dev->ibdev, "Failed to map DMA address\n");
18340909f66SGal Pressman 		free_pages_exact(addr, size);
18440909f66SGal Pressman 		return NULL;
18540909f66SGal Pressman 	}
18640909f66SGal Pressman 
18740909f66SGal Pressman 	return addr;
18840909f66SGal Pressman }
18940909f66SGal Pressman 
190ff6629f8SGal Pressman static void efa_free_mapped(struct efa_dev *dev, void *cpu_addr,
191ff6629f8SGal Pressman 			    dma_addr_t dma_addr,
192ff6629f8SGal Pressman 			    size_t size, enum dma_data_direction dir)
193ff6629f8SGal Pressman {
194ff6629f8SGal Pressman 	dma_unmap_single(&dev->pdev->dev, dma_addr, size, dir);
195ff6629f8SGal Pressman 	free_pages_exact(cpu_addr, size);
196ff6629f8SGal Pressman }
197ff6629f8SGal Pressman 
19840909f66SGal Pressman int efa_query_device(struct ib_device *ibdev,
19940909f66SGal Pressman 		     struct ib_device_attr *props,
20040909f66SGal Pressman 		     struct ib_udata *udata)
20140909f66SGal Pressman {
20240909f66SGal Pressman 	struct efa_com_get_device_attr_result *dev_attr;
20340909f66SGal Pressman 	struct efa_ibv_ex_query_device_resp resp = {};
20440909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibdev);
20540909f66SGal Pressman 	int err;
20640909f66SGal Pressman 
20740909f66SGal Pressman 	if (udata && udata->inlen &&
20840909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, udata->inlen)) {
20940909f66SGal Pressman 		ibdev_dbg(ibdev,
21040909f66SGal Pressman 			  "Incompatible ABI params, udata not cleared\n");
21140909f66SGal Pressman 		return -EINVAL;
21240909f66SGal Pressman 	}
21340909f66SGal Pressman 
21440909f66SGal Pressman 	dev_attr = &dev->dev_attr;
21540909f66SGal Pressman 
21640909f66SGal Pressman 	memset(props, 0, sizeof(*props));
21740909f66SGal Pressman 	props->max_mr_size = dev_attr->max_mr_pages * PAGE_SIZE;
21840909f66SGal Pressman 	props->page_size_cap = dev_attr->page_size_cap;
21940909f66SGal Pressman 	props->vendor_id = dev->pdev->vendor;
22040909f66SGal Pressman 	props->vendor_part_id = dev->pdev->device;
22140909f66SGal Pressman 	props->hw_ver = dev->pdev->subsystem_device;
22240909f66SGal Pressman 	props->max_qp = dev_attr->max_qp;
22340909f66SGal Pressman 	props->max_cq = dev_attr->max_cq;
22440909f66SGal Pressman 	props->max_pd = dev_attr->max_pd;
22540909f66SGal Pressman 	props->max_mr = dev_attr->max_mr;
22640909f66SGal Pressman 	props->max_ah = dev_attr->max_ah;
22740909f66SGal Pressman 	props->max_cqe = dev_attr->max_cq_depth;
22840909f66SGal Pressman 	props->max_qp_wr = min_t(u32, dev_attr->max_sq_depth,
22940909f66SGal Pressman 				 dev_attr->max_rq_depth);
23040909f66SGal Pressman 	props->max_send_sge = dev_attr->max_sq_sge;
23140909f66SGal Pressman 	props->max_recv_sge = dev_attr->max_rq_sge;
232666e8ff5SDaniel Kranzdorf 	props->max_sge_rd = dev_attr->max_wr_rdma_sge;
2330133654dSGal Pressman 	props->max_pkeys = 1;
23440909f66SGal Pressman 
23540909f66SGal Pressman 	if (udata && udata->outlen) {
23640909f66SGal Pressman 		resp.max_sq_sge = dev_attr->max_sq_sge;
23740909f66SGal Pressman 		resp.max_rq_sge = dev_attr->max_rq_sge;
23840909f66SGal Pressman 		resp.max_sq_wr = dev_attr->max_sq_depth;
23940909f66SGal Pressman 		resp.max_rq_wr = dev_attr->max_rq_depth;
240666e8ff5SDaniel Kranzdorf 		resp.max_rdma_size = dev_attr->max_rdma_size;
241666e8ff5SDaniel Kranzdorf 
24234eb009fSGal Pressman 		if (EFA_DEV_CAP(dev, RDMA_READ))
243666e8ff5SDaniel Kranzdorf 			resp.device_caps |= EFA_QUERY_DEVICE_CAPS_RDMA_READ;
24440909f66SGal Pressman 
245a4e6a1ddSGal Pressman 		if (EFA_DEV_CAP(dev, RNR_RETRY))
246a4e6a1ddSGal Pressman 			resp.device_caps |= EFA_QUERY_DEVICE_CAPS_RNR_RETRY;
247a4e6a1ddSGal Pressman 
24840909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
24940909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
25040909f66SGal Pressman 		if (err) {
25140909f66SGal Pressman 			ibdev_dbg(ibdev,
25240909f66SGal Pressman 				  "Failed to copy udata for query_device\n");
25340909f66SGal Pressman 			return err;
25440909f66SGal Pressman 		}
25540909f66SGal Pressman 	}
25640909f66SGal Pressman 
25740909f66SGal Pressman 	return 0;
25840909f66SGal Pressman }
25940909f66SGal Pressman 
2601fb7f897SMark Bloch int efa_query_port(struct ib_device *ibdev, u32 port,
26140909f66SGal Pressman 		   struct ib_port_attr *props)
26240909f66SGal Pressman {
26340909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibdev);
26440909f66SGal Pressman 
26540909f66SGal Pressman 	props->lmc = 1;
26640909f66SGal Pressman 
26740909f66SGal Pressman 	props->state = IB_PORT_ACTIVE;
26872a7720fSKamal Heib 	props->phys_state = IB_PORT_PHYS_STATE_LINK_UP;
26940909f66SGal Pressman 	props->gid_tbl_len = 1;
27040909f66SGal Pressman 	props->pkey_tbl_len = 1;
27140909f66SGal Pressman 	props->active_speed = IB_SPEED_EDR;
27240909f66SGal Pressman 	props->active_width = IB_WIDTH_4X;
273bcf7cc53SGal Pressman 	props->max_mtu = ib_mtu_int_to_enum(dev->dev_attr.mtu);
274bcf7cc53SGal Pressman 	props->active_mtu = ib_mtu_int_to_enum(dev->dev_attr.mtu);
275bcf7cc53SGal Pressman 	props->max_msg_sz = dev->dev_attr.mtu;
27640909f66SGal Pressman 	props->max_vl_num = 1;
27740909f66SGal Pressman 
27840909f66SGal Pressman 	return 0;
27940909f66SGal Pressman }
28040909f66SGal Pressman 
28140909f66SGal Pressman int efa_query_qp(struct ib_qp *ibqp, struct ib_qp_attr *qp_attr,
28240909f66SGal Pressman 		 int qp_attr_mask,
28340909f66SGal Pressman 		 struct ib_qp_init_attr *qp_init_attr)
28440909f66SGal Pressman {
28540909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibqp->device);
28640909f66SGal Pressman 	struct efa_com_query_qp_params params = {};
28740909f66SGal Pressman 	struct efa_com_query_qp_result result;
28840909f66SGal Pressman 	struct efa_qp *qp = to_eqp(ibqp);
28940909f66SGal Pressman 	int err;
29040909f66SGal Pressman 
29140909f66SGal Pressman #define EFA_QUERY_QP_SUPP_MASK \
29240909f66SGal Pressman 	(IB_QP_STATE | IB_QP_PKEY_INDEX | IB_QP_PORT | \
293a4e6a1ddSGal Pressman 	 IB_QP_QKEY | IB_QP_SQ_PSN | IB_QP_CAP | IB_QP_RNR_RETRY)
29440909f66SGal Pressman 
29540909f66SGal Pressman 	if (qp_attr_mask & ~EFA_QUERY_QP_SUPP_MASK) {
29640909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
29740909f66SGal Pressman 			  "Unsupported qp_attr_mask[%#x] supported[%#x]\n",
29840909f66SGal Pressman 			  qp_attr_mask, EFA_QUERY_QP_SUPP_MASK);
29940909f66SGal Pressman 		return -EOPNOTSUPP;
30040909f66SGal Pressman 	}
30140909f66SGal Pressman 
30240909f66SGal Pressman 	memset(qp_attr, 0, sizeof(*qp_attr));
30340909f66SGal Pressman 	memset(qp_init_attr, 0, sizeof(*qp_init_attr));
30440909f66SGal Pressman 
30540909f66SGal Pressman 	params.qp_handle = qp->qp_handle;
30640909f66SGal Pressman 	err = efa_com_query_qp(&dev->edev, &params, &result);
30740909f66SGal Pressman 	if (err)
30840909f66SGal Pressman 		return err;
30940909f66SGal Pressman 
31040909f66SGal Pressman 	qp_attr->qp_state = result.qp_state;
31140909f66SGal Pressman 	qp_attr->qkey = result.qkey;
31240909f66SGal Pressman 	qp_attr->sq_psn = result.sq_psn;
31340909f66SGal Pressman 	qp_attr->sq_draining = result.sq_draining;
31440909f66SGal Pressman 	qp_attr->port_num = 1;
315a4e6a1ddSGal Pressman 	qp_attr->rnr_retry = result.rnr_retry;
31640909f66SGal Pressman 
31740909f66SGal Pressman 	qp_attr->cap.max_send_wr = qp->max_send_wr;
31840909f66SGal Pressman 	qp_attr->cap.max_recv_wr = qp->max_recv_wr;
31940909f66SGal Pressman 	qp_attr->cap.max_send_sge = qp->max_send_sge;
32040909f66SGal Pressman 	qp_attr->cap.max_recv_sge = qp->max_recv_sge;
32140909f66SGal Pressman 	qp_attr->cap.max_inline_data = qp->max_inline_data;
32240909f66SGal Pressman 
32340909f66SGal Pressman 	qp_init_attr->qp_type = ibqp->qp_type;
32440909f66SGal Pressman 	qp_init_attr->recv_cq = ibqp->recv_cq;
32540909f66SGal Pressman 	qp_init_attr->send_cq = ibqp->send_cq;
32640909f66SGal Pressman 	qp_init_attr->qp_context = ibqp->qp_context;
32740909f66SGal Pressman 	qp_init_attr->cap = qp_attr->cap;
32840909f66SGal Pressman 
32940909f66SGal Pressman 	return 0;
33040909f66SGal Pressman }
33140909f66SGal Pressman 
3321fb7f897SMark Bloch int efa_query_gid(struct ib_device *ibdev, u32 port, int index,
33340909f66SGal Pressman 		  union ib_gid *gid)
33440909f66SGal Pressman {
33540909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibdev);
33640909f66SGal Pressman 
337bcf7cc53SGal Pressman 	memcpy(gid->raw, dev->dev_attr.addr, sizeof(dev->dev_attr.addr));
33840909f66SGal Pressman 
33940909f66SGal Pressman 	return 0;
34040909f66SGal Pressman }
34140909f66SGal Pressman 
3421fb7f897SMark Bloch int efa_query_pkey(struct ib_device *ibdev, u32 port, u16 index,
34340909f66SGal Pressman 		   u16 *pkey)
34440909f66SGal Pressman {
34540909f66SGal Pressman 	if (index > 0)
34640909f66SGal Pressman 		return -EINVAL;
34740909f66SGal Pressman 
34840909f66SGal Pressman 	*pkey = 0xffff;
34940909f66SGal Pressman 	return 0;
35040909f66SGal Pressman }
35140909f66SGal Pressman 
35240909f66SGal Pressman static int efa_pd_dealloc(struct efa_dev *dev, u16 pdn)
35340909f66SGal Pressman {
35440909f66SGal Pressman 	struct efa_com_dealloc_pd_params params = {
35540909f66SGal Pressman 		.pdn = pdn,
35640909f66SGal Pressman 	};
35740909f66SGal Pressman 
35840909f66SGal Pressman 	return efa_com_dealloc_pd(&dev->edev, &params);
35940909f66SGal Pressman }
36040909f66SGal Pressman 
36140909f66SGal Pressman int efa_alloc_pd(struct ib_pd *ibpd, struct ib_udata *udata)
36240909f66SGal Pressman {
36340909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibpd->device);
36440909f66SGal Pressman 	struct efa_ibv_alloc_pd_resp resp = {};
36540909f66SGal Pressman 	struct efa_com_alloc_pd_result result;
36640909f66SGal Pressman 	struct efa_pd *pd = to_epd(ibpd);
36740909f66SGal Pressman 	int err;
36840909f66SGal Pressman 
36940909f66SGal Pressman 	if (udata->inlen &&
37040909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, udata->inlen)) {
37140909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
37240909f66SGal Pressman 			  "Incompatible ABI params, udata not cleared\n");
37340909f66SGal Pressman 		err = -EINVAL;
37440909f66SGal Pressman 		goto err_out;
37540909f66SGal Pressman 	}
37640909f66SGal Pressman 
37740909f66SGal Pressman 	err = efa_com_alloc_pd(&dev->edev, &result);
37840909f66SGal Pressman 	if (err)
37940909f66SGal Pressman 		goto err_out;
38040909f66SGal Pressman 
38140909f66SGal Pressman 	pd->pdn = result.pdn;
38240909f66SGal Pressman 	resp.pdn = result.pdn;
38340909f66SGal Pressman 
38440909f66SGal Pressman 	if (udata->outlen) {
38540909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
38640909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
38740909f66SGal Pressman 		if (err) {
38840909f66SGal Pressman 			ibdev_dbg(&dev->ibdev,
38940909f66SGal Pressman 				  "Failed to copy udata for alloc_pd\n");
39040909f66SGal Pressman 			goto err_dealloc_pd;
39140909f66SGal Pressman 		}
39240909f66SGal Pressman 	}
39340909f66SGal Pressman 
39440909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Allocated pd[%d]\n", pd->pdn);
39540909f66SGal Pressman 
39640909f66SGal Pressman 	return 0;
39740909f66SGal Pressman 
39840909f66SGal Pressman err_dealloc_pd:
39940909f66SGal Pressman 	efa_pd_dealloc(dev, result.pdn);
40040909f66SGal Pressman err_out:
401215b88acSGal Pressman 	atomic64_inc(&dev->stats.alloc_pd_err);
40240909f66SGal Pressman 	return err;
40340909f66SGal Pressman }
40440909f66SGal Pressman 
40591a7c58fSLeon Romanovsky int efa_dealloc_pd(struct ib_pd *ibpd, struct ib_udata *udata)
40640909f66SGal Pressman {
40740909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibpd->device);
40840909f66SGal Pressman 	struct efa_pd *pd = to_epd(ibpd);
40940909f66SGal Pressman 
41040909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Dealloc pd[%d]\n", pd->pdn);
41140909f66SGal Pressman 	efa_pd_dealloc(dev, pd->pdn);
41291a7c58fSLeon Romanovsky 	return 0;
41340909f66SGal Pressman }
41440909f66SGal Pressman 
41540909f66SGal Pressman static int efa_destroy_qp_handle(struct efa_dev *dev, u32 qp_handle)
41640909f66SGal Pressman {
41740909f66SGal Pressman 	struct efa_com_destroy_qp_params params = { .qp_handle = qp_handle };
41840909f66SGal Pressman 
41940909f66SGal Pressman 	return efa_com_destroy_qp(&dev->edev, &params);
42040909f66SGal Pressman }
42140909f66SGal Pressman 
4220428c6efSGal Pressman static void efa_qp_user_mmap_entries_remove(struct efa_qp *qp)
423e84d3c18SMichal Kalderon {
424e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(qp->rq_mmap_entry);
425e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(qp->rq_db_mmap_entry);
426e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(qp->llq_desc_mmap_entry);
427e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(qp->sq_db_mmap_entry);
428e84d3c18SMichal Kalderon }
429e84d3c18SMichal Kalderon 
43040909f66SGal Pressman int efa_destroy_qp(struct ib_qp *ibqp, struct ib_udata *udata)
43140909f66SGal Pressman {
43240909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibqp->pd->device);
43340909f66SGal Pressman 	struct efa_qp *qp = to_eqp(ibqp);
43440909f66SGal Pressman 	int err;
43540909f66SGal Pressman 
43640909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Destroy qp[%u]\n", ibqp->qp_num);
437ff6629f8SGal Pressman 
438ff6629f8SGal Pressman 	efa_qp_user_mmap_entries_remove(qp);
439ff6629f8SGal Pressman 
44040909f66SGal Pressman 	err = efa_destroy_qp_handle(dev, qp->qp_handle);
44140909f66SGal Pressman 	if (err)
44240909f66SGal Pressman 		return err;
44340909f66SGal Pressman 
44440909f66SGal Pressman 	if (qp->rq_cpu_addr) {
44540909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
44640909f66SGal Pressman 			  "qp->cpu_addr[0x%p] freed: size[%lu], dma[%pad]\n",
44740909f66SGal Pressman 			  qp->rq_cpu_addr, qp->rq_size,
44840909f66SGal Pressman 			  &qp->rq_dma_addr);
449ff6629f8SGal Pressman 		efa_free_mapped(dev, qp->rq_cpu_addr, qp->rq_dma_addr,
450ff6629f8SGal Pressman 				qp->rq_size, DMA_TO_DEVICE);
45140909f66SGal Pressman 	}
45240909f66SGal Pressman 
45340909f66SGal Pressman 	return 0;
45440909f66SGal Pressman }
45540909f66SGal Pressman 
456e84d3c18SMichal Kalderon static struct rdma_user_mmap_entry*
457e84d3c18SMichal Kalderon efa_user_mmap_entry_insert(struct ib_ucontext *ucontext,
458e84d3c18SMichal Kalderon 			   u64 address, size_t length,
459e84d3c18SMichal Kalderon 			   u8 mmap_flag, u64 *offset)
460e84d3c18SMichal Kalderon {
461e84d3c18SMichal Kalderon 	struct efa_user_mmap_entry *entry = kzalloc(sizeof(*entry), GFP_KERNEL);
462e84d3c18SMichal Kalderon 	int err;
463e84d3c18SMichal Kalderon 
464e84d3c18SMichal Kalderon 	if (!entry)
465e84d3c18SMichal Kalderon 		return NULL;
466e84d3c18SMichal Kalderon 
467e84d3c18SMichal Kalderon 	entry->address = address;
468e84d3c18SMichal Kalderon 	entry->mmap_flag = mmap_flag;
469e84d3c18SMichal Kalderon 
470e84d3c18SMichal Kalderon 	err = rdma_user_mmap_entry_insert(ucontext, &entry->rdma_entry,
471e84d3c18SMichal Kalderon 					  length);
472e84d3c18SMichal Kalderon 	if (err) {
473e84d3c18SMichal Kalderon 		kfree(entry);
474e84d3c18SMichal Kalderon 		return NULL;
475e84d3c18SMichal Kalderon 	}
476e84d3c18SMichal Kalderon 	*offset = rdma_user_mmap_get_offset(&entry->rdma_entry);
477e84d3c18SMichal Kalderon 
478e84d3c18SMichal Kalderon 	return &entry->rdma_entry;
479e84d3c18SMichal Kalderon }
480e84d3c18SMichal Kalderon 
48140909f66SGal Pressman static int qp_mmap_entries_setup(struct efa_qp *qp,
48240909f66SGal Pressman 				 struct efa_dev *dev,
48340909f66SGal Pressman 				 struct efa_ucontext *ucontext,
48440909f66SGal Pressman 				 struct efa_com_create_qp_params *params,
48540909f66SGal Pressman 				 struct efa_ibv_create_qp_resp *resp)
48640909f66SGal Pressman {
487e84d3c18SMichal Kalderon 	size_t length;
488e84d3c18SMichal Kalderon 	u64 address;
489e84d3c18SMichal Kalderon 
490e84d3c18SMichal Kalderon 	address = dev->db_bar_addr + resp->sq_db_offset;
491e84d3c18SMichal Kalderon 	qp->sq_db_mmap_entry =
492e84d3c18SMichal Kalderon 		efa_user_mmap_entry_insert(&ucontext->ibucontext,
493e84d3c18SMichal Kalderon 					   address,
494e84d3c18SMichal Kalderon 					   PAGE_SIZE, EFA_MMAP_IO_NC,
495e84d3c18SMichal Kalderon 					   &resp->sq_db_mmap_key);
496e84d3c18SMichal Kalderon 	if (!qp->sq_db_mmap_entry)
49740909f66SGal Pressman 		return -ENOMEM;
49840909f66SGal Pressman 
49940909f66SGal Pressman 	resp->sq_db_offset &= ~PAGE_MASK;
50040909f66SGal Pressman 
501e84d3c18SMichal Kalderon 	address = dev->mem_bar_addr + resp->llq_desc_offset;
502e84d3c18SMichal Kalderon 	length = PAGE_ALIGN(params->sq_ring_size_in_bytes +
503e84d3c18SMichal Kalderon 			    (resp->llq_desc_offset & ~PAGE_MASK));
504e84d3c18SMichal Kalderon 
505e84d3c18SMichal Kalderon 	qp->llq_desc_mmap_entry =
506e84d3c18SMichal Kalderon 		efa_user_mmap_entry_insert(&ucontext->ibucontext,
507e84d3c18SMichal Kalderon 					   address, length,
508e84d3c18SMichal Kalderon 					   EFA_MMAP_IO_WC,
509e84d3c18SMichal Kalderon 					   &resp->llq_desc_mmap_key);
510e84d3c18SMichal Kalderon 	if (!qp->llq_desc_mmap_entry)
511e84d3c18SMichal Kalderon 		goto err_remove_mmap;
51240909f66SGal Pressman 
51340909f66SGal Pressman 	resp->llq_desc_offset &= ~PAGE_MASK;
51440909f66SGal Pressman 
51540909f66SGal Pressman 	if (qp->rq_size) {
516e84d3c18SMichal Kalderon 		address = dev->db_bar_addr + resp->rq_db_offset;
517e84d3c18SMichal Kalderon 
518e84d3c18SMichal Kalderon 		qp->rq_db_mmap_entry =
519e84d3c18SMichal Kalderon 			efa_user_mmap_entry_insert(&ucontext->ibucontext,
520e84d3c18SMichal Kalderon 						   address, PAGE_SIZE,
521e84d3c18SMichal Kalderon 						   EFA_MMAP_IO_NC,
522e84d3c18SMichal Kalderon 						   &resp->rq_db_mmap_key);
523e84d3c18SMichal Kalderon 		if (!qp->rq_db_mmap_entry)
524e84d3c18SMichal Kalderon 			goto err_remove_mmap;
52540909f66SGal Pressman 
52640909f66SGal Pressman 		resp->rq_db_offset &= ~PAGE_MASK;
52740909f66SGal Pressman 
528e84d3c18SMichal Kalderon 		address = virt_to_phys(qp->rq_cpu_addr);
529e84d3c18SMichal Kalderon 		qp->rq_mmap_entry =
530e84d3c18SMichal Kalderon 			efa_user_mmap_entry_insert(&ucontext->ibucontext,
531e84d3c18SMichal Kalderon 						   address, qp->rq_size,
532e84d3c18SMichal Kalderon 						   EFA_MMAP_DMA_PAGE,
533e84d3c18SMichal Kalderon 						   &resp->rq_mmap_key);
534e84d3c18SMichal Kalderon 		if (!qp->rq_mmap_entry)
535e84d3c18SMichal Kalderon 			goto err_remove_mmap;
53640909f66SGal Pressman 
53740909f66SGal Pressman 		resp->rq_mmap_size = qp->rq_size;
53840909f66SGal Pressman 	}
53940909f66SGal Pressman 
54040909f66SGal Pressman 	return 0;
541e84d3c18SMichal Kalderon 
542e84d3c18SMichal Kalderon err_remove_mmap:
5430428c6efSGal Pressman 	efa_qp_user_mmap_entries_remove(qp);
544e84d3c18SMichal Kalderon 
545e84d3c18SMichal Kalderon 	return -ENOMEM;
54640909f66SGal Pressman }
54740909f66SGal Pressman 
54840909f66SGal Pressman static int efa_qp_validate_cap(struct efa_dev *dev,
54940909f66SGal Pressman 			       struct ib_qp_init_attr *init_attr)
55040909f66SGal Pressman {
55140909f66SGal Pressman 	if (init_attr->cap.max_send_wr > dev->dev_attr.max_sq_depth) {
55240909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
55340909f66SGal Pressman 			  "qp: requested send wr[%u] exceeds the max[%u]\n",
55440909f66SGal Pressman 			  init_attr->cap.max_send_wr,
55540909f66SGal Pressman 			  dev->dev_attr.max_sq_depth);
55640909f66SGal Pressman 		return -EINVAL;
55740909f66SGal Pressman 	}
55840909f66SGal Pressman 	if (init_attr->cap.max_recv_wr > dev->dev_attr.max_rq_depth) {
55940909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
56040909f66SGal Pressman 			  "qp: requested receive wr[%u] exceeds the max[%u]\n",
56140909f66SGal Pressman 			  init_attr->cap.max_recv_wr,
56240909f66SGal Pressman 			  dev->dev_attr.max_rq_depth);
56340909f66SGal Pressman 		return -EINVAL;
56440909f66SGal Pressman 	}
56540909f66SGal Pressman 	if (init_attr->cap.max_send_sge > dev->dev_attr.max_sq_sge) {
56640909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
56740909f66SGal Pressman 			  "qp: requested sge send[%u] exceeds the max[%u]\n",
56840909f66SGal Pressman 			  init_attr->cap.max_send_sge, dev->dev_attr.max_sq_sge);
56940909f66SGal Pressman 		return -EINVAL;
57040909f66SGal Pressman 	}
57140909f66SGal Pressman 	if (init_attr->cap.max_recv_sge > dev->dev_attr.max_rq_sge) {
57240909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
57340909f66SGal Pressman 			  "qp: requested sge recv[%u] exceeds the max[%u]\n",
57440909f66SGal Pressman 			  init_attr->cap.max_recv_sge, dev->dev_attr.max_rq_sge);
57540909f66SGal Pressman 		return -EINVAL;
57640909f66SGal Pressman 	}
57740909f66SGal Pressman 	if (init_attr->cap.max_inline_data > dev->dev_attr.inline_buf_size) {
57840909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
57940909f66SGal Pressman 			  "qp: requested inline data[%u] exceeds the max[%u]\n",
58040909f66SGal Pressman 			  init_attr->cap.max_inline_data,
58140909f66SGal Pressman 			  dev->dev_attr.inline_buf_size);
58240909f66SGal Pressman 		return -EINVAL;
58340909f66SGal Pressman 	}
58440909f66SGal Pressman 
58540909f66SGal Pressman 	return 0;
58640909f66SGal Pressman }
58740909f66SGal Pressman 
58840909f66SGal Pressman static int efa_qp_validate_attr(struct efa_dev *dev,
58940909f66SGal Pressman 				struct ib_qp_init_attr *init_attr)
59040909f66SGal Pressman {
59140909f66SGal Pressman 	if (init_attr->qp_type != IB_QPT_DRIVER &&
59240909f66SGal Pressman 	    init_attr->qp_type != IB_QPT_UD) {
59340909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
59440909f66SGal Pressman 			  "Unsupported qp type %d\n", init_attr->qp_type);
59540909f66SGal Pressman 		return -EOPNOTSUPP;
59640909f66SGal Pressman 	}
59740909f66SGal Pressman 
59840909f66SGal Pressman 	if (init_attr->srq) {
59940909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "SRQ is not supported\n");
60040909f66SGal Pressman 		return -EOPNOTSUPP;
60140909f66SGal Pressman 	}
60240909f66SGal Pressman 
60340909f66SGal Pressman 	if (init_attr->create_flags) {
60440909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Unsupported create flags\n");
60540909f66SGal Pressman 		return -EOPNOTSUPP;
60640909f66SGal Pressman 	}
60740909f66SGal Pressman 
60840909f66SGal Pressman 	return 0;
60940909f66SGal Pressman }
61040909f66SGal Pressman 
611*514aee66SLeon Romanovsky int efa_create_qp(struct ib_qp *ibqp, struct ib_qp_init_attr *init_attr,
61240909f66SGal Pressman 		  struct ib_udata *udata)
61340909f66SGal Pressman {
61440909f66SGal Pressman 	struct efa_com_create_qp_params create_qp_params = {};
61540909f66SGal Pressman 	struct efa_com_create_qp_result create_qp_resp;
616*514aee66SLeon Romanovsky 	struct efa_dev *dev = to_edev(ibqp->device);
61740909f66SGal Pressman 	struct efa_ibv_create_qp_resp resp = {};
61840909f66SGal Pressman 	struct efa_ibv_create_qp cmd = {};
619*514aee66SLeon Romanovsky 	struct efa_qp *qp = to_eqp(ibqp);
62040909f66SGal Pressman 	struct efa_ucontext *ucontext;
62140909f66SGal Pressman 	int err;
62240909f66SGal Pressman 
62340909f66SGal Pressman 	ucontext = rdma_udata_to_drv_context(udata, struct efa_ucontext,
62440909f66SGal Pressman 					     ibucontext);
62540909f66SGal Pressman 
62640909f66SGal Pressman 	err = efa_qp_validate_cap(dev, init_attr);
62740909f66SGal Pressman 	if (err)
62840909f66SGal Pressman 		goto err_out;
62940909f66SGal Pressman 
63040909f66SGal Pressman 	err = efa_qp_validate_attr(dev, init_attr);
63140909f66SGal Pressman 	if (err)
63240909f66SGal Pressman 		goto err_out;
63340909f66SGal Pressman 
634fa8a44f6SLeon Romanovsky 	if (offsetofend(typeof(cmd), driver_qp_type) > udata->inlen) {
63540909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
63640909f66SGal Pressman 			  "Incompatible ABI params, no input udata\n");
63740909f66SGal Pressman 		err = -EINVAL;
63840909f66SGal Pressman 		goto err_out;
63940909f66SGal Pressman 	}
64040909f66SGal Pressman 
64140909f66SGal Pressman 	if (udata->inlen > sizeof(cmd) &&
64240909f66SGal Pressman 	    !ib_is_udata_cleared(udata, sizeof(cmd),
64340909f66SGal Pressman 				 udata->inlen - sizeof(cmd))) {
64440909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
64540909f66SGal Pressman 			  "Incompatible ABI params, unknown fields in udata\n");
64640909f66SGal Pressman 		err = -EINVAL;
64740909f66SGal Pressman 		goto err_out;
64840909f66SGal Pressman 	}
64940909f66SGal Pressman 
65040909f66SGal Pressman 	err = ib_copy_from_udata(&cmd, udata,
65140909f66SGal Pressman 				 min(sizeof(cmd), udata->inlen));
65240909f66SGal Pressman 	if (err) {
65340909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
65440909f66SGal Pressman 			  "Cannot copy udata for create_qp\n");
65540909f66SGal Pressman 		goto err_out;
65640909f66SGal Pressman 	}
65740909f66SGal Pressman 
65840909f66SGal Pressman 	if (cmd.comp_mask) {
65940909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
66040909f66SGal Pressman 			  "Incompatible ABI params, unknown fields in udata\n");
66140909f66SGal Pressman 		err = -EINVAL;
66240909f66SGal Pressman 		goto err_out;
66340909f66SGal Pressman 	}
66440909f66SGal Pressman 
66540909f66SGal Pressman 	create_qp_params.uarn = ucontext->uarn;
666*514aee66SLeon Romanovsky 	create_qp_params.pd = to_epd(ibqp->pd)->pdn;
66740909f66SGal Pressman 
66840909f66SGal Pressman 	if (init_attr->qp_type == IB_QPT_UD) {
66940909f66SGal Pressman 		create_qp_params.qp_type = EFA_ADMIN_QP_TYPE_UD;
67040909f66SGal Pressman 	} else if (cmd.driver_qp_type == EFA_QP_DRIVER_TYPE_SRD) {
67140909f66SGal Pressman 		create_qp_params.qp_type = EFA_ADMIN_QP_TYPE_SRD;
67240909f66SGal Pressman 	} else {
67340909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
67440909f66SGal Pressman 			  "Unsupported qp type %d driver qp type %d\n",
67540909f66SGal Pressman 			  init_attr->qp_type, cmd.driver_qp_type);
67640909f66SGal Pressman 		err = -EOPNOTSUPP;
677*514aee66SLeon Romanovsky 		goto err_out;
67840909f66SGal Pressman 	}
67940909f66SGal Pressman 
68040909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Create QP: qp type %d driver qp type %#x\n",
68140909f66SGal Pressman 		  init_attr->qp_type, cmd.driver_qp_type);
68240909f66SGal Pressman 	create_qp_params.send_cq_idx = to_ecq(init_attr->send_cq)->cq_idx;
68340909f66SGal Pressman 	create_qp_params.recv_cq_idx = to_ecq(init_attr->recv_cq)->cq_idx;
68440909f66SGal Pressman 	create_qp_params.sq_depth = init_attr->cap.max_send_wr;
68540909f66SGal Pressman 	create_qp_params.sq_ring_size_in_bytes = cmd.sq_ring_size;
68640909f66SGal Pressman 
68740909f66SGal Pressman 	create_qp_params.rq_depth = init_attr->cap.max_recv_wr;
68840909f66SGal Pressman 	create_qp_params.rq_ring_size_in_bytes = cmd.rq_ring_size;
68940909f66SGal Pressman 	qp->rq_size = PAGE_ALIGN(create_qp_params.rq_ring_size_in_bytes);
69040909f66SGal Pressman 	if (qp->rq_size) {
69140909f66SGal Pressman 		qp->rq_cpu_addr = efa_zalloc_mapped(dev, &qp->rq_dma_addr,
69240909f66SGal Pressman 						    qp->rq_size, DMA_TO_DEVICE);
69340909f66SGal Pressman 		if (!qp->rq_cpu_addr) {
69440909f66SGal Pressman 			err = -ENOMEM;
695*514aee66SLeon Romanovsky 			goto err_out;
69640909f66SGal Pressman 		}
69740909f66SGal Pressman 
69840909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
69940909f66SGal Pressman 			  "qp->cpu_addr[0x%p] allocated: size[%lu], dma[%pad]\n",
70040909f66SGal Pressman 			  qp->rq_cpu_addr, qp->rq_size, &qp->rq_dma_addr);
70140909f66SGal Pressman 		create_qp_params.rq_base_addr = qp->rq_dma_addr;
70240909f66SGal Pressman 	}
70340909f66SGal Pressman 
70440909f66SGal Pressman 	err = efa_com_create_qp(&dev->edev, &create_qp_params,
70540909f66SGal Pressman 				&create_qp_resp);
70640909f66SGal Pressman 	if (err)
70740909f66SGal Pressman 		goto err_free_mapped;
70840909f66SGal Pressman 
70940909f66SGal Pressman 	resp.sq_db_offset = create_qp_resp.sq_db_offset;
71040909f66SGal Pressman 	resp.rq_db_offset = create_qp_resp.rq_db_offset;
71140909f66SGal Pressman 	resp.llq_desc_offset = create_qp_resp.llq_descriptors_offset;
71240909f66SGal Pressman 	resp.send_sub_cq_idx = create_qp_resp.send_sub_cq_idx;
71340909f66SGal Pressman 	resp.recv_sub_cq_idx = create_qp_resp.recv_sub_cq_idx;
71440909f66SGal Pressman 
71540909f66SGal Pressman 	err = qp_mmap_entries_setup(qp, dev, ucontext, &create_qp_params,
71640909f66SGal Pressman 				    &resp);
71740909f66SGal Pressman 	if (err)
71840909f66SGal Pressman 		goto err_destroy_qp;
71940909f66SGal Pressman 
72040909f66SGal Pressman 	qp->qp_handle = create_qp_resp.qp_handle;
72140909f66SGal Pressman 	qp->ibqp.qp_num = create_qp_resp.qp_num;
72240909f66SGal Pressman 	qp->max_send_wr = init_attr->cap.max_send_wr;
72340909f66SGal Pressman 	qp->max_recv_wr = init_attr->cap.max_recv_wr;
72440909f66SGal Pressman 	qp->max_send_sge = init_attr->cap.max_send_sge;
72540909f66SGal Pressman 	qp->max_recv_sge = init_attr->cap.max_recv_sge;
72640909f66SGal Pressman 	qp->max_inline_data = init_attr->cap.max_inline_data;
72740909f66SGal Pressman 
72840909f66SGal Pressman 	if (udata->outlen) {
72940909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
73040909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
73140909f66SGal Pressman 		if (err) {
73240909f66SGal Pressman 			ibdev_dbg(&dev->ibdev,
73340909f66SGal Pressman 				  "Failed to copy udata for qp[%u]\n",
73440909f66SGal Pressman 				  create_qp_resp.qp_num);
735e84d3c18SMichal Kalderon 			goto err_remove_mmap_entries;
73640909f66SGal Pressman 		}
73740909f66SGal Pressman 	}
73840909f66SGal Pressman 
73940909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Created qp[%d]\n", qp->ibqp.qp_num);
74040909f66SGal Pressman 
741*514aee66SLeon Romanovsky 	return 0;
74240909f66SGal Pressman 
743e84d3c18SMichal Kalderon err_remove_mmap_entries:
7440428c6efSGal Pressman 	efa_qp_user_mmap_entries_remove(qp);
74540909f66SGal Pressman err_destroy_qp:
74640909f66SGal Pressman 	efa_destroy_qp_handle(dev, create_qp_resp.qp_handle);
74740909f66SGal Pressman err_free_mapped:
748ff6629f8SGal Pressman 	if (qp->rq_size)
749ff6629f8SGal Pressman 		efa_free_mapped(dev, qp->rq_cpu_addr, qp->rq_dma_addr,
750ff6629f8SGal Pressman 				qp->rq_size, DMA_TO_DEVICE);
75140909f66SGal Pressman err_out:
752215b88acSGal Pressman 	atomic64_inc(&dev->stats.create_qp_err);
753*514aee66SLeon Romanovsky 	return err;
75440909f66SGal Pressman }
75540909f66SGal Pressman 
75622c50e06SGal Pressman static const struct {
75722c50e06SGal Pressman 	int			valid;
75822c50e06SGal Pressman 	enum ib_qp_attr_mask	req_param;
75922c50e06SGal Pressman 	enum ib_qp_attr_mask	opt_param;
76022c50e06SGal Pressman } srd_qp_state_table[IB_QPS_ERR + 1][IB_QPS_ERR + 1] = {
76122c50e06SGal Pressman 	[IB_QPS_RESET] = {
76222c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
76322c50e06SGal Pressman 		[IB_QPS_INIT]  = {
76422c50e06SGal Pressman 			.valid = 1,
76522c50e06SGal Pressman 			.req_param = IB_QP_PKEY_INDEX |
76622c50e06SGal Pressman 				     IB_QP_PORT |
76722c50e06SGal Pressman 				     IB_QP_QKEY,
76822c50e06SGal Pressman 		},
76922c50e06SGal Pressman 	},
77022c50e06SGal Pressman 	[IB_QPS_INIT] = {
77122c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
77222c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
77322c50e06SGal Pressman 		[IB_QPS_INIT]  = {
77422c50e06SGal Pressman 			.valid = 1,
77522c50e06SGal Pressman 			.opt_param = IB_QP_PKEY_INDEX |
77622c50e06SGal Pressman 				     IB_QP_PORT |
77722c50e06SGal Pressman 				     IB_QP_QKEY,
77822c50e06SGal Pressman 		},
77922c50e06SGal Pressman 		[IB_QPS_RTR]   = {
78022c50e06SGal Pressman 			.valid = 1,
78122c50e06SGal Pressman 			.opt_param = IB_QP_PKEY_INDEX |
78222c50e06SGal Pressman 				     IB_QP_QKEY,
78322c50e06SGal Pressman 		},
78422c50e06SGal Pressman 	},
78522c50e06SGal Pressman 	[IB_QPS_RTR] = {
78622c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
78722c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
78822c50e06SGal Pressman 		[IB_QPS_RTS]   = {
78922c50e06SGal Pressman 			.valid = 1,
79022c50e06SGal Pressman 			.req_param = IB_QP_SQ_PSN,
79122c50e06SGal Pressman 			.opt_param = IB_QP_CUR_STATE |
792a4e6a1ddSGal Pressman 				     IB_QP_QKEY |
793a4e6a1ddSGal Pressman 				     IB_QP_RNR_RETRY,
794a4e6a1ddSGal Pressman 
79522c50e06SGal Pressman 		}
79622c50e06SGal Pressman 	},
79722c50e06SGal Pressman 	[IB_QPS_RTS] = {
79822c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
79922c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
80022c50e06SGal Pressman 		[IB_QPS_RTS]   = {
80122c50e06SGal Pressman 			.valid = 1,
80222c50e06SGal Pressman 			.opt_param = IB_QP_CUR_STATE |
80322c50e06SGal Pressman 				     IB_QP_QKEY,
80422c50e06SGal Pressman 		},
80522c50e06SGal Pressman 		[IB_QPS_SQD] = {
80622c50e06SGal Pressman 			.valid = 1,
80722c50e06SGal Pressman 			.opt_param = IB_QP_EN_SQD_ASYNC_NOTIFY,
80822c50e06SGal Pressman 		},
80922c50e06SGal Pressman 	},
81022c50e06SGal Pressman 	[IB_QPS_SQD] = {
81122c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
81222c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
81322c50e06SGal Pressman 		[IB_QPS_RTS]   = {
81422c50e06SGal Pressman 			.valid = 1,
81522c50e06SGal Pressman 			.opt_param = IB_QP_CUR_STATE |
81622c50e06SGal Pressman 				     IB_QP_QKEY,
81722c50e06SGal Pressman 		},
81822c50e06SGal Pressman 		[IB_QPS_SQD] = {
81922c50e06SGal Pressman 			.valid = 1,
82022c50e06SGal Pressman 			.opt_param = IB_QP_PKEY_INDEX |
82122c50e06SGal Pressman 				     IB_QP_QKEY,
82222c50e06SGal Pressman 		}
82322c50e06SGal Pressman 	},
82422c50e06SGal Pressman 	[IB_QPS_SQE] = {
82522c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
82622c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
82722c50e06SGal Pressman 		[IB_QPS_RTS]   = {
82822c50e06SGal Pressman 			.valid = 1,
82922c50e06SGal Pressman 			.opt_param = IB_QP_CUR_STATE |
83022c50e06SGal Pressman 				     IB_QP_QKEY,
83122c50e06SGal Pressman 		}
83222c50e06SGal Pressman 	},
83322c50e06SGal Pressman 	[IB_QPS_ERR] = {
83422c50e06SGal Pressman 		[IB_QPS_RESET] = { .valid = 1 },
83522c50e06SGal Pressman 		[IB_QPS_ERR]   = { .valid = 1 },
83622c50e06SGal Pressman 	}
83722c50e06SGal Pressman };
83822c50e06SGal Pressman 
83922c50e06SGal Pressman static bool efa_modify_srd_qp_is_ok(enum ib_qp_state cur_state,
84022c50e06SGal Pressman 				    enum ib_qp_state next_state,
84122c50e06SGal Pressman 				    enum ib_qp_attr_mask mask)
84222c50e06SGal Pressman {
84322c50e06SGal Pressman 	enum ib_qp_attr_mask req_param, opt_param;
84422c50e06SGal Pressman 
84522c50e06SGal Pressman 	if (mask & IB_QP_CUR_STATE  &&
84622c50e06SGal Pressman 	    cur_state != IB_QPS_RTR && cur_state != IB_QPS_RTS &&
84722c50e06SGal Pressman 	    cur_state != IB_QPS_SQD && cur_state != IB_QPS_SQE)
84822c50e06SGal Pressman 		return false;
84922c50e06SGal Pressman 
85022c50e06SGal Pressman 	if (!srd_qp_state_table[cur_state][next_state].valid)
85122c50e06SGal Pressman 		return false;
85222c50e06SGal Pressman 
85322c50e06SGal Pressman 	req_param = srd_qp_state_table[cur_state][next_state].req_param;
85422c50e06SGal Pressman 	opt_param = srd_qp_state_table[cur_state][next_state].opt_param;
85522c50e06SGal Pressman 
85622c50e06SGal Pressman 	if ((mask & req_param) != req_param)
85722c50e06SGal Pressman 		return false;
85822c50e06SGal Pressman 
85922c50e06SGal Pressman 	if (mask & ~(req_param | opt_param | IB_QP_STATE))
86022c50e06SGal Pressman 		return false;
86122c50e06SGal Pressman 
86222c50e06SGal Pressman 	return true;
86322c50e06SGal Pressman }
86422c50e06SGal Pressman 
86540909f66SGal Pressman static int efa_modify_qp_validate(struct efa_dev *dev, struct efa_qp *qp,
86640909f66SGal Pressman 				  struct ib_qp_attr *qp_attr, int qp_attr_mask,
86740909f66SGal Pressman 				  enum ib_qp_state cur_state,
86840909f66SGal Pressman 				  enum ib_qp_state new_state)
86940909f66SGal Pressman {
87022c50e06SGal Pressman 	int err;
87122c50e06SGal Pressman 
87240909f66SGal Pressman #define EFA_MODIFY_QP_SUPP_MASK \
87340909f66SGal Pressman 	(IB_QP_STATE | IB_QP_CUR_STATE | IB_QP_EN_SQD_ASYNC_NOTIFY | \
874a4e6a1ddSGal Pressman 	 IB_QP_PKEY_INDEX | IB_QP_PORT | IB_QP_QKEY | IB_QP_SQ_PSN | \
875a4e6a1ddSGal Pressman 	 IB_QP_RNR_RETRY)
87640909f66SGal Pressman 
87740909f66SGal Pressman 	if (qp_attr_mask & ~EFA_MODIFY_QP_SUPP_MASK) {
87840909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
87940909f66SGal Pressman 			  "Unsupported qp_attr_mask[%#x] supported[%#x]\n",
88040909f66SGal Pressman 			  qp_attr_mask, EFA_MODIFY_QP_SUPP_MASK);
88140909f66SGal Pressman 		return -EOPNOTSUPP;
88240909f66SGal Pressman 	}
88340909f66SGal Pressman 
88422c50e06SGal Pressman 	if (qp->ibqp.qp_type == IB_QPT_DRIVER)
88522c50e06SGal Pressman 		err = !efa_modify_srd_qp_is_ok(cur_state, new_state,
88622c50e06SGal Pressman 					       qp_attr_mask);
88722c50e06SGal Pressman 	else
88822c50e06SGal Pressman 		err = !ib_modify_qp_is_ok(cur_state, new_state, IB_QPT_UD,
88922c50e06SGal Pressman 					  qp_attr_mask);
89022c50e06SGal Pressman 
89122c50e06SGal Pressman 	if (err) {
89240909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Invalid modify QP parameters\n");
89340909f66SGal Pressman 		return -EINVAL;
89440909f66SGal Pressman 	}
89540909f66SGal Pressman 
89640909f66SGal Pressman 	if ((qp_attr_mask & IB_QP_PORT) && qp_attr->port_num != 1) {
89740909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Can't change port num\n");
89840909f66SGal Pressman 		return -EOPNOTSUPP;
89940909f66SGal Pressman 	}
90040909f66SGal Pressman 
90140909f66SGal Pressman 	if ((qp_attr_mask & IB_QP_PKEY_INDEX) && qp_attr->pkey_index) {
90240909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Can't change pkey index\n");
90340909f66SGal Pressman 		return -EOPNOTSUPP;
90440909f66SGal Pressman 	}
90540909f66SGal Pressman 
90640909f66SGal Pressman 	return 0;
90740909f66SGal Pressman }
90840909f66SGal Pressman 
90940909f66SGal Pressman int efa_modify_qp(struct ib_qp *ibqp, struct ib_qp_attr *qp_attr,
91040909f66SGal Pressman 		  int qp_attr_mask, struct ib_udata *udata)
91140909f66SGal Pressman {
91240909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibqp->device);
91340909f66SGal Pressman 	struct efa_com_modify_qp_params params = {};
91440909f66SGal Pressman 	struct efa_qp *qp = to_eqp(ibqp);
91540909f66SGal Pressman 	enum ib_qp_state cur_state;
91640909f66SGal Pressman 	enum ib_qp_state new_state;
91740909f66SGal Pressman 	int err;
91840909f66SGal Pressman 
91926e990baSJason Gunthorpe 	if (qp_attr_mask & ~IB_QP_ATTR_STANDARD_BITS)
92026e990baSJason Gunthorpe 		return -EOPNOTSUPP;
92126e990baSJason Gunthorpe 
92240909f66SGal Pressman 	if (udata->inlen &&
92340909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, udata->inlen)) {
92440909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
92540909f66SGal Pressman 			  "Incompatible ABI params, udata not cleared\n");
92640909f66SGal Pressman 		return -EINVAL;
92740909f66SGal Pressman 	}
92840909f66SGal Pressman 
92940909f66SGal Pressman 	cur_state = qp_attr_mask & IB_QP_CUR_STATE ? qp_attr->cur_qp_state :
93040909f66SGal Pressman 						     qp->state;
93140909f66SGal Pressman 	new_state = qp_attr_mask & IB_QP_STATE ? qp_attr->qp_state : cur_state;
93240909f66SGal Pressman 
93340909f66SGal Pressman 	err = efa_modify_qp_validate(dev, qp, qp_attr, qp_attr_mask, cur_state,
93440909f66SGal Pressman 				     new_state);
93540909f66SGal Pressman 	if (err)
93640909f66SGal Pressman 		return err;
93740909f66SGal Pressman 
93840909f66SGal Pressman 	params.qp_handle = qp->qp_handle;
93940909f66SGal Pressman 
94040909f66SGal Pressman 	if (qp_attr_mask & IB_QP_STATE) {
941ab67baddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_QP_STATE,
942ab67baddSGal Pressman 			1);
943ab67baddSGal Pressman 		EFA_SET(&params.modify_mask,
944ab67baddSGal Pressman 			EFA_ADMIN_MODIFY_QP_CMD_CUR_QP_STATE, 1);
94593416ab0SGal Pressman 		params.cur_qp_state = cur_state;
94693416ab0SGal Pressman 		params.qp_state = new_state;
94740909f66SGal Pressman 	}
94840909f66SGal Pressman 
94940909f66SGal Pressman 	if (qp_attr_mask & IB_QP_EN_SQD_ASYNC_NOTIFY) {
950ab67baddSGal Pressman 		EFA_SET(&params.modify_mask,
951ab67baddSGal Pressman 			EFA_ADMIN_MODIFY_QP_CMD_SQ_DRAINED_ASYNC_NOTIFY, 1);
95240909f66SGal Pressman 		params.sq_drained_async_notify = qp_attr->en_sqd_async_notify;
95340909f66SGal Pressman 	}
95440909f66SGal Pressman 
95540909f66SGal Pressman 	if (qp_attr_mask & IB_QP_QKEY) {
956ab67baddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_QKEY, 1);
95740909f66SGal Pressman 		params.qkey = qp_attr->qkey;
95840909f66SGal Pressman 	}
95940909f66SGal Pressman 
96040909f66SGal Pressman 	if (qp_attr_mask & IB_QP_SQ_PSN) {
961ab67baddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_SQ_PSN, 1);
96240909f66SGal Pressman 		params.sq_psn = qp_attr->sq_psn;
96340909f66SGal Pressman 	}
96440909f66SGal Pressman 
965a4e6a1ddSGal Pressman 	if (qp_attr_mask & IB_QP_RNR_RETRY) {
966a4e6a1ddSGal Pressman 		EFA_SET(&params.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_RNR_RETRY,
967a4e6a1ddSGal Pressman 			1);
968a4e6a1ddSGal Pressman 		params.rnr_retry = qp_attr->rnr_retry;
969a4e6a1ddSGal Pressman 	}
970a4e6a1ddSGal Pressman 
97140909f66SGal Pressman 	err = efa_com_modify_qp(&dev->edev, &params);
97240909f66SGal Pressman 	if (err)
97340909f66SGal Pressman 		return err;
97440909f66SGal Pressman 
97540909f66SGal Pressman 	qp->state = new_state;
97640909f66SGal Pressman 
97740909f66SGal Pressman 	return 0;
97840909f66SGal Pressman }
97940909f66SGal Pressman 
98040909f66SGal Pressman static int efa_destroy_cq_idx(struct efa_dev *dev, int cq_idx)
98140909f66SGal Pressman {
98240909f66SGal Pressman 	struct efa_com_destroy_cq_params params = { .cq_idx = cq_idx };
98340909f66SGal Pressman 
98440909f66SGal Pressman 	return efa_com_destroy_cq(&dev->edev, &params);
98540909f66SGal Pressman }
98640909f66SGal Pressman 
98743d781b9SLeon Romanovsky int efa_destroy_cq(struct ib_cq *ibcq, struct ib_udata *udata)
98840909f66SGal Pressman {
98940909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibcq->device);
99040909f66SGal Pressman 	struct efa_cq *cq = to_ecq(ibcq);
99140909f66SGal Pressman 
99240909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
99340909f66SGal Pressman 		  "Destroy cq[%d] virt[0x%p] freed: size[%lu], dma[%pad]\n",
99440909f66SGal Pressman 		  cq->cq_idx, cq->cpu_addr, cq->size, &cq->dma_addr);
99540909f66SGal Pressman 
996e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(cq->mmap_entry);
997ff6629f8SGal Pressman 	efa_destroy_cq_idx(dev, cq->cq_idx);
998ff6629f8SGal Pressman 	efa_free_mapped(dev, cq->cpu_addr, cq->dma_addr, cq->size,
999ff6629f8SGal Pressman 			DMA_FROM_DEVICE);
100043d781b9SLeon Romanovsky 	return 0;
100140909f66SGal Pressman }
100240909f66SGal Pressman 
100340909f66SGal Pressman static int cq_mmap_entries_setup(struct efa_dev *dev, struct efa_cq *cq,
100440909f66SGal Pressman 				 struct efa_ibv_create_cq_resp *resp)
100540909f66SGal Pressman {
100640909f66SGal Pressman 	resp->q_mmap_size = cq->size;
1007e84d3c18SMichal Kalderon 	cq->mmap_entry = efa_user_mmap_entry_insert(&cq->ucontext->ibucontext,
100840909f66SGal Pressman 						    virt_to_phys(cq->cpu_addr),
1009e84d3c18SMichal Kalderon 						    cq->size, EFA_MMAP_DMA_PAGE,
1010e84d3c18SMichal Kalderon 						    &resp->q_mmap_key);
1011e84d3c18SMichal Kalderon 	if (!cq->mmap_entry)
101240909f66SGal Pressman 		return -ENOMEM;
101340909f66SGal Pressman 
101440909f66SGal Pressman 	return 0;
101540909f66SGal Pressman }
101640909f66SGal Pressman 
1017e39afe3dSLeon Romanovsky int efa_create_cq(struct ib_cq *ibcq, const struct ib_cq_init_attr *attr,
101840909f66SGal Pressman 		  struct ib_udata *udata)
101940909f66SGal Pressman {
1020e39afe3dSLeon Romanovsky 	struct efa_ucontext *ucontext = rdma_udata_to_drv_context(
1021e39afe3dSLeon Romanovsky 		udata, struct efa_ucontext, ibucontext);
102240909f66SGal Pressman 	struct efa_ibv_create_cq_resp resp = {};
102340909f66SGal Pressman 	struct efa_com_create_cq_params params;
102440909f66SGal Pressman 	struct efa_com_create_cq_result result;
1025e39afe3dSLeon Romanovsky 	struct ib_device *ibdev = ibcq->device;
102640909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibdev);
102740909f66SGal Pressman 	struct efa_ibv_create_cq cmd = {};
1028e39afe3dSLeon Romanovsky 	struct efa_cq *cq = to_ecq(ibcq);
1029e39afe3dSLeon Romanovsky 	int entries = attr->cqe;
103040909f66SGal Pressman 	int err;
103140909f66SGal Pressman 
103240909f66SGal Pressman 	ibdev_dbg(ibdev, "create_cq entries %d\n", entries);
103340909f66SGal Pressman 
10341c407cb5SJason Gunthorpe 	if (attr->flags)
10351c407cb5SJason Gunthorpe 		return -EOPNOTSUPP;
10361c407cb5SJason Gunthorpe 
103740909f66SGal Pressman 	if (entries < 1 || entries > dev->dev_attr.max_cq_depth) {
103840909f66SGal Pressman 		ibdev_dbg(ibdev,
103940909f66SGal Pressman 			  "cq: requested entries[%u] non-positive or greater than max[%u]\n",
104040909f66SGal Pressman 			  entries, dev->dev_attr.max_cq_depth);
104140909f66SGal Pressman 		err = -EINVAL;
104240909f66SGal Pressman 		goto err_out;
104340909f66SGal Pressman 	}
104440909f66SGal Pressman 
1045fa8a44f6SLeon Romanovsky 	if (offsetofend(typeof(cmd), num_sub_cqs) > udata->inlen) {
104640909f66SGal Pressman 		ibdev_dbg(ibdev,
104740909f66SGal Pressman 			  "Incompatible ABI params, no input udata\n");
104840909f66SGal Pressman 		err = -EINVAL;
104940909f66SGal Pressman 		goto err_out;
105040909f66SGal Pressman 	}
105140909f66SGal Pressman 
105240909f66SGal Pressman 	if (udata->inlen > sizeof(cmd) &&
105340909f66SGal Pressman 	    !ib_is_udata_cleared(udata, sizeof(cmd),
105440909f66SGal Pressman 				 udata->inlen - sizeof(cmd))) {
105540909f66SGal Pressman 		ibdev_dbg(ibdev,
105640909f66SGal Pressman 			  "Incompatible ABI params, unknown fields in udata\n");
105740909f66SGal Pressman 		err = -EINVAL;
105840909f66SGal Pressman 		goto err_out;
105940909f66SGal Pressman 	}
106040909f66SGal Pressman 
106140909f66SGal Pressman 	err = ib_copy_from_udata(&cmd, udata,
106240909f66SGal Pressman 				 min(sizeof(cmd), udata->inlen));
106340909f66SGal Pressman 	if (err) {
106440909f66SGal Pressman 		ibdev_dbg(ibdev, "Cannot copy udata for create_cq\n");
106540909f66SGal Pressman 		goto err_out;
106640909f66SGal Pressman 	}
106740909f66SGal Pressman 
106840909f66SGal Pressman 	if (cmd.comp_mask || !is_reserved_cleared(cmd.reserved_50)) {
106940909f66SGal Pressman 		ibdev_dbg(ibdev,
107040909f66SGal Pressman 			  "Incompatible ABI params, unknown fields in udata\n");
107140909f66SGal Pressman 		err = -EINVAL;
107240909f66SGal Pressman 		goto err_out;
107340909f66SGal Pressman 	}
107440909f66SGal Pressman 
107540909f66SGal Pressman 	if (!cmd.cq_entry_size) {
107640909f66SGal Pressman 		ibdev_dbg(ibdev,
107740909f66SGal Pressman 			  "Invalid entry size [%u]\n", cmd.cq_entry_size);
107840909f66SGal Pressman 		err = -EINVAL;
107940909f66SGal Pressman 		goto err_out;
108040909f66SGal Pressman 	}
108140909f66SGal Pressman 
108240909f66SGal Pressman 	if (cmd.num_sub_cqs != dev->dev_attr.sub_cqs_per_cq) {
108340909f66SGal Pressman 		ibdev_dbg(ibdev,
108440909f66SGal Pressman 			  "Invalid number of sub cqs[%u] expected[%u]\n",
108540909f66SGal Pressman 			  cmd.num_sub_cqs, dev->dev_attr.sub_cqs_per_cq);
108640909f66SGal Pressman 		err = -EINVAL;
108740909f66SGal Pressman 		goto err_out;
108840909f66SGal Pressman 	}
108940909f66SGal Pressman 
1090e39afe3dSLeon Romanovsky 	cq->ucontext = ucontext;
109140909f66SGal Pressman 	cq->size = PAGE_ALIGN(cmd.cq_entry_size * entries * cmd.num_sub_cqs);
109240909f66SGal Pressman 	cq->cpu_addr = efa_zalloc_mapped(dev, &cq->dma_addr, cq->size,
109340909f66SGal Pressman 					 DMA_FROM_DEVICE);
109440909f66SGal Pressman 	if (!cq->cpu_addr) {
109540909f66SGal Pressman 		err = -ENOMEM;
1096e39afe3dSLeon Romanovsky 		goto err_out;
109740909f66SGal Pressman 	}
109840909f66SGal Pressman 
109940909f66SGal Pressman 	params.uarn = cq->ucontext->uarn;
110040909f66SGal Pressman 	params.cq_depth = entries;
110140909f66SGal Pressman 	params.dma_addr = cq->dma_addr;
110240909f66SGal Pressman 	params.entry_size_in_bytes = cmd.cq_entry_size;
110340909f66SGal Pressman 	params.num_sub_cqs = cmd.num_sub_cqs;
110440909f66SGal Pressman 	err = efa_com_create_cq(&dev->edev, &params, &result);
110540909f66SGal Pressman 	if (err)
110640909f66SGal Pressman 		goto err_free_mapped;
110740909f66SGal Pressman 
110840909f66SGal Pressman 	resp.cq_idx = result.cq_idx;
110940909f66SGal Pressman 	cq->cq_idx = result.cq_idx;
111040909f66SGal Pressman 	cq->ibcq.cqe = result.actual_depth;
111140909f66SGal Pressman 	WARN_ON_ONCE(entries != result.actual_depth);
111240909f66SGal Pressman 
111340909f66SGal Pressman 	err = cq_mmap_entries_setup(dev, cq, &resp);
111440909f66SGal Pressman 	if (err) {
1115e39afe3dSLeon Romanovsky 		ibdev_dbg(ibdev, "Could not setup cq[%u] mmap entries\n",
1116e39afe3dSLeon Romanovsky 			  cq->cq_idx);
111740909f66SGal Pressman 		goto err_destroy_cq;
111840909f66SGal Pressman 	}
111940909f66SGal Pressman 
112040909f66SGal Pressman 	if (udata->outlen) {
112140909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
112240909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
112340909f66SGal Pressman 		if (err) {
112440909f66SGal Pressman 			ibdev_dbg(ibdev,
112540909f66SGal Pressman 				  "Failed to copy udata for create_cq\n");
1126e84d3c18SMichal Kalderon 			goto err_remove_mmap;
112740909f66SGal Pressman 		}
112840909f66SGal Pressman 	}
112940909f66SGal Pressman 
1130e39afe3dSLeon Romanovsky 	ibdev_dbg(ibdev, "Created cq[%d], cq depth[%u]. dma[%pad] virt[0x%p]\n",
113140909f66SGal Pressman 		  cq->cq_idx, result.actual_depth, &cq->dma_addr, cq->cpu_addr);
113240909f66SGal Pressman 
1133e39afe3dSLeon Romanovsky 	return 0;
113440909f66SGal Pressman 
1135e84d3c18SMichal Kalderon err_remove_mmap:
1136e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_remove(cq->mmap_entry);
113740909f66SGal Pressman err_destroy_cq:
113840909f66SGal Pressman 	efa_destroy_cq_idx(dev, cq->cq_idx);
113940909f66SGal Pressman err_free_mapped:
1140ff6629f8SGal Pressman 	efa_free_mapped(dev, cq->cpu_addr, cq->dma_addr, cq->size,
114140909f66SGal Pressman 			DMA_FROM_DEVICE);
1142e84d3c18SMichal Kalderon 
114340909f66SGal Pressman err_out:
1144215b88acSGal Pressman 	atomic64_inc(&dev->stats.create_cq_err);
1145e39afe3dSLeon Romanovsky 	return err;
114640909f66SGal Pressman }
114740909f66SGal Pressman 
114840909f66SGal Pressman static int umem_to_page_list(struct efa_dev *dev,
114940909f66SGal Pressman 			     struct ib_umem *umem,
115040909f66SGal Pressman 			     u64 *page_list,
115140909f66SGal Pressman 			     u32 hp_cnt,
115240909f66SGal Pressman 			     u8 hp_shift)
115340909f66SGal Pressman {
115440909f66SGal Pressman 	u32 pages_in_hp = BIT(hp_shift - PAGE_SHIFT);
115540ddb3f0SGal Pressman 	struct ib_block_iter biter;
115640909f66SGal Pressman 	unsigned int hp_idx = 0;
115740909f66SGal Pressman 
115840909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "hp_cnt[%u], pages_in_hp[%u]\n",
115940909f66SGal Pressman 		  hp_cnt, pages_in_hp);
116040909f66SGal Pressman 
1161ebc24096SJason Gunthorpe 	rdma_umem_for_each_dma_block(umem, &biter, BIT(hp_shift))
116240ddb3f0SGal Pressman 		page_list[hp_idx++] = rdma_block_iter_dma_address(&biter);
116340909f66SGal Pressman 
116440909f66SGal Pressman 	return 0;
116540909f66SGal Pressman }
116640909f66SGal Pressman 
116740909f66SGal Pressman static struct scatterlist *efa_vmalloc_buf_to_sg(u64 *buf, int page_cnt)
116840909f66SGal Pressman {
116940909f66SGal Pressman 	struct scatterlist *sglist;
117040909f66SGal Pressman 	struct page *pg;
117140909f66SGal Pressman 	int i;
117240909f66SGal Pressman 
11733de3c478SJulia Lawall 	sglist = kmalloc_array(page_cnt, sizeof(*sglist), GFP_KERNEL);
117440909f66SGal Pressman 	if (!sglist)
117540909f66SGal Pressman 		return NULL;
117640909f66SGal Pressman 	sg_init_table(sglist, page_cnt);
117740909f66SGal Pressman 	for (i = 0; i < page_cnt; i++) {
117840909f66SGal Pressman 		pg = vmalloc_to_page(buf);
117940909f66SGal Pressman 		if (!pg)
118040909f66SGal Pressman 			goto err;
118140909f66SGal Pressman 		sg_set_page(&sglist[i], pg, PAGE_SIZE, 0);
118240909f66SGal Pressman 		buf += PAGE_SIZE / sizeof(*buf);
118340909f66SGal Pressman 	}
118440909f66SGal Pressman 	return sglist;
118540909f66SGal Pressman 
118640909f66SGal Pressman err:
118740909f66SGal Pressman 	kfree(sglist);
118840909f66SGal Pressman 	return NULL;
118940909f66SGal Pressman }
119040909f66SGal Pressman 
119140909f66SGal Pressman /*
119240909f66SGal Pressman  * create a chunk list of physical pages dma addresses from the supplied
119340909f66SGal Pressman  * scatter gather list
119440909f66SGal Pressman  */
119540909f66SGal Pressman static int pbl_chunk_list_create(struct efa_dev *dev, struct pbl_context *pbl)
119640909f66SGal Pressman {
119740909f66SGal Pressman 	struct pbl_chunk_list *chunk_list = &pbl->phys.indirect.chunk_list;
119840909f66SGal Pressman 	int page_cnt = pbl->phys.indirect.pbl_buf_size_in_pages;
119940909f66SGal Pressman 	struct scatterlist *pages_sgl = pbl->phys.indirect.sgl;
12004d50e084SGal Pressman 	unsigned int chunk_list_size, chunk_idx, payload_idx;
120140909f66SGal Pressman 	int sg_dma_cnt = pbl->phys.indirect.sg_dma_cnt;
120240909f66SGal Pressman 	struct efa_com_ctrl_buff_info *ctrl_buf;
120340909f66SGal Pressman 	u64 *cur_chunk_buf, *prev_chunk_buf;
12044d50e084SGal Pressman 	struct ib_block_iter biter;
120540909f66SGal Pressman 	dma_addr_t dma_addr;
120640909f66SGal Pressman 	int i;
120740909f66SGal Pressman 
120840909f66SGal Pressman 	/* allocate a chunk list that consists of 4KB chunks */
120940909f66SGal Pressman 	chunk_list_size = DIV_ROUND_UP(page_cnt, EFA_PTRS_PER_CHUNK);
121040909f66SGal Pressman 
121140909f66SGal Pressman 	chunk_list->size = chunk_list_size;
121240909f66SGal Pressman 	chunk_list->chunks = kcalloc(chunk_list_size,
121340909f66SGal Pressman 				     sizeof(*chunk_list->chunks),
121440909f66SGal Pressman 				     GFP_KERNEL);
121540909f66SGal Pressman 	if (!chunk_list->chunks)
121640909f66SGal Pressman 		return -ENOMEM;
121740909f66SGal Pressman 
121840909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
121940909f66SGal Pressman 		  "chunk_list_size[%u] - pages[%u]\n", chunk_list_size,
122040909f66SGal Pressman 		  page_cnt);
122140909f66SGal Pressman 
122240909f66SGal Pressman 	/* allocate chunk buffers: */
122340909f66SGal Pressman 	for (i = 0; i < chunk_list_size; i++) {
122440909f66SGal Pressman 		chunk_list->chunks[i].buf = kzalloc(EFA_CHUNK_SIZE, GFP_KERNEL);
122540909f66SGal Pressman 		if (!chunk_list->chunks[i].buf)
122640909f66SGal Pressman 			goto chunk_list_dealloc;
122740909f66SGal Pressman 
122840909f66SGal Pressman 		chunk_list->chunks[i].length = EFA_CHUNK_USED_SIZE;
122940909f66SGal Pressman 	}
123040909f66SGal Pressman 	chunk_list->chunks[chunk_list_size - 1].length =
123140909f66SGal Pressman 		((page_cnt % EFA_PTRS_PER_CHUNK) * EFA_CHUNK_PAYLOAD_PTR_SIZE) +
123240909f66SGal Pressman 			EFA_CHUNK_PTR_SIZE;
123340909f66SGal Pressman 
123440909f66SGal Pressman 	/* fill the dma addresses of sg list pages to chunks: */
123540909f66SGal Pressman 	chunk_idx = 0;
123640909f66SGal Pressman 	payload_idx = 0;
123740909f66SGal Pressman 	cur_chunk_buf = chunk_list->chunks[0].buf;
12384d50e084SGal Pressman 	rdma_for_each_block(pages_sgl, &biter, sg_dma_cnt,
12394d50e084SGal Pressman 			    EFA_CHUNK_PAYLOAD_SIZE) {
124040909f66SGal Pressman 		cur_chunk_buf[payload_idx++] =
12414d50e084SGal Pressman 			rdma_block_iter_dma_address(&biter);
124240909f66SGal Pressman 
124340909f66SGal Pressman 		if (payload_idx == EFA_PTRS_PER_CHUNK) {
124440909f66SGal Pressman 			chunk_idx++;
124540909f66SGal Pressman 			cur_chunk_buf = chunk_list->chunks[chunk_idx].buf;
124640909f66SGal Pressman 			payload_idx = 0;
124740909f66SGal Pressman 		}
124840909f66SGal Pressman 	}
124940909f66SGal Pressman 
125040909f66SGal Pressman 	/* map chunks to dma and fill chunks next ptrs */
125140909f66SGal Pressman 	for (i = chunk_list_size - 1; i >= 0; i--) {
125240909f66SGal Pressman 		dma_addr = dma_map_single(&dev->pdev->dev,
125340909f66SGal Pressman 					  chunk_list->chunks[i].buf,
125440909f66SGal Pressman 					  chunk_list->chunks[i].length,
125540909f66SGal Pressman 					  DMA_TO_DEVICE);
125640909f66SGal Pressman 		if (dma_mapping_error(&dev->pdev->dev, dma_addr)) {
125740909f66SGal Pressman 			ibdev_err(&dev->ibdev,
125840909f66SGal Pressman 				  "chunk[%u] dma_map_failed\n", i);
125940909f66SGal Pressman 			goto chunk_list_unmap;
126040909f66SGal Pressman 		}
126140909f66SGal Pressman 
126240909f66SGal Pressman 		chunk_list->chunks[i].dma_addr = dma_addr;
126340909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
126440909f66SGal Pressman 			  "chunk[%u] mapped at [%pad]\n", i, &dma_addr);
126540909f66SGal Pressman 
126640909f66SGal Pressman 		if (!i)
126740909f66SGal Pressman 			break;
126840909f66SGal Pressman 
126940909f66SGal Pressman 		prev_chunk_buf = chunk_list->chunks[i - 1].buf;
127040909f66SGal Pressman 
127140909f66SGal Pressman 		ctrl_buf = (struct efa_com_ctrl_buff_info *)
127240909f66SGal Pressman 				&prev_chunk_buf[EFA_PTRS_PER_CHUNK];
127340909f66SGal Pressman 		ctrl_buf->length = chunk_list->chunks[i].length;
127440909f66SGal Pressman 
127540909f66SGal Pressman 		efa_com_set_dma_addr(dma_addr,
127640909f66SGal Pressman 				     &ctrl_buf->address.mem_addr_high,
127740909f66SGal Pressman 				     &ctrl_buf->address.mem_addr_low);
127840909f66SGal Pressman 	}
127940909f66SGal Pressman 
128040909f66SGal Pressman 	return 0;
128140909f66SGal Pressman 
128240909f66SGal Pressman chunk_list_unmap:
128340909f66SGal Pressman 	for (; i < chunk_list_size; i++) {
128440909f66SGal Pressman 		dma_unmap_single(&dev->pdev->dev, chunk_list->chunks[i].dma_addr,
128540909f66SGal Pressman 				 chunk_list->chunks[i].length, DMA_TO_DEVICE);
128640909f66SGal Pressman 	}
128740909f66SGal Pressman chunk_list_dealloc:
128840909f66SGal Pressman 	for (i = 0; i < chunk_list_size; i++)
128940909f66SGal Pressman 		kfree(chunk_list->chunks[i].buf);
129040909f66SGal Pressman 
129140909f66SGal Pressman 	kfree(chunk_list->chunks);
129240909f66SGal Pressman 	return -ENOMEM;
129340909f66SGal Pressman }
129440909f66SGal Pressman 
129540909f66SGal Pressman static void pbl_chunk_list_destroy(struct efa_dev *dev, struct pbl_context *pbl)
129640909f66SGal Pressman {
129740909f66SGal Pressman 	struct pbl_chunk_list *chunk_list = &pbl->phys.indirect.chunk_list;
129840909f66SGal Pressman 	int i;
129940909f66SGal Pressman 
130040909f66SGal Pressman 	for (i = 0; i < chunk_list->size; i++) {
130140909f66SGal Pressman 		dma_unmap_single(&dev->pdev->dev, chunk_list->chunks[i].dma_addr,
130240909f66SGal Pressman 				 chunk_list->chunks[i].length, DMA_TO_DEVICE);
130340909f66SGal Pressman 		kfree(chunk_list->chunks[i].buf);
130440909f66SGal Pressman 	}
130540909f66SGal Pressman 
130640909f66SGal Pressman 	kfree(chunk_list->chunks);
130740909f66SGal Pressman }
130840909f66SGal Pressman 
130940909f66SGal Pressman /* initialize pbl continuous mode: map pbl buffer to a dma address. */
131040909f66SGal Pressman static int pbl_continuous_initialize(struct efa_dev *dev,
131140909f66SGal Pressman 				     struct pbl_context *pbl)
131240909f66SGal Pressman {
131340909f66SGal Pressman 	dma_addr_t dma_addr;
131440909f66SGal Pressman 
131540909f66SGal Pressman 	dma_addr = dma_map_single(&dev->pdev->dev, pbl->pbl_buf,
131640909f66SGal Pressman 				  pbl->pbl_buf_size_in_bytes, DMA_TO_DEVICE);
131740909f66SGal Pressman 	if (dma_mapping_error(&dev->pdev->dev, dma_addr)) {
131840909f66SGal Pressman 		ibdev_err(&dev->ibdev, "Unable to map pbl to DMA address\n");
131940909f66SGal Pressman 		return -ENOMEM;
132040909f66SGal Pressman 	}
132140909f66SGal Pressman 
132240909f66SGal Pressman 	pbl->phys.continuous.dma_addr = dma_addr;
132340909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
132440909f66SGal Pressman 		  "pbl continuous - dma_addr = %pad, size[%u]\n",
132540909f66SGal Pressman 		  &dma_addr, pbl->pbl_buf_size_in_bytes);
132640909f66SGal Pressman 
132740909f66SGal Pressman 	return 0;
132840909f66SGal Pressman }
132940909f66SGal Pressman 
133040909f66SGal Pressman /*
133140909f66SGal Pressman  * initialize pbl indirect mode:
133240909f66SGal Pressman  * create a chunk list out of the dma addresses of the physical pages of
133340909f66SGal Pressman  * pbl buffer.
133440909f66SGal Pressman  */
133540909f66SGal Pressman static int pbl_indirect_initialize(struct efa_dev *dev, struct pbl_context *pbl)
133640909f66SGal Pressman {
133740909f66SGal Pressman 	u32 size_in_pages = DIV_ROUND_UP(pbl->pbl_buf_size_in_bytes, PAGE_SIZE);
133840909f66SGal Pressman 	struct scatterlist *sgl;
133940909f66SGal Pressman 	int sg_dma_cnt, err;
134040909f66SGal Pressman 
134140909f66SGal Pressman 	BUILD_BUG_ON(EFA_CHUNK_PAYLOAD_SIZE > PAGE_SIZE);
134240909f66SGal Pressman 	sgl = efa_vmalloc_buf_to_sg(pbl->pbl_buf, size_in_pages);
134340909f66SGal Pressman 	if (!sgl)
134440909f66SGal Pressman 		return -ENOMEM;
134540909f66SGal Pressman 
134640909f66SGal Pressman 	sg_dma_cnt = dma_map_sg(&dev->pdev->dev, sgl, size_in_pages, DMA_TO_DEVICE);
134740909f66SGal Pressman 	if (!sg_dma_cnt) {
134840909f66SGal Pressman 		err = -EINVAL;
134940909f66SGal Pressman 		goto err_map;
135040909f66SGal Pressman 	}
135140909f66SGal Pressman 
135240909f66SGal Pressman 	pbl->phys.indirect.pbl_buf_size_in_pages = size_in_pages;
135340909f66SGal Pressman 	pbl->phys.indirect.sgl = sgl;
135440909f66SGal Pressman 	pbl->phys.indirect.sg_dma_cnt = sg_dma_cnt;
135540909f66SGal Pressman 	err = pbl_chunk_list_create(dev, pbl);
135640909f66SGal Pressman 	if (err) {
135740909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
135840909f66SGal Pressman 			  "chunk_list creation failed[%d]\n", err);
135940909f66SGal Pressman 		goto err_chunk;
136040909f66SGal Pressman 	}
136140909f66SGal Pressman 
136240909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
136340909f66SGal Pressman 		  "pbl indirect - size[%u], chunks[%u]\n",
136440909f66SGal Pressman 		  pbl->pbl_buf_size_in_bytes,
136540909f66SGal Pressman 		  pbl->phys.indirect.chunk_list.size);
136640909f66SGal Pressman 
136740909f66SGal Pressman 	return 0;
136840909f66SGal Pressman 
136940909f66SGal Pressman err_chunk:
137040909f66SGal Pressman 	dma_unmap_sg(&dev->pdev->dev, sgl, size_in_pages, DMA_TO_DEVICE);
137140909f66SGal Pressman err_map:
137240909f66SGal Pressman 	kfree(sgl);
137340909f66SGal Pressman 	return err;
137440909f66SGal Pressman }
137540909f66SGal Pressman 
137640909f66SGal Pressman static void pbl_indirect_terminate(struct efa_dev *dev, struct pbl_context *pbl)
137740909f66SGal Pressman {
137840909f66SGal Pressman 	pbl_chunk_list_destroy(dev, pbl);
137940909f66SGal Pressman 	dma_unmap_sg(&dev->pdev->dev, pbl->phys.indirect.sgl,
138040909f66SGal Pressman 		     pbl->phys.indirect.pbl_buf_size_in_pages, DMA_TO_DEVICE);
138140909f66SGal Pressman 	kfree(pbl->phys.indirect.sgl);
138240909f66SGal Pressman }
138340909f66SGal Pressman 
138440909f66SGal Pressman /* create a page buffer list from a mapped user memory region */
138540909f66SGal Pressman static int pbl_create(struct efa_dev *dev,
138640909f66SGal Pressman 		      struct pbl_context *pbl,
138740909f66SGal Pressman 		      struct ib_umem *umem,
138840909f66SGal Pressman 		      int hp_cnt,
138940909f66SGal Pressman 		      u8 hp_shift)
139040909f66SGal Pressman {
139140909f66SGal Pressman 	int err;
139240909f66SGal Pressman 
139340909f66SGal Pressman 	pbl->pbl_buf_size_in_bytes = hp_cnt * EFA_CHUNK_PAYLOAD_PTR_SIZE;
1394255efcaeSGal Pressman 	pbl->pbl_buf = kvzalloc(pbl->pbl_buf_size_in_bytes, GFP_KERNEL);
1395255efcaeSGal Pressman 	if (!pbl->pbl_buf)
1396255efcaeSGal Pressman 		return -ENOMEM;
1397255efcaeSGal Pressman 
1398255efcaeSGal Pressman 	if (is_vmalloc_addr(pbl->pbl_buf)) {
1399255efcaeSGal Pressman 		pbl->physically_continuous = 0;
1400255efcaeSGal Pressman 		err = umem_to_page_list(dev, umem, pbl->pbl_buf, hp_cnt,
1401255efcaeSGal Pressman 					hp_shift);
1402255efcaeSGal Pressman 		if (err)
1403255efcaeSGal Pressman 			goto err_free;
1404255efcaeSGal Pressman 
1405255efcaeSGal Pressman 		err = pbl_indirect_initialize(dev, pbl);
1406255efcaeSGal Pressman 		if (err)
1407255efcaeSGal Pressman 			goto err_free;
1408255efcaeSGal Pressman 	} else {
140940909f66SGal Pressman 		pbl->physically_continuous = 1;
141040909f66SGal Pressman 		err = umem_to_page_list(dev, umem, pbl->pbl_buf, hp_cnt,
141140909f66SGal Pressman 					hp_shift);
141240909f66SGal Pressman 		if (err)
1413255efcaeSGal Pressman 			goto err_free;
1414255efcaeSGal Pressman 
141540909f66SGal Pressman 		err = pbl_continuous_initialize(dev, pbl);
141640909f66SGal Pressman 		if (err)
1417255efcaeSGal Pressman 			goto err_free;
141840909f66SGal Pressman 	}
141940909f66SGal Pressman 
142040909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
142140909f66SGal Pressman 		  "user_pbl_created: user_pages[%u], continuous[%u]\n",
142240909f66SGal Pressman 		  hp_cnt, pbl->physically_continuous);
142340909f66SGal Pressman 
142440909f66SGal Pressman 	return 0;
142540909f66SGal Pressman 
1426255efcaeSGal Pressman err_free:
1427255efcaeSGal Pressman 	kvfree(pbl->pbl_buf);
142840909f66SGal Pressman 	return err;
142940909f66SGal Pressman }
143040909f66SGal Pressman 
143140909f66SGal Pressman static void pbl_destroy(struct efa_dev *dev, struct pbl_context *pbl)
143240909f66SGal Pressman {
1433255efcaeSGal Pressman 	if (pbl->physically_continuous)
143440909f66SGal Pressman 		dma_unmap_single(&dev->pdev->dev, pbl->phys.continuous.dma_addr,
143540909f66SGal Pressman 				 pbl->pbl_buf_size_in_bytes, DMA_TO_DEVICE);
1436255efcaeSGal Pressman 	else
143740909f66SGal Pressman 		pbl_indirect_terminate(dev, pbl);
1438255efcaeSGal Pressman 
1439255efcaeSGal Pressman 	kvfree(pbl->pbl_buf);
144040909f66SGal Pressman }
144140909f66SGal Pressman 
144240909f66SGal Pressman static int efa_create_inline_pbl(struct efa_dev *dev, struct efa_mr *mr,
144340909f66SGal Pressman 				 struct efa_com_reg_mr_params *params)
144440909f66SGal Pressman {
144540909f66SGal Pressman 	int err;
144640909f66SGal Pressman 
144740909f66SGal Pressman 	params->inline_pbl = 1;
144840909f66SGal Pressman 	err = umem_to_page_list(dev, mr->umem, params->pbl.inline_pbl_array,
144940909f66SGal Pressman 				params->page_num, params->page_shift);
145040909f66SGal Pressman 	if (err)
145140909f66SGal Pressman 		return err;
145240909f66SGal Pressman 
145340909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
145440909f66SGal Pressman 		  "inline_pbl_array - pages[%u]\n", params->page_num);
145540909f66SGal Pressman 
145640909f66SGal Pressman 	return 0;
145740909f66SGal Pressman }
145840909f66SGal Pressman 
145940909f66SGal Pressman static int efa_create_pbl(struct efa_dev *dev,
146040909f66SGal Pressman 			  struct pbl_context *pbl,
146140909f66SGal Pressman 			  struct efa_mr *mr,
146240909f66SGal Pressman 			  struct efa_com_reg_mr_params *params)
146340909f66SGal Pressman {
146440909f66SGal Pressman 	int err;
146540909f66SGal Pressman 
146640909f66SGal Pressman 	err = pbl_create(dev, pbl, mr->umem, params->page_num,
146740909f66SGal Pressman 			 params->page_shift);
146840909f66SGal Pressman 	if (err) {
146940909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Failed to create pbl[%d]\n", err);
147040909f66SGal Pressman 		return err;
147140909f66SGal Pressman 	}
147240909f66SGal Pressman 
147340909f66SGal Pressman 	params->inline_pbl = 0;
147440909f66SGal Pressman 	params->indirect = !pbl->physically_continuous;
147540909f66SGal Pressman 	if (pbl->physically_continuous) {
147640909f66SGal Pressman 		params->pbl.pbl.length = pbl->pbl_buf_size_in_bytes;
147740909f66SGal Pressman 
147840909f66SGal Pressman 		efa_com_set_dma_addr(pbl->phys.continuous.dma_addr,
147940909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_high,
148040909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_low);
148140909f66SGal Pressman 	} else {
148240909f66SGal Pressman 		params->pbl.pbl.length =
148340909f66SGal Pressman 			pbl->phys.indirect.chunk_list.chunks[0].length;
148440909f66SGal Pressman 
148540909f66SGal Pressman 		efa_com_set_dma_addr(pbl->phys.indirect.chunk_list.chunks[0].dma_addr,
148640909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_high,
148740909f66SGal Pressman 				     &params->pbl.pbl.address.mem_addr_low);
148840909f66SGal Pressman 	}
148940909f66SGal Pressman 
149040909f66SGal Pressman 	return 0;
149140909f66SGal Pressman }
149240909f66SGal Pressman 
149340909f66SGal Pressman struct ib_mr *efa_reg_mr(struct ib_pd *ibpd, u64 start, u64 length,
149440909f66SGal Pressman 			 u64 virt_addr, int access_flags,
149540909f66SGal Pressman 			 struct ib_udata *udata)
149640909f66SGal Pressman {
149740909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibpd->device);
149840909f66SGal Pressman 	struct efa_com_reg_mr_params params = {};
149940909f66SGal Pressman 	struct efa_com_reg_mr_result result = {};
150040909f66SGal Pressman 	struct pbl_context pbl;
1501666e8ff5SDaniel Kranzdorf 	int supp_access_flags;
150240ddb3f0SGal Pressman 	unsigned int pg_sz;
150340909f66SGal Pressman 	struct efa_mr *mr;
150440909f66SGal Pressman 	int inline_size;
150540909f66SGal Pressman 	int err;
150640909f66SGal Pressman 
150733006bd4SMoni Shoua 	if (udata && udata->inlen &&
150840909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, sizeof(udata->inlen))) {
150940909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
151040909f66SGal Pressman 			  "Incompatible ABI params, udata not cleared\n");
151140909f66SGal Pressman 		err = -EINVAL;
151240909f66SGal Pressman 		goto err_out;
151340909f66SGal Pressman 	}
151440909f66SGal Pressman 
1515666e8ff5SDaniel Kranzdorf 	supp_access_flags =
1516666e8ff5SDaniel Kranzdorf 		IB_ACCESS_LOCAL_WRITE |
151734eb009fSGal Pressman 		(EFA_DEV_CAP(dev, RDMA_READ) ? IB_ACCESS_REMOTE_READ : 0);
1518666e8ff5SDaniel Kranzdorf 
1519ba19e166SGal Pressman 	access_flags &= ~IB_ACCESS_OPTIONAL;
1520666e8ff5SDaniel Kranzdorf 	if (access_flags & ~supp_access_flags) {
152140909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
152240909f66SGal Pressman 			  "Unsupported access flags[%#x], supported[%#x]\n",
1523666e8ff5SDaniel Kranzdorf 			  access_flags, supp_access_flags);
152440909f66SGal Pressman 		err = -EOPNOTSUPP;
152540909f66SGal Pressman 		goto err_out;
152640909f66SGal Pressman 	}
152740909f66SGal Pressman 
152840909f66SGal Pressman 	mr = kzalloc(sizeof(*mr), GFP_KERNEL);
152940909f66SGal Pressman 	if (!mr) {
153040909f66SGal Pressman 		err = -ENOMEM;
153140909f66SGal Pressman 		goto err_out;
153240909f66SGal Pressman 	}
153340909f66SGal Pressman 
1534c320e527SMoni Shoua 	mr->umem = ib_umem_get(ibpd->device, start, length, access_flags);
153540909f66SGal Pressman 	if (IS_ERR(mr->umem)) {
153640909f66SGal Pressman 		err = PTR_ERR(mr->umem);
153740909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
153840909f66SGal Pressman 			  "Failed to pin and map user space memory[%d]\n", err);
153940909f66SGal Pressman 		goto err_free;
154040909f66SGal Pressman 	}
154140909f66SGal Pressman 
154240909f66SGal Pressman 	params.pd = to_epd(ibpd)->pdn;
154340909f66SGal Pressman 	params.iova = virt_addr;
154440909f66SGal Pressman 	params.mr_length_in_bytes = length;
1545e6c4f3ffSDaniel Kranzdorf 	params.permissions = access_flags;
154640909f66SGal Pressman 
154740ddb3f0SGal Pressman 	pg_sz = ib_umem_find_best_pgsz(mr->umem,
154840ddb3f0SGal Pressman 				       dev->dev_attr.page_size_cap,
154940ddb3f0SGal Pressman 				       virt_addr);
155040ddb3f0SGal Pressman 	if (!pg_sz) {
155140ddb3f0SGal Pressman 		err = -EOPNOTSUPP;
155240ddb3f0SGal Pressman 		ibdev_dbg(&dev->ibdev, "Failed to find a suitable page size in page_size_cap %#llx\n",
155340ddb3f0SGal Pressman 			  dev->dev_attr.page_size_cap);
155440ddb3f0SGal Pressman 		goto err_unmap;
155540ddb3f0SGal Pressman 	}
155640ddb3f0SGal Pressman 
15571f9b6827SJason Gunthorpe 	params.page_shift = order_base_2(pg_sz);
15581f9b6827SJason Gunthorpe 	params.page_num = ib_umem_num_dma_blocks(mr->umem, pg_sz);
155940ddb3f0SGal Pressman 
156040909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
156140ddb3f0SGal Pressman 		  "start %#llx length %#llx params.page_shift %u params.page_num %u\n",
156240ddb3f0SGal Pressman 		  start, length, params.page_shift, params.page_num);
156340909f66SGal Pressman 
156440909f66SGal Pressman 	inline_size = ARRAY_SIZE(params.pbl.inline_pbl_array);
156540909f66SGal Pressman 	if (params.page_num <= inline_size) {
156640909f66SGal Pressman 		err = efa_create_inline_pbl(dev, mr, &params);
156740909f66SGal Pressman 		if (err)
156840909f66SGal Pressman 			goto err_unmap;
156940909f66SGal Pressman 
157040909f66SGal Pressman 		err = efa_com_register_mr(&dev->edev, &params, &result);
157140909f66SGal Pressman 		if (err)
157240909f66SGal Pressman 			goto err_unmap;
157340909f66SGal Pressman 	} else {
157440909f66SGal Pressman 		err = efa_create_pbl(dev, &pbl, mr, &params);
157540909f66SGal Pressman 		if (err)
157640909f66SGal Pressman 			goto err_unmap;
157740909f66SGal Pressman 
157840909f66SGal Pressman 		err = efa_com_register_mr(&dev->edev, &params, &result);
157940909f66SGal Pressman 		pbl_destroy(dev, &pbl);
158040909f66SGal Pressman 
158140909f66SGal Pressman 		if (err)
158240909f66SGal Pressman 			goto err_unmap;
158340909f66SGal Pressman 	}
158440909f66SGal Pressman 
158540909f66SGal Pressman 	mr->ibmr.lkey = result.l_key;
158640909f66SGal Pressman 	mr->ibmr.rkey = result.r_key;
158740909f66SGal Pressman 	mr->ibmr.length = length;
158840909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Registered mr[%d]\n", mr->ibmr.lkey);
158940909f66SGal Pressman 
159040909f66SGal Pressman 	return &mr->ibmr;
159140909f66SGal Pressman 
159240909f66SGal Pressman err_unmap:
159340909f66SGal Pressman 	ib_umem_release(mr->umem);
159440909f66SGal Pressman err_free:
159540909f66SGal Pressman 	kfree(mr);
159640909f66SGal Pressman err_out:
1597215b88acSGal Pressman 	atomic64_inc(&dev->stats.reg_mr_err);
159840909f66SGal Pressman 	return ERR_PTR(err);
159940909f66SGal Pressman }
160040909f66SGal Pressman 
160140909f66SGal Pressman int efa_dereg_mr(struct ib_mr *ibmr, struct ib_udata *udata)
160240909f66SGal Pressman {
160340909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibmr->device);
160440909f66SGal Pressman 	struct efa_com_dereg_mr_params params;
160540909f66SGal Pressman 	struct efa_mr *mr = to_emr(ibmr);
160640909f66SGal Pressman 	int err;
160740909f66SGal Pressman 
160840909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Deregister mr[%d]\n", ibmr->lkey);
160940909f66SGal Pressman 
161040909f66SGal Pressman 	params.l_key = mr->ibmr.lkey;
161140909f66SGal Pressman 	err = efa_com_dereg_mr(&dev->edev, &params);
161240909f66SGal Pressman 	if (err)
161340909f66SGal Pressman 		return err;
161440909f66SGal Pressman 
1615958b6813SGal Pressman 	ib_umem_release(mr->umem);
161640909f66SGal Pressman 	kfree(mr);
161740909f66SGal Pressman 
161840909f66SGal Pressman 	return 0;
161940909f66SGal Pressman }
162040909f66SGal Pressman 
16211fb7f897SMark Bloch int efa_get_port_immutable(struct ib_device *ibdev, u32 port_num,
162240909f66SGal Pressman 			   struct ib_port_immutable *immutable)
162340909f66SGal Pressman {
162440909f66SGal Pressman 	struct ib_port_attr attr;
162540909f66SGal Pressman 	int err;
162640909f66SGal Pressman 
162740909f66SGal Pressman 	err = ib_query_port(ibdev, port_num, &attr);
162840909f66SGal Pressman 	if (err) {
162940909f66SGal Pressman 		ibdev_dbg(ibdev, "Couldn't query port err[%d]\n", err);
163040909f66SGal Pressman 		return err;
163140909f66SGal Pressman 	}
163240909f66SGal Pressman 
163340909f66SGal Pressman 	immutable->pkey_tbl_len = attr.pkey_tbl_len;
163440909f66SGal Pressman 	immutable->gid_tbl_len = attr.gid_tbl_len;
163540909f66SGal Pressman 
163640909f66SGal Pressman 	return 0;
163740909f66SGal Pressman }
163840909f66SGal Pressman 
163940909f66SGal Pressman static int efa_dealloc_uar(struct efa_dev *dev, u16 uarn)
164040909f66SGal Pressman {
164140909f66SGal Pressman 	struct efa_com_dealloc_uar_params params = {
164240909f66SGal Pressman 		.uarn = uarn,
164340909f66SGal Pressman 	};
164440909f66SGal Pressman 
164540909f66SGal Pressman 	return efa_com_dealloc_uar(&dev->edev, &params);
164640909f66SGal Pressman }
164740909f66SGal Pressman 
1648a5d87b69SGal Pressman #define EFA_CHECK_USER_COMP(_dev, _comp_mask, _attr, _mask, _attr_str) \
1649a5d87b69SGal Pressman 	(_attr_str = (!(_dev)->dev_attr._attr || ((_comp_mask) & (_mask))) ? \
1650a5d87b69SGal Pressman 		     NULL : #_attr)
1651a5d87b69SGal Pressman 
1652a5d87b69SGal Pressman static int efa_user_comp_handshake(const struct ib_ucontext *ibucontext,
1653a5d87b69SGal Pressman 				   const struct efa_ibv_alloc_ucontext_cmd *cmd)
1654a5d87b69SGal Pressman {
1655a5d87b69SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
1656a5d87b69SGal Pressman 	char *attr_str;
1657a5d87b69SGal Pressman 
1658a5d87b69SGal Pressman 	if (EFA_CHECK_USER_COMP(dev, cmd->comp_mask, max_tx_batch,
1659a5d87b69SGal Pressman 				EFA_ALLOC_UCONTEXT_CMD_COMP_TX_BATCH, attr_str))
1660a5d87b69SGal Pressman 		goto err;
1661a5d87b69SGal Pressman 
1662a5d87b69SGal Pressman 	if (EFA_CHECK_USER_COMP(dev, cmd->comp_mask, min_sq_depth,
1663a5d87b69SGal Pressman 				EFA_ALLOC_UCONTEXT_CMD_COMP_MIN_SQ_WR,
1664a5d87b69SGal Pressman 				attr_str))
1665a5d87b69SGal Pressman 		goto err;
1666a5d87b69SGal Pressman 
1667a5d87b69SGal Pressman 	return 0;
1668a5d87b69SGal Pressman 
1669a5d87b69SGal Pressman err:
1670a5d87b69SGal Pressman 	ibdev_dbg(&dev->ibdev, "Userspace handshake failed for %s attribute\n",
1671a5d87b69SGal Pressman 		  attr_str);
1672a5d87b69SGal Pressman 	return -EOPNOTSUPP;
1673a5d87b69SGal Pressman }
1674a5d87b69SGal Pressman 
167540909f66SGal Pressman int efa_alloc_ucontext(struct ib_ucontext *ibucontext, struct ib_udata *udata)
167640909f66SGal Pressman {
167740909f66SGal Pressman 	struct efa_ucontext *ucontext = to_eucontext(ibucontext);
167840909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
167940909f66SGal Pressman 	struct efa_ibv_alloc_ucontext_resp resp = {};
1680a5d87b69SGal Pressman 	struct efa_ibv_alloc_ucontext_cmd cmd = {};
168140909f66SGal Pressman 	struct efa_com_alloc_uar_result result;
168240909f66SGal Pressman 	int err;
168340909f66SGal Pressman 
168440909f66SGal Pressman 	/*
168540909f66SGal Pressman 	 * it's fine if the driver does not know all request fields,
168640909f66SGal Pressman 	 * we will ack input fields in our response.
168740909f66SGal Pressman 	 */
168840909f66SGal Pressman 
1689a5d87b69SGal Pressman 	err = ib_copy_from_udata(&cmd, udata,
1690a5d87b69SGal Pressman 				 min(sizeof(cmd), udata->inlen));
1691a5d87b69SGal Pressman 	if (err) {
1692a5d87b69SGal Pressman 		ibdev_dbg(&dev->ibdev,
1693a5d87b69SGal Pressman 			  "Cannot copy udata for alloc_ucontext\n");
1694a5d87b69SGal Pressman 		goto err_out;
1695a5d87b69SGal Pressman 	}
1696a5d87b69SGal Pressman 
1697a5d87b69SGal Pressman 	err = efa_user_comp_handshake(ibucontext, &cmd);
1698a5d87b69SGal Pressman 	if (err)
1699a5d87b69SGal Pressman 		goto err_out;
1700a5d87b69SGal Pressman 
170140909f66SGal Pressman 	err = efa_com_alloc_uar(&dev->edev, &result);
170240909f66SGal Pressman 	if (err)
170340909f66SGal Pressman 		goto err_out;
170440909f66SGal Pressman 
170540909f66SGal Pressman 	ucontext->uarn = result.uarn;
170640909f66SGal Pressman 
170740909f66SGal Pressman 	resp.cmds_supp_udata_mask |= EFA_USER_CMDS_SUPP_UDATA_QUERY_DEVICE;
170840909f66SGal Pressman 	resp.cmds_supp_udata_mask |= EFA_USER_CMDS_SUPP_UDATA_CREATE_AH;
170940909f66SGal Pressman 	resp.sub_cqs_per_cq = dev->dev_attr.sub_cqs_per_cq;
171040909f66SGal Pressman 	resp.inline_buf_size = dev->dev_attr.inline_buf_size;
171140909f66SGal Pressman 	resp.max_llq_size = dev->dev_attr.max_llq_size;
1712556c811fSGal Pressman 	resp.max_tx_batch = dev->dev_attr.max_tx_batch;
1713da2924bdSGal Pressman 	resp.min_sq_wr = dev->dev_attr.min_sq_depth;
171440909f66SGal Pressman 
171540909f66SGal Pressman 	err = ib_copy_to_udata(udata, &resp,
171640909f66SGal Pressman 			       min(sizeof(resp), udata->outlen));
171740909f66SGal Pressman 	if (err)
171840909f66SGal Pressman 		goto err_dealloc_uar;
171940909f66SGal Pressman 
172040909f66SGal Pressman 	return 0;
172140909f66SGal Pressman 
172240909f66SGal Pressman err_dealloc_uar:
172340909f66SGal Pressman 	efa_dealloc_uar(dev, result.uarn);
172440909f66SGal Pressman err_out:
1725215b88acSGal Pressman 	atomic64_inc(&dev->stats.alloc_ucontext_err);
172640909f66SGal Pressman 	return err;
172740909f66SGal Pressman }
172840909f66SGal Pressman 
172940909f66SGal Pressman void efa_dealloc_ucontext(struct ib_ucontext *ibucontext)
173040909f66SGal Pressman {
173140909f66SGal Pressman 	struct efa_ucontext *ucontext = to_eucontext(ibucontext);
173240909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
173340909f66SGal Pressman 
173440909f66SGal Pressman 	efa_dealloc_uar(dev, ucontext->uarn);
173540909f66SGal Pressman }
173640909f66SGal Pressman 
1737e84d3c18SMichal Kalderon void efa_mmap_free(struct rdma_user_mmap_entry *rdma_entry)
173840909f66SGal Pressman {
1739e84d3c18SMichal Kalderon 	struct efa_user_mmap_entry *entry = to_emmap(rdma_entry);
174040909f66SGal Pressman 
1741e84d3c18SMichal Kalderon 	kfree(entry);
174240909f66SGal Pressman }
174340909f66SGal Pressman 
1744e84d3c18SMichal Kalderon static int __efa_mmap(struct efa_dev *dev, struct efa_ucontext *ucontext,
1745e84d3c18SMichal Kalderon 		      struct vm_area_struct *vma)
1746e84d3c18SMichal Kalderon {
1747e84d3c18SMichal Kalderon 	struct rdma_user_mmap_entry *rdma_entry;
1748e84d3c18SMichal Kalderon 	struct efa_user_mmap_entry *entry;
1749e84d3c18SMichal Kalderon 	unsigned long va;
1750e84d3c18SMichal Kalderon 	int err = 0;
1751e84d3c18SMichal Kalderon 	u64 pfn;
1752e84d3c18SMichal Kalderon 
1753e84d3c18SMichal Kalderon 	rdma_entry = rdma_user_mmap_entry_get(&ucontext->ibucontext, vma);
1754e84d3c18SMichal Kalderon 	if (!rdma_entry) {
175540909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
1756e84d3c18SMichal Kalderon 			  "pgoff[%#lx] does not have valid entry\n",
1757e84d3c18SMichal Kalderon 			  vma->vm_pgoff);
1758215b88acSGal Pressman 		atomic64_inc(&dev->stats.mmap_err);
1759e84d3c18SMichal Kalderon 		return -EINVAL;
1760e84d3c18SMichal Kalderon 	}
1761e84d3c18SMichal Kalderon 	entry = to_emmap(rdma_entry);
1762e84d3c18SMichal Kalderon 
1763e84d3c18SMichal Kalderon 	ibdev_dbg(&dev->ibdev,
1764e84d3c18SMichal Kalderon 		  "Mapping address[%#llx], length[%#zx], mmap_flag[%d]\n",
1765e84d3c18SMichal Kalderon 		  entry->address, rdma_entry->npages * PAGE_SIZE,
1766e84d3c18SMichal Kalderon 		  entry->mmap_flag);
176740909f66SGal Pressman 
176840909f66SGal Pressman 	pfn = entry->address >> PAGE_SHIFT;
176940909f66SGal Pressman 	switch (entry->mmap_flag) {
177040909f66SGal Pressman 	case EFA_MMAP_IO_NC:
1771e84d3c18SMichal Kalderon 		err = rdma_user_mmap_io(&ucontext->ibucontext, vma, pfn,
1772e84d3c18SMichal Kalderon 					entry->rdma_entry.npages * PAGE_SIZE,
1773c043ff2cSMichal Kalderon 					pgprot_noncached(vma->vm_page_prot),
1774e84d3c18SMichal Kalderon 					rdma_entry);
177540909f66SGal Pressman 		break;
177640909f66SGal Pressman 	case EFA_MMAP_IO_WC:
1777e84d3c18SMichal Kalderon 		err = rdma_user_mmap_io(&ucontext->ibucontext, vma, pfn,
1778e84d3c18SMichal Kalderon 					entry->rdma_entry.npages * PAGE_SIZE,
1779c043ff2cSMichal Kalderon 					pgprot_writecombine(vma->vm_page_prot),
1780e84d3c18SMichal Kalderon 					rdma_entry);
178140909f66SGal Pressman 		break;
178240909f66SGal Pressman 	case EFA_MMAP_DMA_PAGE:
178340909f66SGal Pressman 		for (va = vma->vm_start; va < vma->vm_end;
178440909f66SGal Pressman 		     va += PAGE_SIZE, pfn++) {
178540909f66SGal Pressman 			err = vm_insert_page(vma, va, pfn_to_page(pfn));
178640909f66SGal Pressman 			if (err)
178740909f66SGal Pressman 				break;
178840909f66SGal Pressman 		}
178940909f66SGal Pressman 		break;
179040909f66SGal Pressman 	default:
179140909f66SGal Pressman 		err = -EINVAL;
179240909f66SGal Pressman 	}
179340909f66SGal Pressman 
1794eca5757fSGal Pressman 	if (err) {
179540909f66SGal Pressman 		ibdev_dbg(
179640909f66SGal Pressman 			&dev->ibdev,
1797e84d3c18SMichal Kalderon 			"Couldn't mmap address[%#llx] length[%#zx] mmap_flag[%d] err[%d]\n",
1798e84d3c18SMichal Kalderon 			entry->address, rdma_entry->npages * PAGE_SIZE,
1799e84d3c18SMichal Kalderon 			entry->mmap_flag, err);
1800215b88acSGal Pressman 		atomic64_inc(&dev->stats.mmap_err);
1801eca5757fSGal Pressman 	}
180240909f66SGal Pressman 
1803e84d3c18SMichal Kalderon 	rdma_user_mmap_entry_put(rdma_entry);
1804e84d3c18SMichal Kalderon 	return err;
1805b41f7572SGal Pressman }
1806b41f7572SGal Pressman 
180740909f66SGal Pressman int efa_mmap(struct ib_ucontext *ibucontext,
180840909f66SGal Pressman 	     struct vm_area_struct *vma)
180940909f66SGal Pressman {
181040909f66SGal Pressman 	struct efa_ucontext *ucontext = to_eucontext(ibucontext);
181140909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibucontext->device);
1812e84d3c18SMichal Kalderon 	size_t length = vma->vm_end - vma->vm_start;
181340909f66SGal Pressman 
181440909f66SGal Pressman 	ibdev_dbg(&dev->ibdev,
1815e84d3c18SMichal Kalderon 		  "start %#lx, end %#lx, length = %#zx, pgoff = %#lx\n",
1816e84d3c18SMichal Kalderon 		  vma->vm_start, vma->vm_end, length, vma->vm_pgoff);
181740909f66SGal Pressman 
1818e84d3c18SMichal Kalderon 	return __efa_mmap(dev, ucontext, vma);
181940909f66SGal Pressman }
182040909f66SGal Pressman 
182140909f66SGal Pressman static int efa_ah_destroy(struct efa_dev *dev, struct efa_ah *ah)
182240909f66SGal Pressman {
182340909f66SGal Pressman 	struct efa_com_destroy_ah_params params = {
182440909f66SGal Pressman 		.ah = ah->ah,
182540909f66SGal Pressman 		.pdn = to_epd(ah->ibah.pd)->pdn,
182640909f66SGal Pressman 	};
182740909f66SGal Pressman 
182840909f66SGal Pressman 	return efa_com_destroy_ah(&dev->edev, &params);
182940909f66SGal Pressman }
183040909f66SGal Pressman 
183140909f66SGal Pressman int efa_create_ah(struct ib_ah *ibah,
1832fa5d010cSMaor Gottlieb 		  struct rdma_ah_init_attr *init_attr,
183340909f66SGal Pressman 		  struct ib_udata *udata)
183440909f66SGal Pressman {
1835fa5d010cSMaor Gottlieb 	struct rdma_ah_attr *ah_attr = init_attr->ah_attr;
183640909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibah->device);
183740909f66SGal Pressman 	struct efa_com_create_ah_params params = {};
183840909f66SGal Pressman 	struct efa_ibv_create_ah_resp resp = {};
183940909f66SGal Pressman 	struct efa_com_create_ah_result result;
184040909f66SGal Pressman 	struct efa_ah *ah = to_eah(ibah);
184140909f66SGal Pressman 	int err;
184240909f66SGal Pressman 
1843fa5d010cSMaor Gottlieb 	if (!(init_attr->flags & RDMA_CREATE_AH_SLEEPABLE)) {
184440909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
184540909f66SGal Pressman 			  "Create address handle is not supported in atomic context\n");
184640909f66SGal Pressman 		err = -EOPNOTSUPP;
184740909f66SGal Pressman 		goto err_out;
184840909f66SGal Pressman 	}
184940909f66SGal Pressman 
185040909f66SGal Pressman 	if (udata->inlen &&
185140909f66SGal Pressman 	    !ib_is_udata_cleared(udata, 0, udata->inlen)) {
185240909f66SGal Pressman 		ibdev_dbg(&dev->ibdev, "Incompatible ABI params\n");
185340909f66SGal Pressman 		err = -EINVAL;
185440909f66SGal Pressman 		goto err_out;
185540909f66SGal Pressman 	}
185640909f66SGal Pressman 
185740909f66SGal Pressman 	memcpy(params.dest_addr, ah_attr->grh.dgid.raw,
185840909f66SGal Pressman 	       sizeof(params.dest_addr));
185940909f66SGal Pressman 	params.pdn = to_epd(ibah->pd)->pdn;
186040909f66SGal Pressman 	err = efa_com_create_ah(&dev->edev, &params, &result);
186140909f66SGal Pressman 	if (err)
186240909f66SGal Pressman 		goto err_out;
186340909f66SGal Pressman 
186440909f66SGal Pressman 	memcpy(ah->id, ah_attr->grh.dgid.raw, sizeof(ah->id));
186540909f66SGal Pressman 	ah->ah = result.ah;
186640909f66SGal Pressman 
186740909f66SGal Pressman 	resp.efa_address_handle = result.ah;
186840909f66SGal Pressman 
186940909f66SGal Pressman 	if (udata->outlen) {
187040909f66SGal Pressman 		err = ib_copy_to_udata(udata, &resp,
187140909f66SGal Pressman 				       min(sizeof(resp), udata->outlen));
187240909f66SGal Pressman 		if (err) {
187340909f66SGal Pressman 			ibdev_dbg(&dev->ibdev,
187440909f66SGal Pressman 				  "Failed to copy udata for create_ah response\n");
187540909f66SGal Pressman 			goto err_destroy_ah;
187640909f66SGal Pressman 		}
187740909f66SGal Pressman 	}
187840909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Created ah[%d]\n", ah->ah);
187940909f66SGal Pressman 
188040909f66SGal Pressman 	return 0;
188140909f66SGal Pressman 
188240909f66SGal Pressman err_destroy_ah:
188340909f66SGal Pressman 	efa_ah_destroy(dev, ah);
188440909f66SGal Pressman err_out:
1885215b88acSGal Pressman 	atomic64_inc(&dev->stats.create_ah_err);
188640909f66SGal Pressman 	return err;
188740909f66SGal Pressman }
188840909f66SGal Pressman 
18899a9ebf8cSLeon Romanovsky int efa_destroy_ah(struct ib_ah *ibah, u32 flags)
189040909f66SGal Pressman {
189140909f66SGal Pressman 	struct efa_dev *dev = to_edev(ibah->pd->device);
189240909f66SGal Pressman 	struct efa_ah *ah = to_eah(ibah);
189340909f66SGal Pressman 
189440909f66SGal Pressman 	ibdev_dbg(&dev->ibdev, "Destroy ah[%d]\n", ah->ah);
189540909f66SGal Pressman 
189640909f66SGal Pressman 	if (!(flags & RDMA_DESTROY_AH_SLEEPABLE)) {
189740909f66SGal Pressman 		ibdev_dbg(&dev->ibdev,
189840909f66SGal Pressman 			  "Destroy address handle is not supported in atomic context\n");
18999a9ebf8cSLeon Romanovsky 		return -EOPNOTSUPP;
190040909f66SGal Pressman 	}
190140909f66SGal Pressman 
190240909f66SGal Pressman 	efa_ah_destroy(dev, ah);
19039a9ebf8cSLeon Romanovsky 	return 0;
190440909f66SGal Pressman }
190540909f66SGal Pressman 
19068c1b4316SGal Pressman struct rdma_hw_stats *efa_alloc_hw_port_stats(struct ib_device *ibdev,
19078c1b4316SGal Pressman 					      u32 port_num)
190816e9111eSGal Pressman {
19098c1b4316SGal Pressman 	return rdma_alloc_hw_stats_struct(efa_port_stats_names,
19108c1b4316SGal Pressman 					  ARRAY_SIZE(efa_port_stats_names),
191116e9111eSGal Pressman 					  RDMA_HW_STATS_DEFAULT_LIFESPAN);
191216e9111eSGal Pressman }
191316e9111eSGal Pressman 
19144b5f4d3fSJason Gunthorpe struct rdma_hw_stats *efa_alloc_hw_device_stats(struct ib_device *ibdev)
19154b5f4d3fSJason Gunthorpe {
19168c1b4316SGal Pressman 	return rdma_alloc_hw_stats_struct(efa_device_stats_names,
19178c1b4316SGal Pressman 					  ARRAY_SIZE(efa_device_stats_names),
19188c1b4316SGal Pressman 					  RDMA_HW_STATS_DEFAULT_LIFESPAN);
19194b5f4d3fSJason Gunthorpe }
19204b5f4d3fSJason Gunthorpe 
19218c1b4316SGal Pressman static int efa_fill_device_stats(struct efa_dev *dev,
19228c1b4316SGal Pressman 				 struct rdma_hw_stats *stats)
19238c1b4316SGal Pressman {
19248c1b4316SGal Pressman 	struct efa_com_stats_admin *as = &dev->edev.aq.stats;
19258c1b4316SGal Pressman 	struct efa_stats *s = &dev->stats;
19268c1b4316SGal Pressman 
19278c1b4316SGal Pressman 	stats->value[EFA_SUBMITTED_CMDS] = atomic64_read(&as->submitted_cmd);
19288c1b4316SGal Pressman 	stats->value[EFA_COMPLETED_CMDS] = atomic64_read(&as->completed_cmd);
19298c1b4316SGal Pressman 	stats->value[EFA_CMDS_ERR] = atomic64_read(&as->cmd_err);
19308c1b4316SGal Pressman 	stats->value[EFA_NO_COMPLETION_CMDS] = atomic64_read(&as->no_completion);
19318c1b4316SGal Pressman 
19328c1b4316SGal Pressman 	stats->value[EFA_KEEP_ALIVE_RCVD] = atomic64_read(&s->keep_alive_rcvd);
19338c1b4316SGal Pressman 	stats->value[EFA_ALLOC_PD_ERR] = atomic64_read(&s->alloc_pd_err);
19348c1b4316SGal Pressman 	stats->value[EFA_CREATE_QP_ERR] = atomic64_read(&s->create_qp_err);
19358c1b4316SGal Pressman 	stats->value[EFA_CREATE_CQ_ERR] = atomic64_read(&s->create_cq_err);
19368c1b4316SGal Pressman 	stats->value[EFA_REG_MR_ERR] = atomic64_read(&s->reg_mr_err);
19378c1b4316SGal Pressman 	stats->value[EFA_ALLOC_UCONTEXT_ERR] =
19388c1b4316SGal Pressman 		atomic64_read(&s->alloc_ucontext_err);
19398c1b4316SGal Pressman 	stats->value[EFA_CREATE_AH_ERR] = atomic64_read(&s->create_ah_err);
19408c1b4316SGal Pressman 	stats->value[EFA_MMAP_ERR] = atomic64_read(&s->mmap_err);
19418c1b4316SGal Pressman 
19428c1b4316SGal Pressman 	return ARRAY_SIZE(efa_device_stats_names);
19438c1b4316SGal Pressman }
19448c1b4316SGal Pressman 
19458c1b4316SGal Pressman static int efa_fill_port_stats(struct efa_dev *dev, struct rdma_hw_stats *stats,
19468c1b4316SGal Pressman 			       u32 port_num)
194716e9111eSGal Pressman {
194816e9111eSGal Pressman 	struct efa_com_get_stats_params params = {};
194916e9111eSGal Pressman 	union efa_com_get_stats_result result;
1950b0cff387SDaniel Kranzdorf 	struct efa_com_rdma_read_stats *rrs;
1951b0cff387SDaniel Kranzdorf 	struct efa_com_messages_stats *ms;
195216e9111eSGal Pressman 	struct efa_com_basic_stats *bs;
195316e9111eSGal Pressman 	int err;
195416e9111eSGal Pressman 
195516e9111eSGal Pressman 	params.scope = EFA_ADMIN_GET_STATS_SCOPE_ALL;
1956b0cff387SDaniel Kranzdorf 	params.type = EFA_ADMIN_GET_STATS_TYPE_BASIC;
195716e9111eSGal Pressman 
195816e9111eSGal Pressman 	err = efa_com_get_stats(&dev->edev, &params, &result);
195916e9111eSGal Pressman 	if (err)
196016e9111eSGal Pressman 		return err;
196116e9111eSGal Pressman 
196216e9111eSGal Pressman 	bs = &result.basic_stats;
196316e9111eSGal Pressman 	stats->value[EFA_TX_BYTES] = bs->tx_bytes;
196416e9111eSGal Pressman 	stats->value[EFA_TX_PKTS] = bs->tx_pkts;
196516e9111eSGal Pressman 	stats->value[EFA_RX_BYTES] = bs->rx_bytes;
196616e9111eSGal Pressman 	stats->value[EFA_RX_PKTS] = bs->rx_pkts;
196716e9111eSGal Pressman 	stats->value[EFA_RX_DROPS] = bs->rx_drops;
196816e9111eSGal Pressman 
1969b0cff387SDaniel Kranzdorf 	params.type = EFA_ADMIN_GET_STATS_TYPE_MESSAGES;
1970b0cff387SDaniel Kranzdorf 	err = efa_com_get_stats(&dev->edev, &params, &result);
1971b0cff387SDaniel Kranzdorf 	if (err)
1972b0cff387SDaniel Kranzdorf 		return err;
1973b0cff387SDaniel Kranzdorf 
1974b0cff387SDaniel Kranzdorf 	ms = &result.messages_stats;
1975b0cff387SDaniel Kranzdorf 	stats->value[EFA_SEND_BYTES] = ms->send_bytes;
1976b0cff387SDaniel Kranzdorf 	stats->value[EFA_SEND_WRS] = ms->send_wrs;
1977b0cff387SDaniel Kranzdorf 	stats->value[EFA_RECV_BYTES] = ms->recv_bytes;
1978b0cff387SDaniel Kranzdorf 	stats->value[EFA_RECV_WRS] = ms->recv_wrs;
1979b0cff387SDaniel Kranzdorf 
1980b0cff387SDaniel Kranzdorf 	params.type = EFA_ADMIN_GET_STATS_TYPE_RDMA_READ;
1981b0cff387SDaniel Kranzdorf 	err = efa_com_get_stats(&dev->edev, &params, &result);
1982b0cff387SDaniel Kranzdorf 	if (err)
1983b0cff387SDaniel Kranzdorf 		return err;
1984b0cff387SDaniel Kranzdorf 
1985b0cff387SDaniel Kranzdorf 	rrs = &result.rdma_read_stats;
1986b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_WRS] = rrs->read_wrs;
1987b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_BYTES] = rrs->read_bytes;
1988b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_WR_ERR] = rrs->read_wr_err;
1989b0cff387SDaniel Kranzdorf 	stats->value[EFA_RDMA_READ_RESP_BYTES] = rrs->read_resp_bytes;
1990b0cff387SDaniel Kranzdorf 
19918c1b4316SGal Pressman 	return ARRAY_SIZE(efa_port_stats_names);
19928c1b4316SGal Pressman }
199316e9111eSGal Pressman 
19948c1b4316SGal Pressman int efa_get_hw_stats(struct ib_device *ibdev, struct rdma_hw_stats *stats,
19958c1b4316SGal Pressman 		     u32 port_num, int index)
19968c1b4316SGal Pressman {
19978c1b4316SGal Pressman 	if (port_num)
19988c1b4316SGal Pressman 		return efa_fill_port_stats(to_edev(ibdev), stats, port_num);
19998c1b4316SGal Pressman 	else
20008c1b4316SGal Pressman 		return efa_fill_device_stats(to_edev(ibdev), stats);
200116e9111eSGal Pressman }
200216e9111eSGal Pressman 
200340909f66SGal Pressman enum rdma_link_layer efa_port_link_layer(struct ib_device *ibdev,
20041fb7f897SMark Bloch 					 u32 port_num)
200540909f66SGal Pressman {
200640909f66SGal Pressman 	return IB_LINK_LAYER_UNSPECIFIED;
200740909f66SGal Pressman }
200840909f66SGal Pressman 
2009