USB: Debug: Add centralized debug buffer for USB drivers

Add a centralized debug buffer which can log events from all USB
drivers in gadget directory. This will help in debugging issue
from first instance rather than enabling dynamic debug log and
reproducing again.

Change-Id: Id0285d30bf640a63d904f1dd02dcd061f1819359
Signed-off-by: Tarun Gupta <tarung@codeaurora.org>

drivers/usb/gadget/Makefile

@@ -38,6 +38,7 @@ obj-$(CONFIG_USB_FUSB300)	+= fusb300_udc.o
 obj-$(CONFIG_USB_MV_U3D)	+= mv_u3d_core.o
 
 # USB Functions
+obj-y				+= debug.o
 usb_f_acm-y			:= f_acm.o
 obj-$(CONFIG_USB_F_ACM)		+= usb_f_acm.o
 usb_f_ss_lb-y			:= f_loopback.o f_sourcesink.o

drivers/usb/gadget/android.c

@@ -76,6 +76,7 @@
 #endif
 #include "f_ncm.c"
 #include "f_charger.c"
+#include "debug.h"
 
 MODULE_AUTHOR("Mike Lockwood");
 MODULE_DESCRIPTION("Android Composite USB Driver");
@@ -3880,6 +3881,8 @@ static int android_probe(struct platform_device *pdev)
 	list_add_tail(&android_dev->list_item, &android_dev_list);
 	android_dev_count++;
 
+	debug_debugfs_init();
+
 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 	if (res) {
 		diag_dload = devm_ioremap(&pdev->dev, res->start,
@@ -3941,6 +3944,7 @@ err_alloc:
 		class_destroy(android_class);
 		android_class = NULL;
 	}
+	debug_debugfs_exit();
 	return ret;
 }
 
@@ -3961,6 +3965,8 @@ static int android_remove(struct platform_device *pdev)
 			break;
 	}
 
+	debug_debugfs_exit();
+
 	if (dev) {
 		android_destroy_device(dev);
 		if (pdata && pdata->pm_qos_latency[0])

drivers/usb/gadget/debug.c

@@ -0,0 +1,133 @@
+/*
+ * Copyright (c) 2015, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only 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/kernel.h>
+#include <linux/module.h>
+#include <linux/sched.h>
+#include <linux/rwlock.h>
+#include <linux/debugfs.h>
+
+#include "debug.h"
+
+#define dbg_inc(i) ((i+1) % DBG_MAX_MSG)
+
+#define ENABLE_EVENT_LOG 1
+unsigned int enable_event_log = ENABLE_EVENT_LOG;
+module_param(enable_event_log, uint, S_IRUGO | S_IWUSR);
+MODULE_PARM_DESC(enable_event_log, "enable event logging in debug buffer");
+
+static struct {
+	char buf[DBG_MAX_MSG][DBG_MSG_LEN];   /* buffer */
+	unsigned idx;   /* index */
+	rwlock_t lck;   /* lock */
+	struct dentry *root;
+} __maybe_unused dbg_buffer = {
+	.idx = 0,
+	.lck = __RW_LOCK_UNLOCKED(lck),
+	.root = NULL
+};
+
+void __maybe_unused put_timestamp(char *tbuf)
+{
+	unsigned long long t;
+	unsigned long nanosec_rem;
+	unsigned long flags;
+
+	write_lock_irqsave(&dbg_buffer.lck, flags);
+	t = cpu_clock(smp_processor_id());
+	write_unlock_irqrestore(&dbg_buffer.lck, flags);
+	nanosec_rem = do_div(t, 1000000000)/1000;
+	snprintf(tbuf, TIME_BUF_LEN, "[%5lu.%06lu]: ", (unsigned long)t,
+		nanosec_rem);
+}
+
+void __maybe_unused add_event_to_buf(char *tbuf)
+{
+	unsigned long flags;
+	char *buf;
+	write_lock_irqsave(&dbg_buffer.lck, flags);
+	buf = dbg_buffer.buf[dbg_buffer.idx];
+	memcpy(buf, tbuf, DBG_MSG_LEN);
+	dbg_buffer.idx = (dbg_buffer.idx + 1) % DBG_MAX_MSG;
+	write_unlock_irqrestore(&dbg_buffer.lck, flags);
+}
+
+static int dbg_read_buf_show(struct seq_file *s, void *unused)
+{
+	unsigned long	flags;
+	unsigned	i;
+
+	read_lock_irqsave(&dbg_buffer.lck, flags);
+
+	i = dbg_buffer.idx;
+	if (strnlen(dbg_buffer.buf[i], DBG_MSG_LEN))
+		seq_printf(s, "%s\n", dbg_buffer.buf[i]);
+	for (i = dbg_inc(i); i != dbg_buffer.idx;  i = dbg_inc(i)) {
+		if (!strnlen(dbg_buffer.buf[i], DBG_MSG_LEN))
+			continue;
+		seq_printf(s, "%s\n", dbg_buffer.buf[i]);
+	}
+
+	read_unlock_irqrestore(&dbg_buffer.lck, flags);
+
+	return 0;
+}
+
+static int dbg_read_buf_open(struct inode *inode, struct file *file)
+{
+	return single_open(file, dbg_read_buf_show, inode->i_private);
+}
+
+const struct file_operations dbg_read_buf_fops = {
+	.open			= dbg_read_buf_open,
+	.read			= seq_read,
+	.llseek			= seq_lseek,
+	.release		= single_release,
+};
+
+int debug_debugfs_init(void)
+{
+	struct dentry		*root;
+	struct dentry		*file;
+	int			ret;
+
+	root = debugfs_create_dir("debug", NULL);
+	if (!root) {
+		ret = -ENOMEM;
+		goto err0;
+	}
+
+	dbg_buffer.root = root;
+
+	file = debugfs_create_file("read_buf", S_IRUGO, root,
+			NULL, &dbg_read_buf_fops);
+	if (!file) {
+		ret = -ENOMEM;
+		goto err1;
+	}
+
+	return 0;
+
+err1:
+	debugfs_remove_recursive(root);
+
+err0:
+	return ret;
+}
+
+void debug_debugfs_exit(void)
+{
+	debugfs_remove_recursive(dbg_buffer.root);
+	dbg_buffer.root = NULL;
+}

drivers/usb/gadget/debug.h

@@ -0,0 +1,41 @@
+/*
+ * Copyright (c) 2015, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only 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.
+ *
+ */
+
+#ifndef __DEBUG_H_
+#define __DEBUG_H_
+
+#define DBG_MAX_MSG   512UL
+#define DBG_MSG_LEN   160UL
+#define TIME_BUF_LEN  17
+#define DBG_EVENT_LEN  143
+
+extern unsigned int enable_event_log;
+extern void put_timestamp(char *tbuf);
+extern void add_event_to_buf(char *tbuf);
+extern int debug_debugfs_init(void);
+extern void debug_debugfs_exit(void);
+
+#define log_event(dlog, x...)						\
+do {									\
+	char buf[160];							\
+	if (dlog)							\
+		pr_debug(x);						\
+	if (enable_event_log) {						\
+		put_timestamp(buf);					\
+		snprintf(&buf[TIME_BUF_LEN - 1], DBG_EVENT_LEN, x);	\
+		add_event_to_buf(buf);					\
+	}								\
+} while (0)
+
+#endif	/* __DEBUG_H_ */