[deliverable/linux.git] / drivers / infiniband / hw / cxgb4 / device.c

/*
 * Copyright (c) 2009-2010 Chelsio, 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 <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/debugfs.h>

#include <rdma/ib_verbs.h>

#include "iw_cxgb4.h"

#define DRV_VERSION "0.1"

MODULE_AUTHOR("Steve Wise");
MODULE_DESCRIPTION("Chelsio T4 RDMA Driver");
MODULE_LICENSE("Dual BSD/GPL");
MODULE_VERSION(DRV_VERSION);

static LIST_HEAD(dev_list);
static DEFINE_MUTEX(dev_mutex);

static struct dentry *c4iw_debugfs_root;

struct c4iw_debugfs_data {
	struct c4iw_dev *devp;
	char *buf;
	int bufsize;
	int pos;
};

static int count_idrs(int id, void *p, void *data)
{
	int *countp = data;

	*countp = *countp + 1;
	return 0;
}

static ssize_t debugfs_read(struct file *file, char __user *buf, size_t count,
			    loff_t *ppos)
{
	struct c4iw_debugfs_data *d = file->private_data;
	loff_t pos = *ppos;
	loff_t avail = d->pos;

	if (pos < 0)
		return -EINVAL;
	if (pos >= avail)
		return 0;
	if (count > avail - pos)
		count = avail - pos;

	while (count) {
		size_t len = 0;

		len = min((int)count, (int)d->pos - (int)pos);
		if (copy_to_user(buf, d->buf + pos, len))
			return -EFAULT;
		if (len == 0)
			return -EINVAL;

		buf += len;
		pos += len;
		count -= len;
	}
	count = pos - *ppos;
	*ppos = pos;
	return count;
}

static int dump_qp(int id, void *p, void *data)
{
	struct c4iw_qp *qp = p;
	struct c4iw_debugfs_data *qpd = data;
	int space;
	int cc;

	if (id != qp->wq.sq.qid)
		return 0;

	space = qpd->bufsize - qpd->pos - 1;
	if (space == 0)
		return 1;

	if (qp->ep)
		cc = snprintf(qpd->buf + qpd->pos, space, "qp id %u state %u "
			     "ep tid %u state %u %pI4:%u->%pI4:%u\n",
			     qp->wq.sq.qid, (int)qp->attr.state,
			     qp->ep->hwtid, (int)qp->ep->com.state,
			     &qp->ep->com.local_addr.sin_addr.s_addr,
			     ntohs(qp->ep->com.local_addr.sin_port),
			     &qp->ep->com.remote_addr.sin_addr.s_addr,
			     ntohs(qp->ep->com.remote_addr.sin_port));
	else
		cc = snprintf(qpd->buf + qpd->pos, space, "qp id %u state %u\n",
			      qp->wq.sq.qid, (int)qp->attr.state);
	if (cc < space)
		qpd->pos += cc;
	return 0;
}

static int qp_release(struct inode *inode, struct file *file)
{
	struct c4iw_debugfs_data *qpd = file->private_data;
	if (!qpd) {
		printk(KERN_INFO "%s null qpd?\n", __func__);
		return 0;
	}
	kfree(qpd->buf);
	kfree(qpd);
	return 0;
}

static int qp_open(struct inode *inode, struct file *file)
{
	struct c4iw_debugfs_data *qpd;
	int ret = 0;
	int count = 1;

	qpd = kmalloc(sizeof *qpd, GFP_KERNEL);
	if (!qpd) {
		ret = -ENOMEM;
		goto out;
	}
	qpd->devp = inode->i_private;
	qpd->pos = 0;

	spin_lock_irq(&qpd->devp->lock);
	idr_for_each(&qpd->devp->qpidr, count_idrs, &count);
	spin_unlock_irq(&qpd->devp->lock);

	qpd->bufsize = count * 128;
	qpd->buf = kmalloc(qpd->bufsize, GFP_KERNEL);
	if (!qpd->buf) {
		ret = -ENOMEM;
		goto err1;
	}

	spin_lock_irq(&qpd->devp->lock);
	idr_for_each(&qpd->devp->qpidr, dump_qp, qpd);
	spin_unlock_irq(&qpd->devp->lock);

	qpd->buf[qpd->pos++] = 0;
	file->private_data = qpd;
	goto out;
err1:
	kfree(qpd);
out:
	return ret;
}

static const struct file_operations qp_debugfs_fops = {
	.owner   = THIS_MODULE,
	.open    = qp_open,
	.release = qp_release,
	.read    = debugfs_read,
};

static int dump_stag(int id, void *p, void *data)
{
	struct c4iw_debugfs_data *stagd = data;
	int space;
	int cc;

	space = stagd->bufsize - stagd->pos - 1;
	if (space == 0)
		return 1;

	cc = snprintf(stagd->buf + stagd->pos, space, "0x%x\n", id<<8);
	if (cc < space)
		stagd->pos += cc;
	return 0;
}

static int stag_release(struct inode *inode, struct file *file)
{
	struct c4iw_debugfs_data *stagd = file->private_data;
	if (!stagd) {
		printk(KERN_INFO "%s null stagd?\n", __func__);
		return 0;
	}
	kfree(stagd->buf);
	kfree(stagd);
	return 0;
}

static int stag_open(struct inode *inode, struct file *file)
{
	struct c4iw_debugfs_data *stagd;
	int ret = 0;
	int count = 1;

	stagd = kmalloc(sizeof *stagd, GFP_KERNEL);
	if (!stagd) {
		ret = -ENOMEM;
		goto out;
	}
	stagd->devp = inode->i_private;
	stagd->pos = 0;

	spin_lock_irq(&stagd->devp->lock);
	idr_for_each(&stagd->devp->mmidr, count_idrs, &count);
	spin_unlock_irq(&stagd->devp->lock);

	stagd->bufsize = count * sizeof("0x12345678\n");
	stagd->buf = kmalloc(stagd->bufsize, GFP_KERNEL);
	if (!stagd->buf) {
		ret = -ENOMEM;
		goto err1;
	}

	spin_lock_irq(&stagd->devp->lock);
	idr_for_each(&stagd->devp->mmidr, dump_stag, stagd);
	spin_unlock_irq(&stagd->devp->lock);

	stagd->buf[stagd->pos++] = 0;
	file->private_data = stagd;
	goto out;
err1:
	kfree(stagd);
out:
	return ret;
}

static const struct file_operations stag_debugfs_fops = {
	.owner   = THIS_MODULE,
	.open    = stag_open,
	.release = stag_release,
	.read    = debugfs_read,
};

static int setup_debugfs(struct c4iw_dev *devp)
{
	struct dentry *de;

	if (!devp->debugfs_root)
		return -1;

	de = debugfs_create_file("qps", S_IWUSR, devp->debugfs_root,
				 (void *)devp, &qp_debugfs_fops);
	if (de && de->d_inode)
		de->d_inode->i_size = 4096;

	de = debugfs_create_file("stags", S_IWUSR, devp->debugfs_root,
				 (void *)devp, &stag_debugfs_fops);
	if (de && de->d_inode)
		de->d_inode->i_size = 4096;
	return 0;
}

void c4iw_release_dev_ucontext(struct c4iw_rdev *rdev,
			       struct c4iw_dev_ucontext *uctx)
{
	struct list_head *pos, *nxt;
	struct c4iw_qid_list *entry;

	mutex_lock(&uctx->lock);
	list_for_each_safe(pos, nxt, &uctx->qpids) {
		entry = list_entry(pos, struct c4iw_qid_list, entry);
		list_del_init(&entry->entry);
		if (!(entry->qid & rdev->qpmask))
			c4iw_put_resource(&rdev->resource.qid_fifo, entry->qid,
					  &rdev->resource.qid_fifo_lock);
		kfree(entry);
	}

	list_for_each_safe(pos, nxt, &uctx->qpids) {
		entry = list_entry(pos, struct c4iw_qid_list, entry);
		list_del_init(&entry->entry);
		kfree(entry);
	}
	mutex_unlock(&uctx->lock);
}

void c4iw_init_dev_ucontext(struct c4iw_rdev *rdev,
			    struct c4iw_dev_ucontext *uctx)
{
	INIT_LIST_HEAD(&uctx->qpids);
	INIT_LIST_HEAD(&uctx->cqids);
	mutex_init(&uctx->lock);
}

/* Caller takes care of locking if needed */
static int c4iw_rdev_open(struct c4iw_rdev *rdev)
{
	int err;

	c4iw_init_dev_ucontext(rdev, &rdev->uctx);

	/*
	 * qpshift is the number of bits to shift the qpid left in order
	 * to get the correct address of the doorbell for that qp.
	 */
	rdev->qpshift = PAGE_SHIFT - ilog2(rdev->lldi.udb_density);
	rdev->qpmask = rdev->lldi.udb_density - 1;
	rdev->cqshift = PAGE_SHIFT - ilog2(rdev->lldi.ucq_density);
	rdev->cqmask = rdev->lldi.ucq_density - 1;
	PDBG("%s dev %s stag start 0x%0x size 0x%0x num stags %d "
	     "pbl start 0x%0x size 0x%0x rq start 0x%0x size 0x%0x "
	     "qp qid start %u size %u cq qid start %u size %u\n",
	     __func__, pci_name(rdev->lldi.pdev), rdev->lldi.vr->stag.start,
	     rdev->lldi.vr->stag.size, c4iw_num_stags(rdev),
	     rdev->lldi.vr->pbl.start,
	     rdev->lldi.vr->pbl.size, rdev->lldi.vr->rq.start,
	     rdev->lldi.vr->rq.size,
	     rdev->lldi.vr->qp.start,
	     rdev->lldi.vr->qp.size,
	     rdev->lldi.vr->cq.start,
	     rdev->lldi.vr->cq.size);
	PDBG("udb len 0x%x udb base %p db_reg %p gts_reg %p qpshift %lu "
	     "qpmask 0x%x cqshift %lu cqmask 0x%x\n",
	     (unsigned)pci_resource_len(rdev->lldi.pdev, 2),
	     (void *)pci_resource_start(rdev->lldi.pdev, 2),
	     rdev->lldi.db_reg,
	     rdev->lldi.gts_reg,
	     rdev->qpshift, rdev->qpmask,
	     rdev->cqshift, rdev->cqmask);

	if (c4iw_num_stags(rdev) == 0) {
		err = -EINVAL;
		goto err1;
	}

	err = c4iw_init_resource(rdev, c4iw_num_stags(rdev), T4_MAX_NUM_PD);
	if (err) {
		printk(KERN_ERR MOD "error %d initializing resources\n", err);
		goto err1;
	}
	err = c4iw_pblpool_create(rdev);
	if (err) {
		printk(KERN_ERR MOD "error %d initializing pbl pool\n", err);
		goto err2;
	}
	err = c4iw_rqtpool_create(rdev);
	if (err) {
		printk(KERN_ERR MOD "error %d initializing rqt pool\n", err);
		goto err3;
	}
	return 0;
err3:
	c4iw_pblpool_destroy(rdev);
err2:
	c4iw_destroy_resource(&rdev->resource);
err1:
	return err;
}

