diff --git a/lib/utils/timer/fdt_timer.c b/lib/utils/timer/fdt_timer.c index 46edb83a..d1d0e0ce 100644 --- a/lib/utils/timer/fdt_timer.c +++ b/lib/utils/timer/fdt_timer.c @@ -80,17 +80,19 @@ static int fdt_timer_cold_init(void) for (pos = 0; pos < array_size(timer_drivers); pos++) { drv = timer_drivers[pos]; - noff = fdt_find_match(fdt, -1, drv->match_table, &match); - if (noff < 0) - continue; - - if (drv->cold_init) { - rc = drv->cold_init(fdt, noff, match); - if (rc) - return rc; + noff = -1; + while ((noff = fdt_find_match(fdt, noff, + drv->match_table, &match)) >= 0) { + if (drv->cold_init) { + rc = drv->cold_init(fdt, noff, match); + if (rc) + return rc; + } + current_driver = drv; } - current_driver = drv; - break; + + if (current_driver != &dummy) + break; } return 0; diff --git a/lib/utils/timer/fdt_timer_clint.c b/lib/utils/timer/fdt_timer_clint.c index 85779b78..fe667086 100644 --- a/lib/utils/timer/fdt_timer_clint.c +++ b/lib/utils/timer/fdt_timer_clint.c @@ -7,22 +7,33 @@ * Anup Patel */ +#include #include #include #include -static struct clint_data clint_timer; +#define CLINT_TIMER_MAX_NR 16 + +static unsigned long clint_timer_count = 0; +static struct clint_data clint_timer[CLINT_TIMER_MAX_NR]; static int timer_clint_cold_init(void *fdt, int nodeoff, const struct fdt_match *match) { int rc; + struct clint_data *ct, *ctmaster = NULL; - rc = fdt_parse_clint_node(fdt, nodeoff, TRUE, &clint_timer); + if (CLINT_TIMER_MAX_NR <= clint_timer_count) + return SBI_ENOSPC; + ct = &clint_timer[clint_timer_count++]; + if (1 < clint_timer_count) + ctmaster = &clint_timer[0]; + + rc = fdt_parse_clint_node(fdt, nodeoff, TRUE, ct); if (rc) return rc; - return clint_cold_timer_init(&clint_timer, NULL); + return clint_cold_timer_init(ct, ctmaster); } static const struct fdt_match timer_clint_match[] = {