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: Felipe Balbi <felipe.balbi@nokia.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>

4 files changed, 317 insertions, 0 deletions

diff --git a/drivers/usb/musb/Makefile b/drivers/usb/musb/Makefile
index db7933de17b5..a1677f9955aa 100644
--- a/drivers/usb/musb/Makefile
+++ b/drivers/usb/musb/Makefile
@@ -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).
diff --git a/drivers/usb/musb/musb_core.c b/drivers/usb/musb/musb_core.c
index 28ff0330bcea..3466cd53e9c8 100644
--- a/drivers/usb/musb/musb_core.c
+++ b/drivers/usb/musb/musb_core.c
@@ -2054,6 +2054,10 @@ bad_config:
         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)
diff --git a/drivers/usb/musb/musb_debug.h b/drivers/usb/musb/musb_debug.h
index 9fc1db44c72c..d73afdbde3ee 100644
--- a/drivers/usb/musb/musb_debug.h
+++ b/drivers/usb/musb/musb_debug.h
@@ -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__ */
diff --git a/drivers/usb/musb/musb_debugfs.c b/drivers/usb/musb/musb_debugfs.c
new file mode 100644
index 000000000000..b6a27bab223a
--- /dev/null
+++ b/drivers/usb/musb/musb_debugfs.c
@@ -0,0 +1,295 @@
+/*
+ * 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);
+}