diff options
Diffstat (limited to 'src/console')
| -rw-r--r-- | src/console/Config.lb | 4 | ||||
| -rw-r--r-- | src/console/usbdebug_direct_console.c | 58 |
2 files changed, 62 insertions, 0 deletions
diff --git a/src/console/Config.lb b/src/console/Config.lb index daba367f94..7a1672e494 100644 --- a/src/console/Config.lb +++ b/src/console/Config.lb @@ -1,4 +1,5 @@ uses CONFIG_CONSOLE_SERIAL8250 +uses CONFIG_USBDEBUG_DIRECT uses CONFIG_CONSOLE_VGA uses CONFIG_CONSOLE_BTEXT uses CONFIG_CONSOLE_LOGBUF @@ -9,6 +10,9 @@ object printk.o if CONFIG_CONSOLE_SERIAL8250 driver uart8250_console.o end +if CONFIG_USBDEBUG_DIRECT + driver usbdebug_direct_console.o +end if CONFIG_CONSOLE_VGA driver vga_console.o end diff --git a/src/console/usbdebug_direct_console.c b/src/console/usbdebug_direct_console.c new file mode 100644 index 0000000000..172d5c8b55 --- /dev/null +++ b/src/console/usbdebug_direct_console.c @@ -0,0 +1,58 @@ +#include <console/console.h> +#include <usbdebug_direct.h> +#include <pc80/mc146818rtc.h> + +struct ehci_debug_info dbg_info; + +void set_ehci_base(unsigned ehci_base) +{ + unsigned diff; + if(!dbg_info.ehci_debug) return; + diff = dbg_info.ehci_caps - ehci_base; + dbg_info.ehci_regs -= diff; + dbg_info.ehci_debug -= diff; + dbg_info.ehci_caps = ehci_base; +} +void set_ehci_debug(unsigned ehci_debug) +{ + dbg_info.ehci_debug = ehci_debug; +} + +unsigned get_ehci_debug(void) +{ + return dbg_info.ehci_debug; +} + +static void dbgp_init(void) +{ + struct ehci_debug_info *dbg_infox; + dbg_infox = (struct ehci_debug_info *)((CONFIG_LB_MEM_TOPK<<10) - sizeof (struct ehci_debug_info)); //in RAM + memcpy(&dbg_info, dbg_infox, sizeof(struct ehci_debug_info) ); +} + +static void dbgp_tx_byte(unsigned char data) +{ + if(dbg_info.ehci_debug) + dbgp_bulk_write_x(&dbg_info,&data,1); +} + +static unsigned char dbgp_rx_byte(void) +{ + unsigned char data = 0xff; + if(dbg_info.ehci_debug) + dbgp_bulk_read_x(&dbg_info,&data,1); + return data; +} + +static int dbgp_tst_byte(void) +{ + return dbg_info.ehci_debug; +} + +static struct console_driver usbdebug_direct_console __console = { + .init = dbgp_init, + .tx_byte = dbgp_tx_byte, + .rx_byte = dbgp_rx_byte, + .tst_byte = dbgp_tst_byte, +}; + |