Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 7f7f9e2a authored by Felipe Balbi's avatar Felipe Balbi Committed by Greg Kroah-Hartman
Browse files

usb: musb: add debugfs support 



for now only a simple register dump entry (which can
be rather useful on debugging) and a way to start
test modes.

Signed-off-by: default avatarFelipe Balbi <felipe.balbi@nokia.com>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@suse.de>
parent 6ddc6dae

drivers/usb/musb/Makefile

+4 −0
Original line number Diff line number Diff line
@@ -42,6 +42,10 @@ ifeq ($(CONFIG_USB_MUSB_HDRC_HCD),y) 
	musb_hdrc-objs		+= musb_virthub.o musb_host.o

endif



ifeq ($(CONFIG_DEBUG_FS),y)

	musb_hdrc-objs		+= musb_debugfs.o

endif



# the kconfig must guarantee that only one of the

# possible I/O schemes will be enabled at a time ...

# PIO only, or DMA (several potential schemes).

drivers/usb/musb/musb_core.c

+5 −0
Original line number Diff line number Diff line
@@ -2054,6 +2054,10 @@ musb_init_controller(struct device *dev, int nIrq, void __iomem *ctrl) 
	if (status < 0)

		goto fail3;



	status = musb_init_debugfs(musb);

	if (status < 0)

		goto fail2;



#ifdef CONFIG_SYSFS

	status = sysfs_create_group(&musb->controller->kobj, &musb_attr_group);

	if (status)
@@ -2150,6 +2154,7 @@ static int __exit musb_remove(struct platform_device *pdev) 
	 *  - Peripheral mode: peripheral is deactivated (or never-activated)

	 *  - OTG mode: both roles are deactivated (or never-activated)

	 */

	musb_exit_debugfs(musb);

	musb_shutdown(pdev);

#ifdef CONFIG_USB_MUSB_HDRC_HCD

	if (musb->board_mode == MUSB_HOST)

drivers/usb/musb/musb_debug.h

+13 −0
Original line number Diff line number Diff line
@@ -59,4 +59,17 @@ static inline int _dbg_level(unsigned l) 


extern const char *otg_state_string(struct musb *);



#ifdef CONFIG_DEBUG_FS

extern int musb_init_debugfs(struct musb *musb);

extern void musb_exit_debugfs(struct musb *musb);

#else

static inline int musb_init_debugfs(struct musb *musb)

{

	return 0;

}

static inline void musb_exit_debugfs(struct musb *musb)

{

}

#endif



#endif				/*  __MUSB_LINUX_DEBUG_H__ */

drivers/usb/musb/musb_debugfs.c

0 → 100644
+295 −0
Original line number Diff line number Diff line 
/*

 * MUSB OTG driver debugfs support

 *

 * Copyright 2010 Nokia Corporation

 * Contact: Felipe Balbi <felipe.balbi@nokia.com>

 *

 * This program is free software; you can redistribute it and/or

 * modify it under the terms of the GNU General Public License

 * 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.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA

 * 02110-1301 USA

 *

 * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED

 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF

 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN

 * NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,

 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT

 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF

 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON

 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT

 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF

 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

 *

 */



#include <linux/module.h>

#include <linux/kernel.h>

#include <linux/sched.h>

#include <linux/slab.h>

#include <linux/init.h>

#include <linux/list.h>

#include <linux/kobject.h>

#include <linux/platform_device.h>

#include <linux/io.h>

#include <linux/debugfs.h>

#include <linux/seq_file.h>



#ifdef	CONFIG_ARM

#include <mach/hardware.h>

#include <mach/memory.h>

#include <asm/mach-types.h>

#endif



#include <asm/uaccess.h>



#include "musb_core.h"

#include "musb_debug.h"



#ifdef CONFIG_ARCH_DAVINCI

#include "davinci.h"

#endif



struct musb_register_map {

	char			*name;

	unsigned		offset;

	unsigned		size;

};



