forked from Mirrors/opensbi
lib: utils/serial: Use fdt_driver for initialization
The serial driver subsystem does not need any extra data, so it can use `struct fdt_driver` directly. The generic fdt_serial_init() first attempts to match the chosen stdout device, and upon failure matches the first available serial device in the DT. It is a fatal error if no such device is found. This matches the behavior of fdt_driver_init_one(). Signed-off-by: Samuel Holland <samuel.holland@sifive.com> Reviewed-by: Anup Patel <anup@brainfault.org>
This commit is contained in:

committed by
Anup Patel

parent
6d9ad492db
commit
a524f0a507
@@ -11,14 +11,10 @@
|
|||||||
#define __FDT_SERIAL_H__
|
#define __FDT_SERIAL_H__
|
||||||
|
|
||||||
#include <sbi/sbi_types.h>
|
#include <sbi/sbi_types.h>
|
||||||
|
#include <sbi_utils/fdt/fdt_driver.h>
|
||||||
|
|
||||||
#ifdef CONFIG_FDT_SERIAL
|
#ifdef CONFIG_FDT_SERIAL
|
||||||
|
|
||||||
struct fdt_serial {
|
|
||||||
const struct fdt_match *match_table;
|
|
||||||
int (*init)(const void *fdt, int nodeoff, const struct fdt_match *match);
|
|
||||||
};
|
|
||||||
|
|
||||||
int fdt_serial_init(const void *fdt);
|
int fdt_serial_init(const void *fdt);
|
||||||
|
|
||||||
#else
|
#else
|
||||||
|
@@ -9,19 +9,16 @@
|
|||||||
|
|
||||||
#include <libfdt.h>
|
#include <libfdt.h>
|
||||||
#include <sbi/sbi_error.h>
|
#include <sbi/sbi_error.h>
|
||||||
#include <sbi/sbi_scratch.h>
|
|
||||||
#include <sbi_utils/fdt/fdt_helper.h>
|
#include <sbi_utils/fdt/fdt_helper.h>
|
||||||
#include <sbi_utils/serial/fdt_serial.h>
|
#include <sbi_utils/serial/fdt_serial.h>
|
||||||
|
|
||||||
/* List of FDT serial drivers generated at compile time */
|
/* List of FDT serial drivers generated at compile time */
|
||||||
extern struct fdt_serial *const fdt_serial_drivers[];
|
extern const struct fdt_driver *const fdt_serial_drivers[];
|
||||||
|
|
||||||
int fdt_serial_init(const void *fdt)
|
int fdt_serial_init(const void *fdt)
|
||||||
{
|
{
|
||||||
const void *prop;
|
const void *prop;
|
||||||
struct fdt_serial *drv;
|
int noff = -1, len, coff, rc;
|
||||||
const struct fdt_match *match;
|
|
||||||
int pos, noff = -1, len, coff, rc;
|
|
||||||
|
|
||||||
/* Find offset of node pointed to by stdout-path */
|
/* Find offset of node pointed to by stdout-path */
|
||||||
coff = fdt_path_offset(fdt, "/chosen");
|
coff = fdt_path_offset(fdt, "/chosen");
|
||||||
@@ -38,50 +35,15 @@ int fdt_serial_init(const void *fdt)
|
|||||||
else
|
else
|
||||||
noff = fdt_path_offset(fdt, prop);
|
noff = fdt_path_offset(fdt, prop);
|
||||||
}
|
}
|
||||||
if (-1 < noff) {
|
|
||||||
if (!fdt_node_is_enabled(fdt, noff))
|
|
||||||
noff = -1;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/* First check DT node pointed by stdout-path */
|
/* First check DT node pointed by stdout-path */
|
||||||
for (pos = 0; fdt_serial_drivers[pos] && -1 < noff; pos++) {
|
if (-1 < noff) {
|
||||||
drv = fdt_serial_drivers[pos];
|
rc = fdt_driver_init_by_offset(fdt, noff, fdt_serial_drivers);
|
||||||
|
if (rc != SBI_ENODEV)
|
||||||
match = fdt_match_node(fdt, noff, drv->match_table);
|
return rc;
|
||||||
if (!match)
|
|
||||||
continue;
|
|
||||||
|
|
||||||
/* drv->init must not be NULL */
|
|
||||||
if (drv->init == NULL)
|
|
||||||
return SBI_EFAIL;
|
|
||||||
|
|
||||||
rc = drv->init(fdt, noff, match);
|
|
||||||
if (rc == SBI_ENODEV)
|
|
||||||
continue;
|
|
||||||
return rc;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Lastly check all DT nodes */
|
/* Lastly check all DT nodes */
|
||||||
for (pos = 0; fdt_serial_drivers[pos]; pos++) {
|
return fdt_driver_init_one(fdt, fdt_serial_drivers);
|
||||||
drv = fdt_serial_drivers[pos];
|
|
||||||
|
|
||||||
noff = -1;
|
|
||||||
while ((noff = fdt_find_match(fdt, noff,
|
|
||||||
drv->match_table, &match)) >= 0) {
|
|
||||||
if (!fdt_node_is_enabled(fdt, noff))
|
|
||||||
continue;
|
|
||||||
|
|
||||||
/* drv->init must not be NULL */
|
|
||||||
if (drv->init == NULL)
|
|
||||||
return SBI_EFAIL;
|
|
||||||
|
|
||||||
rc = drv->init(fdt, noff, match);
|
|
||||||
if (rc == SBI_ENODEV)
|
|
||||||
continue;
|
|
||||||
return rc;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return SBI_ENODEV;
|
|
||||||
}
|
}
|
||||||
|
@@ -30,7 +30,7 @@ static const struct fdt_match serial_cadence_match[] = {
|
|||||||
{ },
|
{ },
|
||||||
};
|
};
|
||||||
|
|
||||||
struct fdt_serial fdt_serial_cadence = {
|
const struct fdt_driver fdt_serial_cadence = {
|
||||||
.match_table = serial_cadence_match,
|
.match_table = serial_cadence_match,
|
||||||
.init = serial_cadence_init
|
.init = serial_cadence_init
|
||||||
};
|
};
|
||||||
|
@@ -1,3 +1,3 @@
|
|||||||
HEADER: sbi_utils/serial/fdt_serial.h
|
HEADER: sbi_utils/serial/fdt_serial.h
|
||||||
TYPE: struct fdt_serial
|
TYPE: const struct fdt_driver
|
||||||
NAME: fdt_serial_drivers
|
NAME: fdt_serial_drivers
|
||||||
|
@@ -29,7 +29,7 @@ static const struct fdt_match serial_gaisler_match[] = {
|
|||||||
{},
|
{},
|
||||||
};
|
};
|
||||||
|
|
||||||
struct fdt_serial fdt_serial_gaisler = {
|
const struct fdt_driver fdt_serial_gaisler = {
|
||||||
.match_table = serial_gaisler_match,
|
.match_table = serial_gaisler_match,
|
||||||
.init = serial_gaisler_init
|
.init = serial_gaisler_init
|
||||||
};
|
};
|
||||||
|
@@ -41,7 +41,7 @@ static int serial_htif_init(const void *fdt, int nodeoff,
|
|||||||
return htif_serial_init(custom, fromhost_addr, tohost_addr);
|
return htif_serial_init(custom, fromhost_addr, tohost_addr);
|
||||||
}
|
}
|
||||||
|
|
||||||
struct fdt_serial fdt_serial_htif = {
|
const struct fdt_driver fdt_serial_htif = {
|
||||||
.match_table = serial_htif_match,
|
.match_table = serial_htif_match,
|
||||||
.init = serial_htif_init
|
.init = serial_htif_init
|
||||||
};
|
};
|
||||||
|
@@ -33,7 +33,7 @@ static const struct fdt_match serial_litex_match[] = {
|
|||||||
{ },
|
{ },
|
||||||
};
|
};
|
||||||
|
|
||||||
struct fdt_serial fdt_serial_litex = {
|
const struct fdt_driver fdt_serial_litex = {
|
||||||
.match_table = serial_litex_match,
|
.match_table = serial_litex_match,
|
||||||
.init = serial_litex_init
|
.init = serial_litex_init
|
||||||
};
|
};
|
||||||
|
@@ -25,7 +25,7 @@ static const struct fdt_match serial_renesas_scif_match[] = {
|
|||||||
{ /* sentinel */ }
|
{ /* sentinel */ }
|
||||||
};
|
};
|
||||||
|
|
||||||
struct fdt_serial fdt_serial_renesas_scif = {
|
const struct fdt_driver fdt_serial_renesas_scif = {
|
||||||
.match_table = serial_renesas_scif_match,
|
.match_table = serial_renesas_scif_match,
|
||||||
.init = serial_renesas_scif_init
|
.init = serial_renesas_scif_init
|
||||||
};
|
};
|
||||||
|
@@ -27,7 +27,7 @@ static const struct fdt_match serial_shakti_match[] = {
|
|||||||
{ },
|
{ },
|
||||||
};
|
};
|
||||||
|
|
||||||
struct fdt_serial fdt_serial_shakti = {
|
const struct fdt_driver fdt_serial_shakti = {
|
||||||
.match_table = serial_shakti_match,
|
.match_table = serial_shakti_match,
|
||||||
.init = serial_shakti_init
|
.init = serial_shakti_init
|
||||||
};
|
};
|
||||||
|
@@ -30,7 +30,7 @@ static const struct fdt_match serial_sifive_match[] = {
|
|||||||
{ },
|
{ },
|
||||||
};
|
};
|
||||||
|
|
||||||
struct fdt_serial fdt_serial_sifive = {
|
const struct fdt_driver fdt_serial_sifive = {
|
||||||
.match_table = serial_sifive_match,
|
.match_table = serial_sifive_match,
|
||||||
.init = serial_sifive_init
|
.init = serial_sifive_init
|
||||||
};
|
};
|
||||||
|
@@ -33,7 +33,7 @@ static const struct fdt_match serial_uart8250_match[] = {
|
|||||||
{ },
|
{ },
|
||||||
};
|
};
|
||||||
|
|
||||||
struct fdt_serial fdt_serial_uart8250 = {
|
const struct fdt_driver fdt_serial_uart8250 = {
|
||||||
.match_table = serial_uart8250_match,
|
.match_table = serial_uart8250_match,
|
||||||
.init = serial_uart8250_init,
|
.init = serial_uart8250_init,
|
||||||
};
|
};
|
||||||
|
@@ -29,7 +29,7 @@ static const struct fdt_match serial_xlnx_uartlite_match[] = {
|
|||||||
{ },
|
{ },
|
||||||
};
|
};
|
||||||
|
|
||||||
struct fdt_serial fdt_serial_xlnx_uartlite = {
|
const struct fdt_driver fdt_serial_xlnx_uartlite = {
|
||||||
.match_table = serial_xlnx_uartlite_match,
|
.match_table = serial_xlnx_uartlite_match,
|
||||||
.init = serial_xlnx_uartlite_init,
|
.init = serial_xlnx_uartlite_init,
|
||||||
};
|
};
|
||||||
|
Reference in New Issue
Block a user