mirror of
				https://git.kernel.org/pub/scm/linux/kernel/git/chenhuacai/linux-loongson
				synced 2025-10-31 09:36:25 +00:00 
			
		
		
		
	 9a6edb60ec
			
		
	
	
		9a6edb60ec
		
	
	
	
	
		
			
			Add a new parameter to ib_register_device() so that low-level device
drivers can pass in a pointer to a callback function that will be
called for each port that is registered in sysfs.  This allows
low-level device drivers to create files in
    /sys/class/infiniband/<hca>/ports/<N>/
without having to poke through the internals of the RDMA sysfs handling.
There is no need for an unregister function since the kobject
reference will go to zero when ib_unregister_device() is called.
Signed-off-by: Ralph Campbell <ralph.campbell@qlogic.com>
Signed-off-by: Roland Dreier <rolandd@cisco.com>
		
	
			
		
			
				
	
	
		
			1429 lines
		
	
	
		
			36 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1429 lines
		
	
	
		
			36 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Copyright (c) 2004, 2005 Topspin Communications.  All rights reserved.
 | |
|  * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved.
 | |
|  * Copyright (c) 2005, 2006 Cisco Systems.  All rights reserved.
 | |
|  * Copyright (c) 2005 Mellanox Technologies. All rights reserved.
 | |
|  * Copyright (c) 2004 Voltaire, Inc. All rights reserved.
 | |
|  *
 | |
|  * This software is available to you under a choice of one of two
 | |
|  * licenses.  You may choose to be licensed under the terms of the GNU
 | |
|  * General Public License (GPL) Version 2, available from the file
 | |
|  * COPYING in the main directory of this source tree, or the
 | |
|  * OpenIB.org BSD license below:
 | |
|  *
 | |
|  *     Redistribution and use in source and binary forms, with or
 | |
|  *     without modification, are permitted provided that the following
 | |
|  *     conditions are met:
 | |
|  *
 | |
|  *      - Redistributions of source code must retain the above
 | |
|  *        copyright notice, this list of conditions and the following
 | |
|  *        disclaimer.
 | |
|  *
 | |
|  *      - Redistributions in binary form must reproduce the above
 | |
|  *        copyright notice, this list of conditions and the following
 | |
|  *        disclaimer in the documentation and/or other materials
 | |
|  *        provided with the distribution.
 | |
|  *
 | |
|  * 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 <rdma/ib_smi.h>
 | |
| #include <rdma/ib_umem.h>
 | |
| #include <rdma/ib_user_verbs.h>
 | |
| 
 | |
| #include <linux/sched.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/mm.h>
 | |
| 
 | |
| #include "mthca_dev.h"
 | |
| #include "mthca_cmd.h"
 | |
| #include "mthca_user.h"
 | |
| #include "mthca_memfree.h"
 | |
| 
 | |
| static void init_query_mad(struct ib_smp *mad)
 | |
| {
 | |
| 	mad->base_version  = 1;
 | |
| 	mad->mgmt_class    = IB_MGMT_CLASS_SUBN_LID_ROUTED;
 | |
| 	mad->class_version = 1;
 | |
| 	mad->method    	   = IB_MGMT_METHOD_GET;
 | |
| }
 | |
| 
 | |
| static int mthca_query_device(struct ib_device *ibdev,
 | |
| 			      struct ib_device_attr *props)
 | |
