[deliverable/linux.git] / drivers / scsi / bfa / bfad_debugfs.c

/*
 * Copyright (c) 2005-2014 Brocade Communications Systems, Inc.
 * Copyright (c) 2014- QLogic Corporation.
 * All rights reserved
 * www.qlogic.com
 *
 * Linux driver for QLogic BR-series Fibre Channel Host Bus Adapter.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License (GPL) Version 2 as
 * published by the Free Software Foundation
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 */

#include <linux/debugfs.h>
#include <linux/export.h>

#include "bfad_drv.h"
#include "bfad_im.h"

/*
 * BFA debufs interface
 *
 * To access the interface, debugfs file system should be mounted
 * if not already mounted using:
 * mount -t debugfs none /sys/kernel/debug
 *
 * BFA Hierarchy:
 *	- bfa/pci_dev:<pci_name>
 * where the pci_name corresponds to the one under /sys/bus/pci/drivers/bfa
 *
 * Debugging service available per pci_dev:
 * fwtrc:  To collect current firmware trace.
 * drvtrc: To collect current driver trace
 * fwsave: To collect last saved fw trace as a result of firmware crash.
 * regwr:  To write one word to chip register
 * regrd:  To read one or more words from chip register.
 */

struct bfad_debug_info {
	char *debug_buffer;
	void *i_private;
	int buffer_len;
};

static int
bfad_debugfs_open_drvtrc(struct inode *inode, struct file *file)
{
	struct bfad_port_s *port = inode->i_private;
	struct bfad_s *bfad = port->bfad;
	struct bfad_debug_info *debug;

	debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
	if (!debug)
		return -ENOMEM;

	debug->debug_buffer = (void *) bfad->trcmod;
	debug->buffer_len = sizeof(struct bfa_trc_mod_s);

	file->private_data = debug;

	return 0;
}

static int
bfad_debugfs_open_fwtrc(struct inode *inode, struct file *file)
{
	struct bfad_port_s *port = inode->i_private;
	struct bfad_s *bfad = port->bfad;
	struct bfad_debug_info *fw_debug;
	unsigned long flags;
	int rc;

	fw_debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
	if (!fw_debug)
		return -ENOMEM;

	fw_debug->buffer_len = sizeof(struct bfa_trc_mod_s);

	fw_debug->debug_buffer = vmalloc(fw_debug->buffer_len);
	if (!fw_debug->debug_buffer) {
		kfree(fw_debug);
		printk(KERN_INFO "bfad[%d]: Failed to allocate fwtrc buffer\n",
				bfad->inst_no);
		return -ENOMEM;
	}

	memset(fw_debug->debug_buffer, 0, fw_debug->buffer_len);

	spin_lock_irqsave(&bfad->bfad_lock, flags);
	rc = bfa_ioc_debug_fwtrc(&bfad->bfa.ioc,
			fw_debug->debug_buffer,
			&fw_debug->buffer_len);
	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
	if (rc != BFA_STATUS_OK) {
		vfree(fw_debug->debug_buffer);
		fw_debug->debug_buffer = NULL;
		kfree(fw_debug);
		printk(KERN_INFO "bfad[%d]: Failed to collect fwtrc\n",
				bfad->inst_no);
		return -ENOMEM;
	}

	file->private_data = fw_debug;

	return 0;
}

static int
bfad_debugfs_open_fwsave(struct inode *inode, struct file *file)
{
	struct bfad_port_s *port = inode->i_private;
	struct bfad_s *bfad = port->bfad;
	struct bfad_debug_info *fw_debug;
	unsigned long flags;
	int rc;

	fw_debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
	if (!fw_debug)
		return -ENOMEM;

	fw_debug->buffer_len = sizeof(struct bfa_trc_mod_s);

	fw_debug->debug_buffer = vmalloc(fw_debug->buffer_len);
	if (!fw_debug->debug_buffer) {
		kfree(fw_debug);
		printk(KERN_INFO "bfad[%d]: Failed to allocate fwsave buffer\n",
				bfad->inst_no);
		return -ENOMEM;
	}

	memset(fw_debug->debug_buffer, 0, fw_debug->buffer_len);

	spin_lock_irqsave(&bfad->bfad_lock, flags);
	rc = bfa_ioc_debug_fwsave(&bfad->bfa.ioc,
			fw_debug->debug_buffer,
			&fw_debug->buffer_len);
	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
	if (rc != BFA_STATUS_OK) {
		vfree(fw_debug->debug_buffer);
		fw_debug->debug_buffer = NULL;
		kfree(fw_debug);
		printk(KERN_INFO "bfad[%d]: Failed to collect fwsave\n",
				bfad->inst_no);
		return -ENOMEM;
	}

	file->private_data = fw_debug;

	return 0;
}

static int
bfad_debugfs_open_reg(struct inode *inode, struct file *file)
{
	struct bfad_debug_info *reg_debug;

	reg_debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
	if (!reg_debug)
		return -ENOMEM;

	reg_debug->i_private = inode->i_private;

	file->private_data = reg_debug;

	return 0;
}