static void c4iw_rdev_close(struct c4iw_rdev *rdev)
{
	c4iw_pblpool_destroy(rdev);
	c4iw_rqtpool_destroy(rdev);
	c4iw_destroy_resource(&rdev->resource);
}

static void c4iw_remove(struct c4iw_dev *dev)
{
	PDBG("%s c4iw_dev %p\n", __func__,  dev);
	cancel_delayed_work_sync(&dev->db_drop_task);
	list_del(&dev->entry);
	if (dev->registered)
		c4iw_unregister_device(dev);
	c4iw_rdev_close(&dev->rdev);
	idr_destroy(&dev->cqidr);
	idr_destroy(&dev->qpidr);
	idr_destroy(&dev->mmidr);
	ib_dealloc_device(&dev->ibdev);
}

static struct c4iw_dev *c4iw_alloc(const struct cxgb4_lld_info *infop)
{
	struct c4iw_dev *devp;
	int ret;

	devp = (struct c4iw_dev *)ib_alloc_device(sizeof(*devp));
	if (!devp) {
		printk(KERN_ERR MOD "Cannot allocate ib device\n");
		return NULL;
	}
	devp->rdev.lldi = *infop;

	mutex_lock(&dev_mutex);

	ret = c4iw_rdev_open(&devp->rdev);
	if (ret) {
		mutex_unlock(&dev_mutex);
		printk(KERN_ERR MOD "Unable to open CXIO rdev err %d\n", ret);
		ib_dealloc_device(&devp->ibdev);
		return NULL;
	}

