From 091463c1057f50b47156a138d7d1dbd09494a6d5 Mon Sep 17 00:00:00 2001 From: Kimplul Date: Mon, 11 Oct 2021 13:58:11 +0300 Subject: Moved some functions to common/ --- common/debug.c | 32 ++++++++++++++++++++++++++++++++ 1 file changed, 32 insertions(+) (limited to 'common/debug.c') diff --git a/common/debug.c b/common/debug.c index c82377c..523ae7b 100644 --- a/common/debug.c +++ b/common/debug.c @@ -1,6 +1,8 @@ #include #include #include +#include +#include #include #ifdef DEBUG @@ -56,6 +58,36 @@ static void __putchar(char c) port->data = c; } +static enum serial_dev_t serial_dev_enum(const char *dev_name) +{ + if (strncmp("ns16550", dev_name, 7) == 0) + return NS16550A; + + return -1; +} + +struct dbg_info_t dbg_from_fdt(void *fdt) +{ + int chosen_offset = fdt_path_offset(fdt, "/chosen"); + const char *stdout = fdt_getprop(fdt, chosen_offset, "stdout-path", NULL); + + int stdout_offset = fdt_path_offset(fdt, stdout); + + /* get serial device type */ + const char *dev_name = (const char *)fdt_getprop(fdt, stdout_offset, + "compatible", NULL); + + enum serial_dev_t dev = serial_dev_enum(dev_name); + + /* get serial device address */ + struct cell_info_t ci = get_reginfo(fdt, stdout); + void *reg_ptr = (void *)fdt_getprop(fdt, stdout_offset, "reg", NULL); + + void *dbg_ptr = (void *)(paddr_t)fdt_load_int_ptr(ci.addr_cells, reg_ptr); + + return (struct dbg_info_t){dbg_ptr, dev}; +} + void dbg_init(void *pt, enum serial_dev_t dev) { switch (dev) { -- cgit v1.3