/* Changes the current file position */
static loff_t
bfad_debugfs_lseek(struct file *file, loff_t offset, int orig)
{
	struct bfad_debug_info *debug = file->private_data;
	return fixed_size_llseek(file, offset, orig,
				debug->buffer_len);
}

static ssize_t
bfad_debugfs_read(struct file *file, char __user *buf,
			size_t nbytes, loff_t *pos)
{
	struct bfad_debug_info *debug = file->private_data;

	if (!debug || !debug->debug_buffer)
		return 0;

	return simple_read_from_buffer(buf, nbytes, pos,
				debug->debug_buffer, debug->buffer_len);
}

#define BFA_REG_CT_ADDRSZ	(0x40000)
#define BFA_REG_CB_ADDRSZ	(0x20000)
#define BFA_REG_ADDRSZ(__ioc)	\
	((u32)(bfa_asic_id_ctc(bfa_ioc_devid(__ioc)) ?	\
	 BFA_REG_CT_ADDRSZ : BFA_REG_CB_ADDRSZ))
#define BFA_REG_ADDRMSK(__ioc)	(BFA_REG_ADDRSZ(__ioc) - 1)

static bfa_status_t
bfad_reg_offset_check(struct bfa_s *bfa, u32 offset, u32 len)
{
	u8	area;

	/* check [16:15] */
	area = (offset >> 15) & 0x7;
	if (area == 0) {
		/* PCIe core register */
		if ((offset + (len<<2)) > 0x8000)    /* 8k dwords or 32KB */
			return BFA_STATUS_EINVAL;
	} else if (area == 0x1) {
		/* CB 32 KB memory page */
		if ((offset + (len<<2)) > 0x10000)    /* 8k dwords or 32KB */
			return BFA_STATUS_EINVAL;
	} else {
		/* CB register space 64KB */
		if ((offset + (len<<2)) > BFA_REG_ADDRMSK(&bfa->ioc))
			return BFA_STATUS_EINVAL;
	}
	return BFA_STATUS_OK;
}

static ssize_t
bfad_debugfs_read_regrd(struct file *file, char __user *buf,
		size_t nbytes, loff_t *pos)
{
	struct bfad_debug_info *regrd_debug = file->private_data;
	struct bfad_port_s *port = (struct bfad_port_s *)regrd_debug->i_private;
	struct bfad_s *bfad = port->bfad;
	ssize_t rc;

	if (!bfad->regdata)
		return 0;

	rc = simple_read_from_buffer(buf, nbytes, pos,
			bfad->regdata, bfad->reglen);

	if ((*pos + nbytes) >= bfad->reglen) {
		kfree(bfad->regdata);
		bfad->regdata = NULL;
		bfad->reglen = 0;
	}

	return rc;
}

static ssize_t
bfad_debugfs_write_regrd(struct file *file, const char __user *buf,
		size_t nbytes, loff_t *ppos)
{
	struct bfad_debug_info *regrd_debug = file->private_data;
	struct bfad_port_s *port = (struct bfad_port_s *)regrd_debug->i_private;
	struct bfad_s *bfad = port->bfad;
	struct bfa_s *bfa = &bfad->bfa;
	struct bfa_ioc_s *ioc = &bfa->ioc;
	int addr, len, rc, i;
	u32 *regbuf;
	void __iomem *rb, *reg_addr;
	unsigned long flags;
	void *kern_buf;

	kern_buf = memdup_user(buf, nbytes);
	if (IS_ERR(kern_buf))
		return PTR_ERR(kern_buf);

	rc = sscanf(kern_buf, "%x:%x", &addr, &len);
	if (rc < 2) {
		printk(KERN_INFO
			"bfad[%d]: %s failed to read user buf\n",
			bfad->inst_no, __func__);
		kfree(kern_buf);
		return -EINVAL;
	}

	kfree(kern_buf);
	kfree(bfad->regdata);
	bfad->regdata = NULL;
	bfad->reglen = 0;

	bfad->regdata = kzalloc(len << 2, GFP_KERNEL);
	if (!bfad->regdata) {
		printk(KERN_INFO "bfad[%d]: Failed to allocate regrd buffer\n",
				bfad->inst_no);
		return -ENOMEM;
	}

	bfad->reglen = len << 2;
	rb = bfa_ioc_bar0(ioc);
	addr &= BFA_REG_ADDRMSK(ioc);

	/* offset and len sanity check */
	rc = bfad_reg_offset_check(bfa, addr, len);
	if (rc) {
		printk(KERN_INFO "bfad[%d]: Failed reg offset check\n",
				bfad->inst_no);
		kfree(bfad->regdata);
		bfad->regdata = NULL;
		bfad->reglen = 0;
		return -EINVAL;
	}

	reg_addr = rb + addr;
	regbuf =  (u32 *)bfad->regdata;
	spin_lock_irqsave(&bfad->bfad_lock, flags);
	for (i = 0; i < len; i++) {
		*regbuf = readl(reg_addr);
		regbuf++;
		reg_addr += sizeof(u32);
	}
	spin_unlock_irqrestore(&bfad->bfad_lock, flags);

	return nbytes;
}