	idr_init(&devp->cqidr);
	idr_init(&devp->qpidr);
	idr_init(&devp->mmidr);
	spin_lock_init(&devp->lock);
	list_add_tail(&devp->entry, &dev_list);
	mutex_unlock(&dev_mutex);

	if (c4iw_debugfs_root) {
		devp->debugfs_root = debugfs_create_dir(
					pci_name(devp->rdev.lldi.pdev),
					c4iw_debugfs_root);
		setup_debugfs(devp);
	}
	return devp;
}

static void *c4iw_uld_add(const struct cxgb4_lld_info *infop)
{
	struct c4iw_dev *dev;
	static int vers_printed;
	int i;

	if (!vers_printed++)
		printk(KERN_INFO MOD "Chelsio T4 RDMA Driver - version %s\n",
		       DRV_VERSION);

	dev = c4iw_alloc(infop);
	if (!dev)
		goto out;

	PDBG("%s found device %s nchan %u nrxq %u ntxq %u nports %u\n",
	     __func__, pci_name(dev->rdev.lldi.pdev),
	     dev->rdev.lldi.nchan, dev->rdev.lldi.nrxq,
	     dev->rdev.lldi.ntxq, dev->rdev.lldi.nports);

	for (i = 0; i < dev->rdev.lldi.nrxq; i++)
		PDBG("rxqid[%u] %u\n", i, dev->rdev.lldi.rxq_ids[i]);
out:
	return dev;
}

static struct sk_buff *t4_pktgl_to_skb(const struct pkt_gl *gl,
				       unsigned int skb_len,
				       unsigned int pull_len)
{
	struct sk_buff *skb;
	struct skb_shared_info *ssi;

	if (gl->tot_len <= 512) {
		skb = alloc_skb(gl->tot_len, GFP_ATOMIC);
		if (unlikely(!skb))
			goto out;
		__skb_put(skb, gl->tot_len);
		skb_copy_to_linear_data(skb, gl->va, gl->tot_len);
	} else {
		skb = alloc_skb(skb_len, GFP_ATOMIC);
		if (unlikely(!skb))
			goto out;
		__skb_put(skb, pull_len);
		skb_copy_to_linear_data(skb, gl->va, pull_len);

		ssi = skb_shinfo(skb);
		ssi->frags[0].page = gl->frags[0].page;
		ssi->frags[0].page_offset = gl->frags[0].page_offset + pull_len;
		ssi->frags[0].size = gl->frags[0].size - pull_len;
		if (gl->nfrags > 1)
			memcpy(&ssi->frags[1], &gl->frags[1],
			       (gl->nfrags - 1) * sizeof(skb_frag_t));
		ssi->nr_frags = gl->nfrags;

		skb->len = gl->tot_len;
		skb->data_len = skb->len - pull_len;
		skb->truesize += skb->data_len;

		/* Get a reference for the last page, we don't own it */
		get_page(gl->frags[gl->nfrags - 1].page);
	}
out:
	return skb;
}

static int c4iw_uld_rx_handler(void *handle, const __be64 *rsp,
			const struct pkt_gl *gl)
{
	struct c4iw_dev *dev = handle;
	struct sk_buff *skb;
	const struct cpl_act_establish *rpl;
	unsigned int opcode;

	if (gl == NULL) {
		/* omit RSS and rsp_ctrl at end of descriptor */
		unsigned int len = 64 - sizeof(struct rsp_ctrl) - 8;

		skb = alloc_skb(256, GFP_ATOMIC);
		if (!skb)
			goto nomem;
		__skb_put(skb, len);
		skb_copy_to_linear_data(skb, &rsp[1], len);
	} else if (gl == CXGB4_MSG_AN) {
		const struct rsp_ctrl *rc = (void *)rsp;

		u32 qid = be32_to_cpu(rc->pldbuflen_qid);
		c4iw_ev_handler(dev, qid);
		return 0;
	} else {
		skb = t4_pktgl_to_skb(gl, 128, 128);
		if (unlikely(!skb))
			goto nomem;
	}

	rpl = cplhdr(skb);
	opcode = rpl->ot.opcode;

	if (c4iw_handlers[opcode])
		c4iw_handlers[opcode](dev, skb);
	else
		printk(KERN_INFO "%s no handler opcode 0x%x...\n", __func__,
		       opcode);

	return 0;
nomem:
	return -1;
}

