mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-24 01:41:39 +00:00
![Li Jun](/assets/img/avatar_default.png)
Do not try to queue a drd work for change mode if the port is not a drd, this is to avoid below kernel dump: [ 60.115529] ------------[ cut here ]------------ [ 60.120166] WARNING: CPU: 1 PID: 627 at kernel/workqueue.c:1473 __queue_work+0x46c/0x520 [ 60.128254] Modules linked in: [ 60.131313] CPU: 1 PID: 627 Comm: sh Not tainted 5.7.0-rc4-00022-g914a586-dirty #135 [ 60.139054] Hardware name: NXP i.MX8MQ EVK (DT) [ 60.143585] pstate: a0000085 (NzCv daIf -PAN -UAO) [ 60.148376] pc : __queue_work+0x46c/0x520 [ 60.152385] lr : __queue_work+0x314/0x520 [ 60.156393] sp : ffff8000124ebc40 [ 60.159705] x29: ffff8000124ebc40 x28: ffff800011808018 [ 60.165018] x27: ffff800011819ef8 x26: ffff800011d39980 [ 60.170331] x25: ffff800011808018 x24: 0000000000000100 [ 60.175643] x23: 0000000000000013 x22: 0000000000000001 [ 60.180955] x21: ffff0000b7c08e00 x20: ffff0000b6c31080 [ 60.186267] x19: ffff0000bb99bc00 x18: 0000000000000000 [ 60.191579] x17: 0000000000000000 x16: 0000000000000000 [ 60.196891] x15: 0000000000000000 x14: 0000000000000000 [ 60.202202] x13: 0000000000000000 x12: 0000000000000000 [ 60.207515] x11: 0000000000000000 x10: 0000000000000040 [ 60.212827] x9 : ffff800011d55460 x8 : ffff800011d55458 [ 60.218138] x7 : ffff0000b7800028 x6 : 0000000000000000 [ 60.223450] x5 : ffff0000b7800000 x4 : 0000000000000000 [ 60.228762] x3 : ffff0000bb997cc0 x2 : 0000000000000001 [ 60.234074] x1 : 0000000000000000 x0 : ffff0000b6c31088 [ 60.239386] Call trace: [ 60.241834] __queue_work+0x46c/0x520 [ 60.245496] queue_work_on+0x6c/0x90 [ 60.249075] dwc3_set_mode+0x48/0x58 [ 60.252651] dwc3_mode_write+0xf8/0x150 [ 60.256489] full_proxy_write+0x5c/0xa8 [ 60.260327] __vfs_write+0x18/0x40 [ 60.263729] vfs_write+0xdc/0x1c8 [ 60.267045] ksys_write+0x68/0xf0 [ 60.270360] __arm64_sys_write+0x18/0x20 [ 60.274286] el0_svc_common.constprop.0+0x68/0x160 [ 60.279077] do_el0_svc+0x20/0x80 [ 60.282394] el0_sync_handler+0x10c/0x178 [ 60.286403] el0_sync+0x140/0x180 [ 60.289716] ---[ end trace 70b155582e2b7988 ]--- Signed-off-by: Li Jun <jun.li@nxp.com> Signed-off-by: Felipe Balbi <balbi@kernel.org>
955 lines
24 KiB
C
955 lines
24 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/**
|
|
* debugfs.c - DesignWare USB3 DRD Controller DebugFS file
|
|
*
|
|
* Copyright (C) 2010-2011 Texas Instruments Incorporated - https://www.ti.com
|
|
*
|
|
* Authors: Felipe Balbi <balbi@ti.com>,
|
|
* Sebastian Andrzej Siewior <bigeasy@linutronix.de>
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/ptrace.h>
|
|
#include <linux/types.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/debugfs.h>
|
|
#include <linux/seq_file.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/uaccess.h>
|
|
|
|
#include <linux/usb/ch9.h>
|
|
|
|
#include "core.h"
|
|
#include "gadget.h"
|
|
#include "io.h"
|
|
#include "debug.h"
|
|
|
|
#define DWC3_LSP_MUX_UNSELECTED 0xfffff
|
|
|
|
#define dump_register(nm) \
|
|
{ \
|
|
.name = __stringify(nm), \
|
|
.offset = DWC3_ ##nm, \
|
|
}
|
|
|
|
#define dump_ep_register_set(n) \
|
|
{ \
|
|
.name = "DEPCMDPAR2("__stringify(n)")", \
|
|
.offset = DWC3_DEP_BASE(n) + \
|
|
DWC3_DEPCMDPAR2, \
|
|
}, \
|
|
{ \
|
|
.name = "DEPCMDPAR1("__stringify(n)")", \
|
|
.offset = DWC3_DEP_BASE(n) + \
|
|
DWC3_DEPCMDPAR1, \
|
|
}, \
|
|
{ \
|
|
.name = "DEPCMDPAR0("__stringify(n)")", \
|
|
.offset = DWC3_DEP_BASE(n) + \
|
|
DWC3_DEPCMDPAR0, \
|
|
}, \
|
|
{ \
|
|
.name = "DEPCMD("__stringify(n)")", \
|
|
.offset = DWC3_DEP_BASE(n) + \
|
|
DWC3_DEPCMD, \
|
|
}
|
|
|
|
|
|
static const struct debugfs_reg32 dwc3_regs[] = {
|
|
dump_register(GSBUSCFG0),
|
|
dump_register(GSBUSCFG1),
|
|
dump_register(GTXTHRCFG),
|
|
dump_register(GRXTHRCFG),
|
|
dump_register(GCTL),
|
|
dump_register(GEVTEN),
|
|
dump_register(GSTS),
|
|
dump_register(GUCTL1),
|
|
dump_register(GSNPSID),
|
|
dump_register(GGPIO),
|
|
dump_register(GUID),
|
|
dump_register(GUCTL),
|
|
dump_register(GBUSERRADDR0),
|
|
dump_register(GBUSERRADDR1),
|
|
dump_register(GPRTBIMAP0),
|
|
dump_register(GPRTBIMAP1),
|
|
dump_register(GHWPARAMS0),
|
|
dump_register(GHWPARAMS1),
|
|
dump_register(GHWPARAMS2),
|
|
dump_register(GHWPARAMS3),
|
|
dump_register(GHWPARAMS4),
|
|
dump_register(GHWPARAMS5),
|
|
dump_register(GHWPARAMS6),
|
|
dump_register(GHWPARAMS7),
|
|
dump_register(GDBGFIFOSPACE),
|
|
dump_register(GDBGLTSSM),
|
|
dump_register(GDBGBMU),
|
|
dump_register(GPRTBIMAP_HS0),
|
|
dump_register(GPRTBIMAP_HS1),
|
|
dump_register(GPRTBIMAP_FS0),
|
|
dump_register(GPRTBIMAP_FS1),
|
|
|
|
dump_register(GUSB2PHYCFG(0)),
|
|
dump_register(GUSB2PHYCFG(1)),
|
|
dump_register(GUSB2PHYCFG(2)),
|
|
dump_register(GUSB2PHYCFG(3)),
|
|
dump_register(GUSB2PHYCFG(4)),
|
|
dump_register(GUSB2PHYCFG(5)),
|
|
dump_register(GUSB2PHYCFG(6)),
|
|
dump_register(GUSB2PHYCFG(7)),
|
|
dump_register(GUSB2PHYCFG(8)),
|
|
dump_register(GUSB2PHYCFG(9)),
|
|
dump_register(GUSB2PHYCFG(10)),
|
|
dump_register(GUSB2PHYCFG(11)),
|
|
dump_register(GUSB2PHYCFG(12)),
|
|
dump_register(GUSB2PHYCFG(13)),
|
|
dump_register(GUSB2PHYCFG(14)),
|
|
dump_register(GUSB2PHYCFG(15)),
|
|
|
|
dump_register(GUSB2I2CCTL(0)),
|
|
dump_register(GUSB2I2CCTL(1)),
|
|
dump_register(GUSB2I2CCTL(2)),
|
|
dump_register(GUSB2I2CCTL(3)),
|
|
dump_register(GUSB2I2CCTL(4)),
|
|
dump_register(GUSB2I2CCTL(5)),
|
|
dump_register(GUSB2I2CCTL(6)),
|
|
dump_register(GUSB2I2CCTL(7)),
|
|
dump_register(GUSB2I2CCTL(8)),
|
|
dump_register(GUSB2I2CCTL(9)),
|
|
dump_register(GUSB2I2CCTL(10)),
|
|
dump_register(GUSB2I2CCTL(11)),
|
|
dump_register(GUSB2I2CCTL(12)),
|
|
dump_register(GUSB2I2CCTL(13)),
|
|
dump_register(GUSB2I2CCTL(14)),
|
|
dump_register(GUSB2I2CCTL(15)),
|
|
|
|
dump_register(GUSB2PHYACC(0)),
|
|
dump_register(GUSB2PHYACC(1)),
|
|
dump_register(GUSB2PHYACC(2)),
|
|
dump_register(GUSB2PHYACC(3)),
|
|
dump_register(GUSB2PHYACC(4)),
|
|
dump_register(GUSB2PHYACC(5)),
|
|
dump_register(GUSB2PHYACC(6)),
|
|
dump_register(GUSB2PHYACC(7)),
|
|
dump_register(GUSB2PHYACC(8)),
|
|
dump_register(GUSB2PHYACC(9)),
|
|
dump_register(GUSB2PHYACC(10)),
|
|
dump_register(GUSB2PHYACC(11)),
|
|
dump_register(GUSB2PHYACC(12)),
|
|
dump_register(GUSB2PHYACC(13)),
|
|
dump_register(GUSB2PHYACC(14)),
|
|
dump_register(GUSB2PHYACC(15)),
|
|
|
|
dump_register(GUSB3PIPECTL(0)),
|
|
dump_register(GUSB3PIPECTL(1)),
|
|
dump_register(GUSB3PIPECTL(2)),
|
|
dump_register(GUSB3PIPECTL(3)),
|
|
dump_register(GUSB3PIPECTL(4)),
|
|
dump_register(GUSB3PIPECTL(5)),
|
|
dump_register(GUSB3PIPECTL(6)),
|
|
dump_register(GUSB3PIPECTL(7)),
|
|
dump_register(GUSB3PIPECTL(8)),
|
|
dump_register(GUSB3PIPECTL(9)),
|
|
dump_register(GUSB3PIPECTL(10)),
|
|
dump_register(GUSB3PIPECTL(11)),
|
|
dump_register(GUSB3PIPECTL(12)),
|
|
dump_register(GUSB3PIPECTL(13)),
|
|
dump_register(GUSB3PIPECTL(14)),
|
|
dump_register(GUSB3PIPECTL(15)),
|
|
|
|
dump_register(GTXFIFOSIZ(0)),
|
|
dump_register(GTXFIFOSIZ(1)),
|
|
dump_register(GTXFIFOSIZ(2)),
|
|
dump_register(GTXFIFOSIZ(3)),
|
|
dump_register(GTXFIFOSIZ(4)),
|
|
dump_register(GTXFIFOSIZ(5)),
|
|
dump_register(GTXFIFOSIZ(6)),
|
|
dump_register(GTXFIFOSIZ(7)),
|
|
dump_register(GTXFIFOSIZ(8)),
|
|
dump_register(GTXFIFOSIZ(9)),
|
|
dump_register(GTXFIFOSIZ(10)),
|
|
dump_register(GTXFIFOSIZ(11)),
|
|
dump_register(GTXFIFOSIZ(12)),
|
|
dump_register(GTXFIFOSIZ(13)),
|
|
dump_register(GTXFIFOSIZ(14)),
|
|
dump_register(GTXFIFOSIZ(15)),
|
|
dump_register(GTXFIFOSIZ(16)),
|
|
dump_register(GTXFIFOSIZ(17)),
|
|
dump_register(GTXFIFOSIZ(18)),
|
|
dump_register(GTXFIFOSIZ(19)),
|
|
dump_register(GTXFIFOSIZ(20)),
|
|
dump_register(GTXFIFOSIZ(21)),
|
|
dump_register(GTXFIFOSIZ(22)),
|
|
dump_register(GTXFIFOSIZ(23)),
|
|
dump_register(GTXFIFOSIZ(24)),
|
|
dump_register(GTXFIFOSIZ(25)),
|
|
dump_register(GTXFIFOSIZ(26)),
|
|
dump_register(GTXFIFOSIZ(27)),
|
|
dump_register(GTXFIFOSIZ(28)),
|
|
dump_register(GTXFIFOSIZ(29)),
|
|
dump_register(GTXFIFOSIZ(30)),
|
|
dump_register(GTXFIFOSIZ(31)),
|
|
|
|
dump_register(GRXFIFOSIZ(0)),
|
|
dump_register(GRXFIFOSIZ(1)),
|
|
dump_register(GRXFIFOSIZ(2)),
|
|
dump_register(GRXFIFOSIZ(3)),
|
|
dump_register(GRXFIFOSIZ(4)),
|
|
dump_register(GRXFIFOSIZ(5)),
|
|
dump_register(GRXFIFOSIZ(6)),
|
|
dump_register(GRXFIFOSIZ(7)),
|
|
dump_register(GRXFIFOSIZ(8)),
|
|
dump_register(GRXFIFOSIZ(9)),
|
|
dump_register(GRXFIFOSIZ(10)),
|
|
dump_register(GRXFIFOSIZ(11)),
|
|
dump_register(GRXFIFOSIZ(12)),
|
|
dump_register(GRXFIFOSIZ(13)),
|
|
dump_register(GRXFIFOSIZ(14)),
|
|
dump_register(GRXFIFOSIZ(15)),
|
|
dump_register(GRXFIFOSIZ(16)),
|
|
dump_register(GRXFIFOSIZ(17)),
|
|
dump_register(GRXFIFOSIZ(18)),
|
|
dump_register(GRXFIFOSIZ(19)),
|
|
dump_register(GRXFIFOSIZ(20)),
|
|
dump_register(GRXFIFOSIZ(21)),
|
|
dump_register(GRXFIFOSIZ(22)),
|
|
dump_register(GRXFIFOSIZ(23)),
|
|
dump_register(GRXFIFOSIZ(24)),
|
|
dump_register(GRXFIFOSIZ(25)),
|
|
dump_register(GRXFIFOSIZ(26)),
|
|
dump_register(GRXFIFOSIZ(27)),
|
|
dump_register(GRXFIFOSIZ(28)),
|
|
dump_register(GRXFIFOSIZ(29)),
|
|
dump_register(GRXFIFOSIZ(30)),
|
|
dump_register(GRXFIFOSIZ(31)),
|
|
|
|
dump_register(GEVNTADRLO(0)),
|
|
dump_register(GEVNTADRHI(0)),
|
|
dump_register(GEVNTSIZ(0)),
|
|
dump_register(GEVNTCOUNT(0)),
|
|
|
|
dump_register(GHWPARAMS8),
|
|
dump_register(DCFG),
|
|
dump_register(DCTL),
|
|
dump_register(DEVTEN),
|
|
dump_register(DSTS),
|
|
dump_register(DGCMDPAR),
|
|
dump_register(DGCMD),
|
|
dump_register(DALEPENA),
|
|
|
|
dump_ep_register_set(0),
|
|
dump_ep_register_set(1),
|
|
dump_ep_register_set(2),
|
|
dump_ep_register_set(3),
|
|
dump_ep_register_set(4),
|
|
dump_ep_register_set(5),
|
|
dump_ep_register_set(6),
|
|
dump_ep_register_set(7),
|
|
dump_ep_register_set(8),
|
|
dump_ep_register_set(9),
|
|
dump_ep_register_set(10),
|
|
dump_ep_register_set(11),
|
|
dump_ep_register_set(12),
|
|
dump_ep_register_set(13),
|
|
dump_ep_register_set(14),
|
|
dump_ep_register_set(15),
|
|
dump_ep_register_set(16),
|
|
dump_ep_register_set(17),
|
|
dump_ep_register_set(18),
|
|
dump_ep_register_set(19),
|
|
dump_ep_register_set(20),
|
|
dump_ep_register_set(21),
|
|
dump_ep_register_set(22),
|
|
dump_ep_register_set(23),
|
|
dump_ep_register_set(24),
|
|
dump_ep_register_set(25),
|
|
dump_ep_register_set(26),
|
|
dump_ep_register_set(27),
|
|
dump_ep_register_set(28),
|
|
dump_ep_register_set(29),
|
|
dump_ep_register_set(30),
|
|
dump_ep_register_set(31),
|
|
|
|
dump_register(OCFG),
|
|
dump_register(OCTL),
|
|
dump_register(OEVT),
|
|
dump_register(OEVTEN),
|
|
dump_register(OSTS),
|
|
};
|
|
|
|
static void dwc3_host_lsp(struct seq_file *s)
|
|
{
|
|
struct dwc3 *dwc = s->private;
|
|
bool dbc_enabled;
|
|
u32 sel;
|
|
u32 reg;
|
|
u32 val;
|
|
|
|
dbc_enabled = !!(dwc->hwparams.hwparams1 & DWC3_GHWPARAMS1_ENDBC);
|
|
|
|
sel = dwc->dbg_lsp_select;
|
|
if (sel == DWC3_LSP_MUX_UNSELECTED) {
|
|
seq_puts(s, "Write LSP selection to print for host\n");
|
|
return;
|
|
}
|
|
|
|
reg = DWC3_GDBGLSPMUX_HOSTSELECT(sel);
|
|
|
|
dwc3_writel(dwc->regs, DWC3_GDBGLSPMUX, reg);
|
|
val = dwc3_readl(dwc->regs, DWC3_GDBGLSP);
|
|
seq_printf(s, "GDBGLSP[%d] = 0x%08x\n", sel, val);
|
|
|
|
if (dbc_enabled && sel < 256) {
|
|
reg |= DWC3_GDBGLSPMUX_ENDBC;
|
|
dwc3_writel(dwc->regs, DWC3_GDBGLSPMUX, reg);
|
|
val = dwc3_readl(dwc->regs, DWC3_GDBGLSP);
|
|
seq_printf(s, "GDBGLSP_DBC[%d] = 0x%08x\n", sel, val);
|
|
}
|
|
}
|
|
|
|
static void dwc3_gadget_lsp(struct seq_file *s)
|
|
{
|
|
struct dwc3 *dwc = s->private;
|
|
int i;
|
|
u32 reg;
|
|
|
|
for (i = 0; i < 16; i++) {
|
|
reg = DWC3_GDBGLSPMUX_DEVSELECT(i);
|
|
dwc3_writel(dwc->regs, DWC3_GDBGLSPMUX, reg);
|
|
reg = dwc3_readl(dwc->regs, DWC3_GDBGLSP);
|
|
seq_printf(s, "GDBGLSP[%d] = 0x%08x\n", i, reg);
|
|
}
|
|
}
|
|
|
|
static int dwc3_lsp_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3 *dwc = s->private;
|
|
unsigned int current_mode;
|
|
unsigned long flags;
|
|
u32 reg;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
reg = dwc3_readl(dwc->regs, DWC3_GSTS);
|
|
current_mode = DWC3_GSTS_CURMOD(reg);
|
|
|
|
switch (current_mode) {
|
|
case DWC3_GSTS_CURMOD_HOST:
|
|
dwc3_host_lsp(s);
|
|
break;
|
|
case DWC3_GSTS_CURMOD_DEVICE:
|
|
dwc3_gadget_lsp(s);
|
|
break;
|
|
default:
|
|
seq_puts(s, "Mode is unknown, no LSP register printed\n");
|
|
break;
|
|
}
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_lsp_open(struct inode *inode, struct file *file)
|
|
{
|
|
return single_open(file, dwc3_lsp_show, inode->i_private);
|
|
}
|
|
|
|
static ssize_t dwc3_lsp_write(struct file *file, const char __user *ubuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct seq_file *s = file->private_data;
|
|
struct dwc3 *dwc = s->private;
|
|
unsigned long flags;
|
|
char buf[32] = { 0 };
|
|
u32 sel;
|
|
int ret;
|
|
|
|
if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
|
|
return -EFAULT;
|
|
|
|
ret = kstrtouint(buf, 0, &sel);
|
|
if (ret)
|
|
return ret;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
dwc->dbg_lsp_select = sel;
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return count;
|
|
}
|
|
|
|
static const struct file_operations dwc3_lsp_fops = {
|
|
.open = dwc3_lsp_open,
|
|
.write = dwc3_lsp_write,
|
|
.read = seq_read,
|
|
.llseek = seq_lseek,
|
|
.release = single_release,
|
|
};
|
|
|
|
static int dwc3_mode_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3 *dwc = s->private;
|
|
unsigned long flags;
|
|
u32 reg;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
reg = dwc3_readl(dwc->regs, DWC3_GCTL);
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
switch (DWC3_GCTL_PRTCAP(reg)) {
|
|
case DWC3_GCTL_PRTCAP_HOST:
|
|
seq_puts(s, "host\n");
|
|
break;
|
|
case DWC3_GCTL_PRTCAP_DEVICE:
|
|
seq_puts(s, "device\n");
|
|
break;
|
|
case DWC3_GCTL_PRTCAP_OTG:
|
|
seq_puts(s, "otg\n");
|
|
break;
|
|
default:
|
|
seq_printf(s, "UNKNOWN %08x\n", DWC3_GCTL_PRTCAP(reg));
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_mode_open(struct inode *inode, struct file *file)
|
|
{
|
|
return single_open(file, dwc3_mode_show, inode->i_private);
|
|
}
|
|
|
|
static ssize_t dwc3_mode_write(struct file *file,
|
|
const char __user *ubuf, size_t count, loff_t *ppos)
|
|
{
|
|
struct seq_file *s = file->private_data;
|
|
struct dwc3 *dwc = s->private;
|
|
u32 mode = 0;
|
|
char buf[32];
|
|
|
|
if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
|
|
return -EFAULT;
|
|
|
|
if (dwc->dr_mode != USB_DR_MODE_OTG)
|
|
return count;
|
|
|
|
if (!strncmp(buf, "host", 4))
|
|
mode = DWC3_GCTL_PRTCAP_HOST;
|
|
|
|
if (!strncmp(buf, "device", 6))
|
|
mode = DWC3_GCTL_PRTCAP_DEVICE;
|
|
|
|
if (!strncmp(buf, "otg", 3))
|
|
mode = DWC3_GCTL_PRTCAP_OTG;
|
|
|
|
dwc3_set_mode(dwc, mode);
|
|
|
|
return count;
|
|
}
|
|
|
|
static const struct file_operations dwc3_mode_fops = {
|
|
.open = dwc3_mode_open,
|
|
.write = dwc3_mode_write,
|
|
.read = seq_read,
|
|
.llseek = seq_lseek,
|
|
.release = single_release,
|
|
};
|
|
|
|
static int dwc3_testmode_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3 *dwc = s->private;
|
|
unsigned long flags;
|
|
u32 reg;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
reg = dwc3_readl(dwc->regs, DWC3_DCTL);
|
|
reg &= DWC3_DCTL_TSTCTRL_MASK;
|
|
reg >>= 1;
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
switch (reg) {
|
|
case 0:
|
|
seq_puts(s, "no test\n");
|
|
break;
|
|
case USB_TEST_J:
|
|
seq_puts(s, "test_j\n");
|
|
break;
|
|
case USB_TEST_K:
|
|
seq_puts(s, "test_k\n");
|
|
break;
|
|
case USB_TEST_SE0_NAK:
|
|
seq_puts(s, "test_se0_nak\n");
|
|
break;
|
|
case USB_TEST_PACKET:
|
|
seq_puts(s, "test_packet\n");
|
|
break;
|
|
case USB_TEST_FORCE_ENABLE:
|
|
seq_puts(s, "test_force_enable\n");
|
|
break;
|
|
default:
|
|
seq_printf(s, "UNKNOWN %d\n", reg);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_testmode_open(struct inode *inode, struct file *file)
|
|
{
|
|
return single_open(file, dwc3_testmode_show, inode->i_private);
|
|
}
|
|
|
|
static ssize_t dwc3_testmode_write(struct file *file,
|
|
const char __user *ubuf, size_t count, loff_t *ppos)
|
|
{
|
|
struct seq_file *s = file->private_data;
|
|
struct dwc3 *dwc = s->private;
|
|
unsigned long flags;
|
|
u32 testmode = 0;
|
|
char buf[32];
|
|
|
|
if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
|
|
return -EFAULT;
|
|
|
|
if (!strncmp(buf, "test_j", 6))
|
|
testmode = USB_TEST_J;
|
|
else if (!strncmp(buf, "test_k", 6))
|
|
testmode = USB_TEST_K;
|
|
else if (!strncmp(buf, "test_se0_nak", 12))
|
|
testmode = USB_TEST_SE0_NAK;
|
|
else if (!strncmp(buf, "test_packet", 11))
|
|
testmode = USB_TEST_PACKET;
|
|
else if (!strncmp(buf, "test_force_enable", 17))
|
|
testmode = USB_TEST_FORCE_ENABLE;
|
|
else
|
|
testmode = 0;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
dwc3_gadget_set_test_mode(dwc, testmode);
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return count;
|
|
}
|
|
|
|
static const struct file_operations dwc3_testmode_fops = {
|
|
.open = dwc3_testmode_open,
|
|
.write = dwc3_testmode_write,
|
|
.read = seq_read,
|
|
.llseek = seq_lseek,
|
|
.release = single_release,
|
|
};
|
|
|
|
static int dwc3_link_state_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3 *dwc = s->private;
|
|
unsigned long flags;
|
|
enum dwc3_link_state state;
|
|
u32 reg;
|
|
u8 speed;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
reg = dwc3_readl(dwc->regs, DWC3_GSTS);
|
|
if (DWC3_GSTS_CURMOD(reg) != DWC3_GSTS_CURMOD_DEVICE) {
|
|
seq_puts(s, "Not available\n");
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
return 0;
|
|
}
|
|
|
|
reg = dwc3_readl(dwc->regs, DWC3_DSTS);
|
|
state = DWC3_DSTS_USBLNKST(reg);
|
|
speed = reg & DWC3_DSTS_CONNECTSPD;
|
|
|
|
seq_printf(s, "%s\n", (speed >= DWC3_DSTS_SUPERSPEED) ?
|
|
dwc3_gadget_link_string(state) :
|
|
dwc3_gadget_hs_link_string(state));
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_link_state_open(struct inode *inode, struct file *file)
|
|
{
|
|
return single_open(file, dwc3_link_state_show, inode->i_private);
|
|
}
|
|
|
|
static ssize_t dwc3_link_state_write(struct file *file,
|
|
const char __user *ubuf, size_t count, loff_t *ppos)
|
|
{
|
|
struct seq_file *s = file->private_data;
|
|
struct dwc3 *dwc = s->private;
|
|
unsigned long flags;
|
|
enum dwc3_link_state state = 0;
|
|
char buf[32];
|
|
u32 reg;
|
|
u8 speed;
|
|
|
|
if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
|
|
return -EFAULT;
|
|
|
|
if (!strncmp(buf, "SS.Disabled", 11))
|
|
state = DWC3_LINK_STATE_SS_DIS;
|
|
else if (!strncmp(buf, "Rx.Detect", 9))
|
|
state = DWC3_LINK_STATE_RX_DET;
|
|
else if (!strncmp(buf, "SS.Inactive", 11))
|
|
state = DWC3_LINK_STATE_SS_INACT;
|
|
else if (!strncmp(buf, "Recovery", 8))
|
|
state = DWC3_LINK_STATE_RECOV;
|
|
else if (!strncmp(buf, "Compliance", 10))
|
|
state = DWC3_LINK_STATE_CMPLY;
|
|
else if (!strncmp(buf, "Loopback", 8))
|
|
state = DWC3_LINK_STATE_LPBK;
|
|
else
|
|
return -EINVAL;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
reg = dwc3_readl(dwc->regs, DWC3_GSTS);
|
|
if (DWC3_GSTS_CURMOD(reg) != DWC3_GSTS_CURMOD_DEVICE) {
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
return -EINVAL;
|
|
}
|
|
|
|
reg = dwc3_readl(dwc->regs, DWC3_DSTS);
|
|
speed = reg & DWC3_DSTS_CONNECTSPD;
|
|
|
|
if (speed < DWC3_DSTS_SUPERSPEED &&
|
|
state != DWC3_LINK_STATE_RECOV) {
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
return -EINVAL;
|
|
}
|
|
|
|
dwc3_gadget_set_link_state(dwc, state);
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return count;
|
|
}
|
|
|
|
static const struct file_operations dwc3_link_state_fops = {
|
|
.open = dwc3_link_state_open,
|
|
.write = dwc3_link_state_write,
|
|
.read = seq_read,
|
|
.llseek = seq_lseek,
|
|
.release = single_release,
|
|
};
|
|
|
|
struct dwc3_ep_file_map {
|
|
const char name[25];
|
|
const struct file_operations *const fops;
|
|
};
|
|
|
|
static int dwc3_tx_fifo_size_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3_ep *dep = s->private;
|
|
struct dwc3 *dwc = dep->dwc;
|
|
unsigned long flags;
|
|
int mdwidth;
|
|
u32 val;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
val = dwc3_core_fifo_space(dep, DWC3_TXFIFO);
|
|
|
|
/* Convert to bytes */
|
|
mdwidth = DWC3_MDWIDTH(dwc->hwparams.hwparams0);
|
|
if (DWC3_IP_IS(DWC32))
|
|
mdwidth += DWC3_GHWPARAMS6_MDWIDTH(dwc->hwparams.hwparams6);
|
|
|
|
val *= mdwidth;
|
|
val >>= 3;
|
|
seq_printf(s, "%u\n", val);
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_rx_fifo_size_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3_ep *dep = s->private;
|
|
struct dwc3 *dwc = dep->dwc;
|
|
unsigned long flags;
|
|
int mdwidth;
|
|
u32 val;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
val = dwc3_core_fifo_space(dep, DWC3_RXFIFO);
|
|
|
|
/* Convert to bytes */
|
|
mdwidth = DWC3_MDWIDTH(dwc->hwparams.hwparams0);
|
|
if (DWC3_IP_IS(DWC32))
|
|
mdwidth += DWC3_GHWPARAMS6_MDWIDTH(dwc->hwparams.hwparams6);
|
|
|
|
val *= mdwidth;
|
|
val >>= 3;
|
|
seq_printf(s, "%u\n", val);
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_tx_request_queue_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3_ep *dep = s->private;
|
|
struct dwc3 *dwc = dep->dwc;
|
|
unsigned long flags;
|
|
u32 val;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
val = dwc3_core_fifo_space(dep, DWC3_TXREQQ);
|
|
seq_printf(s, "%u\n", val);
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_rx_request_queue_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3_ep *dep = s->private;
|
|
struct dwc3 *dwc = dep->dwc;
|
|
unsigned long flags;
|
|
u32 val;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
val = dwc3_core_fifo_space(dep, DWC3_RXREQQ);
|
|
seq_printf(s, "%u\n", val);
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_rx_info_queue_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3_ep *dep = s->private;
|
|
struct dwc3 *dwc = dep->dwc;
|
|
unsigned long flags;
|
|
u32 val;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
val = dwc3_core_fifo_space(dep, DWC3_RXINFOQ);
|
|
seq_printf(s, "%u\n", val);
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_descriptor_fetch_queue_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3_ep *dep = s->private;
|
|
struct dwc3 *dwc = dep->dwc;
|
|
unsigned long flags;
|
|
u32 val;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
val = dwc3_core_fifo_space(dep, DWC3_DESCFETCHQ);
|
|
seq_printf(s, "%u\n", val);
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_event_queue_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3_ep *dep = s->private;
|
|
struct dwc3 *dwc = dep->dwc;
|
|
unsigned long flags;
|
|
u32 val;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
val = dwc3_core_fifo_space(dep, DWC3_EVENTQ);
|
|
seq_printf(s, "%u\n", val);
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_transfer_type_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3_ep *dep = s->private;
|
|
struct dwc3 *dwc = dep->dwc;
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
if (!(dep->flags & DWC3_EP_ENABLED) || !dep->endpoint.desc) {
|
|
seq_puts(s, "--\n");
|
|
goto out;
|
|
}
|
|
|
|
switch (usb_endpoint_type(dep->endpoint.desc)) {
|
|
case USB_ENDPOINT_XFER_CONTROL:
|
|
seq_puts(s, "control\n");
|
|
break;
|
|
case USB_ENDPOINT_XFER_ISOC:
|
|
seq_puts(s, "isochronous\n");
|
|
break;
|
|
case USB_ENDPOINT_XFER_BULK:
|
|
seq_puts(s, "bulk\n");
|
|
break;
|
|
case USB_ENDPOINT_XFER_INT:
|
|
seq_puts(s, "interrupt\n");
|
|
break;
|
|
default:
|
|
seq_puts(s, "--\n");
|
|
}
|
|
|
|
out:
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_trb_ring_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3_ep *dep = s->private;
|
|
struct dwc3 *dwc = dep->dwc;
|
|
unsigned long flags;
|
|
int i;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
if (dep->number <= 1) {
|
|
seq_puts(s, "--\n");
|
|
goto out;
|
|
}
|
|
|
|
seq_puts(s, "buffer_addr,size,type,ioc,isp_imi,csp,chn,lst,hwo\n");
|
|
|
|
for (i = 0; i < DWC3_TRB_NUM; i++) {
|
|
struct dwc3_trb *trb = &dep->trb_pool[i];
|
|
unsigned int type = DWC3_TRBCTL_TYPE(trb->ctrl);
|
|
|
|
seq_printf(s, "%08x%08x,%d,%s,%d,%d,%d,%d,%d,%d %c%c\n",
|
|
trb->bph, trb->bpl, trb->size,
|
|
dwc3_trb_type_string(type),
|
|
!!(trb->ctrl & DWC3_TRB_CTRL_IOC),
|
|
!!(trb->ctrl & DWC3_TRB_CTRL_ISP_IMI),
|
|
!!(trb->ctrl & DWC3_TRB_CTRL_CSP),
|
|
!!(trb->ctrl & DWC3_TRB_CTRL_CHN),
|
|
!!(trb->ctrl & DWC3_TRB_CTRL_LST),
|
|
!!(trb->ctrl & DWC3_TRB_CTRL_HWO),
|
|
dep->trb_enqueue == i ? 'E' : ' ',
|
|
dep->trb_dequeue == i ? 'D' : ' ');
|
|
}
|
|
|
|
out:
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_ep_info_register_show(struct seq_file *s, void *unused)
|
|
{
|
|
struct dwc3_ep *dep = s->private;
|
|
struct dwc3 *dwc = dep->dwc;
|
|
unsigned long flags;
|
|
u64 ep_info;
|
|
u32 lower_32_bits;
|
|
u32 upper_32_bits;
|
|
u32 reg;
|
|
|
|
spin_lock_irqsave(&dwc->lock, flags);
|
|
reg = DWC3_GDBGLSPMUX_EPSELECT(dep->number);
|
|
dwc3_writel(dwc->regs, DWC3_GDBGLSPMUX, reg);
|
|
|
|
lower_32_bits = dwc3_readl(dwc->regs, DWC3_GDBGEPINFO0);
|
|
upper_32_bits = dwc3_readl(dwc->regs, DWC3_GDBGEPINFO1);
|
|
|
|
ep_info = ((u64)upper_32_bits << 32) | lower_32_bits;
|
|
seq_printf(s, "0x%016llx\n", ep_info);
|
|
spin_unlock_irqrestore(&dwc->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
DEFINE_SHOW_ATTRIBUTE(dwc3_tx_fifo_size);
|
|
DEFINE_SHOW_ATTRIBUTE(dwc3_rx_fifo_size);
|
|
DEFINE_SHOW_ATTRIBUTE(dwc3_tx_request_queue);
|
|
DEFINE_SHOW_ATTRIBUTE(dwc3_rx_request_queue);
|
|
DEFINE_SHOW_ATTRIBUTE(dwc3_rx_info_queue);
|
|
DEFINE_SHOW_ATTRIBUTE(dwc3_descriptor_fetch_queue);
|
|
DEFINE_SHOW_ATTRIBUTE(dwc3_event_queue);
|
|
DEFINE_SHOW_ATTRIBUTE(dwc3_transfer_type);
|
|
DEFINE_SHOW_ATTRIBUTE(dwc3_trb_ring);
|
|
DEFINE_SHOW_ATTRIBUTE(dwc3_ep_info_register);
|
|
|
|
static const struct dwc3_ep_file_map dwc3_ep_file_map[] = {
|
|
{ "tx_fifo_size", &dwc3_tx_fifo_size_fops, },
|
|
{ "rx_fifo_size", &dwc3_rx_fifo_size_fops, },
|
|
{ "tx_request_queue", &dwc3_tx_request_queue_fops, },
|
|
{ "rx_request_queue", &dwc3_rx_request_queue_fops, },
|
|
{ "rx_info_queue", &dwc3_rx_info_queue_fops, },
|
|
{ "descriptor_fetch_queue", &dwc3_descriptor_fetch_queue_fops, },
|
|
{ "event_queue", &dwc3_event_queue_fops, },
|
|
{ "transfer_type", &dwc3_transfer_type_fops, },
|
|
{ "trb_ring", &dwc3_trb_ring_fops, },
|
|
{ "GDBGEPINFO", &dwc3_ep_info_register_fops, },
|
|
};
|
|
|
|
static void dwc3_debugfs_create_endpoint_files(struct dwc3_ep *dep,
|
|
struct dentry *parent)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(dwc3_ep_file_map); i++) {
|
|
const struct file_operations *fops = dwc3_ep_file_map[i].fops;
|
|
const char *name = dwc3_ep_file_map[i].name;
|
|
|
|
debugfs_create_file(name, 0444, parent, dep, fops);
|
|
}
|
|
}
|
|
|
|
static void dwc3_debugfs_create_endpoint_dir(struct dwc3_ep *dep,
|
|
struct dentry *parent)
|
|
{
|
|
struct dentry *dir;
|
|
|
|
dir = debugfs_create_dir(dep->name, parent);
|
|
dwc3_debugfs_create_endpoint_files(dep, dir);
|
|
}
|
|
|
|
static void dwc3_debugfs_create_endpoint_dirs(struct dwc3 *dwc,
|
|
struct dentry *parent)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < dwc->num_eps; i++) {
|
|
struct dwc3_ep *dep = dwc->eps[i];
|
|
|
|
if (!dep)
|
|
continue;
|
|
|
|
dwc3_debugfs_create_endpoint_dir(dep, parent);
|
|
}
|
|
}
|
|
|
|
void dwc3_debugfs_init(struct dwc3 *dwc)
|
|
{
|
|
struct dentry *root;
|
|
|
|
dwc->regset = kzalloc(sizeof(*dwc->regset), GFP_KERNEL);
|
|
if (!dwc->regset)
|
|
return;
|
|
|
|
dwc->dbg_lsp_select = DWC3_LSP_MUX_UNSELECTED;
|
|
|
|
dwc->regset->regs = dwc3_regs;
|
|
dwc->regset->nregs = ARRAY_SIZE(dwc3_regs);
|
|
dwc->regset->base = dwc->regs - DWC3_GLOBALS_REGS_START;
|
|
|
|
root = debugfs_create_dir(dev_name(dwc->dev), usb_debug_root);
|
|
dwc->root = root;
|
|
|
|
debugfs_create_regset32("regdump", 0444, root, dwc->regset);
|
|
debugfs_create_file("lsp_dump", 0644, root, dwc, &dwc3_lsp_fops);
|
|
|
|
if (IS_ENABLED(CONFIG_USB_DWC3_DUAL_ROLE))
|
|
debugfs_create_file("mode", 0644, root, dwc,
|
|
&dwc3_mode_fops);
|
|
|
|
if (IS_ENABLED(CONFIG_USB_DWC3_DUAL_ROLE) ||
|
|
IS_ENABLED(CONFIG_USB_DWC3_GADGET)) {
|
|
debugfs_create_file("testmode", 0644, root, dwc,
|
|
&dwc3_testmode_fops);
|
|
debugfs_create_file("link_state", 0644, root, dwc,
|
|
&dwc3_link_state_fops);
|
|
dwc3_debugfs_create_endpoint_dirs(dwc, root);
|
|
}
|
|
}
|
|
|
|
void dwc3_debugfs_exit(struct dwc3 *dwc)
|
|
{
|
|
debugfs_remove_recursive(dwc->root);
|
|
kfree(dwc->regset);
|
|
}
|