static ssize_t
bfad_debugfs_write_regwr(struct file *file, const char __user *buf,
		size_t nbytes, loff_t *ppos)
{
	struct bfad_debug_info *debug = file->private_data;
	struct bfad_port_s *port = (struct bfad_port_s *)debug->i_private;
	struct bfad_s *bfad = port->bfad;
	struct bfa_s *bfa = &bfad->bfa;
	struct bfa_ioc_s *ioc = &bfa->ioc;
	int addr, val, rc;
	void __iomem *reg_addr;
	unsigned long flags;
	void *kern_buf;

	kern_buf = memdup_user(buf, nbytes);
	if (IS_ERR(kern_buf))
		return PTR_ERR(kern_buf);

	rc = sscanf(kern_buf, "%x:%x", &addr, &val);
	if (rc < 2) {
		printk(KERN_INFO
			"bfad[%d]: %s failed to read user buf\n",
			bfad->inst_no, __func__);
		kfree(kern_buf);
		return -EINVAL;
	}
	kfree(kern_buf);

	addr &= BFA_REG_ADDRMSK(ioc); /* offset only 17 bit and word align */

	/* offset and len sanity check */
	rc = bfad_reg_offset_check(bfa, addr, 1);
	if (rc) {
		printk(KERN_INFO
			"bfad[%d]: Failed reg offset check\n",
			bfad->inst_no);
		return -EINVAL;
	}

	reg_addr = (bfa_ioc_bar0(ioc)) + addr;
	spin_lock_irqsave(&bfad->bfad_lock, flags);
	writel(val, reg_addr);
	spin_unlock_irqrestore(&bfad->bfad_lock, flags);

	return nbytes;
}

static int
bfad_debugfs_release(struct inode *inode, struct file *file)
{
	struct bfad_debug_info *debug = file->private_data;

	if (!debug)
		return 0;

	file->private_data = NULL;
	kfree(debug);
	return 0;
}

static int
bfad_debugfs_release_fwtrc(struct inode *inode, struct file *file)
{
	struct bfad_debug_info *fw_debug = file->private_data;

	if (!fw_debug)
		return 0;

	if (fw_debug->debug_buffer)
		vfree(fw_debug->debug_buffer);

	file->private_data = NULL;
	kfree(fw_debug);
	return 0;
}

static const struct file_operations bfad_debugfs_op_drvtrc = {
	.owner		=	THIS_MODULE,
	.open		=	bfad_debugfs_open_drvtrc,
	.llseek		=	bfad_debugfs_lseek,
	.read		=	bfad_debugfs_read,
	.release	=	bfad_debugfs_release,
};

static const struct file_operations bfad_debugfs_op_fwtrc = {
	.owner		=	THIS_MODULE,
	.open		=	bfad_debugfs_open_fwtrc,
	.llseek		=	bfad_debugfs_lseek,
	.read		=	bfad_debugfs_read,
	.release	=	bfad_debugfs_release_fwtrc,
};

static const struct file_operations bfad_debugfs_op_fwsave = {
	.owner		=	THIS_MODULE,
	.open		=	bfad_debugfs_open_fwsave,
	.llseek		=	bfad_debugfs_lseek,
	.read		=	bfad_debugfs_read,
	.release	=	bfad_debugfs_release_fwtrc,
};

static const struct file_operations bfad_debugfs_op_regrd = {
	.owner		=	THIS_MODULE,
	.open		=	bfad_debugfs_open_reg,
	.llseek		=	bfad_debugfs_lseek,
	.read		=	bfad_debugfs_read_regrd,
	.write		=	bfad_debugfs_write_regrd,
	.release	=	bfad_debugfs_release,
};

static const struct file_operations bfad_debugfs_op_regwr = {
	.owner		=	THIS_MODULE,
	.open		=	bfad_debugfs_open_reg,
	.llseek		=	bfad_debugfs_lseek,
	.write		=	bfad_debugfs_write_regwr,
	.release	=	bfad_debugfs_release,
};

struct bfad_debugfs_entry {
	const char *name;
	umode_t	mode;
	const struct file_operations *fops;
};

static const struct bfad_debugfs_entry bfad_debugfs_files[] = {
	{ "drvtrc", S_IFREG|S_IRUGO, &bfad_debugfs_op_drvtrc, },
	{ "fwtrc",  S_IFREG|S_IRUGO, &bfad_debugfs_op_fwtrc,  },
	{ "fwsave", S_IFREG|S_IRUGO, &bfad_debugfs_op_fwsave, },
	{ "regrd",  S_IFREG|S_IRUGO|S_IWUSR, &bfad_debugfs_op_regrd,  },
	{ "regwr",  S_IFREG|S_IWUSR, &bfad_debugfs_op_regwr,  },
};

