forked from Mirrors/opensbi
fa6dfce017
Indicate that this function does not modify the FDT blob, and deduplicate the call to fdt_get_address(). Signed-off-by: Samuel Holland <samuel.holland@sifive.com> Reviewed-by: Andrew Jones <ajones@ventanamicro.com> Reviewed-by: Anup Patel <anup@brainfault.org>
52 lines
1.1 KiB
C
52 lines
1.1 KiB
C
/*
|
|
* SPDX-License-Identifier: BSD-2-Clause
|
|
*
|
|
* Copyright (c) 2020 Western Digital Corporation or its affiliates.
|
|
*
|
|
* Authors:
|
|
* Anup Patel <anup.patel@wdc.com>
|
|
*/
|
|
|
|
#include <sbi/sbi_console.h>
|
|
#include <sbi/sbi_error.h>
|
|
#include <sbi/sbi_scratch.h>
|
|
#include <sbi_utils/fdt/fdt_helper.h>
|
|
#include <sbi_utils/reset/fdt_reset.h>
|
|
|
|
/* List of FDT reset drivers generated at compile time */
|
|
extern struct fdt_reset *fdt_reset_drivers[];
|
|
extern unsigned long fdt_reset_drivers_size;
|
|
|
|
int fdt_reset_driver_init(const void *fdt, struct fdt_reset *drv)
|
|
{
|
|
int noff, rc, cnt = 0;
|
|
const struct fdt_match *match;
|
|
|
|
noff = -1;
|
|
while ((noff = fdt_find_match(fdt, noff,
|
|
drv->match_table, &match)) >= 0) {
|
|
if (!fdt_node_is_enabled(fdt, noff))
|
|
continue;
|
|
|
|
if (drv->init) {
|
|
rc = drv->init(fdt, noff, match);
|
|
if (!rc)
|
|
cnt++;
|
|
else if (rc != SBI_ENODEV) {
|
|
sbi_printf("%s: %s init failed, %d\n",
|
|
__func__, match->compatible, rc);
|
|
}
|
|
}
|
|
}
|
|
|
|
return cnt > 0 ? 0 : SBI_ENODEV;
|
|
}
|
|
|
|
void fdt_reset_init(const void *fdt)
|
|
{
|
|
int pos;
|
|
|
|
for (pos = 0; pos < fdt_reset_drivers_size; pos++)
|
|
fdt_reset_driver_init(fdt, fdt_reset_drivers[pos]);
|
|
}
|