diff --git a/common/serial.c b/common/serial.c index db577d1ad0..7ca65e14d2 100644 --- a/common/serial.c +++ b/common/serial.c @@ -79,6 +79,7 @@ serial_initfunc(ns9750_serial_initialize); serial_initfunc(oc_serial_initialize); serial_initfunc(s3c4510b_serial_initialize); serial_initfunc(s3c64xx_serial_initialize); +serial_initfunc(sandbox_serial_initialize); void serial_register(struct serial_device *dev) { @@ -136,6 +137,7 @@ void serial_initialize(void) oc_serial_initialize(); s3c4510b_serial_initialize(); s3c64xx_serial_initialize(); + sandbox_serial_initialize(); serial_assign(default_serial_console()->name); } diff --git a/drivers/serial/sandbox.c b/drivers/serial/sandbox.c index 1927c167bb..d60fbba23f 100644 --- a/drivers/serial/sandbox.c +++ b/drivers/serial/sandbox.c @@ -27,28 +27,30 @@ #include #include +#include +#include -int serial_init(void) +static int sandbox_serial_init(void) { os_tty_raw(0); return 0; } -void serial_setbrg(void) +static void sandbox_serial_setbrg(void) { } -void serial_putc(const char ch) +static void sandbox_serial_putc(const char ch) { os_write(1, &ch, 1); } -void serial_puts(const char *str) +static void sandbox_serial_puts(const char *str) { os_write(1, str, strlen(str)); } -int serial_getc(void) +static int sandbox_serial_getc(void) { char buf; ssize_t count; @@ -57,7 +59,60 @@ int serial_getc(void) return count == 1 ? buf : 0; } -int serial_tstc(void) +static int sandbox_serial_tstc(void) { return 0; } + +#ifdef CONFIG_SERIAL_MULTI +static struct serial_device sandbox_serial_drv = { + .name = "sandbox_serial", + .start = sandbox_serial_init, + .stop = NULL, + .setbrg = sandbox_serial_setbrg, + .putc = sandbox_serial_putc, + .puts = sandbox_serial_puts, + .getc = sandbox_serial_getc, + .tstc = sandbox_serial_tstc, +}; + +void sandbox_serial_initialize(void) +{ + serial_register(&sandbox_serial_drv); +} + +__weak struct serial_device *default_serial_console(void) +{ + return &sandbox_serial_drv; +} +#else +int serial_init(void) +{ + return sandbox_serial_init(); +} + +void serial_setbrg(void) +{ + sandbox_serial_setbrg(); +} + +void serial_putc(const char c) +{ + sandbox_serial_putc(c); +} + +void serial_puts(const char *s) +{ + sandbox_serial_puts(s); +} + +int serial_getc(void) +{ + return sandbox_serial_getc(); +} + +int serial_tstc(void) +{ + return sandbox_serial_tstc(); +} +#endif