static struct dentry *bfa_debugfs_root;
static atomic_t bfa_debugfs_port_count;

inline void
bfad_debugfs_init(struct bfad_port_s *port)
{
	struct bfad_s *bfad = port->bfad;
	const struct bfad_debugfs_entry *file;
	char name[64];
	int i;

	if (!bfa_debugfs_enable)
		return;

	/* Setup the BFA debugfs root directory*/
	if (!bfa_debugfs_root) {
		bfa_debugfs_root = debugfs_create_dir("bfa", NULL);
		atomic_set(&bfa_debugfs_port_count, 0);
		if (!bfa_debugfs_root) {
			printk(KERN_WARNING
				"BFA debugfs root dir creation failed\n");
			goto err;
		}
	}

	/* Setup the pci_dev debugfs directory for the port */
	snprintf(name, sizeof(name), "pci_dev:%s", bfad->pci_name);
	if (!port->port_debugfs_root) {
		port->port_debugfs_root =
			debugfs_create_dir(name, bfa_debugfs_root);
		if (!port->port_debugfs_root) {
			printk(KERN_WARNING
				"bfa %s: debugfs root creation failed\n",
				bfad->pci_name);
			goto err;
		}

		atomic_inc(&bfa_debugfs_port_count);

		for (i = 0; i < ARRAY_SIZE(bfad_debugfs_files); i++) {
			file = &bfad_debugfs_files[i];
			bfad->bfad_dentry_files[i] =
					debugfs_create_file(file->name,
							file->mode,
							port->port_debugfs_root,
							port,
							file->fops);
			if (!bfad->bfad_dentry_files[i]) {
				printk(KERN_WARNING
					"bfa %s: debugfs %s creation failed\n",
					bfad->pci_name, file->name);
				goto err;
			}
		}
	}

err:
	return;
}

inline void
bfad_debugfs_exit(struct bfad_port_s *port)
{
	struct bfad_s *bfad = port->bfad;
	int i;

	for (i = 0; i < ARRAY_SIZE(bfad_debugfs_files); i++) {
		if (bfad->bfad_dentry_files[i]) {
			debugfs_remove(bfad->bfad_dentry_files[i]);
			bfad->bfad_dentry_files[i] = NULL;
		}
	}

	/* Remove the pci_dev debugfs directory for the port */
	if (port->port_debugfs_root) {
		debugfs_remove(port->port_debugfs_root);
		port->port_debugfs_root = NULL;
		atomic_dec(&bfa_debugfs_port_count);
	}

	/* Remove the BFA debugfs root directory */
	if (atomic_read(&bfa_debugfs_port_count) == 0) {
		debugfs_remove(bfa_debugfs_root);
		bfa_debugfs_root = NULL;
	}
}
Commit	Line	Data
ab2a9ba1	1	/*
889d0d42 AG	2	* Copyright (c) 2005-2014 Brocade Communications Systems, Inc.
889d0d42 AG	3	* Copyright (c) 2014- QLogic Corporation.
ab2a9ba1	4	* All rights reserved
889d0d42	5	* www.qlogic.com
ab2a9ba1	6	*
31e1d569	7	* Linux driver for QLogic BR-series Fibre Channel Host Bus Adapter.
ab2a9ba1 JH	8	*
	9	* This program is free software; you can redistribute it and/or modify it
	10	* under the terms of the GNU General Public License (GPL) Version 2 as
	11	* published by the Free Software Foundation
	12	*
	13	* This program is distributed in the hope that it will be useful, but
	14	* WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	16	* General Public License for more details.
	17	*/
	18
	19	#include <linux/debugfs.h>