static const struct musb_register_map musb_regmap[] = {

	{ "FAddr",		0x00,	8 },

	{ "Power",		0x01,	8 },

	{ "Frame",		0x0c,	16 },

	{ "Index",		0x0e,	8 },

	{ "Testmode",		0x0f,	8 },

	{ "TxMaxPp",		0x10,	16 },

	{ "TxCSRp",		0x12,	16 },

	{ "RxMaxPp",		0x14,	16 },

	{ "RxCSR",		0x16,	16 },

	{ "RxCount",		0x18,	16 },

	{ "ConfigData",		0x1f,	8 },

	{ "DevCtl",		0x60,	8 },

	{ "MISC",		0x61,	8 },

	{ "TxFIFOsz",		0x62,	8 },

	{ "RxFIFOsz",		0x63,	8 },

	{ "TxFIFOadd",		0x64,	16 },

	{ "RxFIFOadd",		0x66,	16 },

	{ "VControl",		0x68,	32 },

	{ "HWVers",		0x6C,	16 },

	{ "EPInfo",		0x78,	8 },

	{ "RAMInfo",		0x79,	8 },

	{ "LinkInfo",		0x7A,	8 },

	{ "VPLen",		0x7B,	8 },

	{ "HS_EOF1",		0x7C,	8 },

	{ "FS_EOF1",		0x7D,	8 },

	{ "LS_EOF1",		0x7E,	8 },

	{ "SOFT_RST",		0x7F,	8 },

	{ "DMA_CNTLch0",	0x204,	16 },

	{ "DMA_ADDRch0",	0x208,	16 },

	{ "DMA_COUNTch0",	0x20C,	16 },

	{ "DMA_CNTLch1",	0x214,	16 },

	{ "DMA_ADDRch1",	0x218,	16 },

	{ "DMA_COUNTch1",	0x21C,	16 },

	{ "DMA_CNTLch2",	0x224,	16 },

	{ "DMA_ADDRch2",	0x228,	16 },

	{ "DMA_COUNTch2",	0x22C,	16 },

	{ "DMA_CNTLch3",	0x234,	16 },

	{ "DMA_ADDRch3",	0x238,	16 },

	{ "DMA_COUNTch3",	0x23C,	16 },

	{ "DMA_CNTLch4",	0x244,	16 },

	{ "DMA_ADDRch4",	0x248,	16 },

	{ "DMA_COUNTch4",	0x24C,	16 },

	{ "DMA_CNTLch5",	0x254,	16 },

	{ "DMA_ADDRch5",	0x258,	16 },

	{ "DMA_COUNTch5",	0x25C,	16 },

	{ "DMA_CNTLch6",	0x264,	16 },

	{ "DMA_ADDRch6",	0x268,	16 },

	{ "DMA_COUNTch6",	0x26C,	16 },

	{ "DMA_CNTLch7",	0x274,	16 },

	{ "DMA_ADDRch7",	0x278,	16 },

	{ "DMA_COUNTch7",	0x27C,	16 },

	{  }	/* Terminating Entry */

};



static struct dentry *musb_debugfs_root;



static int musb_regdump_show(struct seq_file *s, void *unused)

{

	struct musb		*musb = s->private;

	unsigned		i;



	seq_printf(s, "MUSB (M)HDRC Register Dump\n");



	for (i = 0; i < ARRAY_SIZE(musb_regmap); i++) {

		switch (musb_regmap[i].size) {

		case 8:

			seq_printf(s, "%-12s: %02x\n", musb_regmap[i].name,

					musb_readb(musb->mregs, musb_regmap[i].offset));

			break;

		case 16:

			seq_printf(s, "%-12s: %04x\n", musb_regmap[i].name,

					musb_readw(musb->mregs, musb_regmap[i].offset));

			break;

		case 32:

			seq_printf(s, "%-12s: %08x\n", musb_regmap[i].name,

					musb_readl(musb->mregs, musb_regmap[i].offset));

			break;

		}

	}



	return 0;

}



static int musb_regdump_open(struct inode *inode, struct file *file)