static int c4iw_uld_state_change(void *handle, enum cxgb4_state new_state)
{
	struct c4iw_dev *dev = handle;

	PDBG("%s new_state %u\n", __func__, new_state);
	switch (new_state) {
	case CXGB4_STATE_UP:
		printk(KERN_INFO MOD "%s: Up\n", pci_name(dev->rdev.lldi.pdev));
		if (!dev->registered) {
			int ret;
			ret = c4iw_register_device(dev);
			if (ret)
				printk(KERN_ERR MOD
				       "%s: RDMA registration failed: %d\n",
				       pci_name(dev->rdev.lldi.pdev), ret);
		}
		break;
	case CXGB4_STATE_DOWN:
		printk(KERN_INFO MOD "%s: Down\n",
		       pci_name(dev->rdev.lldi.pdev));
		if (dev->registered)
			c4iw_unregister_device(dev);
		break;
	case CXGB4_STATE_START_RECOVERY:
		printk(KERN_INFO MOD "%s: Fatal Error\n",
		       pci_name(dev->rdev.lldi.pdev));
		if (dev->registered)
			c4iw_unregister_device(dev);
		break;
	case CXGB4_STATE_DETACH:
		printk(KERN_INFO MOD "%s: Detach\n",
		       pci_name(dev->rdev.lldi.pdev));
		mutex_lock(&dev_mutex);
		c4iw_remove(dev);
		mutex_unlock(&dev_mutex);
		break;
	}
	return 0;
}

static struct cxgb4_uld_info c4iw_uld_info = {
	.name = DRV_NAME,
	.add = c4iw_uld_add,
	.rx_handler = c4iw_uld_rx_handler,
	.state_change = c4iw_uld_state_change,
};

static int __init c4iw_init_module(void)
{
	int err;

	err = c4iw_cm_init();
	if (err)
		return err;

	c4iw_debugfs_root = debugfs_create_dir(DRV_NAME, NULL);
	if (!c4iw_debugfs_root)
		printk(KERN_WARNING MOD
		       "could not create debugfs entry, continuing\n");

	cxgb4_register_uld(CXGB4_ULD_RDMA, &c4iw_uld_info);

	return 0;
}

static void __exit c4iw_exit_module(void)
{
	struct c4iw_dev *dev, *tmp;

	mutex_lock(&dev_mutex);
	list_for_each_entry_safe(dev, tmp, &dev_list, entry) {
		c4iw_remove(dev);
	}
	mutex_unlock(&dev_mutex);
	cxgb4_unregister_uld(CXGB4_ULD_RDMA);
	c4iw_cm_term();
	debugfs_remove_recursive(c4iw_debugfs_root);
}

module_init(c4iw_init_module);
module_exit(c4iw_exit_module);
Commit	Line	Data
cfdda9d7 SW	1	/*
	2	* Copyright (c) 2009-2010 Chelsio, Inc. All rights reserved.
	3	*
	4	* This software is available to you under a choice of one of two
	5	* licenses. You may choose to be licensed under the terms of the GNU
	6	* General Public License (GPL) Version 2, available from the file
	7	* COPYING in the main directory of this source tree, or the
	8	* OpenIB.org BSD license below:
	9	*
	10	* Redistribution and use in source and binary forms, with or
	11	* without modification, are permitted provided that the following
	12	* conditions are met:
	13	*
	14	* - Redistributions of source code must retain the above
	15	* copyright notice, this list of conditions and the following
	16	* disclaimer.
	17	*
	18	* - Redistributions in binary form must reproduce the above
	19	* copyright notice, this list of conditions and the following
	20	* disclaimer in the documentation and/or other materials
	21	* provided with the distribution.
	22	*
	23	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
	24	* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
	25	* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
	26	* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
	27	* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
	28	* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
	29	* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
	30	* SOFTWARE.
	31	*/
	32	#include <linux/module.h>
	33	#include <linux/moduleparam.h>
	34	#include <linux/debugfs.h>
	35
	36	#include <rdma/ib_verbs.h>
	37
	38	#include "iw_cxgb4.h"
	39
	40	#define DRV_VERSION "0.1"
	41
	42	MODULE_AUTHOR("Steve Wise");
	43	MODULE_DESCRIPTION("Chelsio T4 RDMA Driver");
	44	MODULE_LICENSE("Dual BSD/GPL");
	45	MODULE_VERSION(DRV_VERSION);
	46
	47	static LIST_HEAD(dev_list);
	48	static DEFINE_MUTEX(dev_mutex);
	49
	50	static struct dentry *c4iw_debugfs_root;
	51
9e8d1fa3	52	struct c4iw_debugfs_data {
cfdda9d7 SW	53	struct c4iw_dev *devp;
	54	char *buf;
	55	int bufsize;
	56	int pos;
	57	};
	58
9e8d1fa3	59	static int count_idrs(int id, void p, void data)
cfdda9d7	60	{
cfdda9d7 SW	61	int *countp = data;
cfdda9d7 SW	62
cfdda9d7 SW	63	countp = countp + 1;
	64	return 0;
	65	}
	66