09703660	20	#include <linux/export.h>
ab2a9ba1	21
a36c61f9 KG	22	#include "bfad_drv.h"
a36c61f9 KG	23	#include "bfad_im.h"
ab2a9ba1 JH	24
	25	/*
	26	* BFA debufs interface
	27	*
	28	* To access the interface, debugfs file system should be mounted
	29	* if not already mounted using:
	30	* mount -t debugfs none /sys/kernel/debug
	31	*
	32	* BFA Hierarchy:
7c38c05b KG	33	* - bfa/pci_dev:<pci_name>
7c38c05b KG	34	* where the pci_name corresponds to the one under /sys/bus/pci/drivers/bfa
ab2a9ba1	35	*
7c38c05b	36	* Debugging service available per pci_dev:
ab2a9ba1 JH	37	* fwtrc: To collect current firmware trace.
	38	* drvtrc: To collect current driver trace
	39	* fwsave: To collect last saved fw trace as a result of firmware crash.
	40	* regwr: To write one word to chip register
	41	* regrd: To read one or more words from chip register.
	42	*/
	43
	44	struct bfad_debug_info {
	45	char *debug_buffer;
	46	void *i_private;
	47	int buffer_len;
	48	};
	49
	50	static int
	51	bfad_debugfs_open_drvtrc(struct inode inode, struct file file)
	52	{
	53	struct bfad_port_s *port = inode->i_private;
	54	struct bfad_s *bfad = port->bfad;
	55	struct bfad_debug_info *debug;
	56
	57	debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
	58	if (!debug)
	59	return -ENOMEM;
	60
	61	debug->debug_buffer = (void *) bfad->trcmod;
	62	debug->buffer_len = sizeof(struct bfa_trc_mod_s);
	63
	64	file->private_data = debug;
	65
	66	return 0;
	67	}
	68
	69	static int
	70	bfad_debugfs_open_fwtrc(struct inode inode, struct file file)
	71	{
	72	struct bfad_port_s *port = inode->i_private;
	73	struct bfad_s *bfad = port->bfad;
	74	struct bfad_debug_info *fw_debug;
	75	unsigned long flags;
	76	int rc;
	77
	78	fw_debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
	79	if (!fw_debug)
	80	return -ENOMEM;
	81
	82	fw_debug->buffer_len = sizeof(struct bfa_trc_mod_s);
	83
	84	fw_debug->debug_buffer = vmalloc(fw_debug->buffer_len);
	85	if (!fw_debug->debug_buffer) {
	86	kfree(fw_debug);
	87	printk(KERN_INFO "bfad[%d]: Failed to allocate fwtrc buffer\n",
	88	bfad->inst_no);
	89	return -ENOMEM;
	90	}
	91
	92	memset(fw_debug->debug_buffer, 0, fw_debug->buffer_len);
	93
	94	spin_lock_irqsave(&bfad->bfad_lock, flags);
f7f73812	95	rc = bfa_ioc_debug_fwtrc(&bfad->bfa.ioc,
ab2a9ba1 JH	96	fw_debug->debug_buffer,
	97	&fw_debug->buffer_len);
	98	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
	99	if (rc != BFA_STATUS_OK) {
	100	vfree(fw_debug->debug_buffer);
	101	fw_debug->debug_buffer = NULL;
	102	kfree(fw_debug);
	103	printk(KERN_INFO "bfad[%d]: Failed to collect fwtrc\n",
	104	bfad->inst_no);
	105	return -ENOMEM;
	106	}
	107
	108	file->private_data = fw_debug;
	109
	110	return 0;
	111	}
	112
	113	static int
	114	bfad_debugfs_open_fwsave(struct inode inode, struct file file)
	115	{
	116	struct bfad_port_s *port = inode->i_private;
	117	struct bfad_s *bfad = port->bfad;
	118	struct bfad_debug_info *fw_debug;
	119	unsigned long flags;
	120	int rc;
	121
	122	fw_debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
	123	if (!fw_debug)
	124	return -ENOMEM;
	125
	126	fw_debug->buffer_len = sizeof(struct bfa_trc_mod_s);
	127
	128	fw_debug->debug_buffer = vmalloc(fw_debug->buffer_len);
	129	if (!fw_debug->debug_buffer) {
	130	kfree(fw_debug);
	131	printk(KERN_INFO "bfad[%d]: Failed to allocate fwsave buffer\n",
	132	bfad->inst_no);
	133	return -ENOMEM;
	134	}
	135
	136	memset(fw_debug->debug_buffer, 0, fw_debug->buffer_len);
	137
	138	spin_lock_irqsave(&bfad->bfad_lock, flags);
f7f73812	139	rc = bfa_ioc_debug_fwsave(&bfad->bfa.ioc,
ab2a9ba1 JH	140	fw_debug->debug_buffer,
	141	&fw_debug->buffer_len);
	142	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
	143	if (rc != BFA_STATUS_OK) {
	144	vfree(fw_debug->debug_buffer);
	145	fw_debug->debug_buffer = NULL;
	146	kfree(fw_debug);
	147	printk(KERN_INFO "bfad[%d]: Failed to collect fwsave\n",
	148	bfad->inst_no);
	149	return -ENOMEM;
	150	}
	151
	152	file->private_data = fw_debug;
	153
	154	return 0;
	155	}
	156
	157	static int
	158	bfad_debugfs_open_reg(struct inode inode, struct file file)
	159	{
	160	struct bfad_debug_info *reg_debug;
	161
	162	reg_debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
	163	if (!reg_debug)
	164	return -ENOMEM;
	165
	166	reg_debug->i_private = inode->i_private;
	167
	168	file->private_data = reg_debug;
	169
	170	return 0;
	171	}
	172
	173	/* Changes the current file position */
	174	static loff_t
	175	bfad_debugfs_lseek(struct file *file, loff_t offset, int orig)
	176	{
c04eba72 AV	177	struct bfad_debug_info *debug = file->private_data;
	178	return fixed_size_llseek(file, offset, orig,
	179	debug->buffer_len);
ab2a9ba1 JH	180	}
	181
	182	static ssize_t
	183	bfad_debugfs_read(struct file file, char __user buf,
	184	size_t nbytes, loff_t *pos)
	185	{
	186	struct bfad_debug_info *debug = file->private_data;
	187
	188	if (!debug \|\| !debug->debug_buffer)
	189	return 0;
	190
52f94b6f	191	return simple_read_from_buffer(buf, nbytes, pos,
ab2a9ba1 JH	192	debug->debug_buffer, debug->buffer_len);
	193	}
	194
	195	#define BFA_REG_CT_ADDRSZ (0x40000)
	196	#define BFA_REG_CB_ADDRSZ (0x20000)
