[coreboot-gerrit] New patch to review for coreboot: 7b0358e usbdebug: Dump low-level protocol details

[Kyösti Mälkki]

Kyösti Mälkki ([e-mail]) just uploaded a new patch set to gerrit, which you can find at http://review.coreboot.org/3866

-gerrit

commit 7b0358e979c7065d8c40f749abf5a355f1bc587b
Author: Kyösti Mälkki 
Date:   Sat Aug 10 10:50:43 2013 +0300

usbdebug: Dump low-level protocol details

Dumping these EHCI host controller registers is useful to
    solve problems with debug devices.

Change-Id: I0610cecca57b1b952d4f87211dd00c8c0bc398b9
    Signed-off-by: Kyösti Mälkki 
---
 src/lib/usbdebug.c | 35 +++++++++++++++++++++++++++++++++++
 1 file changed, 35 insertions(+)

diff --git a/src/lib/usbdebug.c b/src/lib/usbdebug.c
index 6e60950..5f7a457 100644
--- a/src/lib/usbdebug.c
+++ b/src/lib/usbdebug.c
@@ -61,10 +61,12 @@ struct ehci_debug_info {
 };

#if CONFIG_DEBUG_USBDEBUG
+static void dbgp_print_data(struct ehci_dbg_port *ehci_debug);
 static int dbgp_enabled(void);
 # define dprintk(LEVEL, args...) \
    do { if (!dbgp_enabled()) printk(LEVEL, ##args); } while (0)
 #else
+# define dbgp_print_data(x)	do {} while(0)
 # define dprintk(LEVEL, args...)   do {} while(0)
 #endif

@@ -133,6 +135,9 @@ static int dbgp_wait_until_complete(struct ehci_dbg_port *ehci_debug)
    		break;
    } while (--loop > 0);

+	dprintk(BIOS_SPEW, "dbgp: godone (%d @ %4d) ctrl=%08x\n",
+		loop ? 0 : -1, 1000000-loop, ctrl);
+
    if (!loop)
    	return -1;

@@ -152,15 +157,24 @@ static int dbgp_wait_until_done(struct ehci_dbg_port *ehci_debug, struct dbgp_pi
    unsigned ctrl, int loop)
 {
    u32 rd_ctrl, rd_pids;
+	u32 ctrl_prev = 0, pids_prev = 0;
    u8 lpid;
    int ret;

+	dprintk(BIOS_SPEW, "dbgp:  start (0 @ %4d) ctrl=%08x\n", loop, ctrl | DBGP_GO);
 retry:
    write32((unsigned long)&ehci_debug->control, ctrl | DBGP_GO);
    ret = dbgp_wait_until_complete(ehci_debug);
    rd_ctrl = read32((unsigned long)&ehci_debug->control);
    rd_pids = read32((unsigned long)&ehci_debug->pids);

+	if (rd_ctrl != ctrl_prev || rd_pids != pids_prev) {
+		ctrl_prev = rd_ctrl;
+		pids_prev = rd_pids;
+		dprintk(BIOS_SPEW, "dbgp: status (%d @ %4d) ctrl=%08x pids=%08x\n",
+			ret, loop, rd_ctrl, rd_pids);
+	}
+
    if (ret < 0) {
    	if (ret == -DBGP_ERR_BAD && --loop > 0)
    		goto retry;
@@ -192,6 +206,8 @@ retry:
    	ret = -DBGP_ERR_BAD;
    }

+	dbgp_print_data(ehci_debug);
+
    return ret;
 }

@@ -224,6 +240,25 @@ static void dbgp_get_data(struct ehci_dbg_port *ehci_debug, void *buf, int size)
    	bytes[i] = (hi >> (8*(i - 4))) & 0xff;
 }

+#if CONFIG_DEBUG_USBDEBUG
+static void dbgp_print_data(struct ehci_dbg_port *ehci_debug)
+{
+	u32 ctrl = read32((unsigned long)&ehci_debug->control);
+	u32	lo = read32((unsigned long)&ehci_debug->data03);
+	u32	hi = read32((unsigned long)&ehci_debug->data47);
+	int len = DBGP_LEN(ctrl);
+	if (len) {
+		int i;
+		dprintk(BIOS_SPEW, "dbgp:    buf:");
+		for (i = 0; i < 4 && i < len; i++)
+			dprintk(BIOS_SPEW, " %02x", (lo >> (8*i)) & 0xff);
+		for (; i < 8 && i < len; i++)
+			dprintk(BIOS_SPEW, " %02x", (hi >> (8*(i - 4))) & 0xff);
+		dprintk(BIOS_SPEW, "\n");
+	}
+}
+#endif
+
 static int dbgp_bulk_write(struct ehci_dbg_port *ehci_debug, struct dbgp_pipe *pipe,
    const char *bytes, int size)
 {