| /* |
| * Copyright (c) 2013, Cisco Systems, Inc. All rights reserved. |
| * |
| * This program is free software; you may redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; version 2 of the License. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
| * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
| * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
| * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS |
| * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN |
| * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN |
| * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
| * SOFTWARE. |
| * |
| */ |
| #include <linux/module.h> |
| #include <linux/init.h> |
| #include <linux/slab.h> |
| #include <linux/errno.h> |
| |
| #include <rdma/ib_user_verbs.h> |
| #include <rdma/ib_addr.h> |
| |
| #include "usnic_abi.h" |
| #include "usnic_ib.h" |
| #include "usnic_common_util.h" |
| #include "usnic_ib_qp_grp.h" |
| #include "usnic_fwd.h" |
| #include "usnic_log.h" |
| #include "usnic_uiom.h" |
| #include "usnic_transport.h" |
| |
| #define USNIC_DEFAULT_TRANSPORT USNIC_TRANSPORT_ROCE_CUSTOM |
| |
| static void usnic_ib_fw_string_to_u64(char *fw_ver_str, u64 *fw_ver) |
| { |
| *fw_ver = (u64) *fw_ver_str; |
| } |
| |
| static int usnic_ib_fill_create_qp_resp(struct usnic_ib_qp_grp *qp_grp, |
| struct ib_udata *udata) |
| { |
| struct usnic_ib_dev *us_ibdev; |
| struct usnic_ib_create_qp_resp resp; |
| struct pci_dev *pdev; |
| struct vnic_dev_bar *bar; |
| struct usnic_vnic_res_chunk *chunk; |
| struct usnic_ib_qp_grp_flow *default_flow; |
| int i, err; |
| |
| memset(&resp, 0, sizeof(resp)); |
| |
| us_ibdev = qp_grp->vf->pf; |
| pdev = usnic_vnic_get_pdev(qp_grp->vf->vnic); |
| if (!pdev) { |
| usnic_err("Failed to get pdev of qp_grp %d\n", |
| qp_grp->grp_id); |
| return -EFAULT; |
| } |
| |
| bar = usnic_vnic_get_bar(qp_grp->vf->vnic, 0); |
| if (!bar) { |
| usnic_err("Failed to get bar0 of qp_grp %d vf %s", |
| qp_grp->grp_id, pci_name(pdev)); |
| return -EFAULT; |
| } |
| |
| resp.vfid = usnic_vnic_get_index(qp_grp->vf->vnic); |
| resp.bar_bus_addr = bar->bus_addr; |
| resp.bar_len = bar->len; |
| |
| chunk = usnic_ib_qp_grp_get_chunk(qp_grp, USNIC_VNIC_RES_TYPE_RQ); |
| if (IS_ERR_OR_NULL(chunk)) { |
| usnic_err("Failed to get chunk %s for qp_grp %d with err %ld\n", |
| usnic_vnic_res_type_to_str(USNIC_VNIC_RES_TYPE_RQ), |
| qp_grp->grp_id, |
| PTR_ERR(chunk)); |
| return chunk ? PTR_ERR(chunk) : -ENOMEM; |
| } |
| |
| WARN_ON(chunk->type != USNIC_VNIC_RES_TYPE_RQ); |
| resp.rq_cnt = chunk->cnt; |
| for (i = 0; i < chunk->cnt; i++) |
| resp.rq_idx[i] = chunk->res[i]->vnic_idx; |
| |
| chunk = usnic_ib_qp_grp_get_chunk(qp_grp, USNIC_VNIC_RES_TYPE_WQ); |
| if (IS_ERR_OR_NULL(chunk)) { |
| usnic_err("Failed to get chunk %s for qp_grp %d with err %ld\n", |
| usnic_vnic_res_type_to_str(USNIC_VNIC_RES_TYPE_WQ), |
| qp_grp->grp_id, |
| PTR_ERR(chunk)); |
| return chunk ? PTR_ERR(chunk) : -ENOMEM; |
| } |
| |
| WARN_ON(chunk->type != USNIC_VNIC_RES_TYPE_WQ); |
| resp.wq_cnt = chunk->cnt; |
| for (i = 0; i < chunk->cnt; i++) |
| resp.wq_idx[i] = chunk->res[i]->vnic_idx; |
| |
| chunk = usnic_ib_qp_grp_get_chunk(qp_grp, USNIC_VNIC_RES_TYPE_CQ); |
| if (IS_ERR_OR_NULL(chunk)) { |
| usnic_err("Failed to get chunk %s for qp_grp %d with err %ld\n", |
| usnic_vnic_res_type_to_str(USNIC_VNIC_RES_TYPE_CQ), |
| qp_grp->grp_id, |
| PTR_ERR(chunk)); |
| return chunk ? PTR_ERR(chunk) : -ENOMEM; |
| } |
| |
| WARN_ON(chunk->type != USNIC_VNIC_RES_TYPE_CQ); |
| resp.cq_cnt = chunk->cnt; |
| for (i = 0; i < chunk->cnt; i++) |
| resp.cq_idx[i] = chunk->res[i]->vnic_idx; |
| |
| default_flow = list_first_entry(&qp_grp->flows_lst, |
| struct usnic_ib_qp_grp_flow, link); |
| resp.transport = default_flow->trans_type; |
| |
| err = ib_copy_to_udata(udata, &resp, sizeof(resp)); |
| if (err) { |
| usnic_err("Failed to copy udata for %s", us_ibdev->ib_dev.name); |
| return err; |
| } |
| |
| return 0; |
| } |
| |
| static struct usnic_ib_qp_grp* |
| find_free_vf_and_create_qp_grp(struct usnic_ib_dev *us_ibdev, |
| struct usnic_ib_pd *pd, |
| struct usnic_transport_spec *trans_spec, |
| struct usnic_vnic_res_spec *res_spec) |
| { |
| struct usnic_ib_vf *vf; |
| struct usnic_vnic *vnic; |
| struct usnic_ib_qp_grp *qp_grp; |
| struct device *dev, **dev_list; |
| int i, found = 0; |
| |
| BUG_ON(!mutex_is_locked(&us_ibdev->usdev_lock)); |
| |
| if (list_empty(&us_ibdev->vf_dev_list)) { |
| usnic_info("No vfs to allocate\n"); |
| return NULL; |
| } |
| |
| if (usnic_ib_share_vf) { |
| /* Try to find resouces on a used vf which is in pd */ |
| dev_list = usnic_uiom_get_dev_list(pd->umem_pd); |
| for (i = 0; dev_list[i]; i++) { |
| dev = dev_list[i]; |
| vf = pci_get_drvdata(to_pci_dev(dev)); |
| spin_lock(&vf->lock); |
| vnic = vf->vnic; |
| if (!usnic_vnic_check_room(vnic, res_spec)) { |
| usnic_dbg("Found used vnic %s from %s\n", |
| us_ibdev->ib_dev.name, |
| pci_name(usnic_vnic_get_pdev( |
| vnic))); |
| found = 1; |
| break; |
| } |
| spin_unlock(&vf->lock); |
| |
| } |
| usnic_uiom_free_dev_list(dev_list); |
| } |
| |
| if (!found) { |
| /* Try to find resources on an unused vf */ |
| list_for_each_entry(vf, &us_ibdev->vf_dev_list, link) { |
| spin_lock(&vf->lock); |
| vnic = vf->vnic; |
| if (vf->qp_grp_ref_cnt == 0 && |
| usnic_vnic_check_room(vnic, res_spec) == 0) { |
| found = 1; |
| break; |
| } |
| spin_unlock(&vf->lock); |
| } |
| } |
| |
| if (!found) { |
| usnic_info("No free qp grp found on %s\n", |
| us_ibdev->ib_dev.name); |
| return ERR_PTR(-ENOMEM); |
| } |
| |
| qp_grp = usnic_ib_qp_grp_create(us_ibdev->ufdev, vf, pd, res_spec, |
| trans_spec); |
| spin_unlock(&vf->lock); |
| if (IS_ERR_OR_NULL(qp_grp)) { |
| usnic_err("Failed to allocate qp_grp\n"); |
| return ERR_PTR(qp_grp ? PTR_ERR(qp_grp) : -ENOMEM); |
| } |
| |
| return qp_grp; |
| } |
| |
| static void qp_grp_destroy(struct usnic_ib_qp_grp *qp_grp) |
| { |
| struct usnic_ib_vf *vf = qp_grp->vf; |
| |
| WARN_ON(qp_grp->state != IB_QPS_RESET); |
| |
| spin_lock(&vf->lock); |
| usnic_ib_qp_grp_destroy(qp_grp); |
| spin_unlock(&vf->lock); |
| } |
| |
| static void eth_speed_to_ib_speed(int speed, u8 *active_speed, |
| u8 *active_width) |
| { |
| if (speed <= 10000) { |
| *active_width = IB_WIDTH_1X; |
| *active_speed = IB_SPEED_FDR10; |
| } else if (speed <= 20000) { |
| *active_width = IB_WIDTH_4X; |
| *active_speed = IB_SPEED_DDR; |
| } else if (speed <= 30000) { |
| *active_width = IB_WIDTH_4X; |
| *active_speed = IB_SPEED_QDR; |
| } else if (speed <= 40000) { |
| *active_width = IB_WIDTH_4X; |
| *active_speed = IB_SPEED_FDR10; |
| } else { |
| *active_width = IB_WIDTH_4X; |
| *active_speed = IB_SPEED_EDR; |
| } |
| } |
| |
| static int create_qp_validate_user_data(struct usnic_ib_create_qp_cmd cmd) |
| { |
| if (cmd.spec.trans_type <= USNIC_TRANSPORT_UNKNOWN || |
| cmd.spec.trans_type >= USNIC_TRANSPORT_MAX) |
| return -EINVAL; |
| |
| return 0; |
| } |
| |
| /* Start of ib callback functions */ |
| |
| enum rdma_link_layer usnic_ib_port_link_layer(struct ib_device *device, |
| u8 port_num) |
| { |
| return IB_LINK_LAYER_ETHERNET; |
| } |
| |
| int usnic_ib_query_device(struct ib_device *ibdev, |
| struct ib_device_attr *props) |
| { |
| struct usnic_ib_dev *us_ibdev = to_usdev(ibdev); |
| union ib_gid gid; |
| struct ethtool_drvinfo info; |
| struct ethtool_cmd cmd; |
| int qp_per_vf; |
| |
| usnic_dbg("\n"); |
| mutex_lock(&us_ibdev->usdev_lock); |
| us_ibdev->netdev->ethtool_ops->get_drvinfo(us_ibdev->netdev, &info); |
| us_ibdev->netdev->ethtool_ops->get_settings(us_ibdev->netdev, &cmd); |
| memset(props, 0, sizeof(*props)); |
| usnic_mac_ip_to_gid(us_ibdev->ufdev->mac, us_ibdev->ufdev->inaddr, |
| &gid.raw[0]); |
| memcpy(&props->sys_image_guid, &gid.global.interface_id, |
| sizeof(gid.global.interface_id)); |
| usnic_ib_fw_string_to_u64(&info.fw_version[0], &props->fw_ver); |
| props->max_mr_size = USNIC_UIOM_MAX_MR_SIZE; |
| props->page_size_cap = USNIC_UIOM_PAGE_SIZE; |
| props->vendor_id = PCI_VENDOR_ID_CISCO; |
| props->vendor_part_id = PCI_DEVICE_ID_CISCO_VIC_USPACE_NIC; |
| props->hw_ver = us_ibdev->pdev->subsystem_device; |
| qp_per_vf = max(us_ibdev->vf_res_cnt[USNIC_VNIC_RES_TYPE_WQ], |
| us_ibdev->vf_res_cnt[USNIC_VNIC_RES_TYPE_RQ]); |
| props->max_qp = qp_per_vf * |
| atomic_read(&us_ibdev->vf_cnt.refcount); |
| props->device_cap_flags = IB_DEVICE_PORT_ACTIVE_EVENT | |
| IB_DEVICE_SYS_IMAGE_GUID | IB_DEVICE_BLOCK_MULTICAST_LOOPBACK; |
| props->max_cq = us_ibdev->vf_res_cnt[USNIC_VNIC_RES_TYPE_CQ] * |
| atomic_read(&us_ibdev->vf_cnt.refcount); |
| props->max_pd = USNIC_UIOM_MAX_PD_CNT; |
| props->max_mr = USNIC_UIOM_MAX_MR_CNT; |
| props->local_ca_ack_delay = 0; |
| props->max_pkeys = 0; |
| props->atomic_cap = IB_ATOMIC_NONE; |
| props->masked_atomic_cap = props->atomic_cap; |
| props->max_qp_rd_atom = 0; |
| props->max_qp_init_rd_atom = 0; |
| props->max_res_rd_atom = 0; |
| props->max_srq = 0; |
| props->max_srq_wr = 0; |
| props->max_srq_sge = 0; |
| props->max_fast_reg_page_list_len = 0; |
| props->max_mcast_grp = 0; |
| props->max_mcast_qp_attach = 0; |
| props->max_total_mcast_qp_attach = 0; |
| props->max_map_per_fmr = 0; |
| /* Owned by Userspace |
| * max_qp_wr, max_sge, max_sge_rd, max_cqe */ |
| mutex_unlock(&us_ibdev->usdev_lock); |
| |
| return 0; |
| } |
| |
| int usnic_ib_query_port(struct ib_device *ibdev, u8 port, |
| struct ib_port_attr *props) |
| { |
| struct usnic_ib_dev *us_ibdev = to_usdev(ibdev); |
| struct ethtool_cmd cmd; |
| |
| usnic_dbg("\n"); |
| |
| mutex_lock(&us_ibdev->usdev_lock); |
| us_ibdev->netdev->ethtool_ops->get_settings(us_ibdev->netdev, &cmd); |
| memset(props, 0, sizeof(*props)); |
| |
| props->lid = 0; |
| props->lmc = 1; |
| props->sm_lid = 0; |
| props->sm_sl = 0; |
| |
| if (!us_ibdev->ufdev->link_up) { |
| props->state = IB_PORT_DOWN; |
| props->phys_state = 3; |
| } else if (!us_ibdev->ufdev->inaddr) { |
| props->state = IB_PORT_INIT; |
| props->phys_state = 4; |
| } else { |
| props->state = IB_PORT_ACTIVE; |
| props->phys_state = 5; |
| } |
| |
| props->port_cap_flags = 0; |
| props->gid_tbl_len = 1; |
| props->pkey_tbl_len = 1; |
| props->bad_pkey_cntr = 0; |
| props->qkey_viol_cntr = 0; |
| eth_speed_to_ib_speed(cmd.speed, &props->active_speed, |
| &props->active_width); |
| props->max_mtu = IB_MTU_4096; |
| props->active_mtu = iboe_get_mtu(us_ibdev->ufdev->mtu); |
| /* Userspace will adjust for hdrs */ |
| props->max_msg_sz = us_ibdev->ufdev->mtu; |
| props->max_vl_num = 1; |
| mutex_unlock(&us_ibdev->usdev_lock); |
| |
| return 0; |
| } |
| |
| int usnic_ib_query_qp(struct ib_qp *qp, struct ib_qp_attr *qp_attr, |
| int qp_attr_mask, |
| struct ib_qp_init_attr *qp_init_attr) |
| { |
| struct usnic_ib_qp_grp *qp_grp; |
| struct usnic_ib_vf *vf; |
| int err; |
| |
| usnic_dbg("\n"); |
| |
| memset(qp_attr, 0, sizeof(*qp_attr)); |
| memset(qp_init_attr, 0, sizeof(*qp_init_attr)); |
| |
| qp_grp = to_uqp_grp(qp); |
| vf = qp_grp->vf; |
| mutex_lock(&vf->pf->usdev_lock); |
| usnic_dbg("\n"); |
| qp_attr->qp_state = qp_grp->state; |
| qp_attr->cur_qp_state = qp_grp->state; |
| |
| switch (qp_grp->ibqp.qp_type) { |
| case IB_QPT_UD: |
| qp_attr->qkey = 0; |
| break; |
| default: |
| usnic_err("Unexpected qp_type %d\n", qp_grp->ibqp.qp_type); |
| err = -EINVAL; |
| goto err_out; |
| } |
| |
| mutex_unlock(&vf->pf->usdev_lock); |
| return 0; |
| |
| err_out: |
| mutex_unlock(&vf->pf->usdev_lock); |
| return err; |
| } |
| |
| int usnic_ib_query_gid(struct ib_device *ibdev, u8 port, int index, |
| union ib_gid *gid) |
| { |
| |
| struct usnic_ib_dev *us_ibdev = to_usdev(ibdev); |
| usnic_dbg("\n"); |
| |
| if (index > 1) |
| return -EINVAL; |
| |
| mutex_lock(&us_ibdev->usdev_lock); |
| memset(&(gid->raw[0]), 0, sizeof(gid->raw)); |
| usnic_mac_ip_to_gid(us_ibdev->ufdev->mac, us_ibdev->ufdev->inaddr, |
| &gid->raw[0]); |
| mutex_unlock(&us_ibdev->usdev_lock); |
| |
| return 0; |
| } |
| |
| int usnic_ib_query_pkey(struct ib_device *ibdev, u8 port, u16 index, |
| u16 *pkey) |
| { |
| if (index > 1) |
| return -EINVAL; |
| |
| *pkey = 0xffff; |
| return 0; |
| } |
| |
| struct ib_pd *usnic_ib_alloc_pd(struct ib_device *ibdev, |
| struct ib_ucontext *context, |
| struct ib_udata *udata) |
| { |
| struct usnic_ib_pd *pd; |
| void *umem_pd; |
| |
| usnic_dbg("\n"); |
| |
| pd = kzalloc(sizeof(*pd), GFP_KERNEL); |
| if (!pd) |
| return ERR_PTR(-ENOMEM); |
| |
| umem_pd = pd->umem_pd = usnic_uiom_alloc_pd(); |
| if (IS_ERR_OR_NULL(umem_pd)) { |
| kfree(pd); |
| return ERR_PTR(umem_pd ? PTR_ERR(umem_pd) : -ENOMEM); |
| } |
| |
| usnic_info("domain 0x%p allocated for context 0x%p and device %s\n", |
| pd, context, ibdev->name); |
| return &pd->ibpd; |
| } |
| |
| int usnic_ib_dealloc_pd(struct ib_pd *pd) |
| { |
| usnic_info("freeing domain 0x%p\n", pd); |
| |
| usnic_uiom_dealloc_pd((to_upd(pd))->umem_pd); |
| kfree(pd); |
| return 0; |
| } |
| |
| struct ib_qp *usnic_ib_create_qp(struct ib_pd *pd, |
| struct ib_qp_init_attr *init_attr, |
| struct ib_udata *udata) |
| { |
| int err; |
| struct usnic_ib_dev *us_ibdev; |
| struct usnic_ib_qp_grp *qp_grp; |
| struct usnic_ib_ucontext *ucontext; |
| int cq_cnt; |
| struct usnic_vnic_res_spec res_spec; |
| struct usnic_ib_create_qp_cmd cmd; |
| struct usnic_transport_spec trans_spec; |
| |
| usnic_dbg("\n"); |
| |
| ucontext = to_uucontext(pd->uobject->context); |
| us_ibdev = to_usdev(pd->device); |
| |
| err = ib_copy_from_udata(&cmd, udata, sizeof(cmd)); |
| if (err) { |
| usnic_err("%s: cannot copy udata for create_qp\n", |
| us_ibdev->ib_dev.name); |
| return ERR_PTR(-EINVAL); |
| } |
| |
| err = create_qp_validate_user_data(cmd); |
| if (err) { |
| usnic_err("%s: Failed to validate user data\n", |
| us_ibdev->ib_dev.name); |
| return ERR_PTR(-EINVAL); |
| } |
| |
| if (init_attr->qp_type != IB_QPT_UD) { |
| usnic_err("%s asked to make a non-UD QP: %d\n", |
| us_ibdev->ib_dev.name, init_attr->qp_type); |
| return ERR_PTR(-EINVAL); |
| } |
| |
| trans_spec = cmd.spec; |
| mutex_lock(&us_ibdev->usdev_lock); |
| cq_cnt = (init_attr->send_cq == init_attr->recv_cq) ? 1 : 2; |
| res_spec = min_transport_spec[trans_spec.trans_type]; |
| usnic_vnic_res_spec_update(&res_spec, USNIC_VNIC_RES_TYPE_CQ, cq_cnt); |
| qp_grp = find_free_vf_and_create_qp_grp(us_ibdev, to_upd(pd), |
| &trans_spec, |
| &res_spec); |
| if (IS_ERR_OR_NULL(qp_grp)) { |
| err = qp_grp ? PTR_ERR(qp_grp) : -ENOMEM; |
| goto out_release_mutex; |
| } |
| |
| err = usnic_ib_fill_create_qp_resp(qp_grp, udata); |
| if (err) { |
| err = -EBUSY; |
| goto out_release_qp_grp; |
| } |
| |
| qp_grp->ctx = ucontext; |
| list_add_tail(&qp_grp->link, &ucontext->qp_grp_list); |
| usnic_ib_log_vf(qp_grp->vf); |
| mutex_unlock(&us_ibdev->usdev_lock); |
| return &qp_grp->ibqp; |
| |
| out_release_qp_grp: |
| qp_grp_destroy(qp_grp); |
| out_release_mutex: |
| mutex_unlock(&us_ibdev->usdev_lock); |
| return ERR_PTR(err); |
| } |
| |
| int usnic_ib_destroy_qp(struct ib_qp *qp) |
| { |
| struct usnic_ib_qp_grp *qp_grp; |
| struct usnic_ib_vf *vf; |
| |
| usnic_dbg("\n"); |
| |
| qp_grp = to_uqp_grp(qp); |
| vf = qp_grp->vf; |
| mutex_lock(&vf->pf->usdev_lock); |
| if (usnic_ib_qp_grp_modify(qp_grp, IB_QPS_RESET, NULL)) { |
| usnic_err("Failed to move qp grp %u to reset\n", |
| qp_grp->grp_id); |
| } |
| |
| list_del(&qp_grp->link); |
| qp_grp_destroy(qp_grp); |
| mutex_unlock(&vf->pf->usdev_lock); |
| |
| return 0; |
| } |
| |
| int usnic_ib_modify_qp(struct ib_qp *ibqp, struct ib_qp_attr *attr, |
| int attr_mask, struct ib_udata *udata) |
| { |
| struct usnic_ib_qp_grp *qp_grp; |
| int status; |
| usnic_dbg("\n"); |
| |
| qp_grp = to_uqp_grp(ibqp); |
| |
| /* TODO: Future Support All States */ |
| mutex_lock(&qp_grp->vf->pf->usdev_lock); |
| if ((attr_mask & IB_QP_STATE) && attr->qp_state == IB_QPS_INIT) { |
| status = usnic_ib_qp_grp_modify(qp_grp, IB_QPS_INIT, NULL); |
| } else if ((attr_mask & IB_QP_STATE) && attr->qp_state == IB_QPS_RTR) { |
| status = usnic_ib_qp_grp_modify(qp_grp, IB_QPS_RTR, NULL); |
| } else if ((attr_mask & IB_QP_STATE) && attr->qp_state == IB_QPS_RTS) { |
| status = usnic_ib_qp_grp_modify(qp_grp, IB_QPS_RTS, NULL); |
| } else { |
| usnic_err("Unexpected combination mask: %u state: %u\n", |
| attr_mask & IB_QP_STATE, attr->qp_state); |
| status = -EINVAL; |
| } |
| |
| mutex_unlock(&qp_grp->vf->pf->usdev_lock); |
| return status; |
| } |
| |
| struct ib_cq *usnic_ib_create_cq(struct ib_device *ibdev, int entries, |
| int vector, struct ib_ucontext *context, |
| struct ib_udata *udata) |
| { |
| struct ib_cq *cq; |
| |
| usnic_dbg("\n"); |
| cq = kzalloc(sizeof(*cq), GFP_KERNEL); |
| if (!cq) |
| return ERR_PTR(-EBUSY); |
| |
| return cq; |
| } |
| |
| int usnic_ib_destroy_cq(struct ib_cq *cq) |
| { |
| usnic_dbg("\n"); |
| kfree(cq); |
| return 0; |
| } |
| |
| struct ib_mr *usnic_ib_reg_mr(struct ib_pd *pd, u64 start, u64 length, |
| u64 virt_addr, int access_flags, |
| struct ib_udata *udata) |
| { |
| struct usnic_ib_mr *mr; |
| int err; |
| |
| usnic_dbg("start 0x%llx va 0x%llx length 0x%llx\n", start, |
| virt_addr, length); |
| |
| mr = kzalloc(sizeof(*mr), GFP_KERNEL); |
| if (IS_ERR_OR_NULL(mr)) |
| return ERR_PTR(mr ? PTR_ERR(mr) : -ENOMEM); |
| |
| mr->umem = usnic_uiom_reg_get(to_upd(pd)->umem_pd, start, length, |
| access_flags, 0); |
| if (IS_ERR_OR_NULL(mr->umem)) { |
| err = mr->umem ? PTR_ERR(mr->umem) : -EFAULT; |
| goto err_free; |
| } |
| |
| mr->ibmr.lkey = mr->ibmr.rkey = 0; |
| return &mr->ibmr; |
| |
| err_free: |
| kfree(mr); |
| return ERR_PTR(err); |
| } |
| |
| int usnic_ib_dereg_mr(struct ib_mr *ibmr) |
| { |
| struct usnic_ib_mr *mr = to_umr(ibmr); |
| |
| usnic_dbg("va 0x%lx length 0x%zx\n", mr->umem->va, mr->umem->length); |
| |
| usnic_uiom_reg_release(mr->umem, ibmr->pd->uobject->context->closing); |
| kfree(mr); |
| return 0; |
| } |
| |
| struct ib_ucontext *usnic_ib_alloc_ucontext(struct ib_device *ibdev, |
| struct ib_udata *udata) |
| { |
| struct usnic_ib_ucontext *context; |
| struct usnic_ib_dev *us_ibdev = to_usdev(ibdev); |
| usnic_dbg("\n"); |
| |
| context = kmalloc(sizeof(*context), GFP_KERNEL); |
| if (!context) |
| return ERR_PTR(-ENOMEM); |
| |
| INIT_LIST_HEAD(&context->qp_grp_list); |
| mutex_lock(&us_ibdev->usdev_lock); |
| list_add_tail(&context->link, &us_ibdev->ctx_list); |
| mutex_unlock(&us_ibdev->usdev_lock); |
| |
| return &context->ibucontext; |
| } |
| |
| int usnic_ib_dealloc_ucontext(struct ib_ucontext *ibcontext) |
| { |
| struct usnic_ib_ucontext *context = to_uucontext(ibcontext); |
| struct usnic_ib_dev *us_ibdev = to_usdev(ibcontext->device); |
| usnic_dbg("\n"); |
| |
| mutex_lock(&us_ibdev->usdev_lock); |
| BUG_ON(!list_empty(&context->qp_grp_list)); |
| list_del(&context->link); |
| mutex_unlock(&us_ibdev->usdev_lock); |
| kfree(context); |
| return 0; |
| } |
| |
| int usnic_ib_mmap(struct ib_ucontext *context, |
| struct vm_area_struct *vma) |
| { |
| struct usnic_ib_ucontext *uctx = to_ucontext(context); |
| struct usnic_ib_dev *us_ibdev; |
| struct usnic_ib_qp_grp *qp_grp; |
| struct usnic_ib_vf *vf; |
| struct vnic_dev_bar *bar; |
| dma_addr_t bus_addr; |
| unsigned int len; |
| unsigned int vfid; |
| |
| usnic_dbg("\n"); |
| |
| us_ibdev = to_usdev(context->device); |
| vma->vm_flags |= VM_IO; |
| vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); |
| vfid = vma->vm_pgoff; |
| usnic_dbg("Page Offset %lu PAGE_SHIFT %u VFID %u\n", |
| vma->vm_pgoff, PAGE_SHIFT, vfid); |
| |
| mutex_lock(&us_ibdev->usdev_lock); |
| list_for_each_entry(qp_grp, &uctx->qp_grp_list, link) { |
| vf = qp_grp->vf; |
| if (usnic_vnic_get_index(vf->vnic) == vfid) { |
| bar = usnic_vnic_get_bar(vf->vnic, 0); |
| if ((vma->vm_end - vma->vm_start) != bar->len) { |
| usnic_err("Bar0 Len %lu - Request map %lu\n", |
| bar->len, |
| vma->vm_end - vma->vm_start); |
| mutex_unlock(&us_ibdev->usdev_lock); |
| return -EINVAL; |
| } |
| bus_addr = bar->bus_addr; |
| len = bar->len; |
| usnic_dbg("bus: %pa vaddr: %p size: %ld\n", |
| &bus_addr, bar->vaddr, bar->len); |
| mutex_unlock(&us_ibdev->usdev_lock); |
| |
| return remap_pfn_range(vma, |
| vma->vm_start, |
| bus_addr >> PAGE_SHIFT, |
| len, vma->vm_page_prot); |
| } |
| } |
| |
| mutex_unlock(&us_ibdev->usdev_lock); |
| usnic_err("No VF %u found\n", vfid); |
| return -EINVAL; |
| } |
| |
| /* In ib callbacks section - Start of stub funcs */ |
| struct ib_ah *usnic_ib_create_ah(struct ib_pd *pd, |
| struct ib_ah_attr *ah_attr) |
| { |
| usnic_dbg("\n"); |
| return ERR_PTR(-EPERM); |
| } |
| |
| int usnic_ib_destroy_ah(struct ib_ah *ah) |
| { |
| usnic_dbg("\n"); |
| return -EINVAL; |
| } |
| |
| int usnic_ib_post_send(struct ib_qp *ibqp, struct ib_send_wr *wr, |
| struct ib_send_wr **bad_wr) |
| { |
| usnic_dbg("\n"); |
| return -EINVAL; |
| } |
| |
| int usnic_ib_post_recv(struct ib_qp *ibqp, struct ib_recv_wr *wr, |
| struct ib_recv_wr **bad_wr) |
| { |
| usnic_dbg("\n"); |
| return -EINVAL; |
| } |
| |
| int usnic_ib_poll_cq(struct ib_cq *ibcq, int num_entries, |
| struct ib_wc *wc) |
| { |
| usnic_dbg("\n"); |
| return -EINVAL; |
| } |
| |
| int usnic_ib_req_notify_cq(struct ib_cq *cq, |
| enum ib_cq_notify_flags flags) |
| { |
| usnic_dbg("\n"); |
| return -EINVAL; |
| } |
| |
| struct ib_mr *usnic_ib_get_dma_mr(struct ib_pd *pd, int acc) |
| { |
| usnic_dbg("\n"); |
| return ERR_PTR(-ENOMEM); |
| } |
| |
| |
| /* In ib callbacks section - End of stub funcs */ |
| /* End of ib callbacks section */ |