3d7fc66d KG	197	#define BFA_REG_ADDRSZ(__ioc) \
	198	((u32)(bfa_asic_id_ctc(bfa_ioc_devid(__ioc)) ? \
	199	BFA_REG_CT_ADDRSZ : BFA_REG_CB_ADDRSZ))
	200	#define BFA_REG_ADDRMSK(__ioc) (BFA_REG_ADDRSZ(__ioc) - 1)
ab2a9ba1 JH	201
	202	static bfa_status_t
	203	bfad_reg_offset_check(struct bfa_s *bfa, u32 offset, u32 len)
	204	{
	205	u8 area;
	206
	207	/* check [16:15] */
	208	area = (offset >> 15) & 0x7;
	209	if (area == 0) {
	210	/* PCIe core register */
	211	if ((offset + (len<<2)) > 0x8000) /* 8k dwords or 32KB */
	212	return BFA_STATUS_EINVAL;
	213	} else if (area == 0x1) {
	214	/* CB 32 KB memory page */
	215	if ((offset + (len<<2)) > 0x10000) /* 8k dwords or 32KB */
	216	return BFA_STATUS_EINVAL;
	217	} else {
	218	/* CB register space 64KB */
3d7fc66d	219	if ((offset + (len<<2)) > BFA_REG_ADDRMSK(&bfa->ioc))
ab2a9ba1 JH	220	return BFA_STATUS_EINVAL;
	221	}
	222	return BFA_STATUS_OK;
	223	}
	224
	225	static ssize_t
	226	bfad_debugfs_read_regrd(struct file file, char __user buf,
	227	size_t nbytes, loff_t *pos)
	228	{
	229	struct bfad_debug_info *regrd_debug = file->private_data;
	230	struct bfad_port_s port = (struct bfad_port_s )regrd_debug->i_private;
	231	struct bfad_s *bfad = port->bfad;
	232	ssize_t rc;
	233
	234	if (!bfad->regdata)
	235	return 0;
	236
52f94b6f	237	rc = simple_read_from_buffer(buf, nbytes, pos,
ab2a9ba1 JH	238	bfad->regdata, bfad->reglen);
	239
	240	if ((*pos + nbytes) >= bfad->reglen) {
	241	kfree(bfad->regdata);
	242	bfad->regdata = NULL;
	243	bfad->reglen = 0;
	244	}
	245
	246	return rc;
	247	}
	248
	249	static ssize_t
	250	bfad_debugfs_write_regrd(struct file file, const char __user buf,
	251	size_t nbytes, loff_t *ppos)
	252	{
	253	struct bfad_debug_info *regrd_debug = file->private_data;
	254	struct bfad_port_s port = (struct bfad_port_s )regrd_debug->i_private;
	255	struct bfad_s *bfad = port->bfad;
	256	struct bfa_s *bfa = &bfad->bfa;
	257	struct bfa_ioc_s *ioc = &bfa->ioc;
	258	int addr, len, rc, i;
	259	u32 *regbuf;
	260	void __iomem rb, reg_addr;
	261	unsigned long flags;
52f94b6f	262	void *kern_buf;
ab2a9ba1	263
9f30b674 FF	264	kern_buf = memdup_user(buf, nbytes);
	265	if (IS_ERR(kern_buf))
	266	return PTR_ERR(kern_buf);
52f94b6f M	267
52f94b6f M	268	rc = sscanf(kern_buf, "%x:%x", &addr, &len);
ab2a9ba1 JH	269	if (rc < 2) {
	270	printk(KERN_INFO
	271	"bfad[%d]: %s failed to read user buf\n",
	272	bfad->inst_no, __func__);
52f94b6f	273	kfree(kern_buf);
ab2a9ba1 JH	274	return -EINVAL;
	275	}
	276
52f94b6f	277	kfree(kern_buf);
ab2a9ba1 JH	278	kfree(bfad->regdata);
	279	bfad->regdata = NULL;
	280	bfad->reglen = 0;
	281
	282	bfad->regdata = kzalloc(len << 2, GFP_KERNEL);
	283	if (!bfad->regdata) {
	284	printk(KERN_INFO "bfad[%d]: Failed to allocate regrd buffer\n",
	285	bfad->inst_no);
	286	return -ENOMEM;
	287	}
	288
	289	bfad->reglen = len << 2;
	290	rb = bfa_ioc_bar0(ioc);
3d7fc66d	291	addr &= BFA_REG_ADDRMSK(ioc);
ab2a9ba1 JH	292
	293	/* offset and len sanity check */
	294	rc = bfad_reg_offset_check(bfa, addr, len);
	295	if (rc) {
	296	printk(KERN_INFO "bfad[%d]: Failed reg offset check\n",
	297	bfad->inst_no);
	298	kfree(bfad->regdata);
	299	bfad->regdata = NULL;
	300	bfad->reglen = 0;
	301	return -EINVAL;
	302	}
	303
	304	reg_addr = rb + addr;
	305	regbuf = (u32 *)bfad->regdata;
	306	spin_lock_irqsave(&bfad->bfad_lock, flags);
	307	for (i = 0; i < len; i++) {
53440260	308	*regbuf = readl(reg_addr);
ab2a9ba1 JH	309	regbuf++;
	310	reg_addr += sizeof(u32);
	311	}
	312	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
	313
	314	return nbytes;
	315	}
	316
	317	static ssize_t
	318	bfad_debugfs_write_regwr(struct file file, const char __user buf,
	319	size_t nbytes, loff_t *ppos)
	320	{
	321	struct bfad_debug_info *debug = file->private_data;
	322	struct bfad_port_s port = (struct bfad_port_s )debug->i_private;
	323	struct bfad_s *bfad = port->bfad;
	324	struct bfa_s *bfa = &bfad->bfa;
	325	struct bfa_ioc_s *ioc = &bfa->ioc;
	326	int addr, val, rc;
	327	void __iomem *reg_addr;
	328	unsigned long flags;
52f94b6f M	329	void *kern_buf;
52f94b6f M	330
9f30b674 FF	331	kern_buf = memdup_user(buf, nbytes);
	332	if (IS_ERR(kern_buf))
	333	return PTR_ERR(kern_buf);
ab2a9ba1	334
52f94b6f	335	rc = sscanf(kern_buf, "%x:%x", &addr, &val);
ab2a9ba1 JH	336	if (rc < 2) {
	337	printk(KERN_INFO
	338	"bfad[%d]: %s failed to read user buf\n",
	339	bfad->inst_no, __func__);
52f94b6f	340	kfree(kern_buf);
ab2a9ba1 JH	341	return -EINVAL;
ab2a9ba1 JH	342	}
52f94b6f	343	kfree(kern_buf);
ab2a9ba1	344
3d7fc66d	345	addr &= BFA_REG_ADDRMSK(ioc); /* offset only 17 bit and word align */
ab2a9ba1 JH	346
	347	/* offset and len sanity check */
	348	rc = bfad_reg_offset_check(bfa, addr, 1);
	349	if (rc) {
	350	printk(KERN_INFO
	351	"bfad[%d]: Failed reg offset check\n",
	352	bfad->inst_no);
	353	return -EINVAL;
	354	}
	355
52f94b6f	356	reg_addr = (bfa_ioc_bar0(ioc)) + addr;
ab2a9ba1	357	spin_lock_irqsave(&bfad->bfad_lock, flags);
53440260	358	writel(val, reg_addr);
ab2a9ba1 JH	359	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
	360
	361	return nbytes;
	362	}
	363
	364	static int
	365	bfad_debugfs_release(struct inode inode, struct file file)
	366	{
	367	struct bfad_debug_info *debug = file->private_data;
	368
	369	if (!debug)
	370	return 0;
	371
	372	file->private_data = NULL;
	373	kfree(debug);
	374	return 0;
	375	}
	376
	377	static int
	378	bfad_debugfs_release_fwtrc(struct inode inode, struct file file)
	379	{
	380	struct bfad_debug_info *fw_debug = file->private_data;
	381
	382	if (!fw_debug)
	383	return 0;
	384
	385	if (fw_debug->debug_buffer)
	386	vfree(fw_debug->debug_buffer);
	387
	388	file->private_data = NULL;
	389	kfree(fw_debug);
	390	return 0;
	391	}
	392
	393	static const struct file_operations bfad_debugfs_op_drvtrc = {
	394	.owner = THIS_MODULE,
	395	.open = bfad_debugfs_open_drvtrc,
	396	.llseek = bfad_debugfs_lseek,
	397	.read = bfad_debugfs_read,
	398	.release = bfad_debugfs_release,
	399	};
	400
	401	static const struct file_operations bfad_debugfs_op_fwtrc = {
	402	.owner = THIS_MODULE,
	403	.open = bfad_debugfs_open_fwtrc,
	404	.llseek = bfad_debugfs_lseek,
	405	.read = bfad_debugfs_read,
	406	.release = bfad_debugfs_release_fwtrc,
	407	};
	408
	409	static const struct file_operations bfad_debugfs_op_fwsave = {
	410	.owner = THIS_MODULE,
	411	.open = bfad_debugfs_open_fwsave,
	412	.llseek = bfad_debugfs_lseek,
	413	.read = bfad_debugfs_read,
	414	.release = bfad_debugfs_release_fwtrc,
	415	};
	416
	417	static const struct file_operations bfad_debugfs_op_regrd = {
	418	.owner = THIS_MODULE,
	419	.open = bfad_debugfs_open_reg,
	420	.llseek = bfad_debugfs_lseek,
	421	.read = bfad_debugfs_read_regrd,
	422	.write = bfad_debugfs_write_regrd,
423	.release = bfad_debugfs_release,
424	};
425
426	static const struct file_operations bfad_debugfs_op_regwr = {
427	.owner = THIS_MODULE,
428	.open = bfad_debugfs_open_reg,
429	.llseek = bfad_debugfs_lseek,
430	.write = bfad_debugfs_write_regwr,
431	.release = bfad_debugfs_release,
432	};
433
434	struct bfad_debugfs_entry {
435	const char *name;
f4ae40a6	436	umode_t mode;
ab2a9ba1 JH	437	const struct file_operations *fops;
	438	};
	439
	440	static const struct bfad_debugfs_entry bfad_debugfs_files[] = {
	441	{ "drvtrc", S_IFREG\|S_IRUGO, &bfad_debugfs_op_drvtrc, },
	442	{ "fwtrc", S_IFREG\|S_IRUGO, &bfad_debugfs_op_fwtrc, },
	443	{ "fwsave", S_IFREG\|S_IRUGO, &bfad_debugfs_op_fwsave, },
	444	{ "regrd", S_IFREG\|S_IRUGO\|S_IWUSR, &bfad_debugfs_op_regrd, },
	445	{ "regwr", S_IFREG\|S_IWUSR, &bfad_debugfs_op_regwr, },
	446	};
	447
	448	static struct dentry *bfa_debugfs_root;
	449	static atomic_t bfa_debugfs_port_count;
	450
	451	inline void
	452	bfad_debugfs_init(struct bfad_port_s *port)
	453	{
7c38c05b	454	struct bfad_s *bfad = port->bfad;
ab2a9ba1	455	const struct bfad_debugfs_entry *file;
7c38c05b	456	char name[64];
ab2a9ba1 JH	457	int i;
	458
	459	if (!bfa_debugfs_enable)
	460	return;
	461
	462	/* Setup the BFA debugfs root directory*/
	463	if (!bfa_debugfs_root) {
	464	bfa_debugfs_root = debugfs_create_dir("bfa", NULL);
	465	atomic_set(&bfa_debugfs_port_count, 0);
	466	if (!bfa_debugfs_root) {
	467	printk(KERN_WARNING
	468	"BFA debugfs root dir creation failed\n");
	469	goto err;
	470	}
	471	}
	472
7c38c05b KG	473	/* Setup the pci_dev debugfs directory for the port */
7c38c05b KG	474	snprintf(name, sizeof(name), "pci_dev:%s", bfad->pci_name);
ab2a9ba1 JH	475	if (!port->port_debugfs_root) {
	476	port->port_debugfs_root =
	477	debugfs_create_dir(name, bfa_debugfs_root);
	478	if (!port->port_debugfs_root) {
	479	printk(KERN_WARNING
7c38c05b KG	480	"bfa %s: debugfs root creation failed\n",
7c38c05b KG	481	bfad->pci_name);
ab2a9ba1 JH	482	goto err;
	483	}
	484
	485	atomic_inc(&bfa_debugfs_port_count);
	486
	487	for (i = 0; i < ARRAY_SIZE(bfad_debugfs_files); i++) {
	488	file = &bfad_debugfs_files[i];
	489	bfad->bfad_dentry_files[i] =
	490	debugfs_create_file(file->name,
	491	file->mode,
	492	port->port_debugfs_root,
	493	port,
	494	file->fops);
	495	if (!bfad->bfad_dentry_files[i]) {
	496	printk(KERN_WARNING
7c38c05b KG	497	"bfa %s: debugfs %s creation failed\n",
7c38c05b KG	498	bfad->pci_name, file->name);
ab2a9ba1 JH	499	goto err;
	500	}
	501	}
	502	}
	503
	504	err:
	505	return;
	506	}
	507
	508	inline void
	509	bfad_debugfs_exit(struct bfad_port_s *port)
	510	{
7c38c05b	511	struct bfad_s *bfad = port->bfad;
ab2a9ba1 JH	512	int i;
	513
	514	for (i = 0; i < ARRAY_SIZE(bfad_debugfs_files); i++) {
	515	if (bfad->bfad_dentry_files[i]) {
	516	debugfs_remove(bfad->bfad_dentry_files[i]);
	517	bfad->bfad_dentry_files[i] = NULL;
	518	}
	519	}
	520
275a63ac	521	/* Remove the pci_dev debugfs directory for the port */
ab2a9ba1 JH	522	if (port->port_debugfs_root) {
	523	debugfs_remove(port->port_debugfs_root);
	524	port->port_debugfs_root = NULL;
	525	atomic_dec(&bfa_debugfs_port_count);
	526	}
	527
	528	/* Remove the BFA debugfs root directory */
	529	if (atomic_read(&bfa_debugfs_port_count) == 0) {
	530	debugfs_remove(bfa_debugfs_root);
	531	bfa_debugfs_root = NULL;
	532	}
	533	}