9e8d1fa3 SW	67	static ssize_t debugfs_read(struct file file, char __user buf, size_t count,
	68	loff_t *ppos)
	69	{
	70	struct c4iw_debugfs_data *d = file->private_data;
	71	loff_t pos = *ppos;
	72	loff_t avail = d->pos;
	73
	74	if (pos < 0)
	75	return -EINVAL;
	76	if (pos >= avail)
	77	return 0;
	78	if (count > avail - pos)
	79	count = avail - pos;
	80
	81	while (count) {
	82	size_t len = 0;
	83
	84	len = min((int)count, (int)d->pos - (int)pos);
	85	if (copy_to_user(buf, d->buf + pos, len))
	86	return -EFAULT;
	87	if (len == 0)
	88	return -EINVAL;
	89
	90	buf += len;
	91	pos += len;
	92	count -= len;
	93	}
	94	count = pos - *ppos;
	95	*ppos = pos;
	96	return count;
	97	}
	98
	99	static int dump_qp(int id, void p, void data)
cfdda9d7 SW	100	{
cfdda9d7 SW	101	struct c4iw_qp *qp = p;
9e8d1fa3	102	struct c4iw_debugfs_data *qpd = data;
cfdda9d7 SW	103	int space;
	104	int cc;
	105
	106	if (id != qp->wq.sq.qid)
	107	return 0;
	108
	109	space = qpd->bufsize - qpd->pos - 1;
	110	if (space == 0)
	111	return 1;
	112
	113	if (qp->ep)
	114	cc = snprintf(qpd->buf + qpd->pos, space, "qp id %u state %u "
	115	"ep tid %u state %u %pI4:%u->%pI4:%u\n",
	116	qp->wq.sq.qid, (int)qp->attr.state,
	117	qp->ep->hwtid, (int)qp->ep->com.state,
	118	&qp->ep->com.local_addr.sin_addr.s_addr,
	119	ntohs(qp->ep->com.local_addr.sin_port),
	120	&qp->ep->com.remote_addr.sin_addr.s_addr,
	121	ntohs(qp->ep->com.remote_addr.sin_port));
	122	else
	123	cc = snprintf(qpd->buf + qpd->pos, space, "qp id %u state %u\n",
	124	qp->wq.sq.qid, (int)qp->attr.state);
	125	if (cc < space)
	126	qpd->pos += cc;
	127	return 0;
	128	}
	129
	130	static int qp_release(struct inode inode, struct file file)
	131	{
9e8d1fa3	132	struct c4iw_debugfs_data *qpd = file->private_data;
cfdda9d7 SW	133	if (!qpd) {
	134	printk(KERN_INFO "%s null qpd?\n", __func__);
	135	return 0;
	136	}
	137	kfree(qpd->buf);
	138	kfree(qpd);
	139	return 0;
	140	}
	141
	142	static int qp_open(struct inode inode, struct file file)
	143	{
9e8d1fa3	144	struct c4iw_debugfs_data *qpd;
cfdda9d7 SW	145	int ret = 0;
	146	int count = 1;
	147
	148	qpd = kmalloc(sizeof *qpd, GFP_KERNEL);
	149	if (!qpd) {
	150	ret = -ENOMEM;
	151	goto out;
	152	}
	153	qpd->devp = inode->i_private;
	154	qpd->pos = 0;
	155
	156	spin_lock_irq(&qpd->devp->lock);
9e8d1fa3	157	idr_for_each(&qpd->devp->qpidr, count_idrs, &count);
cfdda9d7 SW	158	spin_unlock_irq(&qpd->devp->lock);
	159
	160	qpd->bufsize = count * 128;
	161	qpd->buf = kmalloc(qpd->bufsize, GFP_KERNEL);
	162	if (!qpd->buf) {
	163	ret = -ENOMEM;
	164	goto err1;
	165	}
	166
	167	spin_lock_irq(&qpd->devp->lock);
9e8d1fa3	168	idr_for_each(&qpd->devp->qpidr, dump_qp, qpd);
cfdda9d7 SW	169	spin_unlock_irq(&qpd->devp->lock);
	170
	171	qpd->buf[qpd->pos++] = 0;
	172	file->private_data = qpd;
	173	goto out;
	174	err1:
	175	kfree(qpd);
	176	out:
	177	return ret;
	178	}
	179
9e8d1fa3 SW	180	static const struct file_operations qp_debugfs_fops = {
	181	.owner = THIS_MODULE,
	182	.open = qp_open,
	183	.release = qp_release,
	184	.read = debugfs_read,
	185	};
	186
	187	static int dump_stag(int id, void p, void data)
cfdda9d7	188	{
9e8d1fa3 SW	189	struct c4iw_debugfs_data *stagd = data;
	190	int space;
	191	int cc;
cfdda9d7	192
9e8d1fa3 SW	193	space = stagd->bufsize - stagd->pos - 1;
	194	if (space == 0)
	195	return 1;
	196
	197	cc = snprintf(stagd->buf + stagd->pos, space, "0x%x\n", id<<8);
	198	if (cc < space)
	199	stagd->pos += cc;
	200	return 0;
	201	}
	202
	203	static int stag_release(struct inode inode, struct file file)
	204	{
	205	struct c4iw_debugfs_data *stagd = file->private_data;
	206	if (!stagd) {
	207	printk(KERN_INFO "%s null stagd?\n", __func__);
cfdda9d7	208	return 0;
9e8d1fa3 SW	209	}
	210	kfree(stagd->buf);
	211	kfree(stagd);
	212	return 0;
	213	}