| {
 | |
| 	struct ib_smp *in_mad  = NULL;
 | |
| 	struct ib_smp *out_mad = NULL;
 | |
| 	int err = -ENOMEM;
 | |
| 	struct mthca_dev *mdev = to_mdev(ibdev);
 | |
| 
 | |
| 	u8 status;
 | |
| 
 | |
| 	in_mad  = kzalloc(sizeof *in_mad, GFP_KERNEL);
 | |
| 	out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
 | |
| 	if (!in_mad || !out_mad)
 | |
| 		goto out;
 | |
| 
 | |
| 	memset(props, 0, sizeof *props);
 | |
| 
 | |
| 	props->fw_ver              = mdev->fw_ver;
 | |
| 
 | |
| 	init_query_mad(in_mad);
 | |
| 	in_mad->attr_id = IB_SMP_ATTR_NODE_INFO;
 | |
| 
 | |
| 	err = mthca_MAD_IFC(mdev, 1, 1,
 | |
| 			    1, NULL, NULL, in_mad, out_mad,
 | |
| 			    &status);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 	if (status) {
 | |
| 		err = -EINVAL;
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	props->device_cap_flags    = mdev->device_cap_flags;
 | |
| 	props->vendor_id           = be32_to_cpup((__be32 *) (out_mad->data + 36)) &
 | |
| 		0xffffff;
 | |
| 	props->vendor_part_id      = be16_to_cpup((__be16 *) (out_mad->data + 30));
 | |
| 	props->hw_ver              = be32_to_cpup((__be32 *) (out_mad->data + 32));
 | |
| 	memcpy(&props->sys_image_guid, out_mad->data +  4, 8);
 | |
| 
 | |
| 	props->max_mr_size         = ~0ull;
 | |
| 	props->page_size_cap       = mdev->limits.page_size_cap;
 | |
| 	props->max_qp              = mdev->limits.num_qps - mdev->limits.reserved_qps;
 | |
| 	props->max_qp_wr           = mdev->limits.max_wqes;
 | |
| 	props->max_sge             = mdev->limits.max_sg;
 | |
| 	props->max_cq              = mdev->limits.num_cqs - mdev->limits.reserved_cqs;
 | |
| 	props->max_cqe             = mdev->limits.max_cqes;
 | |
| 	props->max_mr              = mdev->limits.num_mpts - mdev->limits.reserved_mrws;
 | |
| 	props->max_pd              = mdev->limits.num_pds - mdev->limits.reserved_pds;
 | |
| 	props->max_qp_rd_atom      = 1 << mdev->qp_table.rdb_shift;
 | |
| 	props->max_qp_init_rd_atom = mdev->limits.max_qp_init_rdma;
 | |
| 	props->max_res_rd_atom     = props->max_qp_rd_atom * props->max_qp;
 | |
| 	props->max_srq             = mdev->limits.num_srqs - mdev->limits.reserved_srqs;
 | |
| 	props->max_srq_wr          = mdev->limits.max_srq_wqes;
 | |
| 	props->max_srq_sge         = mdev->limits.max_srq_sge;
 | |
| 	props->local_ca_ack_delay  = mdev->limits.local_ca_ack_delay;
 | |
| 	props->atomic_cap          = mdev->limits.flags & DEV_LIM_FLAG_ATOMIC ?
 | |
| 					IB_ATOMIC_HCA : IB_ATOMIC_NONE;
 | |
| 	props->max_pkeys           = mdev->limits.pkey_table_len;
 | |
| 	props->max_mcast_grp       = mdev->limits.num_mgms + mdev->limits.num_amgms;
 | |
| 	props->max_mcast_qp_attach = MTHCA_QP_PER_MGM;
 | |
| 	props->max_total_mcast_qp_attach = props->max_mcast_qp_attach *
 | |
| 					   props->max_mcast_grp;
 | |
| 	/*
 | |
| 	 * If Sinai memory key optimization is being used, then only
 | |
| 	 * the 8-bit key portion will change.  For other HCAs, the
 | |
| 	 * unused index bits will also be used for FMR remapping.
 | |
| 	 */
 | |
| 	if (mdev->mthca_flags & MTHCA_FLAG_SINAI_OPT)
 | |
| 		props->max_map_per_fmr = 255;
 | |
| 	else
 | |
| 		props->max_map_per_fmr =
 | |
| 			(1 << (32 - ilog2(mdev->limits.num_mpts))) - 1;
 | |
| 
 | |
| 	err = 0;
 | |
|  out:
 | |
| 	kfree(in_mad);
 | |
| 	kfree(out_mad);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int mthca_query_port(struct ib_device *ibdev,
 | |
| 			    u8 port, struct ib_port_attr *props)
 | |
| {
 | |
| 	struct ib_smp *in_mad  = NULL;
 | |
| 	struct ib_smp *out_mad = NULL;
 | |
| 	int err = -ENOMEM;
 | |
| 	u8 status;
 | |
| 
 | |
| 	in_mad  = kzalloc(sizeof *in_mad, GFP_KERNEL);
 | |
| 	out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
 | |
| 	if (!in_mad || !out_mad)
 | |
| 		goto out;
 | |
| 
 | |
| 	memset(props, 0, sizeof *props);
 | |
| 
 | |
| 	init_query_mad(in_mad);
 | |
| 	in_mad->attr_id  = IB_SMP_ATTR_PORT_INFO;
 | |
| 	in_mad->attr_mod = cpu_to_be32(port);
 | |
| 
 | |
| 	err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
 | |
| 			    port, NULL, NULL, in_mad, out_mad,
 | |
| 			    &status);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 	if (status) {
 | |
| 		err = -EINVAL;
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	props->lid               = be16_to_cpup((__be16 *) (out_mad->data + 16));
 | |
| 	props->lmc               = out_mad->data[34] & 0x7;
 | |
| 	props->sm_lid            = be16_to_cpup((__be16 *) (out_mad->data + 18));
 | |
| 	props->sm_sl             = out_mad->data[36] & 0xf;
 | |
| 	props->state             = out_mad->data[32] & 0xf;
 | |
| 	props->phys_state        = out_mad->data[33] >> 4;
 | |
| 	props->port_cap_flags    = be32_to_cpup((__be32 *) (out_mad->data + 20));
 | |
| 	props->gid_tbl_len       = to_mdev(ibdev)->limits.gid_table_len;
 | |
| 	props->max_msg_sz        = 0x80000000;
 | |
| 	props->pkey_tbl_len      = to_mdev(ibdev)->limits.pkey_table_len;
 | |
| 	props->bad_pkey_cntr     = be16_to_cpup((__be16 *) (out_mad->data + 46));
 | |
| 	props->qkey_viol_cntr    = be16_to_cpup((__be16 *) (out_mad->data + 48));
 | |
| 	props->active_width      = out_mad->data[31] & 0xf;
 | |
| 	props->active_speed      = out_mad->data[35] >> 4;
 | |
| 	props->max_mtu           = out_mad->data[41] & 0xf;
 | |
| 	props->active_mtu        = out_mad->data[36] >> 4;
 | |
| 	props->subnet_timeout    = out_mad->data[51] & 0x1f;
 | |
| 	props->max_vl_num        = out_mad->data[37] >> 4;
 | |
| 	props->init_type_reply   = out_mad->data[41] >> 4;
 | |
| 
 | |
|  out:
 | |
| 	kfree(in_mad);
 | |
| 	kfree(out_mad);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int mthca_modify_device(struct ib_device *ibdev,
 | |
| 			       int mask,
 | |
| 			       struct ib_device_modify *props)
 | |
| {
 | |
| 	if (mask & ~IB_DEVICE_MODIFY_NODE_DESC)
 | |
| 		return -EOPNOTSUPP;
 | |
| 
 | |
| 	if (mask & IB_DEVICE_MODIFY_NODE_DESC) {
 | |
| 		if (mutex_lock_interruptible(&to_mdev(ibdev)->cap_mask_mutex))
 | |
| 			return -ERESTARTSYS;
 | |
| 		memcpy(ibdev->node_desc, props->node_desc, 64);
 | |
| 		mutex_unlock(&to_mdev(ibdev)->cap_mask_mutex);
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int mthca_modify_port(struct ib_device *ibdev,
 | |
| 			     u8 port, int port_modify_mask,
 | |
| 			     struct ib_port_modify *props)
 | |
| {
 | |
| 	struct mthca_set_ib_param set_ib;
 | |
| 	struct ib_port_attr attr;
 | |
| 	int err;
 | |
| 	u8 status;
 | |
| 
 | |
| 	if (mutex_lock_interruptible(&to_mdev(ibdev)->cap_mask_mutex))
 | |
| 		return -ERESTARTSYS;
 | |
| 
 | |
| 	err = mthca_query_port(ibdev, port, &attr);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 
 | |
| 	set_ib.set_si_guid     = 0;
 | |
| 	set_ib.reset_qkey_viol = !!(port_modify_mask & IB_PORT_RESET_QKEY_CNTR);
 | |
| 
 | |
| 	set_ib.cap_mask = (attr.port_cap_flags | props->set_port_cap_mask) &
 | |
| 		~props->clr_port_cap_mask;
 | |
| 
 | |
| 	err = mthca_SET_IB(to_mdev(ibdev), &set_ib, port, &status);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 	if (status) {
 | |
| 		err = -EINVAL;
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| out:
 | |
| 	mutex_unlock(&to_mdev(ibdev)->cap_mask_mutex);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int mthca_query_pkey(struct ib_device *ibdev,
 | |
| 			    u8 port, u16 index, u16 *pkey)
 | |
| {
 | |
| 	struct ib_smp *in_mad  = NULL;
 | |
| 	struct ib_smp *out_mad = NULL;
 | |
| 	int err = -ENOMEM;
 | |
| 	u8 status;
 | |
| 
 | |
| 	in_mad  = kzalloc(sizeof *in_mad, GFP_KERNEL);
 | |
| 	out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
 | |
| 	if (!in_mad || !out_mad)
 | |
| 		goto out;
 | |
| 
 | |
| 	init_query_mad(in_mad);
 | |
| 	in_mad->attr_id  = IB_SMP_ATTR_PKEY_TABLE;
 | |
| 	in_mad->attr_mod = cpu_to_be32(index / 32);
 | |
| 
 | |
| 	err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
 | |
| 			    port, NULL, NULL, in_mad, out_mad,
 | |
| 			    &status);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 	if (status) {
 | |
| 		err = -EINVAL;
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	*pkey = be16_to_cpu(((__be16 *) out_mad->data)[index % 32]);
 | |
| 
 | |
|  out:
 | |
| 	kfree(in_mad);
 | |
| 	kfree(out_mad);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int mthca_query_gid(struct ib_device *ibdev, u8 port,
 | |
| 			   int index, union ib_gid *gid)
 | |
| {
 | |
| 	struct ib_smp *in_mad  = NULL;
 | |
| 	struct ib_smp *out_mad = NULL;
 | |
| 	int err = -ENOMEM;
 | |
| 	u8 status;
 | |
| 
 | |
| 	in_mad  = kzalloc(sizeof *in_mad, GFP_KERNEL);
 | |
| 	out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
 | |
| 	if (!in_mad || !out_mad)
 | |
| 		goto out;
 | |
| 
 | |
| 	init_query_mad(in_mad);
 | |
| 	in_mad->attr_id  = IB_SMP_ATTR_PORT_INFO;
 | |
| 	in_mad->attr_mod = cpu_to_be32(port);
 | |
| 
 | |
| 	err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
 | |
| 			    port, NULL, NULL, in_mad, out_mad,
 | |
| 			    &status);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 	if (status) {
 | |
| 		err = -EINVAL;
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	memcpy(gid->raw, out_mad->data + 8, 8);
 | |
| 
 | |
| 	init_query_mad(in_mad);
 | |
| 	in_mad->attr_id  = IB_SMP_ATTR_GUID_INFO;
 | |
| 	in_mad->attr_mod = cpu_to_be32(index / 8);
 | |
| 
 | |
| 	err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
 | |
| 			    port, NULL, NULL, in_mad, out_mad,
 | |
| 			    &status);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 	if (status) {
 | |
| 		err = -EINVAL;
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	memcpy(gid->raw + 8, out_mad->data + (index % 8) * 8, 8);
 | |
| 
 | |
|  out:
 | |
| 	kfree(in_mad);
 | |
| 	kfree(out_mad);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static struct ib_ucontext *mthca_alloc_ucontext(struct ib_device *ibdev,
 | |
| 						struct ib_udata *udata)
 | |
| {
 | |
| 	struct mthca_alloc_ucontext_resp uresp;
 | |
| 	struct mthca_ucontext           *context;
 | |
| 	int                              err;
 | |
| 
 | |
| 	if (!(to_mdev(ibdev)->active))
 | |
| 		return ERR_PTR(-EAGAIN);
 | |
| 
 | |
| 	memset(&uresp, 0, sizeof uresp);
 | |
| 
 | |
| 	uresp.qp_tab_size = to_mdev(ibdev)->limits.num_qps;
 | |
| 	if (mthca_is_memfree(to_mdev(ibdev)))
 | |
| 		uresp.uarc_size = to_mdev(ibdev)->uar_table.uarc_size;
 | |
| 	else
 | |
| 		uresp.uarc_size = 0;
 | |
| 
 | |
| 	context = kmalloc(sizeof *context, GFP_KERNEL);
 | |
| 	if (!context)
 | |
| 		return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 	err = mthca_uar_alloc(to_mdev(ibdev), &context->uar);
 | |
| 	if (err) {
 | |
| 		kfree(context);
 | |
| 		return ERR_PTR(err);
 | |
| 	}
 | |
| 
 | |
| 	context->db_tab = mthca_init_user_db_tab(to_mdev(ibdev));
 | |
| 	if (IS_ERR(context->db_tab)) {
 | |
| 		err = PTR_ERR(context->db_tab);
 | |
| 		mthca_uar_free(to_mdev(ibdev), &context->uar);
 | |
| 		kfree(context);
 | |
| 		return ERR_PTR(err);
 | |
| 	}
 | |
| 
 | |
| 	if (ib_copy_to_udata(udata, &uresp, sizeof uresp)) {
 | |
| 		mthca_cleanup_user_db_tab(to_mdev(ibdev), &context->uar, context->db_tab);
 | |
| 		mthca_uar_free(to_mdev(ibdev), &context->uar);
 | |
| 		kfree(context);
 | |
| 		return ERR_PTR(-EFAULT);
 | |
| 	}
 | |
| 
 | |
| 	context->reg_mr_warned = 0;
 | |
| 
 | |
| 	return &context->ibucontext;
 | |
| }
 | |
| 
 | |
| static int mthca_dealloc_ucontext(struct ib_ucontext *context)
 | |
| {
 | |
| 	mthca_cleanup_user_db_tab(to_mdev(context->device), &to_mucontext(context)->uar,
 | |
| 				  to_mucontext(context)->db_tab);
 | |
| 	mthca_uar_free(to_mdev(context->device), &to_mucontext(context)->uar);
 | |
| 	kfree(to_mucontext(context));
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int mthca_mmap_uar(struct ib_ucontext *context,
 | |
| 			  struct vm_area_struct *vma)
 | |
| {
 | |
| 	if (vma->vm_end - vma->vm_start != PAGE_SIZE)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
 | |
| 
 | |
| 	if (io_remap_pfn_range(vma, vma->vm_start,
 | |
| 			       to_mucontext(context)->uar.pfn,
 | |
| 			       PAGE_SIZE, vma->vm_page_prot))
 | |
| 		return -EAGAIN;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static struct ib_pd *mthca_alloc_pd(struct ib_device *ibdev,
 | |
| 				    struct ib_ucontext *context,
 | |
| 				    struct ib_udata *udata)
 | |
| {
 | |
| 	struct mthca_pd *pd;
 | |
| 	int err;
 | |
| 
 | |
| 	pd = kmalloc(sizeof *pd, GFP_KERNEL);
 | |
| 	if (!pd)
 | |
| 		return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 	err = mthca_pd_alloc(to_mdev(ibdev), !context, pd);
 | |
| 	if (err) {
 | |
| 		kfree(pd);
 | |
| 		return ERR_PTR(err);
 | |
| 	}
 | |
| 
 | |
| 	if (context) {
 | |
| 		if (ib_copy_to_udata(udata, &pd->pd_num, sizeof (__u32))) {
 | |
| 			mthca_pd_free(to_mdev(ibdev), pd);
 | |
| 			kfree(pd);
 | |
| 			return ERR_PTR(-EFAULT);
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	return &pd->ibpd;
 | |
| }
 | |
| 
 | |
| static int mthca_dealloc_pd(struct ib_pd *pd)
 | |
| {
 | |
| 	mthca_pd_free(to_mdev(pd->device), to_mpd(pd));
 | |
| 	kfree(pd);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static struct ib_ah *mthca_ah_create(struct ib_pd *pd,
 | |
| 				     struct ib_ah_attr *ah_attr)
 | |
| {
 | |
| 	int err;
 | |
| 	struct mthca_ah *ah;
 | |
| 
 | |
| 	ah = kmalloc(sizeof *ah, GFP_ATOMIC);
 | |
| 	if (!ah)
 | |
| 		return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 	err = mthca_create_ah(to_mdev(pd->device), to_mpd(pd), ah_attr, ah);
 | |
| 	if (err) {
 | |
| 		kfree(ah);
 | |
| 		return ERR_PTR(err);
 | |
| 	}
 | |
| 
 | |
| 	return &ah->ibah;
 | |
| }
 | |
| 
 | |
| static int mthca_ah_destroy(struct ib_ah *ah)
 | |
| {
 | |
| 	mthca_destroy_ah(to_mdev(ah->device), to_mah(ah));
 | |
| 	kfree(ah);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static struct ib_srq *mthca_create_srq(struct ib_pd *pd,
 | |
| 				       struct ib_srq_init_attr *init_attr,
 | |
| 				       struct ib_udata *udata)
 | |
| {
 | |
| 	struct mthca_create_srq ucmd;
 | |
| 	struct mthca_ucontext *context = NULL;
 | |
| 	struct mthca_srq *srq;
 | |
| 	int err;
 | |
| 
 | |
| 	srq = kmalloc(sizeof *srq, GFP_KERNEL);
 | |
| 	if (!srq)
 | |
| 		return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 	if (pd->uobject) {
 | |
| 		context = to_mucontext(pd->uobject->context);
 | |
| 
 | |
| 		if (ib_copy_from_udata(&ucmd, udata, sizeof ucmd)) {
 | |
| 			err = -EFAULT;
 | |
| 			goto err_free;
 | |
| 		}
 | |
| 
 | |
| 		err = mthca_map_user_db(to_mdev(pd->device), &context->uar,
 | |
| 					context->db_tab, ucmd.db_index,
 | |
| 					ucmd.db_page);
 | |
| 
 | |
| 		if (err)
 | |
| 			goto err_free;
 | |
| 
 | |
| 		srq->mr.ibmr.lkey = ucmd.lkey;
 | |
| 		srq->db_index     = ucmd.db_index;
 | |
| 	}
 | |
| 
 | |
| 	err = mthca_alloc_srq(to_mdev(pd->device), to_mpd(pd),
 | |
| 			      &init_attr->attr, srq);
 | |
| 
 | |
| 	if (err && pd->uobject)
 | |
| 		mthca_unmap_user_db(to_mdev(pd->device), &context->uar,
 | |
| 				    context->db_tab, ucmd.db_index);
 | |
| 
 | |
| 	if (err)
 | |
| 		goto err_free;
 | |
| 
 | |
| 	if (context && ib_copy_to_udata(udata, &srq->srqn, sizeof (__u32))) {
 | |
| 		mthca_free_srq(to_mdev(pd->device), srq);
 | |
| 		err = -EFAULT;
 | |
| 		goto err_free;
 | |
| 	}
 | |
| 
 | |
| 	return &srq->ibsrq;
 | |
| 
 | |
| err_free:
 | |
| 	kfree(srq);
 | |
| 
 | |
| 	return ERR_PTR(err);
 | |
| }
 | |
| 
 | |
| static int mthca_destroy_srq(struct ib_srq *srq)
 | |
| {
 | |
| 	struct mthca_ucontext *context;
 | |
| 
 | |
| 	if (srq->uobject) {
 | |
| 		context = to_mucontext(srq->uobject->context);
 | |
| 
 | |
| 		mthca_unmap_user_db(to_mdev(srq->device), &context->uar,
 | |
| 				    context->db_tab, to_msrq(srq)->db_index);
 | |
| 	}
 | |
| 
 | |
| 	mthca_free_srq(to_mdev(srq->device), to_msrq(srq));
 | |
| 	kfree(srq);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static struct ib_qp *mthca_create_qp(struct ib_pd *pd,
 | |
| 				     struct ib_qp_init_attr *init_attr,
 | |
| 				     struct ib_udata *udata)
 | |
| {
 | |
| 	struct mthca_create_qp ucmd;
 | |
| 	struct mthca_qp *qp;
 | |
| 	int err;
 | |
| 
 | |
| 	if (init_attr->create_flags)
 | |
| 		return ERR_PTR(-EINVAL);
 | |
| 
 | |
| 	switch (init_attr->qp_type) {
 | |
| 	case IB_QPT_RC:
 | |
| 	case IB_QPT_UC:
 | |
| 	case IB_QPT_UD:
 | |
| 	{
 | |
| 		struct mthca_ucontext *context;
 | |
| 
 | |
| 		qp = kmalloc(sizeof *qp, GFP_KERNEL);
 | |
| 		if (!qp)
 | |
| 			return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 		if (pd->uobject) {
 | |
| 			context = to_mucontext(pd->uobject->context);
 | |
| 
 | |
| 			if (ib_copy_from_udata(&ucmd, udata, sizeof ucmd)) {
 | |
| 				kfree(qp);
 | |
| 				return ERR_PTR(-EFAULT);
 | |
| 			}
 | |
| 
 | |
| 			err = mthca_map_user_db(to_mdev(pd->device), &context->uar,
 | |
| 						context->db_tab,
 | |
| 						ucmd.sq_db_index, ucmd.sq_db_page);
 | |
| 			if (err) {
 | |
| 				kfree(qp);
 | |
| 				return ERR_PTR(err);
 | |
| 			}
 | |
| 
 | |
| 			err = mthca_map_user_db(to_mdev(pd->device), &context->uar,
 | |
| 						context->db_tab,
 | |
| 						ucmd.rq_db_index, ucmd.rq_db_page);
 | |
| 			if (err) {
 | |
| 				mthca_unmap_user_db(to_mdev(pd->device),
 | |
| 						    &context->uar,
 | |
| 						    context->db_tab,
 | |
| 						    ucmd.sq_db_index);
 | |
| 				kfree(qp);
 | |
| 				return ERR_PTR(err);
 | |
| 			}
 | |
| 
 | |
| 			qp->mr.ibmr.lkey = ucmd.lkey;
 | |
| 			qp->sq.db_index  = ucmd.sq_db_index;
 | |
| 			qp->rq.db_index  = ucmd.rq_db_index;
 | |
| 		}
 | |
| 
 | |
| 		err = mthca_alloc_qp(to_mdev(pd->device), to_mpd(pd),
 | |
| 				     to_mcq(init_attr->send_cq),
 | |
| 				     to_mcq(init_attr->recv_cq),
 | |
| 				     init_attr->qp_type, init_attr->sq_sig_type,
 | |
| 				     &init_attr->cap, qp);
 | |
| 
 | |
| 		if (err && pd->uobject) {
 | |
| 			context = to_mucontext(pd->uobject->context);
 | |
| 
 | |
| 			mthca_unmap_user_db(to_mdev(pd->device),
 | |
| 					    &context->uar,
 | |
| 					    context->db_tab,
 | |
| 					    ucmd.sq_db_index);
 | |
| 			mthca_unmap_user_db(to_mdev(pd->device),
 | |
| 					    &context->uar,
 | |
| 					    context->db_tab,
 | |
| 					    ucmd.rq_db_index);
 | |
| 		}
 | |
| 
 | |
| 		qp->ibqp.qp_num = qp->qpn;
 | |
| 		break;
 | |
| 	}
 | |
| 	case IB_QPT_SMI:
 | |
| 	case IB_QPT_GSI:
 | |
| 	{
 | |
| 		/* Don't allow userspace to create special QPs */
 | |
| 		if (pd->uobject)
 | |
| 			return ERR_PTR(-EINVAL);
 | |
| 
 | |
| 		qp = kmalloc(sizeof (struct mthca_sqp), GFP_KERNEL);
 | |
| 		if (!qp)
 | |
| 			return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 		qp->ibqp.qp_num = init_attr->qp_type == IB_QPT_SMI ? 0 : 1;
 | |
| 
 | |
| 		err = mthca_alloc_sqp(to_mdev(pd->device), to_mpd(pd),
 | |
| 				      to_mcq(init_attr->send_cq),
 | |
| 				      to_mcq(init_attr->recv_cq),
 | |
| 				      init_attr->sq_sig_type, &init_attr->cap,
 | |
| 				      qp->ibqp.qp_num, init_attr->port_num,
 | |
| 				      to_msqp(qp));
 | |
| 		break;
 | |
| 	}
 | |
| 	default:
 | |
| 		/* Don't support raw QPs */
 | |
| 		return ERR_PTR(-ENOSYS);
 | |
| 	}
 | |
| 
 | |
| 	if (err) {
 | |
| 		kfree(qp);
 | |
| 		return ERR_PTR(err);
 | |
| 	}
 | |
| 
 | |
| 	init_attr->cap.max_send_wr     = qp->sq.max;
 | |
| 	init_attr->cap.max_recv_wr     = qp->rq.max;
 | |
| 	init_attr->cap.max_send_sge    = qp->sq.max_gs;
 | |
| 	init_attr->cap.max_recv_sge    = qp->rq.max_gs;
 | |
| 	init_attr->cap.max_inline_data = qp->max_inline_data;
 | |
| 
 | |
| 	return &qp->ibqp;
 | |
| }
 | |
| 
 | |
| static int mthca_destroy_qp(struct ib_qp *qp)
 | |
| {
 | |
| 	if (qp->uobject) {
 | |
| 		mthca_unmap_user_db(to_mdev(qp->device),
 | |
| 				    &to_mucontext(qp->uobject->context)->uar,
 | |
| 				    to_mucontext(qp->uobject->context)->db_tab,
 | |
| 				    to_mqp(qp)->sq.db_index);
 | |
| 		mthca_unmap_user_db(to_mdev(qp->device),
 | |
| 				    &to_mucontext(qp->uobject->context)->uar,
 | |
| 				    to_mucontext(qp->uobject->context)->db_tab,
 | |
| 				    to_mqp(qp)->rq.db_index);
 | |
| 	}
 | |
| 	mthca_free_qp(to_mdev(qp->device), to_mqp(qp));
 | |
| 	kfree(qp);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static struct ib_cq *mthca_create_cq(struct ib_device *ibdev, int entries,
 | |
| 				     int comp_vector,
 | |
| 				     struct ib_ucontext *context,
 | |
| 				     struct ib_udata *udata)
 | |
| {
 | |
| 	struct mthca_create_cq ucmd;
 | |
| 	struct mthca_cq *cq;
 | |
| 	int nent;
 | |
| 	int err;
 | |
| 
 | |
| 	if (entries < 1 || entries > to_mdev(ibdev)->limits.max_cqes)
 | |
| 		return ERR_PTR(-EINVAL);
 | |
| 
 | |
| 	if (context) {
 | |
| 		if (ib_copy_from_udata(&ucmd, udata, sizeof ucmd))
 | |
| 			return ERR_PTR(-EFAULT);
 | |
| 
 | |
| 		err = mthca_map_user_db(to_mdev(ibdev), &to_mucontext(context)->uar,
 | |
| 					to_mucontext(context)->db_tab,
 | |
| 					ucmd.set_db_index, ucmd.set_db_page);
 | |
| 		if (err)
 | |
| 			return ERR_PTR(err);
 | |
| 
 | |
| 		err = mthca_map_user_db(to_mdev(ibdev), &to_mucontext(context)->uar,
 | |
| 					to_mucontext(context)->db_tab,
 | |
| 					ucmd.arm_db_index, ucmd.arm_db_page);
 | |
| 		if (err)
 | |
| 			goto err_unmap_set;
 | |
| 	}
 | |
| 
 | |
| 	cq = kmalloc(sizeof *cq, GFP_KERNEL);
 | |
| 	if (!cq) {
 | |
| 		err = -ENOMEM;
 | |
| 		goto err_unmap_arm;
 | |
| 	}
 | |
| 
 | |
| 	if (context) {
 | |
| 		cq->buf.mr.ibmr.lkey = ucmd.lkey;
 | |
| 		cq->set_ci_db_index  = ucmd.set_db_index;
 | |
| 		cq->arm_db_index     = ucmd.arm_db_index;
 | |
| 	}
 | |
| 
 | |
| 	for (nent = 1; nent <= entries; nent <<= 1)
 | |
| 		; /* nothing */
 | |
| 
 | |
| 	err = mthca_init_cq(to_mdev(ibdev), nent,
 | |
| 			    context ? to_mucontext(context) : NULL,
 | |
| 			    context ? ucmd.pdn : to_mdev(ibdev)->driver_pd.pd_num,
 | |
| 			    cq);
 | |
| 	if (err)
 | |
| 		goto err_free;
 | |
| 
 | |
| 	if (context && ib_copy_to_udata(udata, &cq->cqn, sizeof (__u32))) {
 | |
| 		mthca_free_cq(to_mdev(ibdev), cq);
 | |
| 		goto err_free;
 | |
| 	}
 | |
| 
 | |
| 	cq->resize_buf = NULL;
 | |
| 
 | |
| 	return &cq->ibcq;
 | |
| 
 | |
| err_free:
 | |
| 	kfree(cq);
 | |
| 
 | |
| err_unmap_arm:
 | |
| 	if (context)
 | |
| 		mthca_unmap_user_db(to_mdev(ibdev), &to_mucontext(context)->uar,
 | |
| 				    to_mucontext(context)->db_tab, ucmd.arm_db_index);
 | |
| 
 | |
| err_unmap_set:
 | |
| 	if (context)
 | |
| 		mthca_unmap_user_db(to_mdev(ibdev), &to_mucontext(context)->uar,
 | |
| 				    to_mucontext(context)->db_tab, ucmd.set_db_index);
 | |
| 
 | |
| 	return ERR_PTR(err);
 | |
| }
 | |
| 
 | |
| static int mthca_alloc_resize_buf(struct mthca_dev *dev, struct mthca_cq *cq,
 | |
| 				  int entries)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| 	spin_lock_irq(&cq->lock);
 | |
| 	if (cq->resize_buf) {
 | |
| 		ret = -EBUSY;
 | |
| 		goto unlock;
 | |
| 	}
 | |
| 
 | |
| 	cq->resize_buf = kmalloc(sizeof *cq->resize_buf, GFP_ATOMIC);
 | |
| 	if (!cq->resize_buf) {
 | |
| 		ret = -ENOMEM;
 | |
| 		goto unlock;
 | |
| 	}
 | |
| 
 | |
| 	cq->resize_buf->state = CQ_RESIZE_ALLOC;
 | |
| 
 | |
| 	ret = 0;
 | |
| 
 | |
| unlock:
 | |
| 	spin_unlock_irq(&cq->lock);
 | |
| 
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	ret = mthca_alloc_cq_buf(dev, &cq->resize_buf->buf, entries);
 | |
| 	if (ret) {
 | |
| 		spin_lock_irq(&cq->lock);
 | |
| 		kfree(cq->resize_buf);
 | |
| 		cq->resize_buf = NULL;
 | |
| 		spin_unlock_irq(&cq->lock);
 | |
| 		return ret;
 | |
| 	}
 | |
| 
 | |
| 	cq->resize_buf->cqe = entries - 1;
 | |
| 
 | |
| 	spin_lock_irq(&cq->lock);
 | |
| 	cq->resize_buf->state = CQ_RESIZE_READY;
 | |
| 	spin_unlock_irq(&cq->lock);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int mthca_resize_cq(struct ib_cq *ibcq, int entries, struct ib_udata *udata)
 | |
| {
 | |
| 	struct mthca_dev *dev = to_mdev(ibcq->device);
 | |
| 	struct mthca_cq *cq = to_mcq(ibcq);
 | |
| 	struct mthca_resize_cq ucmd;
 | |
| 	u32 lkey;
 | |
| 	u8 status;
 | |
| 	int ret;
 | |
| 
 | |
| 	if (entries < 1 || entries > dev->limits.max_cqes)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	mutex_lock(&cq->mutex);
 | |
| 
 | |
| 	entries = roundup_pow_of_two(entries + 1);
 | |
| 	if (entries == ibcq->cqe + 1) {
 | |
| 		ret = 0;
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	if (cq->is_kernel) {
 | |
| 		ret = mthca_alloc_resize_buf(dev, cq, entries);
 | |
| 		if (ret)
 | |
| 			goto out;
 | |
| 		lkey = cq->resize_buf->buf.mr.ibmr.lkey;
 | |
| 	} else {
 | |
| 		if (ib_copy_from_udata(&ucmd, udata, sizeof ucmd)) {
 | |
| 			ret = -EFAULT;
 | |
| 			goto out;
 | |
| 		}
 | |
| 		lkey = ucmd.lkey;
 | |
| 	}
 | |
| 
 | |
| 	ret = mthca_RESIZE_CQ(dev, cq->cqn, lkey, ilog2(entries), &status);
 | |
| 	if (status)
 | |
| 		ret = -EINVAL;
 | |
| 
 | |
| 	if (ret) {
 | |
| 		if (cq->resize_buf) {
 | |
| 			mthca_free_cq_buf(dev, &cq->resize_buf->buf,
 | |
| 					  cq->resize_buf->cqe);
 | |
| 			kfree(cq->resize_buf);
 | |
| 			spin_lock_irq(&cq->lock);
 | |
| 			cq->resize_buf = NULL;
 | |
| 			spin_unlock_irq(&cq->lock);
 | |
| 		}
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	if (cq->is_kernel) {
 | |
| 		struct mthca_cq_buf tbuf;
 | |
| 		int tcqe;
 | |
| 
 | |
| 		spin_lock_irq(&cq->lock);
 | |
| 		if (cq->resize_buf->state == CQ_RESIZE_READY) {
 | |
| 			mthca_cq_resize_copy_cqes(cq);
 | |
| 			tbuf         = cq->buf;
 | |
| 			tcqe         = cq->ibcq.cqe;
 | |
| 			cq->buf      = cq->resize_buf->buf;
 | |
| 			cq->ibcq.cqe = cq->resize_buf->cqe;
 | |
| 		} else {
 | |
| 			tbuf = cq->resize_buf->buf;
 | |
| 			tcqe = cq->resize_buf->cqe;
 | |
| 		}
 | |
| 
 | |
| 		kfree(cq->resize_buf);
 | |
| 		cq->resize_buf = NULL;
 | |
| 		spin_unlock_irq(&cq->lock);
 | |
| 
 | |
| 		mthca_free_cq_buf(dev, &tbuf, tcqe);
 | |
| 	} else
 | |
| 		ibcq->cqe = entries - 1;
 | |
| 
 | |
| out:
 | |
| 	mutex_unlock(&cq->mutex);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static int mthca_destroy_cq(struct ib_cq *cq)
 | |
| {
 | |
| 	if (cq->uobject) {
 | |
| 		mthca_unmap_user_db(to_mdev(cq->device),
 | |
| 				    &to_mucontext(cq->uobject->context)->uar,
 | |
| 				    to_mucontext(cq->uobject->context)->db_tab,
 | |
| 				    to_mcq(cq)->arm_db_index);
 | |
| 		mthca_unmap_user_db(to_mdev(cq->device),
 | |
| 				    &to_mucontext(cq->uobject->context)->uar,
 | |
| 				    to_mucontext(cq->uobject->context)->db_tab,
 | |
| 				    to_mcq(cq)->set_ci_db_index);
 | |
| 	}
 | |
| 	mthca_free_cq(to_mdev(cq->device), to_mcq(cq));
 | |
| 	kfree(cq);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static inline u32 convert_access(int acc)
 | |
| {
 | |
| 	return (acc & IB_ACCESS_REMOTE_ATOMIC ? MTHCA_MPT_FLAG_ATOMIC       : 0) |
 | |
| 	       (acc & IB_ACCESS_REMOTE_WRITE  ? MTHCA_MPT_FLAG_REMOTE_WRITE : 0) |
 | |
| 	       (acc & IB_ACCESS_REMOTE_READ   ? MTHCA_MPT_FLAG_REMOTE_READ  : 0) |
 | |
| 	       (acc & IB_ACCESS_LOCAL_WRITE   ? MTHCA_MPT_FLAG_LOCAL_WRITE  : 0) |
 | |
| 	       MTHCA_MPT_FLAG_LOCAL_READ;
 | |
| }
 | |
| 
 | |
| static struct ib_mr *mthca_get_dma_mr(struct ib_pd *pd, int acc)
 | |
| {
 | |
| 	struct mthca_mr *mr;
 | |
| 	int err;
 | |
| 
 | |
| 	mr = kmalloc(sizeof *mr, GFP_KERNEL);
 | |
| 	if (!mr)
 | |
| 		return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 	err = mthca_mr_alloc_notrans(to_mdev(pd->device),
 | |
| 				     to_mpd(pd)->pd_num,
 | |
| 				     convert_access(acc), mr);
 | |
| 
 | |
| 	if (err) {
 | |
| 		kfree(mr);
 | |
| 		return ERR_PTR(err);
 | |
| 	}
 | |
| 
 | |
| 	mr->umem = NULL;
 | |
| 
 | |
| 	return &mr->ibmr;
 | |
| }
 | |
| 
 | |
| static struct ib_mr *mthca_reg_phys_mr(struct ib_pd       *pd,
 | |
| 				       struct ib_phys_buf *buffer_list,
 | |
| 				       int                 num_phys_buf,
 | |
| 				       int                 acc,
 | |
| 				       u64                *iova_start)
 | |
| {
 | |
| 	struct mthca_mr *mr;
 | |
| 	u64 *page_list;
 | |
| 	u64 total_size;
 | |
| 	unsigned long mask;
 | |
| 	int shift;
 | |
| 	int npages;
 | |
| 	int err;
 | |
| 	int i, j, n;
 | |
| 
 | |
| 	mask = buffer_list[0].addr ^ *iova_start;
 | |
| 	total_size = 0;
 | |
| 	for (i = 0; i < num_phys_buf; ++i) {
 | |
| 		if (i != 0)
 | |
| 			mask |= buffer_list[i].addr;
 | |
| 		if (i != num_phys_buf - 1)
 | |
| 			mask |= buffer_list[i].addr + buffer_list[i].size;
 | |
| 
 | |
| 		total_size += buffer_list[i].size;
 | |
| 	}
 | |
| 
 | |
| 	if (mask & ~PAGE_MASK)
 | |
| 		return ERR_PTR(-EINVAL);
 | |
| 
 | |
| 	shift = __ffs(mask | 1 << 31);
 | |
| 
 | |
| 	buffer_list[0].size += buffer_list[0].addr & ((1ULL << shift) - 1);
 | |
| 	buffer_list[0].addr &= ~0ull << shift;
 | |
| 
 | |
| 	mr = kmalloc(sizeof *mr, GFP_KERNEL);
 | |
| 	if (!mr)
 | |
| 		return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 	npages = 0;
 | |
| 	for (i = 0; i < num_phys_buf; ++i)
 | |
| 		npages += (buffer_list[i].size + (1ULL << shift) - 1) >> shift;
 | |
| 
 | |
| 	if (!npages)
 | |
| 		return &mr->ibmr;
 | |
| 
 | |
| 	page_list = kmalloc(npages * sizeof *page_list, GFP_KERNEL);
 | |
| 	if (!page_list) {
 | |
| 		kfree(mr);
 | |
| 		return ERR_PTR(-ENOMEM);
 | |
| 	}
 | |
| 
 | |
| 	n = 0;
 | |
| 	for (i = 0; i < num_phys_buf; ++i)
 | |
| 		for (j = 0;
 | |
| 		     j < (buffer_list[i].size + (1ULL << shift) - 1) >> shift;
 | |
| 		     ++j)
 | |
| 			page_list[n++] = buffer_list[i].addr + ((u64) j << shift);
 | |
| 
 | |
| 	mthca_dbg(to_mdev(pd->device), "Registering memory at %llx (iova %llx) "
 | |
| 		  "in PD %x; shift %d, npages %d.\n",
 | |
| 		  (unsigned long long) buffer_list[0].addr,
 | |
| 		  (unsigned long long) *iova_start,
 | |
| 		  to_mpd(pd)->pd_num,
 | |
| 		  shift, npages);
 | |
| 
 | |
| 	err = mthca_mr_alloc_phys(to_mdev(pd->device),
 | |
| 				  to_mpd(pd)->pd_num,
 | |
| 				  page_list, shift, npages,
 | |
| 				  *iova_start, total_size,
 | |
| 				  convert_access(acc), mr);
 | |
| 
 | |
| 	if (err) {
 | |
| 		kfree(page_list);
 | |
| 		kfree(mr);
 | |
| 		return ERR_PTR(err);
 | |
| 	}
 | |
| 
 | |
| 	kfree(page_list);
 | |
| 	mr->umem = NULL;
 | |
| 
 | |
| 	return &mr->ibmr;
 | |
| }
 | |
| 
 | |
| static struct ib_mr *mthca_reg_user_mr(struct ib_pd *pd, u64 start, u64 length,
 | |
| 				       u64 virt, int acc, struct ib_udata *udata)
 | |
| {
 | |
| 	struct mthca_dev *dev = to_mdev(pd->device);
 | |
| 	struct ib_umem_chunk *chunk;
 | |
| 	struct mthca_mr *mr;
 | |
| 	struct mthca_reg_mr ucmd;
 | |
| 	u64 *pages;
 | |
| 	int shift, n, len;
 | |
| 	int i, j, k;
 | |
| 	int err = 0;
 | |
| 	int write_mtt_size;
 | |
| 
 | |
| 	if (udata->inlen - sizeof (struct ib_uverbs_cmd_hdr) < sizeof ucmd) {
 | |
| 		if (!to_mucontext(pd->uobject->context)->reg_mr_warned) {
 | |
| 			mthca_warn(dev, "Process '%s' did not pass in MR attrs.\n",
 | |
| 				   current->comm);
 | |
| 			mthca_warn(dev, "  Update libmthca to fix this.\n");
 | |
| 		}
 | |
| 		++to_mucontext(pd->uobject->context)->reg_mr_warned;
 | |
| 		ucmd.mr_attrs = 0;
 | |
| 	} else if (ib_copy_from_udata(&ucmd, udata, sizeof ucmd))
 | |
| 		return ERR_PTR(-EFAULT);
 | |
| 
 | |
| 	mr = kmalloc(sizeof *mr, GFP_KERNEL);
 | |
| 	if (!mr)
 | |
| 		return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 	mr->umem = ib_umem_get(pd->uobject->context, start, length, acc,
 | |
| 			       ucmd.mr_attrs & MTHCA_MR_DMASYNC);
 | |
| 
 | |
| 	if (IS_ERR(mr->umem)) {
 | |
| 		err = PTR_ERR(mr->umem);
 | |
| 		goto err;
 | |
| 	}
 | |
| 
 | |
| 	shift = ffs(mr->umem->page_size) - 1;
 | |
| 
 | |
| 	n = 0;
 | |
| 	list_for_each_entry(chunk, &mr->umem->chunk_list, list)
 | |
| 		n += chunk->nents;
 | |
| 
 | |
| 	mr->mtt = mthca_alloc_mtt(dev, n);
 | |
| 	if (IS_ERR(mr->mtt)) {
 | |
| 		err = PTR_ERR(mr->mtt);
 | |
| 		goto err_umem;
 | |
| 	}
 | |
| 
 | |
| 	pages = (u64 *) __get_free_page(GFP_KERNEL);
 | |
| 	if (!pages) {
 | |
| 		err = -ENOMEM;
 | |
| 		goto err_mtt;
 | |
| 	}
 | |
| 
 | |
| 	i = n = 0;
 | |
| 
 | |
| 	write_mtt_size = min(mthca_write_mtt_size(dev), (int) (PAGE_SIZE / sizeof *pages));
 | |
| 
 | |
| 	list_for_each_entry(chunk, &mr->umem->chunk_list, list)
 | |
| 		for (j = 0; j < chunk->nmap; ++j) {
 | |
| 			len = sg_dma_len(&chunk->page_list[j]) >> shift;
 | |
| 			for (k = 0; k < len; ++k) {
 | |
| 				pages[i++] = sg_dma_address(&chunk->page_list[j]) +
 | |
| 					mr->umem->page_size * k;
 | |
| 				/*
 | |
| 				 * Be friendly to write_mtt and pass it chunks
 | |
| 				 * of appropriate size.
 | |
| 				 */
 | |
| 				if (i == write_mtt_size) {
 | |
| 					err = mthca_write_mtt(dev, mr->mtt, n, pages, i);
 | |
| 					if (err)
 | |
| 						goto mtt_done;
 | |
| 					n += i;
 | |
| 					i = 0;
 | |
| 				}
 | |
| 			}
 | |
| 		}
 | |
| 
 | |
| 	if (i)
 | |
| 		err = mthca_write_mtt(dev, mr->mtt, n, pages, i);
 | |
| mtt_done:
 | |
| 	free_page((unsigned long) pages);
 | |
| 	if (err)
 | |
| 		goto err_mtt;
 | |
| 
 | |
| 	err = mthca_mr_alloc(dev, to_mpd(pd)->pd_num, shift, virt, length,
 | |
| 			     convert_access(acc), mr);
 | |
| 
 | |
| 	if (err)
 | |
| 		goto err_mtt;
 | |
| 
 | |
| 	return &mr->ibmr;
 | |
| 
 | |
| err_mtt:
 | |
| 	mthca_free_mtt(dev, mr->mtt);
 | |
| 
 | |
| err_umem:
 | |
| 	ib_umem_release(mr->umem);
 | |
| 
 | |
| err:
 | |
| 	kfree(mr);
 | |
| 	return ERR_PTR(err);
 | |
| }
 | |
| 
 | |
| static int mthca_dereg_mr(struct ib_mr *mr)
 | |
| {
 | |
| 	struct mthca_mr *mmr = to_mmr(mr);
 | |
| 
 | |
| 	mthca_free_mr(to_mdev(mr->device), mmr);
 | |
| 	if (mmr->umem)
 | |
| 		ib_umem_release(mmr->umem);
 | |
| 	kfree(mmr);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static struct ib_fmr *mthca_alloc_fmr(struct ib_pd *pd, int mr_access_flags,
 | |
| 				      struct ib_fmr_attr *fmr_attr)
 | |
| {
 | |
| 	struct mthca_fmr *fmr;
 | |
| 	int err;
 | |
| 
 | |
| 	fmr = kmalloc(sizeof *fmr, GFP_KERNEL);
 | |
| 	if (!fmr)
 | |
| 		return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 	memcpy(&fmr->attr, fmr_attr, sizeof *fmr_attr);
 | |
| 	err = mthca_fmr_alloc(to_mdev(pd->device), to_mpd(pd)->pd_num,
 | |
| 			     convert_access(mr_access_flags), fmr);
 | |
| 
 | |
| 	if (err) {
 | |
| 		kfree(fmr);
 | |
| 		return ERR_PTR(err);
 | |
| 	}
 | |
| 
 | |
| 	return &fmr->ibmr;
 | |
| }
 | |
| 
 | |
| static int mthca_dealloc_fmr(struct ib_fmr *fmr)
 | |
| {
 | |
| 	struct mthca_fmr *mfmr = to_mfmr(fmr);
 | |
| 	int err;
 | |
| 
 | |
| 	err = mthca_free_fmr(to_mdev(fmr->device), mfmr);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	kfree(mfmr);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int mthca_unmap_fmr(struct list_head *fmr_list)
 | |
| {
 | |
| 	struct ib_fmr *fmr;
 | |
| 	int err;
 | |
| 	u8 status;
 | |
| 	struct mthca_dev *mdev = NULL;
 | |
| 
 | |
| 	list_for_each_entry(fmr, fmr_list, list) {
 | |
| 		if (mdev && to_mdev(fmr->device) != mdev)
 | |
| 			return -EINVAL;
 | |
| 		mdev = to_mdev(fmr->device);
 | |
| 	}
 | |
| 
 | |
| 	if (!mdev)
 | |
| 		return 0;
 | |
| 
 | |
| 	if (mthca_is_memfree(mdev)) {
 | |
| 		list_for_each_entry(fmr, fmr_list, list)
 | |
| 			mthca_arbel_fmr_unmap(mdev, to_mfmr(fmr));
 | |
| 
 | |
| 		wmb();
 | |
| 	} else
 | |
| 		list_for_each_entry(fmr, fmr_list, list)
 | |
| 			mthca_tavor_fmr_unmap(mdev, to_mfmr(fmr));
 | |
| 
 | |
| 	err = mthca_SYNC_TPT(mdev, &status);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 	if (status)
 | |
| 		return -EINVAL;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static ssize_t show_rev(struct device *device, struct device_attribute *attr,
 | |
| 			char *buf)
 | |
| {
 | |
| 	struct mthca_dev *dev =
 | |
| 		container_of(device, struct mthca_dev, ib_dev.dev);
 | |
| 	return sprintf(buf, "%x\n", dev->rev_id);
 | |
| }
 | |
| 
 | |
| static ssize_t show_fw_ver(struct device *device, struct device_attribute *attr,
 | |
| 			   char *buf)
 | |
| {
 | |
| 	struct mthca_dev *dev =
 | |
| 		container_of(device, struct mthca_dev, ib_dev.dev);
 | |
| 	return sprintf(buf, "%d.%d.%d\n", (int) (dev->fw_ver >> 32),
 | |
| 		       (int) (dev->fw_ver >> 16) & 0xffff,
 | |
| 		       (int) dev->fw_ver & 0xffff);
 | |
| }
 | |
| 
 | |
| static ssize_t show_hca(struct device *device, struct device_attribute *attr,
 | |
| 			char *buf)
 | |
| {
 | |
| 	struct mthca_dev *dev =
 | |
| 		container_of(device, struct mthca_dev, ib_dev.dev);
 | |
| 	switch (dev->pdev->device) {
 | |
| 	case PCI_DEVICE_ID_MELLANOX_TAVOR:
 | |
| 		return sprintf(buf, "MT23108\n");
 | |
| 	case PCI_DEVICE_ID_MELLANOX_ARBEL_COMPAT:
 | |
| 		return sprintf(buf, "MT25208 (MT23108 compat mode)\n");
 | |
| 	case PCI_DEVICE_ID_MELLANOX_ARBEL:
 | |
| 		return sprintf(buf, "MT25208\n");
 | |
| 	case PCI_DEVICE_ID_MELLANOX_SINAI:
 | |
| 	case PCI_DEVICE_ID_MELLANOX_SINAI_OLD:
 | |
| 		return sprintf(buf, "MT25204\n");
 | |
| 	default:
 | |
| 		return sprintf(buf, "unknown\n");
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static ssize_t show_board(struct device *device, struct device_attribute *attr,
 | |
| 			  char *buf)
 | |
| {
 | |
| 	struct mthca_dev *dev =
 | |
| 		container_of(device, struct mthca_dev, ib_dev.dev);
 | |
| 	return sprintf(buf, "%.*s\n", MTHCA_BOARD_ID_LEN, dev->board_id);
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(hw_rev,   S_IRUGO, show_rev,    NULL);
 | |
| static DEVICE_ATTR(fw_ver,   S_IRUGO, show_fw_ver, NULL);
 | |
| static DEVICE_ATTR(hca_type, S_IRUGO, show_hca,    NULL);
 | |
| static DEVICE_ATTR(board_id, S_IRUGO, show_board,  NULL);
 | |
| 
 | |
| static struct device_attribute *mthca_dev_attributes[] = {
 | |
| 	&dev_attr_hw_rev,
 | |
| 	&dev_attr_fw_ver,
 | |
| 	&dev_attr_hca_type,
 | |
| 	&dev_attr_board_id
 | |
| };
 | |
| 
 | |
| static int mthca_init_node_data(struct mthca_dev *dev)
 | |
| {
 | |
| 	struct ib_smp *in_mad  = NULL;
 | |
| 	struct ib_smp *out_mad = NULL;
 | |
| 	int err = -ENOMEM;
 | |
| 	u8 status;
 | |
| 
 | |
| 	in_mad  = kzalloc(sizeof *in_mad, GFP_KERNEL);
 | |
| 	out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
 | |
| 	if (!in_mad || !out_mad)
 | |
| 		goto out;
 | |
| 
 | |
| 	init_query_mad(in_mad);
 | |
| 	in_mad->attr_id = IB_SMP_ATTR_NODE_DESC;
 | |
| 
 | |
| 	err = mthca_MAD_IFC(dev, 1, 1,
 | |
| 			    1, NULL, NULL, in_mad, out_mad,
 | |
| 			    &status);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 	if (status) {
 | |
| 		err = -EINVAL;
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	memcpy(dev->ib_dev.node_desc, out_mad->data, 64);
 | |
| 
 | |
| 	in_mad->attr_id = IB_SMP_ATTR_NODE_INFO;
 | |
| 
 | |
| 	err = mthca_MAD_IFC(dev, 1, 1,
 | |
| 			    1, NULL, NULL, in_mad, out_mad,
 | |
| 			    &status);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 	if (status) {
 | |
| 		err = -EINVAL;
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	if (mthca_is_memfree(dev))
 | |
| 		dev->rev_id = be32_to_cpup((__be32 *) (out_mad->data + 32));
 | |
| 	memcpy(&dev->ib_dev.node_guid, out_mad->data + 12, 8);
 | |
| 
 | |
| out:
 | |
| 	kfree(in_mad);
 | |
| 	kfree(out_mad);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| int mthca_register_device(struct mthca_dev *dev)
 | |
| {
 | |
| 	int ret;
 | |
| 	int i;
 | |
| 
 | |
| 	ret = mthca_init_node_data(dev);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	strlcpy(dev->ib_dev.name, "mthca%d", IB_DEVICE_NAME_MAX);
 | |
| 	dev->ib_dev.owner                = THIS_MODULE;
 | |
| 
 | |
| 	dev->ib_dev.uverbs_abi_ver	 = MTHCA_UVERBS_ABI_VERSION;
 | |
| 	dev->ib_dev.uverbs_cmd_mask	 =
 | |
| 		(1ull << IB_USER_VERBS_CMD_GET_CONTEXT)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_QUERY_DEVICE)	|
 | |
| 		(1ull << IB_USER_VERBS_CMD_QUERY_PORT)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_ALLOC_PD)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_DEALLOC_PD)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_REG_MR)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_DEREG_MR)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL)	|
 | |
| 		(1ull << IB_USER_VERBS_CMD_CREATE_CQ)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_RESIZE_CQ)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_DESTROY_CQ)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_CREATE_QP)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_QUERY_QP)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_MODIFY_QP)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_DESTROY_QP)		|
 | |
| 		(1ull << IB_USER_VERBS_CMD_ATTACH_MCAST)	|
 | |
| 		(1ull << IB_USER_VERBS_CMD_DETACH_MCAST);
 | |
| 	dev->ib_dev.node_type            = RDMA_NODE_IB_CA;
 | |
| 	dev->ib_dev.phys_port_cnt        = dev->limits.num_ports;
 | |
| 	dev->ib_dev.num_comp_vectors     = 1;
 | |
| 	dev->ib_dev.dma_device           = &dev->pdev->dev;
 | |
| 	dev->ib_dev.query_device         = mthca_query_device;
 | |
| 	dev->ib_dev.query_port           = mthca_query_port;
 | |
| 	dev->ib_dev.modify_device        = mthca_modify_device;
 | |
| 	dev->ib_dev.modify_port          = mthca_modify_port;
 | |
| 	dev->ib_dev.query_pkey           = mthca_query_pkey;
 | |
| 	dev->ib_dev.query_gid            = mthca_query_gid;
 | |
| 	dev->ib_dev.alloc_ucontext       = mthca_alloc_ucontext;
 | |
| 	dev->ib_dev.dealloc_ucontext     = mthca_dealloc_ucontext;
 | |
| 	dev->ib_dev.mmap                 = mthca_mmap_uar;
 | |
| 	dev->ib_dev.alloc_pd             = mthca_alloc_pd;
 | |
| 	dev->ib_dev.dealloc_pd           = mthca_dealloc_pd;
 | |
| 	dev->ib_dev.create_ah            = mthca_ah_create;
 | |
| 	dev->ib_dev.query_ah             = mthca_ah_query;
 | |
| 	dev->ib_dev.destroy_ah           = mthca_ah_destroy;
 | |
| 
 | |
| 	if (dev->mthca_flags & MTHCA_FLAG_SRQ) {
 | |
| 		dev->ib_dev.create_srq           = mthca_create_srq;
 | |
| 		dev->ib_dev.modify_srq           = mthca_modify_srq;
 | |
| 		dev->ib_dev.query_srq            = mthca_query_srq;
 | |
| 		dev->ib_dev.destroy_srq          = mthca_destroy_srq;
 | |
| 		dev->ib_dev.uverbs_cmd_mask	|=
 | |
| 			(1ull << IB_USER_VERBS_CMD_CREATE_SRQ)		|
 | |
| 			(1ull << IB_USER_VERBS_CMD_MODIFY_SRQ)		|
 | |
| 			(1ull << IB_USER_VERBS_CMD_QUERY_SRQ)		|
 | |
| 			(1ull << IB_USER_VERBS_CMD_DESTROY_SRQ);
 | |
| 
 | |
| 		if (mthca_is_memfree(dev))
 | |
| 			dev->ib_dev.post_srq_recv = mthca_arbel_post_srq_recv;
 | |
| 		else
 | |
| 			dev->ib_dev.post_srq_recv = mthca_tavor_post_srq_recv;
 | |
| 	}
 | |
| 
 | |
| 	dev->ib_dev.create_qp            = mthca_create_qp;
 | |
| 	dev->ib_dev.modify_qp            = mthca_modify_qp;
 | |
| 	dev->ib_dev.query_qp             = mthca_query_qp;
 | |
| 	dev->ib_dev.destroy_qp           = mthca_destroy_qp;
 | |
| 	dev->ib_dev.create_cq            = mthca_create_cq;
 | |
| 	dev->ib_dev.resize_cq            = mthca_resize_cq;
 | |
| 	dev->ib_dev.destroy_cq           = mthca_destroy_cq;
 | |
| 	dev->ib_dev.poll_cq              = mthca_poll_cq;
 | |
| 	dev->ib_dev.get_dma_mr           = mthca_get_dma_mr;
 | |
| 	dev->ib_dev.reg_phys_mr          = mthca_reg_phys_mr;
 | |
| 	dev->ib_dev.reg_user_mr          = mthca_reg_user_mr;
 | |
| 	dev->ib_dev.dereg_mr             = mthca_dereg_mr;
 | |
| 
 | |
| 	if (dev->mthca_flags & MTHCA_FLAG_FMR) {
 | |
| 		dev->ib_dev.alloc_fmr            = mthca_alloc_fmr;
 | |
| 		dev->ib_dev.unmap_fmr            = mthca_unmap_fmr;
 | |
| 		dev->ib_dev.dealloc_fmr          = mthca_dealloc_fmr;
 | |
| 		if (mthca_is_memfree(dev))
 | |
| 			dev->ib_dev.map_phys_fmr = mthca_arbel_map_phys_fmr;
 | |
| 		else
 | |
| 			dev->ib_dev.map_phys_fmr = mthca_tavor_map_phys_fmr;
 | |
| 	}
 | |
| 
 | |
| 	dev->ib_dev.attach_mcast         = mthca_multicast_attach;
 | |
| 	dev->ib_dev.detach_mcast         = mthca_multicast_detach;
 | |
| 	dev->ib_dev.process_mad          = mthca_process_mad;
 | |
| 
 | |
| 	if (mthca_is_memfree(dev)) {
 | |
| 		dev->ib_dev.req_notify_cq = mthca_arbel_arm_cq;
 | |
| 		dev->ib_dev.post_send     = mthca_arbel_post_send;
 | |
| 		dev->ib_dev.post_recv     = mthca_arbel_post_receive;
 | |
| 	} else {
 | |
| 		dev->ib_dev.req_notify_cq = mthca_tavor_arm_cq;
 | |
| 		dev->ib_dev.post_send     = mthca_tavor_post_send;
 | |
| 		dev->ib_dev.post_recv     = mthca_tavor_post_receive;
 | |
| 	}
 | |
| 
 | |
| 	mutex_init(&dev->cap_mask_mutex);
 | |
| 
 | |
| 	ret = ib_register_device(&dev->ib_dev, NULL);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	for (i = 0; i < ARRAY_SIZE(mthca_dev_attributes); ++i) {
 | |
| 		ret = device_create_file(&dev->ib_dev.dev,
 | |
| 					 mthca_dev_attributes[i]);
 | |
| 		if (ret) {
 | |
| 			ib_unregister_device(&dev->ib_dev);
 | |
| 			return ret;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	mthca_start_catas_poll(dev);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| void mthca_unregister_device(struct mthca_dev *dev)
 | |
| {
 | |
| 	mthca_stop_catas_poll(dev);
 | |
| 	ib_unregister_device(&dev->ib_dev);
 | |
| }
 |