diff options
| author | Nikita Shubin <n.shubin@yadro.com> | 2021-11-10 12:42:26 +0300 |
|---|---|---|
| committer | Anup Patel <anup@brainfault.org> | 2021-11-12 10:16:23 +0530 |
| commit | 1d462e039782e49d2a96a776e50b7478d87b228d (patch) | |
| tree | f63f3209c7e46941f76d1897bf71614b31638099 | |
| parent | 94eba23376b5324f012e8e035a341d6d2d625b27 (diff) | |
lib: utils/reset: separate driver init func
Move driver init code to separate function, so it can be reused
elsewhere.
Tested-by: Heinrich Schuchardt <heinrich.schuchardt@canonical.com>
Reviewed-by: Alexandre Ghiti <alexandre.ghiti@canonical.com>
Tested-by: Alexandre Ghiti <alexandre.ghiti@canonical.com>
Signed-off-by: Nikita Shubin <n.shubin@yadro.com>
| -rw-r--r-- | include/sbi_utils/reset/fdt_reset.h | 5 | ||||
| -rw-r--r-- | lib/utils/reset/fdt_reset.c | 37 |
2 files changed, 26 insertions, 16 deletions
diff --git a/include/sbi_utils/reset/fdt_reset.h b/include/sbi_utils/reset/fdt_reset.h index 46167b9..e7f7350 100644 --- a/include/sbi_utils/reset/fdt_reset.h +++ b/include/sbi_utils/reset/fdt_reset.h @@ -18,6 +18,11 @@ struct fdt_reset { }; /** + * fdt_reset_driver_init() - initialize reset driver based on the device-tree + */ +int fdt_reset_driver_init(void *fdt, struct fdt_reset *drv); + +/** * fdt_reset_init() - initialize reset drivers based on the device-tree * * This function shall be invoked in final init. diff --git a/lib/utils/reset/fdt_reset.c b/lib/utils/reset/fdt_reset.c index f4befa2..66281cb 100644 --- a/lib/utils/reset/fdt_reset.c +++ b/lib/utils/reset/fdt_reset.c @@ -29,26 +29,31 @@ static struct fdt_reset *reset_drivers[] = { &fdt_reset_thead, }; -void fdt_reset_init(void) +int fdt_reset_driver_init(void *fdt, struct fdt_reset *drv) { - int pos, noff, rc; - struct fdt_reset *drv; + int noff, rc = SBI_ENODEV; const struct fdt_match *match; - void *fdt = fdt_get_address(); - - for (pos = 0; pos < array_size(reset_drivers); pos++) { - drv = reset_drivers[pos]; - noff = fdt_find_match(fdt, -1, drv->match_table, &match); - if (noff < 0) - continue; + noff = fdt_find_match(fdt, -1, drv->match_table, &match); + if (noff < 0) + return SBI_ENODEV; - if (drv->init) { - rc = drv->init(fdt, noff, match); - if (rc && rc != SBI_ENODEV) { - sbi_printf("%s: %s init failed, %d\n", - __func__, match->compatible, rc); - } + if (drv->init) { + rc = drv->init(fdt, noff, match); + if (rc && rc != SBI_ENODEV) { + sbi_printf("%s: %s init failed, %d\n", + __func__, match->compatible, rc); } } + + return rc; +} + +void fdt_reset_init(void) +{ + int pos; + void *fdt = fdt_get_address(); + + for (pos = 0; pos < array_size(reset_drivers); pos++) + fdt_reset_driver_init(fdt, reset_drivers[pos]); } |