cfdda9d7	214
9e8d1fa3 SW	215	static int stag_open(struct inode inode, struct file file)
	216	{
	217	struct c4iw_debugfs_data *stagd;
	218	int ret = 0;
	219	int count = 1;
cfdda9d7	220
9e8d1fa3 SW	221	stagd = kmalloc(sizeof *stagd, GFP_KERNEL);
	222	if (!stagd) {
	223	ret = -ENOMEM;
	224	goto out;
	225	}
	226	stagd->devp = inode->i_private;
	227	stagd->pos = 0;
cfdda9d7	228
9e8d1fa3 SW	229	spin_lock_irq(&stagd->devp->lock);
	230	idr_for_each(&stagd->devp->mmidr, count_idrs, &count);
	231	spin_unlock_irq(&stagd->devp->lock);
	232
	233	stagd->bufsize = count * sizeof("0x12345678\n");
	234	stagd->buf = kmalloc(stagd->bufsize, GFP_KERNEL);
	235	if (!stagd->buf) {
	236	ret = -ENOMEM;
	237	goto err1;
cfdda9d7	238	}
9e8d1fa3 SW	239
	240	spin_lock_irq(&stagd->devp->lock);
	241	idr_for_each(&stagd->devp->mmidr, dump_stag, stagd);
	242	spin_unlock_irq(&stagd->devp->lock);
	243
	244	stagd->buf[stagd->pos++] = 0;
	245	file->private_data = stagd;
	246	goto out;
	247	err1:
	248	kfree(stagd);
	249	out:
	250	return ret;
cfdda9d7 SW	251	}
cfdda9d7 SW	252
9e8d1fa3	253	static const struct file_operations stag_debugfs_fops = {
cfdda9d7	254	.owner = THIS_MODULE,
9e8d1fa3 SW	255	.open = stag_open,
	256	.release = stag_release,
	257	.read = debugfs_read,
cfdda9d7 SW	258	};
	259
	260	static int setup_debugfs(struct c4iw_dev *devp)
	261	{
	262	struct dentry *de;
	263
	264	if (!devp->debugfs_root)
	265	return -1;
	266
	267	de = debugfs_create_file("qps", S_IWUSR, devp->debugfs_root,
	268	(void *)devp, &qp_debugfs_fops);
	269	if (de && de->d_inode)
	270	de->d_inode->i_size = 4096;
9e8d1fa3 SW	271
	272	de = debugfs_create_file("stags", S_IWUSR, devp->debugfs_root,
	273	(void *)devp, &stag_debugfs_fops);
	274	if (de && de->d_inode)
	275	de->d_inode->i_size = 4096;
cfdda9d7 SW	276	return 0;
	277	}
	278
	279	void c4iw_release_dev_ucontext(struct c4iw_rdev *rdev,
	280	struct c4iw_dev_ucontext *uctx)
	281	{
	282	struct list_head pos, nxt;
	283	struct c4iw_qid_list *entry;
	284
	285	mutex_lock(&uctx->lock);
	286	list_for_each_safe(pos, nxt, &uctx->qpids) {
	287	entry = list_entry(pos, struct c4iw_qid_list, entry);
	288	list_del_init(&entry->entry);
	289	if (!(entry->qid & rdev->qpmask))
	290	c4iw_put_resource(&rdev->resource.qid_fifo, entry->qid,
	291	&rdev->resource.qid_fifo_lock);
	292	kfree(entry);
	293	}
	294
	295	list_for_each_safe(pos, nxt, &uctx->qpids) {
	296	entry = list_entry(pos, struct c4iw_qid_list, entry);
	297	list_del_init(&entry->entry);
	298	kfree(entry);
	299	}
	300	mutex_unlock(&uctx->lock);
	301	}
	302
	303	void c4iw_init_dev_ucontext(struct c4iw_rdev *rdev,
	304	struct c4iw_dev_ucontext *uctx)
	305	{
	306	INIT_LIST_HEAD(&uctx->qpids);
	307	INIT_LIST_HEAD(&uctx->cqids);
	308	mutex_init(&uctx->lock);
	309	}
	310
	311	/* Caller takes care of locking if needed */
	312	static int c4iw_rdev_open(struct c4iw_rdev *rdev)
	313	{
	314	int err;
	315
	316	c4iw_init_dev_ucontext(rdev, &rdev->uctx);
	317
	318	/*
	319	* qpshift is the number of bits to shift the qpid left in order
	320	* to get the correct address of the doorbell for that qp.
	321	*/
	322	rdev->qpshift = PAGE_SHIFT - ilog2(rdev->lldi.udb_density);
	323	rdev->qpmask = rdev->lldi.udb_density - 1;
	324	rdev->cqshift = PAGE_SHIFT - ilog2(rdev->lldi.ucq_density);
	325	rdev->cqmask = rdev->lldi.ucq_density - 1;
	326	PDBG("%s dev %s stag start 0x%0x size 0x%0x num stags %d "
93fb72e4 SW	327	"pbl start 0x%0x size 0x%0x rq start 0x%0x size 0x%0x "
93fb72e4 SW	328	"qp qid start %u size %u cq qid start %u size %u\n",
cfdda9d7 SW	329	__func__, pci_name(rdev->lldi.pdev), rdev->lldi.vr->stag.start,
	330	rdev->lldi.vr->stag.size, c4iw_num_stags(rdev),
	331	rdev->lldi.vr->pbl.start,
	332	rdev->lldi.vr->pbl.size, rdev->lldi.vr->rq.start,
93fb72e4 SW	333	rdev->lldi.vr->rq.size,
	334	rdev->lldi.vr->qp.start,
	335	rdev->lldi.vr->qp.size,
	336	rdev->lldi.vr->cq.start,
	337	rdev->lldi.vr->cq.size);
cfdda9d7 SW	338	PDBG("udb len 0x%x udb base %p db_reg %p gts_reg %p qpshift %lu "
	339	"qpmask 0x%x cqshift %lu cqmask 0x%x\n",
	340	(unsigned)pci_resource_len(rdev->lldi.pdev, 2),
	341	(void *)pci_resource_start(rdev->lldi.pdev, 2),
	342	rdev->lldi.db_reg,
	343	rdev->lldi.gts_reg,
	344	rdev->qpshift, rdev->qpmask,
	345	rdev->cqshift, rdev->cqmask);
	346
	347	if (c4iw_num_stags(rdev) == 0) {
	348	err = -EINVAL;
	349	goto err1;
	350	}
	351
	352	err = c4iw_init_resource(rdev, c4iw_num_stags(rdev), T4_MAX_NUM_PD);
	353	if (err) {
	354	printk(KERN_ERR MOD "error %d initializing resources\n", err);
	355	goto err1;
	356	}
	357	err = c4iw_pblpool_create(rdev);
	358	if (err) {
	359	printk(KERN_ERR MOD "error %d initializing pbl pool\n", err);
	360	goto err2;
	361	}
	362	err = c4iw_rqtpool_create(rdev);
	363	if (err) {
	364	printk(KERN_ERR MOD "error %d initializing rqt pool\n", err);
	365	goto err3;
	366	}
	367	return 0;
	368	err3:
	369	c4iw_pblpool_destroy(rdev);
	370	err2:
	371	c4iw_destroy_resource(&rdev->resource);
	372	err1:
	373	return err;
	374	}
	375
	376	static void c4iw_rdev_close(struct c4iw_rdev *rdev)
	377	{
	378	c4iw_pblpool_destroy(rdev);
	379	c4iw_rqtpool_destroy(rdev);
	380	c4iw_destroy_resource(&rdev->resource);
	381	}
	382
	383	static void c4iw_remove(struct c4iw_dev *dev)
	384	{
	385	PDBG("%s c4iw_dev %p\n", __func__, dev);
	386	cancel_delayed_work_sync(&dev->db_drop_task);
	387	list_del(&dev->entry);
1c01c538 SW	388	if (dev->registered)
1c01c538 SW	389	c4iw_unregister_device(dev);
cfdda9d7 SW	390	c4iw_rdev_close(&dev->rdev);
	391	idr_destroy(&dev->cqidr);
	392	idr_destroy(&dev->qpidr);
	393	idr_destroy(&dev->mmidr);
	394	ib_dealloc_device(&dev->ibdev);
	395	}
	396
	397	static struct c4iw_dev c4iw_alloc(const struct cxgb4_lld_info infop)
	398	{
	399	struct c4iw_dev *devp;
	400	int ret;
	401
	402	devp = (struct c4iw_dev )ib_alloc_device(sizeof(devp));
	403	if (!devp) {
	404	printk(KERN_ERR MOD "Cannot allocate ib device\n");
	405	return NULL;
	406	}
	407	devp->rdev.lldi = *infop;
	408
	409	mutex_lock(&dev_mutex);
	410
	411	ret = c4iw_rdev_open(&devp->rdev);
	412	if (ret) {
	413	mutex_unlock(&dev_mutex);
	414	printk(KERN_ERR MOD "Unable to open CXIO rdev err %d\n", ret);
	415	ib_dealloc_device(&devp->ibdev);
	416	return NULL;
	417	}
	418
	419	idr_init(&devp->cqidr);
	420	idr_init(&devp->qpidr);
	421	idr_init(&devp->mmidr);
	422	spin_lock_init(&devp->lock);
	423	list_add_tail(&devp->entry, &dev_list);
	424	mutex_unlock(&dev_mutex);
	425
cfdda9d7 SW	426	if (c4iw_debugfs_root) {
	427	devp->debugfs_root = debugfs_create_dir(
	428	pci_name(devp->rdev.lldi.pdev),
	429	c4iw_debugfs_root);
	430	setup_debugfs(devp);
	431	}
	432	return devp;
	433	}
	434
	435	static void c4iw_uld_add(const struct cxgb4_lld_info infop)
	436	{
	437	struct c4iw_dev *dev;
	438	static int vers_printed;
	439	int i;
	440
	441	if (!vers_printed++)
	442	printk(KERN_INFO MOD "Chelsio T4 RDMA Driver - version %s\n",
	443	DRV_VERSION);
	444
	445	dev = c4iw_alloc(infop);
	446	if (!dev)
	447	goto out;
	448
	449	PDBG("%s found device %s nchan %u nrxq %u ntxq %u nports %u\n",
	450	__func__, pci_name(dev->rdev.lldi.pdev),
	451	dev->rdev.lldi.nchan, dev->rdev.lldi.nrxq,
	452	dev->rdev.lldi.ntxq, dev->rdev.lldi.nports);
	453
	454	for (i = 0; i < dev->rdev.lldi.nrxq; i++)
	455	PDBG("rxqid[%u] %u\n", i, dev->rdev.lldi.rxq_ids[i]);
cfdda9d7 SW	456	out:
	457	return dev;
	458	}
	459
	460	static struct sk_buff t4_pktgl_to_skb(const struct pkt_gl gl,
	461	unsigned int skb_len,
	462	unsigned int pull_len)
	463	{
	464	struct sk_buff *skb;
	465	struct skb_shared_info *ssi;
	466
	467	if (gl->tot_len <= 512) {
	468	skb = alloc_skb(gl->tot_len, GFP_ATOMIC);
	469	if (unlikely(!skb))
	470	goto out;
	471	__skb_put(skb, gl->tot_len);
	472	skb_copy_to_linear_data(skb, gl->va, gl->tot_len);
	473	} else {
	474	skb = alloc_skb(skb_len, GFP_ATOMIC);
	475	if (unlikely(!skb))
	476	goto out;
	477	__skb_put(skb, pull_len);
	478	skb_copy_to_linear_data(skb, gl->va, pull_len);
	479
	480	ssi = skb_shinfo(skb);
	481	ssi->frags[0].page = gl->frags[0].page;
	482	ssi->frags[0].page_offset = gl->frags[0].page_offset + pull_len;
	483	ssi->frags[0].size = gl->frags[0].size - pull_len;
	484	if (gl->nfrags > 1)
	485	memcpy(&ssi->frags[1], &gl->frags[1],
	486	(gl->nfrags - 1) * sizeof(skb_frag_t));
	487	ssi->nr_frags = gl->nfrags;
	488
	489	skb->len = gl->tot_len;
	490	skb->data_len = skb->len - pull_len;
	491	skb->truesize += skb->data_len;
	492
	493	/* Get a reference for the last page, we don't own it */
	494	get_page(gl->frags[gl->nfrags - 1].page);
	495	}
	496	out:
	497	return skb;
	498	}
	499
	500	static int c4iw_uld_rx_handler(void handle, const __be64 rsp,
	501	const struct pkt_gl *gl)
	502	{
	503	struct c4iw_dev *dev = handle;
	504	struct sk_buff *skb;
	505	const struct cpl_act_establish *rpl;
	506	unsigned int opcode;
	507
	508	if (gl == NULL) {
	509	/* omit RSS and rsp_ctrl at end of descriptor */
	510	unsigned int len = 64 - sizeof(struct rsp_ctrl) - 8;
	511
	512	skb = alloc_skb(256, GFP_ATOMIC);
	513	if (!skb)
	514	goto nomem;
	515	__skb_put(skb, len);
	516	skb_copy_to_linear_data(skb, &rsp[1], len);
	517	} else if (gl == CXGB4_MSG_AN) {
	518	const struct rsp_ctrl rc = (void )rsp;
	519
520	u32 qid = be32_to_cpu(rc->pldbuflen_qid);
521	c4iw_ev_handler(dev, qid);
522	return 0;
523	} else {
524	skb = t4_pktgl_to_skb(gl, 128, 128);
525	if (unlikely(!skb))
526	goto nomem;
527	}
528
529	rpl = cplhdr(skb);
530	opcode = rpl->ot.opcode;
531
532	if (c4iw_handlers[opcode])
533	c4iw_handlers[opcode](dev, skb);
534	else
535	printk(KERN_INFO "%s no handler opcode 0x%x...\n", __func__,
536	opcode);
537
538	return 0;
539	nomem:
540	return -1;
541	}
542
543	static int c4iw_uld_state_change(void *handle, enum cxgb4_state new_state)
544	{
1c01c538 SW	545	struct c4iw_dev *dev = handle;
1c01c538 SW	546
cfdda9d7	547	PDBG("%s new_state %u\n", __func__, new_state);
1c01c538 SW	548	switch (new_state) {
	549	case CXGB4_STATE_UP:
	550	printk(KERN_INFO MOD "%s: Up\n", pci_name(dev->rdev.lldi.pdev));
	551	if (!dev->registered) {
	552	int ret;
	553	ret = c4iw_register_device(dev);
	554	if (ret)
	555	printk(KERN_ERR MOD
	556	"%s: RDMA registration failed: %d\n",
	557	pci_name(dev->rdev.lldi.pdev), ret);
	558	}
	559	break;
	560	case CXGB4_STATE_DOWN:
	561	printk(KERN_INFO MOD "%s: Down\n",
	562	pci_name(dev->rdev.lldi.pdev));
	563	if (dev->registered)
	564	c4iw_unregister_device(dev);
	565	break;
	566	case CXGB4_STATE_START_RECOVERY:
	567	printk(KERN_INFO MOD "%s: Fatal Error\n",
	568	pci_name(dev->rdev.lldi.pdev));
	569	if (dev->registered)
	570	c4iw_unregister_device(dev);
	571	break;
	572	case CXGB4_STATE_DETACH:
	573	printk(KERN_INFO MOD "%s: Detach\n",
	574	pci_name(dev->rdev.lldi.pdev));
	575	mutex_lock(&dev_mutex);
	576	c4iw_remove(dev);
	577	mutex_unlock(&dev_mutex);
	578	break;
	579	}
cfdda9d7 SW	580	return 0;
	581	}
	582
	583	static struct cxgb4_uld_info c4iw_uld_info = {
	584	.name = DRV_NAME,
	585	.add = c4iw_uld_add,
	586	.rx_handler = c4iw_uld_rx_handler,
	587	.state_change = c4iw_uld_state_change,
	588	};
	589
	590	static int __init c4iw_init_module(void)
	591	{
	592	int err;
	593
	594	err = c4iw_cm_init();
	595	if (err)
	596	return err;
	597
	598	c4iw_debugfs_root = debugfs_create_dir(DRV_NAME, NULL);
	599	if (!c4iw_debugfs_root)
	600	printk(KERN_WARNING MOD
	601	"could not create debugfs entry, continuing\n");
	602
	603	cxgb4_register_uld(CXGB4_ULD_RDMA, &c4iw_uld_info);
	604
	605	return 0;
	606	}
	607
	608	static void __exit c4iw_exit_module(void)
	609	{
	610	struct c4iw_dev dev, tmp;
	611
cfdda9d7 SW	612	mutex_lock(&dev_mutex);
	613	list_for_each_entry_safe(dev, tmp, &dev_list, entry) {
	614	c4iw_remove(dev);
	615	}
	616	mutex_unlock(&dev_mutex);
fd388ce6	617	cxgb4_unregister_uld(CXGB4_ULD_RDMA);
cfdda9d7 SW	618	c4iw_cm_term();
	619	debugfs_remove_recursive(c4iw_debugfs_root);
	620	}
	621
	622	module_init(c4iw_init_module);
	623	module_exit(c4iw_exit_module);