{

	return single_open(file, musb_regdump_show, inode->i_private);

}



static int musb_test_mode_show(struct seq_file *s, void *unused)

{

	struct musb		*musb = s->private;

	unsigned		test;



	test = musb_readb(musb->mregs, MUSB_TESTMODE);



	if (test & MUSB_TEST_FORCE_HOST)

		seq_printf(s, "force host\n");



	if (test & MUSB_TEST_FIFO_ACCESS)

		seq_printf(s, "fifo access\n");



	if (test & MUSB_TEST_FORCE_FS)

		seq_printf(s, "force full-speed\n");



	if (test & MUSB_TEST_FORCE_HS)

		seq_printf(s, "force high-speed\n");



	if (test & MUSB_TEST_PACKET)

		seq_printf(s, "test packet\n");



	if (test & MUSB_TEST_K)

		seq_printf(s, "test K\n");



	if (test & MUSB_TEST_J)

		seq_printf(s, "test J\n");



	if (test & MUSB_TEST_SE0_NAK)

		seq_printf(s, "test SE0 NAK\n");



	return 0;

}



static const struct file_operations musb_regdump_fops = {

	.open			= musb_regdump_open,

	.read			= seq_read,

	.llseek			= seq_lseek,

	.release		= single_release,

};



static int musb_test_mode_open(struct inode *inode, struct file *file)

{

	file->private_data = inode->i_private;



	return single_open(file, musb_test_mode_show, inode->i_private);

}



static ssize_t musb_test_mode_write(struct file *file,

		const char __user *ubuf, size_t count, loff_t *ppos)

{

	struct musb		*musb = file->private_data;

	u8			test = 0;

	char			buf[18];



	memset(buf, 0x00, sizeof(buf));



	if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))

		return -EFAULT;



	if (!strncmp(buf, "force host", 9))

		test = MUSB_TEST_FORCE_HOST;



	if (!strncmp(buf, "fifo access", 11))

		test = MUSB_TEST_FIFO_ACCESS;



	if (!strncmp(buf, "force full-speed", 15))

		test = MUSB_TEST_FORCE_FS;



	if (!strncmp(buf, "force high-speed", 15))

		test = MUSB_TEST_FORCE_HS;



	if (!strncmp(buf, "test packet", 10)) {

		test = MUSB_TEST_PACKET;

		musb_load_testpacket(musb);

	}



	if (!strncmp(buf, "test K", 6))

		test = MUSB_TEST_K;



	if (!strncmp(buf, "test J", 6))

		test = MUSB_TEST_J;



	if (!strncmp(buf, "test SE0 NAK", 12))

		test = MUSB_TEST_SE0_NAK;



	musb_writeb(musb->mregs, MUSB_TESTMODE, test);



	return count;

}



static const struct file_operations musb_test_mode_fops = {

	.open			= musb_test_mode_open,

	.write			= musb_test_mode_write,

	.read			= seq_read,

	.llseek			= seq_lseek,

	.release		= single_release,

};



int __init musb_init_debugfs(struct musb *musb)

{

	struct dentry		*root;

	struct dentry		*file;

	int			ret;



	root = debugfs_create_dir("musb", NULL);

	if (IS_ERR(root)) {

		ret = PTR_ERR(root);

		goto err0;

	}



	file = debugfs_create_file("regdump", S_IRUGO, root, musb,

			&musb_regdump_fops);

	if (IS_ERR(file)) {

		ret = PTR_ERR(file);

		goto err1;

	}



	file = debugfs_create_file("testmode", S_IRUGO | S_IWUSR,

			root, musb, &musb_test_mode_fops);

	if (IS_ERR(file)) {

		ret = PTR_ERR(file);

		goto err1;

	}



	musb_debugfs_root = root;



	return 0;



err1:

	debugfs_remove_recursive(root);



err0:

	return ret;

}



void __exit musb_exit_debugfs(struct musb *musb)

{

	debugfs_remove_recursive(musb_debugfs_root);

}