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, ¶ms, &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, ¶ms); 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, ¶ms); 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(¶ms.modify_mask, EFA_ADMIN_MODIFY_QP_CMD_QP_STATE, 942ab67baddSGal Pressman 1); 943ab67baddSGal Pressman EFA_SET(¶ms.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(¶ms.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(¶ms.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(¶ms.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(¶ms.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, ¶ms); 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, ¶ms); 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, ¶ms, &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 ¶ms->pbl.pbl.address.mem_addr_high, 148040909f66SGal Pressman ¶ms->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 ¶ms->pbl.pbl.address.mem_addr_high, 148740909f66SGal Pressman ¶ms->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, ¶ms); 156740909f66SGal Pressman if (err) 156840909f66SGal Pressman goto err_unmap; 156940909f66SGal Pressman 157040909f66SGal Pressman err = efa_com_register_mr(&dev->edev, ¶ms, &result); 157140909f66SGal Pressman if (err) 157240909f66SGal Pressman goto err_unmap; 157340909f66SGal Pressman } else { 157440909f66SGal Pressman err = efa_create_pbl(dev, &pbl, mr, ¶ms); 157540909f66SGal Pressman if (err) 157640909f66SGal Pressman goto err_unmap; 157740909f66SGal Pressman 157840909f66SGal Pressman err = efa_com_register_mr(&dev->edev, ¶ms, &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, ¶ms); 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, ¶ms); 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, ¶ms); 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, ¶ms, &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, ¶ms, &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, ¶ms, &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, ¶ms, &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